6,10 → 6,83 |
int res; |
|
servo_open(SERVO_COM2); |
/* |
cprintf("servo_set_RS232_baudrate\n"); |
res = servo_set_RS232_baudrate(9600); |
cprintf("Res = %d\n",res); |
|
res = servo_set_angle_sec(0,ANGLE2SEC(45,0,0)); |
cprintf("Res = %d",res); |
cprintf("servo_get_RS232_baudrate\n"); |
res = servo_get_RS232_baudrate(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_store_RS232_baudrate\n"); |
res = servo_store_RS232_baudrate(); |
cprintf("Res = %d\n",res); |
*/ |
cprintf("servo_set_period\n"); |
res = servo_set_period(20000); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_get_period\n"); |
res = servo_get_period(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_store_period\n"); |
res = servo_store_period(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_get_setup_switch\n"); |
res = servo_get_setup_switch(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_set_RC5_switch\n"); |
res = servo_set_RC5_switch(1); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_turn_off\n"); |
res = servo_turn_off(1); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_turn_on\n"); |
res = servo_turn_off(1); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_turn_off_all\n"); |
res = servo_turn_off_all(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_turn_on_all\n"); |
res = servo_turn_off_all(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_set_levels\n"); |
res = servo_set_levels(0xFE); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_get_levels\n"); |
res = servo_get_levels(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_store_levels\n"); |
res = servo_store_levels(); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_set_angle_sec\n"); |
res = servo_set_angle_sec(0,ANGLE2SEC(45,0,0)); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_store_default_position\n"); |
res = servo_store_default_position(0); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_get_angle_sec\n"); |
res = servo_get_angle_sec(0); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_get_analog\n"); |
res = servo_get_analog(0); |
cprintf("Res = %d\n",res); |
|
servo_close(); |
|
return 0; |