Subversion Repositories shark

#include "kernel/kern.h"

#include "drivers/shark_keyb26.h"

#include "servo.h"

#define N_SEND 100000

int main () {

  TIME seme;

  int res, i, err=0;

  int rnd1, rnd2;

  seme = sys_gettime(NULL);

  srand(seme);

  cprintf("Open Com2\n");

  res = servo_open(COM2, 115200);

  cprintf("Res = %d\n",res);

  cprintf("Servo Turn On 0\n");

  res = servo_turn_on(COM2, 0);

  cprintf("Res = %d\n",res);

  sleep(5);

  cprintf("Servo set angle 45\n");

  res = servo_set_angle_sec(COM2, 0, ANGLE2SEC(45,0,0));

  cprintf("Res = %d\n",res);

  sleep(5);

  servo_close(COM2);

  sys_end();

  return 0;

}