root / trunk / code / projects / diagnostic_station / station / test_rangefinders.c @ 1202
History | View | Annotate | Download (572 Bytes)
1 |
#include "test_rangefinders.h" |
---|---|
2 |
#include "global.h" |
3 |
|
4 |
#include "comm_robot.h" |
5 |
|
6 |
|
7 |
void test_rangefinder (uint8_t num)
|
8 |
{ |
9 |
if (num>4) return; |
10 |
|
11 |
usb_puts("# Testing rangefinder ");
|
12 |
usb_puti(num); |
13 |
usb_puts(NL); |
14 |
|
15 |
// rotate to position
|
16 |
//
|
17 |
// for (wall positions up/down)
|
18 |
// {
|
19 |
// set wall position
|
20 |
// send (read)
|
21 |
// receive (data)
|
22 |
// }
|
23 |
//send data
|
24 |
} |
25 |
|
26 |
|
27 |
void test_rangefinder_all (void) |
28 |
{ |
29 |
usb_puts("# Testing rangefinders" NL);
|
30 |
|
31 |
for (int n=0; n<5; ++n) |
32 |
test_rangefinder (n); |
33 |
|
34 |
usb_puts("# Testing rangefinders finished" NL);
|
35 |
} |