root / trunk / code / projects / test / test_motors.c @ 1401
History | View | Annotate | Download (1.37 KB)
1 | 958 | cmar | #include <dragonfly_lib.h> |
---|---|---|---|
2 | |||
3 | 1369 | emullini | #define OFF 140 |
4 | #define SLOW 160 |
||
5 | #define GO 220 |
||
6 | |||
7 | 958 | cmar | int testmotors(void) { |
8 | //usb_init();
|
||
9 | 1369 | emullini | //usb_puts("usb turned on\n");
|
10 | |||
11 | //forward
|
||
12 | orb_set_color(RED); |
||
13 | motor1_set(1, OFF);
|
||
14 | motor2_set(1, OFF);
|
||
15 | delay_ms(3000);
|
||
16 | orb_set_color(YELLOW); |
||
17 | motor1_set(1, SLOW);
|
||
18 | motor2_set(1, SLOW);
|
||
19 | delay_ms(3000);
|
||
20 | orb_set_color(GREEN); |
||
21 | motor1_set(1, GO);
|
||
22 | motor2_set(1, GO);
|
||
23 | delay_ms(3000);
|
||
24 | |||
25 | //backward
|
||
26 | orb_set_color(RED); |
||
27 | motor1_set(0, OFF);
|
||
28 | motor2_set(0, OFF);
|
||
29 | delay_ms(3000);
|
||
30 | orb_set_color(YELLOW); |
||
31 | motor1_set(0, SLOW);
|
||
32 | motor2_set(0, SLOW);
|
||
33 | delay_ms(3000);
|
||
34 | orb_set_color(GREEN); |
||
35 | motor1_set(0, GO);
|
||
36 | motor2_set(0, GO);
|
||
37 | delay_ms(3000);
|
||
38 | |||
39 | //spin
|
||
40 | orb_set_color(RED); |
||
41 | motor1_set(1, OFF);
|
||
42 | motor2_set(0, OFF);
|
||
43 | delay_ms(3000);
|
||
44 | orb_set_color(YELLOW); |
||
45 | motor1_set(1, SLOW);
|
||
46 | motor2_set(0, SLOW);
|
||
47 | delay_ms(3000);
|
||
48 | orb_set_color(GREEN); |
||
49 | motor1_set(1, GO);
|
||
50 | motor2_set(0, GO);
|
||
51 | delay_ms(3000);
|
||
52 | |||
53 | //spin other way
|
||
54 | orb_set_color(RED); |
||
55 | motor1_set(0, OFF);
|
||
56 | motor2_set(1, OFF);
|
||
57 | delay_ms(3000);
|
||
58 | orb_set_color(YELLOW); |
||
59 | motor1_set(0, SLOW);
|
||
60 | motor2_set(1, SLOW);
|
||
61 | delay_ms(3000);
|
||
62 | orb_set_color(GREEN); |
||
63 | motor1_set(0, GO);
|
||
64 | motor2_set(1, GO);
|
||
65 | delay_ms(3000);
|
||
66 | //while(1){;}
|
||
67 | 958 | cmar | |
68 | return 0; |
||
69 | } |
||
70 | |||
71 | |||
72 | 1369 | emullini | /*test data
|
73 | left >154 forward
|
||
74 | right >150 forward
|
||
75 | both >152 backward
|
||
76 | */ |