Rev 1196 | 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 |