Revision 1246
Implemented all robot sensor dump functions
dump_robot.c | ||
---|---|---|
21 | 21 |
usb_puts (NL); |
22 | 22 |
} |
23 | 23 |
} |
24 |
|
|
25 |
void dump_robot_rangefinders (void) |
|
26 |
{ |
|
27 |
uint16_t rf; |
|
28 |
char c; |
|
29 |
|
|
30 |
while (usb_getc_nb (&c)==-1) |
|
31 |
{ |
|
32 |
for (uint8_t i=0; i<5; ++i) |
|
33 |
{ |
|
34 |
robot_read_rangefinder (i, &rf); |
|
35 |
if (i!=0) usb_puts (" "); |
|
36 |
usb_puti (rf); |
|
37 |
} |
|
38 |
usb_puts (NL); |
|
39 |
} |
|
40 |
} |
|
41 |
|
|
42 |
void dump_robot_bom (void) |
|
43 |
{ |
|
44 |
uint16_t bom; |
|
45 |
char c; |
|
46 |
|
|
47 |
while (usb_getc_nb (&c)==-1) |
|
48 |
{ |
|
49 |
for (uint8_t i=0; i<16; ++i) |
|
50 |
{ |
|
51 |
robot_read_rangefinder (i, &bom); |
|
52 |
if (i!=0) usb_puts (" "); |
|
53 |
usb_puti (bom); |
|
54 |
} |
|
55 |
usb_puts (NL); |
|
56 |
} |
|
57 |
} |
Also available in: Unified diff