Subversion Repositories shark

Compare Revisions

Ignore whitespace Rev 1284 → Rev 1283

/demos/trunk/servo/README
File deleted
/demos/trunk/servo/time.c
File deleted
/demos/trunk/servo/ctrl.c
File deleted
/demos/trunk/servo/load.c
File deleted
/demos/trunk/servo/servo.c
0,0 → 1,131
#include "kernel/kern.h"
 
#include "drivers/keyb.h"
 
#include "servo.h"
#include "leg.h"
 
int main () {
 
int res;
char ch;
/*
servo_open(SERVO_COM2);
 
cprintf("servo_set_RS232_baudrate\n");
res = servo_set_RS232_baudrate(9600);
cprintf("Res = %d\n",res);
 
cprintf("servo_get_RS232_baudrate\n");
res = servo_get_RS232_baudrate();
cprintf("Res = %d\n",res);
 
cprintf("servo_store_RS232_baudrate\n");
res = servo_store_RS232_baudrate();
cprintf("Res = %d\n",res);
 
cprintf("servo_set_period\n");
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_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_on_all();
cprintf("Res = %d\n",res);
 
ch = keyb_getch(BLOCK);
 
cprintf("servo_set_levels\n");
res = servo_set_levels(0x00,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();
*/
set_leg_position(8.0,-5.0,0.0);
set_leg_position(8.0,0.0,0.0);
 
return 0;
 
}
 
/demos/trunk/servo/initfile.c
57,7 → 57,7
struct multiboot_info *mb = (struct multiboot_info *)arg;
 
EDF_register_level(EDF_ENABLE_ALL);
CBS_register_level(CBS_ENABLE_ALL, 0);
//CBS_register_level(CBS_ENABLE_ALL, 0);
RR_register_level(RRTICK, RR_MAIN_YES, mb);
dummy_register_level();
 
74,7 → 74,7
 
HARTPORT_init();
 
KEYB_init(NULL);
//KEYB_init(NULL);
 
__call_main__(mb);
 
/demos/trunk/servo/makefile
7,15 → 7,10
endif
include $(BASE)/config/config.mk
 
PROGS = ctrl time load
PROGS = servo
 
include $(BASE)/config/example.mk
 
ctrl:
make -f $(SUBMAKE) APP=ctrl INIT= OTHEROBJS="initfile.o" OTHERINCL= SHARKOPT="__OLDCHAR__ __SERVO__"
servo:
make -f $(SUBMAKE) APP=servo INIT= OTHEROBJS="initfile.o leg.o" OTHERINCL= SHARKOPT="__OLDCHAR__ __SERVO__"
 
time:
make -f $(SUBMAKE) APP=time INIT= OTHEROBJS="initfile.o" OTHERINCL= SHARKOPT="__OLDCHAR__ __SERVO__"
 
load:
make -f $(SUBMAKE) APP=load INIT= OTHEROBJS="initfile.o" OTHERINCL= SHARKOPT="__OLDCHAR__ __SERVO__"