uhd/host/apps/omap_debug/usrp-e-debug-pins.c

77 lines
1.6 KiB
C

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/types.h>
#include <fcntl.h>
#include <string.h>
#include <sys/ioctl.h>
#include "usrp_e.h"
#include "usrp_e_regs.hpp"
// Usage: usrp_e_gpio <string>
static int fp;
static int read_reg(__u16 reg)
{
int ret;
struct usrp_e_ctl16 d;
d.offset = reg;
d.count = 1;
ret = ioctl(fp, USRP_E_READ_CTL16, &d);
return d.buf[0];
}
static void write_reg(__u16 reg, __u16 val)
{
int ret;
struct usrp_e_ctl16 d;
d.offset = reg;
d.count = 1;
d.buf[0] = val;
ret = ioctl(fp, USRP_E_WRITE_CTL16, &d);
}
int main(int argc, char *argv[])
{
int test;
test = 0;
if (argc < 2) {
printf("%s 0|1|off\n", argv[0]);
}
fp = open("/dev/usrp_e0", O_RDWR);
printf("fp = %d\n", fp);
if (fp < 0) {
perror("Open failed");
return -1;
}
if (strcmp(argv[1], "0") == 0) {
printf("Selected 0 based on %s\n", argv[1]);
write_reg(UE_REG_GPIO_TX_DDR, 0xFFFF);
write_reg(UE_REG_GPIO_RX_DDR, 0xFFFF);
write_reg(UE_REG_GPIO_TX_SEL, 0x0);
write_reg(UE_REG_GPIO_RX_SEL, 0x0);
write_reg(UE_REG_GPIO_TX_DBG, 0xFFFF);
write_reg(UE_REG_GPIO_RX_DBG, 0xFFFF);
} else if (strcmp(argv[1], "1") == 0) {
printf("Selected 1 based on %s\n", argv[1]);
write_reg(UE_REG_GPIO_TX_DDR, 0xFFFF);
write_reg(UE_REG_GPIO_RX_DDR, 0xFFFF);
write_reg(UE_REG_GPIO_TX_SEL, 0xFFFF);
write_reg(UE_REG_GPIO_RX_SEL, 0xFFFF);
write_reg(UE_REG_GPIO_TX_DBG, 0xFFFF);
write_reg(UE_REG_GPIO_RX_DBG, 0xFFFF);
} else {
printf("Selected off based on %s\n", argv[1]);
write_reg(UE_REG_GPIO_TX_DDR, 0x0);
write_reg(UE_REG_GPIO_RX_DDR, 0x0);
}
return 0;
}