| 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++; |
| |