Subversion Repositories shark

Compare Revisions

Ignore whitespace Rev 1478 → Rev 1479

/demos/trunk/servo/load.c
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("(Res = %d)",res);
cprintf("(Cycle = %d)",i);
 
sleep(5);
k = rand() % 180 - 90;
 
cprintf("(Set %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);
 
i++;
 
}
 
servo_close(COM2);
 
sys_end();
/demos/trunk/servo/initfile.c
118,7 → 118,7
 
INPUT26_init();
 
keyb_def_ctrlC(kparms, NULL);
//keyb_def_ctrlC(kparms, NULL);
 
KEYB26_init(&kparms);