Rev 1196 | Rev 1213 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1194 | giacomo | 1 | #include "kernel/kern.h" |
2 | #include "servo.h" |
||
3 | |||
4 | int main () { |
||
5 | |||
1195 | giacomo | 6 | int res; |
7 | |||
1196 | giacomo | 8 | servo_open(SERVO_COM2); |
1212 | giacomo | 9 | /* |
10 | cprintf("servo_set_RS232_baudrate\n"); |
||
11 | res = servo_set_RS232_baudrate(9600); |
||
12 | cprintf("Res = %d\n",res); |
||
1194 | giacomo | 13 | |
1212 | giacomo | 14 | cprintf("servo_get_RS232_baudrate\n"); |
15 | res = servo_get_RS232_baudrate(); |
||
16 | cprintf("Res = %d\n",res); |
||
1194 | giacomo | 17 | |
1212 | giacomo | 18 | cprintf("servo_store_RS232_baudrate\n"); |
19 | res = servo_store_RS232_baudrate(); |
||
20 | cprintf("Res = %d\n",res); |
||
21 | */ |
||
22 | cprintf("servo_set_period\n"); |
||
23 | res = servo_set_period(20000); |
||
24 | cprintf("Res = %d\n",res); |
||
25 | |||
26 | cprintf("servo_get_period\n"); |
||
27 | res = servo_get_period(); |
||
28 | cprintf("Res = %d\n",res); |
||
29 | |||
30 | cprintf("servo_store_period\n"); |
||
31 | res = servo_store_period(); |
||
32 | cprintf("Res = %d\n",res); |
||
33 | |||
34 | cprintf("servo_get_setup_switch\n"); |
||
35 | res = servo_get_setup_switch(); |
||
36 | cprintf("Res = %d\n",res); |
||
37 | |||
38 | cprintf("servo_set_RC5_switch\n"); |
||
39 | res = servo_set_RC5_switch(1); |
||
40 | cprintf("Res = %d\n",res); |
||
41 | |||
42 | cprintf("servo_turn_off\n"); |
||
43 | res = servo_turn_off(1); |
||
44 | cprintf("Res = %d\n",res); |
||
45 | |||
46 | cprintf("servo_turn_on\n"); |
||
47 | res = servo_turn_off(1); |
||
48 | cprintf("Res = %d\n",res); |
||
49 | |||
50 | cprintf("servo_turn_off_all\n"); |
||
51 | res = servo_turn_off_all(); |
||
52 | cprintf("Res = %d\n",res); |
||
53 | |||
54 | cprintf("servo_turn_on_all\n"); |
||
55 | res = servo_turn_off_all(); |
||
56 | cprintf("Res = %d\n",res); |
||
57 | |||
58 | cprintf("servo_set_levels\n"); |
||
59 | res = servo_set_levels(0xFE); |
||
60 | cprintf("Res = %d\n",res); |
||
61 | |||
62 | cprintf("servo_get_levels\n"); |
||
63 | res = servo_get_levels(); |
||
64 | cprintf("Res = %d\n",res); |
||
65 | |||
66 | cprintf("servo_store_levels\n"); |
||
67 | res = servo_store_levels(); |
||
68 | cprintf("Res = %d\n",res); |
||
69 | |||
70 | cprintf("servo_set_angle_sec\n"); |
||
71 | res = servo_set_angle_sec(0,ANGLE2SEC(45,0,0)); |
||
72 | cprintf("Res = %d\n",res); |
||
73 | |||
74 | cprintf("servo_store_default_position\n"); |
||
75 | res = servo_store_default_position(0); |
||
76 | cprintf("Res = %d\n",res); |
||
77 | |||
78 | cprintf("servo_get_angle_sec\n"); |
||
79 | res = servo_get_angle_sec(0); |
||
80 | cprintf("Res = %d\n",res); |
||
81 | |||
82 | cprintf("servo_get_analog\n"); |
||
83 | res = servo_get_analog(0); |
||
84 | cprintf("Res = %d\n",res); |
||
85 | |||
1194 | giacomo | 86 | servo_close(); |
87 | |||
88 | return 0; |
||
89 | |||
90 | } |
||
91 |