root / trunk / code / projects / unit_tests / test_ir.c @ 1837
History | View | Annotate | Download (1.07 KB)
1 |
#include <dragonfly_lib.h> |
---|---|
2 |
|
3 |
#define TEST_PORT 3 |
4 |
#define TEST_ALL 1 |
5 |
#define TEST_INDIV 0 |
6 |
|
7 |
int testir(void) |
8 |
{ |
9 |
analog_init(0);
|
10 |
int port;
|
11 |
int ports[] = {13, 12, 3, 2, 9, 8, 1}; |
12 |
// analog_init(ADC_START);
|
13 |
// usb_puti(analog_loop_status());
|
14 |
|
15 |
if(TEST_ALL)
|
16 |
{ |
17 |
if(TEST_INDIV)
|
18 |
{ |
19 |
while(1) |
20 |
{ |
21 |
for(port = 0; port <5; port++) |
22 |
{ |
23 |
usb_puti(analog_get10(ports[port])); |
24 |
usb_putc('\t');
|
25 |
} |
26 |
|
27 |
for(port = 5; port <7; port++) |
28 |
{ |
29 |
usb_puti(analog_get10(ports[port])); |
30 |
usb_putc('\t');
|
31 |
} |
32 |
usb_putc('\n');
|
33 |
delay_ms(50);
|
34 |
} |
35 |
|
36 |
} |
37 |
else
|
38 |
{ |
39 |
while(1) |
40 |
{ |
41 |
for(port = 0; port <= 6; port++) |
42 |
{ |
43 |
usb_puti(analog_get10(ports[port])); |
44 |
usb_putc('\t');
|
45 |
} |
46 |
usb_putc('\n');
|
47 |
delay_ms(50);
|
48 |
} |
49 |
} |
50 |
} |
51 |
else
|
52 |
{ |
53 |
while(1) |
54 |
{ |
55 |
usb_puti(analog_get10(ports[TEST_PORT])); |
56 |
usb_putc('\n');
|
57 |
delay_ms(50);
|
58 |
} |
59 |
|
60 |
} |
61 |
|
62 |
return 0; |
63 |
} |
64 |
/*Mapping of IR sensor to port number:
|
65 |
Line following (L to R on robot):
|
66 |
1: 5
|
67 |
2: 4
|
68 |
3: 3
|
69 |
4: 2
|
70 |
5: 9
|
71 |
|
72 |
Bar-code reading:
|
73 |
L: 8
|
74 |
R: 1
|
75 |
*/
|