diff --git a/motion/src/examples/main.c b/motion/src/examples/main.c index 49d5cb192be3b9ca49e9f40085ebb4022fbe2079..c52fc01dedd0169cee5b1371c2b6c8fe2edb14ea 100644 --- a/motion/src/examples/main.c +++ b/motion/src/examples/main.c @@ -12,6 +12,7 @@ int main(void) unsigned char cmd; int n_servos = 18; init_cm510(ASYNC); + exp_board_init(192); manager_init(n_servos); serial_initialize(57600); @@ -23,23 +24,9 @@ int main(void) while(1) { - scanf("%c",&cmd);// read a command from the external controller - switch(cmd) - { - case 'l': action_set_page(56); - action_start_page(); - printf("l"); - break; - case 'r': action_set_page(70); - action_start_page(); - printf("r"); - break; - case 's': action_stop_page(); - printf("s"); - while(is_action_running()); - printf("d"); - break; - } + unsigned short int heading = get_avg_heading(); + printf("heading: %d\n",heading); + _delay_ms(500); } /* if(manager_calibrate_gyro())