Rev 1212 | 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" |
| 1213 | giacomo | 2 | |
| 3 | #include "drivers/keyb.h" |
||
| 4 | |||
| 1194 | giacomo | 5 | #include "servo.h" |
| 6 | |||
| 7 | int main () { |
||
| 8 | |||
| 1195 | giacomo | 9 | int res; |
| 1213 | giacomo | 10 | char ch; |
| 1195 | giacomo | 11 | |
| 1196 | giacomo | 12 | servo_open(SERVO_COM2); |
| 1212 | giacomo | 13 | /* |
| 14 | cprintf("servo_set_RS232_baudrate\n"); |
||
| 15 | res = servo_set_RS232_baudrate(9600); |
||
| 16 | cprintf("Res = %d\n",res); |
||
| 1194 | giacomo | 17 | |
| 1212 | giacomo | 18 | cprintf("servo_get_RS232_baudrate\n"); |
| 19 | res = servo_get_RS232_baudrate(); |
||
| 20 | cprintf("Res = %d\n",res); |
||
| 1194 | giacomo | 21 | |
| 1212 | giacomo | 22 | cprintf("servo_store_RS232_baudrate\n"); |
| 23 | res = servo_store_RS232_baudrate(); |
||
| 24 | cprintf("Res = %d\n",res); |
||
| 25 | */ |
||
| 26 | cprintf("servo_set_period\n"); |
||
| 27 | res = servo_set_period(20000); |
||
| 28 | cprintf("Res = %d\n",res); |
||
| 29 | |||
| 1213 | giacomo | 30 | ch = keyb_getch(BLOCK); |
| 31 | |||
| 1212 | giacomo | 32 | cprintf("servo_get_period\n"); |
| 33 | res = servo_get_period(); |
||
| 34 | cprintf("Res = %d\n",res); |
||
| 35 | |||
| 1213 | giacomo | 36 | ch = keyb_getch(BLOCK); |
| 37 | |||
| 1212 | giacomo | 38 | cprintf("servo_store_period\n"); |
| 39 | res = servo_store_period(); |
||
| 40 | cprintf("Res = %d\n",res); |
||
| 1213 | giacomo | 41 | |
| 42 | ch = keyb_getch(BLOCK); |
||
| 1212 | giacomo | 43 | |
| 44 | cprintf("servo_get_setup_switch\n"); |
||
| 45 | res = servo_get_setup_switch(); |
||
| 46 | cprintf("Res = %d\n",res); |
||
| 47 | |||
| 1213 | giacomo | 48 | ch = keyb_getch(BLOCK); |
| 49 | |||
| 1212 | giacomo | 50 | cprintf("servo_set_RC5_switch\n"); |
| 51 | res = servo_set_RC5_switch(1); |
||
| 52 | cprintf("Res = %d\n",res); |
||
| 53 | |||
| 1213 | giacomo | 54 | ch = keyb_getch(BLOCK); |
| 55 | |||
| 1212 | giacomo | 56 | cprintf("servo_turn_off\n"); |
| 57 | res = servo_turn_off(1); |
||
| 58 | cprintf("Res = %d\n",res); |
||
| 59 | |||
| 1213 | giacomo | 60 | ch = keyb_getch(BLOCK); |
| 61 | |||
| 1212 | giacomo | 62 | cprintf("servo_turn_on\n"); |
| 1213 | giacomo | 63 | res = servo_turn_on(1); |
| 1212 | giacomo | 64 | cprintf("Res = %d\n",res); |
| 65 | |||
| 1213 | giacomo | 66 | ch = keyb_getch(BLOCK); |
| 67 | |||
| 1212 | giacomo | 68 | cprintf("servo_turn_off_all\n"); |
| 69 | res = servo_turn_off_all(); |
||
| 70 | cprintf("Res = %d\n",res); |
||
| 71 | |||
| 1213 | giacomo | 72 | ch = keyb_getch(BLOCK); |
| 73 | |||
| 1212 | giacomo | 74 | cprintf("servo_turn_on_all\n"); |
| 1213 | giacomo | 75 | res = servo_turn_on_all(); |
| 1212 | giacomo | 76 | cprintf("Res = %d\n",res); |
| 77 | |||
| 1213 | giacomo | 78 | ch = keyb_getch(BLOCK); |
| 79 | |||
| 1212 | giacomo | 80 | cprintf("servo_set_levels\n"); |
| 1213 | giacomo | 81 | res = servo_set_levels(0x01); |
| 1212 | giacomo | 82 | cprintf("Res = %d\n",res); |
| 83 | |||
| 1213 | giacomo | 84 | ch = keyb_getch(BLOCK); |
| 85 | |||
| 1212 | giacomo | 86 | cprintf("servo_get_levels\n"); |
| 87 | res = servo_get_levels(); |
||
| 88 | cprintf("Res = %d\n",res); |
||
| 89 | |||
| 1213 | giacomo | 90 | ch = keyb_getch(BLOCK); |
| 91 | |||
| 1212 | giacomo | 92 | cprintf("servo_store_levels\n"); |
| 93 | res = servo_store_levels(); |
||
| 94 | cprintf("Res = %d\n",res); |
||
| 95 | |||
| 1213 | giacomo | 96 | ch = keyb_getch(BLOCK); |
| 97 | |||
| 1212 | giacomo | 98 | cprintf("servo_set_angle_sec\n"); |
| 99 | res = servo_set_angle_sec(0,ANGLE2SEC(45,0,0)); |
||
| 100 | cprintf("Res = %d\n",res); |
||
| 101 | |||
| 1213 | giacomo | 102 | ch = keyb_getch(BLOCK); |
| 103 | |||
| 1212 | giacomo | 104 | cprintf("servo_store_default_position\n"); |
| 105 | res = servo_store_default_position(0); |
||
| 106 | cprintf("Res = %d\n",res); |
||
| 107 | |||
| 1213 | giacomo | 108 | ch = keyb_getch(BLOCK); |
| 109 | |||
| 1212 | giacomo | 110 | cprintf("servo_get_angle_sec\n"); |
| 111 | res = servo_get_angle_sec(0); |
||
| 112 | cprintf("Res = %d\n",res); |
||
| 113 | |||
| 1213 | giacomo | 114 | ch = keyb_getch(BLOCK); |
| 115 | |||
| 1212 | giacomo | 116 | cprintf("servo_get_analog\n"); |
| 117 | res = servo_get_analog(0); |
||
| 118 | cprintf("Res = %d\n",res); |
||
| 119 | |||
| 1213 | giacomo | 120 | ch = keyb_getch(BLOCK); |
| 121 | |||
| 1194 | giacomo | 122 | servo_close(); |
| 123 | |||
| 124 | return 0; |
||
| 125 | |||
| 126 | } |
||
| 127 |