qi-hardware/ben-wpan
1
0
Fork 0
mirror of git://projects.qi-hardware.com/ben-wpan.git synced 2024-10-04 05:54:09 +03:00
Code

tools/atrf-gpio/atusb.c: if ATUSB_GPIO fails, show the attempted setting

Browse Source 
- atusb.c (dump_port, gpio): dump the attempted setting if ATUSB_GPIO
  fails (assuming it is that setting that caused the failure)
This commit is contained in:
Werner Almesberger 2011-06-05 21:32:14 -03:00
parent 1a3f169e89
commit a73a8a2044
1 changed files with 16 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
tools/atrf-gpio/atusb.c
View File

@ -39,6 +39,21 @@ static struct atrf_dsc *orig_dsc;
static uint8_t orig_data[3], orig_dir[3];
static void dump_port(int port, uint8_t data, uint8_t dir, uint8_t mask)
{
int i;
fprintf(stderr, "name\t\tcfg\n");
for (i = 0; i != 8; i++) {
int bit = 1 << (i & 7);
fprintf(stderr, "%-16s%c\n", name[port*8+i],
mask & bit ? dir & bit ? data & bit ? '1' : '0' :
data & bit ? 'R' : 'Z' : 'x');
}
}
static uint8_t gpio(struct atrf_dsc *dsc,
uint8_t port, uint8_t *data, uint8_t *dir, uint8_t mask)
{
@ -49,6 +64,7 @@ static uint8_t gpio(struct atrf_dsc *dsc,
FROM_DEV, ATUSB_GPIO, *dir << 8 | *data, mask << 8 | port,
(void *) buf, sizeof(buf), 1000);
if (res < 0) {
dump_port(port-1, *data, *dir, mask);
fprintf(stderr, "ATUSB_GPIO: %s\n", usb_strerror());
exit(1);
}