3,15 → 3,14 |
#include "drivers/keyb.h" |
|
#include "servo.h" |
#include "leg.h" |
|
int main () { |
|
int res; |
char ch; |
|
servo_open(SERVO_COM2); |
/* |
servo_open(SERVO_COM2); |
|
cprintf("servo_set_RS232_baudrate\n"); |
res = servo_set_RS232_baudrate(9600); |
cprintf("Res = %d\n",res); |
23,7 → 22,7 |
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); |
79,7 → 78,7 |
ch = keyb_getch(BLOCK); |
|
cprintf("servo_set_levels\n"); |
res = servo_set_levels(0x00,0x01); |
res = servo_set_levels(0x01); |
cprintf("Res = %d\n",res); |
|
ch = keyb_getch(BLOCK); |
121,9 → 120,6 |
ch = keyb_getch(BLOCK); |
|
servo_close(); |
*/ |
set_leg_position(8.0,-5.0,0.0); |
set_leg_position(8.0,0.0,0.0); |
|
return 0; |
|