| 3,14 → 3,15 |
|---|
| #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); |
| 22,7 → 23,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); |
| 78,7 → 79,7 |
|---|
| ch = keyb_getch(BLOCK); |
| |
| cprintf("servo_set_levels\n"); |
| res = servo_set_levels(0x01); |
| res = servo_set_levels(0x00,0x01); |
| cprintf("Res = %d\n",res); |
| |
| ch = keyb_getch(BLOCK); |
| 120,6 → 121,9 |
|---|
| 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; |
| |