Subversion Repositories shark

Compare Revisions

Regard whitespace Rev 1212 → Rev 1213

/demos/trunk/servo/servo.c
1,9 → 1,13
#include "kernel/kern.h"
 
#include "drivers/keyb.h"
 
#include "servo.h"
 
int main () {
 
int res;
char ch;
 
servo_open(SERVO_COM2);
/*
23,66 → 27,98
res = servo_set_period(20000);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_get_period\n");
res = servo_get_period();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_store_period\n");
res = servo_store_period();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_get_setup_switch\n");
res = servo_get_setup_switch();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_set_RC5_switch\n");
res = servo_set_RC5_switch(1);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_turn_off\n");
res = servo_turn_off(1);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_turn_on\n");
res = servo_turn_off(1);
res = servo_turn_on(1);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_turn_off_all\n");
res = servo_turn_off_all();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_turn_on_all\n");
res = servo_turn_off_all();
res = servo_turn_on_all();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_set_levels\n");
res = servo_set_levels(0xFE);
res = servo_set_levels(0x01);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
cprintf("servo_get_levels\n");
res = servo_get_levels();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_store_levels\n");
res = servo_store_levels();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_set_angle_sec\n");
res = servo_set_angle_sec(0,ANGLE2SEC(45,0,0));
cprintf("Res = %d\n",res);
ch = keyb_getch(BLOCK);
 
cprintf("servo_store_default_position\n");
res = servo_store_default_position(0);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_get_angle_sec\n");
res = servo_get_angle_sec(0);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_get_analog\n");
res = servo_get_analog(0);
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
servo_close();
 
return 0;
/demos/trunk/servo/initfile.c
74,6 → 74,8
 
HARTPORT_init();
 
KEYB_init(NULL);
 
__call_main__(mb);
 
return (void *)0;