X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Ftests%2Fhostsim%2Fmain.c;h=d36fa5f32debe6d3086fa6aa492ffd0ffa3a2120;hp=fe884e79a9aaa5c5939bbba5c5800fddec3d50eb;hb=1714f4ee916fca95ce24120ea6e698237913f947;hpb=1f7500374129db3830592c4e931a5c9297c9dc1c diff --git a/projects/microb2010/tests/hostsim/main.c b/projects/microb2010/tests/hostsim/main.c index fe884e7..d36fa5f 100644 --- a/projects/microb2010/tests/hostsim/main.c +++ b/projects/microb2010/tests/hostsim/main.c @@ -28,7 +28,6 @@ #include #include -#include #include #include @@ -42,10 +41,15 @@ #include #include +#include //#include #include #include "cs.h" +#include "cmdline.h" +#include "robotsim.h" +#include "strat.h" +#include "strat_base.h" #include "main.h" struct genboard gen; @@ -53,38 +57,47 @@ struct mainboard mainboard; int main(void) { -#ifndef HOST_VERSION uart_init(); + uart_register_rx_event(CMDLINE_UART, emergency); +#ifndef HOST_VERSION fdevopen(uart0_dev_send, uart0_dev_recv); sei(); -#else - int i; #endif + memset(&gen, 0, sizeof(gen)); + memset(&mainboard, 0, sizeof(mainboard)); + + /* LOGS */ + error_register_emerg(mylog); + error_register_error(mylog); + error_register_warning(mylog); + error_register_notice(mylog); + error_register_debug(mylog); + #ifdef CONFIG_MODULE_TIMER timer_init(); #endif - scheduler_init(); + printf("init\n"); -#ifdef HOST_VERSION + scheduler_init(); + hostsim_init(); robotsim_init(); -#endif - microb_cs_init(); - gen.logs[0] = E_USER_CS; - gen.log_level = 5; + time_init(TIME_PRIO); + + printf_P(PSTR("\r\n")); + printf_P(PSTR("Respect et robustesse.\r\n")); mainboard.flags = DO_ENCODERS | DO_RS | DO_POS | DO_POWER | DO_BD | DO_CS; + strat_reset_pos(1000, 1000, -90); + + cmdline_interact(); - trajectory_d_rel(&mainboard.traj, 1000); - wait_ms(2000); - trajectory_goto_xy_abs(&mainboard.traj, 1500, 2000); - wait_ms(2000); return 0; }