diff --git a/motion/src/examples/main.c b/motion/src/examples/main.c index 3a50003e54f89fc451dccd8f42ae6746c1a085a7..28ad3cafef05bbc3390e59a178627751eab187e2 100644 --- a/motion/src/examples/main.c +++ b/motion/src/examples/main.c @@ -7,59 +7,34 @@ #include "exp_board_reg.h" #include "serial.h" - int main(void) { - int n_servos = 18; - init_cm510(ASYNC); + int n_servos = 18; + init_cm510(ASYNC); manager_init(n_servos); - - int exp_board_ad_4, exp_board_ad_5, gyro_x, gyro_y; - - //serial_initialize(57600); - exp_board_init(192); - - +// serial_initialize(57600); action_init(); - action_set_page(1); - action_start_page(); - _delay_ms(2000); - - if(manager_calibrate_gyro()) - { - manager_enable_gyro(); - action_set_page(3); - action_start_page(); - } - - exp_board_ad_4 = get_adc_avg_channel(ADC4); - while(exp_board_ad_4 < 400) + action_set_page(31); + action_start_page(); +// while(is_action_running()) +// _delay_ms(100); + _delay_ms(2000); + action_set_page(1); + action_start_page(); + while(is_action_running()) + _delay_ms(100); + + while(1); + +/* if(manager_calibrate_gyro()) { - exp_board_ad_4 = get_adc_avg_channel(ADC4); - //printf("exp_board_ad_4: %d\n",exp_board_ad_4); - _delay_ms(50); + manager_enable_gyro(); + action_set_page(3); + action_start_page(); } - //printf("stop"); - action_stop_page(); - - //while(is_action_running()) - action_set_page(1); - action_start_page(); - - //_delay_ms(1000); - //action_set_page(32); - //action_start_page(); - - while(1) { - //exp_board_ad_4 = get_adc_avg_channel(ADC4); - //printf("exp_board_ad_4: %d\n",exp_board_ad_4); + _delay_ms(2000); + action_stop_page(); - //exp_board_ad_5 = get_adc_avg_channel(ADC5); - //printf("exp_board_ad_5: %d\n\n",exp_board_ad_5); - //turn_led_on(LED_PROGRAM); - //action_process(); - //turn_led_off(LED_PROGRAM); - //_delay_ms(500); - } + while(1);*/ }