1,18 → 1,19 |
#include "kernel/kern.h" |
#include "drivers/shark_keyb26.h" |
#include "unistd.h" |
|
#include "servo.h" |
|
#define N_SEND 100000 |
#define N_SEND 10000 |
|
extern int tot_send; |
extern int tot_rec; |
|
int main () { |
|
TIME seme; |
int res, i, err=0; |
int rnd1, rnd2; |
int res, i = 0, k; |
|
seme = sys_gettime(NULL); |
srand(seme); |
srand(sys_gettime(NULL)); |
|
cprintf("(Open Com2)"); |
res = servo_open(COM2, 115200); |
22,14 → 23,24 |
res = servo_turn_on(COM2, 0); |
cprintf("(Res = %d)",res); |
|
sleep(5); |
while(i < N_SEND) { |
|
cprintf("(Servo set angle 45)"); |
res = servo_set_angle_sec(COM2, 0, ANGLE2SEC(45,0,0)); |
cprintf("(Cycle = %d)",i); |
|
k = rand() % 180 - 90; |
|
cprintf("(Set %d)",k); |
res = servo_set_angle_sec(COM2, 0, ANGLE2SEC(k,0,0)); |
cprintf("(Res = %d)",res); |
|
sleep(5); |
cprintf("(Get)"); |
res = servo_get_angle_sec(COM2, 0); |
cprintf("(Res = %d)",res); |
|
i++; |
|
} |
|
servo_close(COM2); |
|
sys_end(); |