Subversion Repositories shark

Compare Revisions

Regard whitespace Rev 1476 → Rev 1477

/demos/trunk/servo/load.c
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;
 
}