X-Git-Url: http://git.droids-corp.org/?p=aversive.git;a=blobdiff_plain;f=projects%2Fmicrob2010%2Ftests%2Fhostsim%2Fmain.c;h=31a7832ed8e111ee509bd0a61b7ecca3d349b1b8;hp=0182943d760bea331ff991c7baab91d09219bc3f;hb=a16ba178c7ef15fb408593b0e7c666ed2ed1d253;hpb=7d6a4a1f99a11437d608cbe61f07fac0e3d70ad1 diff --git a/projects/microb2010/tests/hostsim/main.c b/projects/microb2010/tests/hostsim/main.c index 0182943..31a7832 100644 --- a/projects/microb2010/tests/hostsim/main.c +++ b/projects/microb2010/tests/hostsim/main.c @@ -46,6 +46,10 @@ #include #include "cs.h" +#include "cmdline.h" +#include "robotsim.h" +#include "strat.h" +#include "strat_base.h" #include "main.h" struct genboard gen; @@ -53,29 +57,47 @@ struct mainboard mainboard; int main(void) { + uart_init(); + uart_register_rx_event(CMDLINE_UART, emergency); +#ifndef HOST_VERSION + fdevopen(uart0_dev_send, uart0_dev_recv); + sei(); +#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 + printf("init\n"); scheduler_init(); - time_init(TIME_PRIO); hostsim_init(); robotsim_init(); 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, 0); + + cmdline_interact(); - time_wait_ms(1000); - printf("init\n"); - trajectory_d_rel(&mainboard.traj, 1000); - time_wait_ms(2000); - printf("init\n"); - trajectory_goto_xy_abs(&mainboard.traj, 1500, 2000); - time_wait_ms(2000); return 0; }