6,9 → 6,6 |
|
#define N_SEND 10000 |
|
extern int tot_send; |
extern int tot_rec; |
|
int main () { |
|
int res, i = 0, k; |
16,7 → 13,7 |
srand(sys_gettime(NULL)); |
|
cprintf("(Open Com2)"); |
res = servo_open(COM2, 115200); |
res = servo_open(COM2, 19200); |
cprintf("(Res = %d)",res); |
|
cprintf("(Servo Turn On 0)"); |
29,13 → 26,11 |
|
k = rand() % 180 - 90; |
|
cprintf("(Set %d)",k); |
cprintf("(Set Servo 0 %d)",k); |
res = servo_set_angle_sec(COM2, 0, ANGLE2SEC(k,0,0)); |
cprintf("(Res = %d)",res); |
|
cprintf("(Get)"); |
res = servo_get_angle_sec(COM2, 0); |
cprintf("(Res = %d)",res); |
udelay(100000); |
|
i++; |
|