10,42 → 10,30 |
TIME seme; |
int res, i, err=0; |
int rnd1, rnd2; |
//char ch; |
|
seme = sys_gettime(NULL); |
srand(seme); |
|
servo_open(COM2, 19200); |
|
/*cprintf("servo_set_RS232_baudrate\n"); |
res = servo_set_RS232_baudrate(COM2, 9600); |
cprintf("Open Com2\n"); |
res = servo_open(COM2, 115200); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_get_RS232_baudrate\n"); |
res = servo_get_RS232_baudrate(COM2); |
cprintf("Servo Turn On 0\n"); |
res = servo_turn_on(COM2, 0); |
cprintf("Res = %d\n",res); |
|
cprintf("servo_store_RS232_baudrate\n"); |
res = servo_store_RS232_baudrate(COM2); |
cprintf("Res = %d\n\n",res); |
sleep(5); |
|
ch = keyb_getch(BLOCK);*/ |
cprintf("Servo set angle 45\n"); |
res = servo_set_angle_sec(COM2, 0, ANGLE2SEC(45,0,0)); |
cprintf("Res = %d\n",res); |
|
sleep(5); |
|
for (i=0; i<N_SEND; i++) { |
servo_close(COM2); |
|
rnd1 = rand()%16; |
rnd2 = rand()%180 - 90; |
res = servo_set_angle_sec(COM2, rnd1,ANGLE2SEC(rnd2,0,0)); |
cprintf("Pin = %2d - Angle = %3d - Res = %d\n",rnd1, rnd2, res); |
if (res) err++; |
sys_end(); |
|
} |
cprintf("\nEvents = %d; Errors = %d\n",i, err); |
|
|
servo_close(COM2); |
|
return 0; |
|
} |