root / trunk / code / projects / unit_tests / test_ir.c @ 1876
History | View | Annotate | Download (1.07 KB)
| 1 | 1827 | bwasserm | #include <dragonfly_lib.h> |
|---|---|---|---|
| 2 | |||
| 3 | 1832 | dgurjar | #define TEST_PORT 3 |
| 4 | #define TEST_ALL 1 |
||
| 5 | #define TEST_INDIV 0 |
||
| 6 | |||
| 7 | 1827 | bwasserm | int testir(void) |
| 8 | {
|
||
| 9 | 1832 | dgurjar | analog_init(0);
|
| 10 | 1827 | bwasserm | int port;
|
| 11 | 1837 | dgurjar | int ports[] = {13, 12, 3, 2, 9, 8, 1}; |
| 12 | 1832 | dgurjar | // 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 | 1837 | dgurjar | for(port = 0; port <5; port++) |
| 22 | 1832 | dgurjar | {
|
| 23 | usb_puti(analog_get10(ports[port])); |
||
| 24 | usb_putc('\t');
|
||
| 25 | } |
||
| 26 | 1837 | dgurjar | |
| 27 | for(port = 5; port <7; port++) |
||
| 28 | {
|
||
| 29 | usb_puti(analog_get10(ports[port])); |
||
| 30 | usb_putc('\t');
|
||
| 31 | } |
||
| 32 | 1832 | dgurjar | usb_putc('\n');
|
| 33 | delay_ms(50);
|
||
| 34 | } |
||
| 35 | |||
| 36 | 1827 | bwasserm | } |
| 37 | 1832 | dgurjar | 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 | 1827 | bwasserm | } |
| 51 | 1832 | dgurjar | 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 | 1827 | bwasserm | return 0; |
| 63 | 1832 | dgurjar | } |
| 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 | */ |