root / trunk / code / projects / diagnostic_station / station / dump_robot.c @ 1295
History | View | Annotate | Download (1.32 KB)
1 | 1244 | deffi | #include "dump_robot.h" |
---|---|---|---|
2 | |||
3 | #include <dragonfly_lib.h> |
||
4 | |||
5 | #include "global.h" |
||
6 | #include "comm_robot.h" |
||
7 | |||
8 | |||
9 | void dump_robot_encoders (void) |
||
10 | { |
||
11 | int16_t left, right; |
||
12 | char c;
|
||
13 | |||
14 | 1293 | deffi | robot_reset_encoders (); |
15 | |||
16 | 1244 | deffi | while (usb_getc_nb (&c)==-1) |
17 | { |
||
18 | robot_read_encoders (&left, &right); |
||
19 | 1269 | deffi | |
20 | usb_puts ("Left: "); usb_puti (left ); usb_puts (NL);
|
||
21 | usb_puts ("Right: "); usb_puti (right); usb_puts (NL);
|
||
22 | usb_puts (NL NL); |
||
23 | 1244 | deffi | } |
24 | } |
||
25 | 1246 | deffi | |
26 | void dump_robot_rangefinders (void) |
||
27 | { |
||
28 | 1269 | deffi | uint16_t rf[5];
|
29 | 1246 | deffi | char c;
|
30 | |||
31 | while (usb_getc_nb (&c)==-1) |
||
32 | { |
||
33 | 1269 | deffi | // First read all of the values, then print them, because it's much more readable that way.
|
34 | |||
35 | 1246 | deffi | for (uint8_t i=0; i<5; ++i) |
36 | { |
||
37 | 1269 | deffi | robot_read_rangefinder (i, &rf[i]); |
38 | 1246 | deffi | } |
39 | 1269 | deffi | |
40 | for (uint8_t i=0; i<5; ++i) |
||
41 | { |
||
42 | usb_puti (i); |
||
43 | usb_puts (": ");
|
||
44 | usb_puti (rf[i]); |
||
45 | usb_puts (NL); |
||
46 | } |
||
47 | |||
48 | usb_puts (NL NL); |
||
49 | 1246 | deffi | } |
50 | } |
||
51 | |||
52 | void dump_robot_bom (void) |
||
53 | { |
||
54 | 1282 | deffi | int16_t bom[16];
|
55 | 1246 | deffi | char c;
|
56 | 1269 | deffi | |
57 | 1246 | deffi | while (usb_getc_nb (&c)==-1) |
58 | { |
||
59 | 1269 | deffi | // First read all of the values, then print them, because it's much more readable that way.
|
60 | |||
61 | 1282 | deffi | //for (uint8_t i=0; i<16; ++i)
|
62 | //robot_read_bom (i, &bom[i]);
|
||
63 | |||
64 | robot_read_bom_all (bom); |
||
65 | 1269 | deffi | |
66 | for (uint8_t i=0; i<16; ++i) |
||
67 | 1246 | deffi | { |
68 | 1269 | deffi | if (i<10) usb_puts (" "); |
69 | usb_puti (i); |
||
70 | usb_puts (": ");
|
||
71 | usb_puti (bom[i]); |
||
72 | usb_puts (NL); |
||
73 | 1246 | deffi | } |
74 | 1269 | deffi | usb_puts (NL NL); |
75 | 1246 | deffi | } |
76 | } |