projects/microb2010/tests/hostsim/main.c

   1 /*  \r
   2  *  Copyright Droids Corporation, Microb Technology, Eirbot (2005)\r
   3  * \r
   4  *  This program is free software; you can redistribute it and/or modify\r
   5  *  it under the terms of the GNU General Public License as published by\r
   6  *  the Free Software Foundation; either version 2 of the License, or\r
   7  *  (at your option) any later version.\r
   8  *\r
   9  *  This program is distributed in the hope that it will be useful,\r
  10  *  but WITHOUT ANY WARRANTY; without even the implied warranty of\r
  11  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
  12  *  GNU General Public License for more details.\r
  13  *\r
  14  *  You should have received a copy of the GNU General Public License\r
  15  *  along with this program; if not, write to the Free Software\r
  16  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA\r
  17  *\r
  18  *  Revision : $Id: main.c,v 1.9.4.5 2007-06-01 09:37:22 zer0 Exp $\r
  19  *\r
  20  */\r
  21 \r
  22 #include <stdio.h>\r
  23 #include <string.h>\r
  24 \r
  25 #include <aversive.h>\r
  26 #include <aversive/error.h>\r
  27 #include <aversive/wait.h>\r
  28 \r
  29 #include <timer.h>\r
  30 #include <scheduler.h>\r
  31 \r
  32 #include <pid.h>\r
  33 #include <quadramp.h>\r
  34 #include <control_system_manager.h>\r
  35 #include <trajectory_manager.h>\r
  36 #include <blocking_detection_manager.h>\r
  37 #include <robot_system.h>\r
  38 #include <position_manager.h>\r
  39 \r
  40 #include <parse.h>\r
  41 #include <rdline.h>\r
  42 \r
  43 #include <uart.h>\r
  44 #include <clock_time.h>\r
  45 //#include <timer.h>\r
  46 #include <hostsim.h>\r
  47 \r
  48 #include "cs.h"\r
  49 #include "main.h"\r
  50 \r
  51 struct genboard gen;\r
  52 struct mainboard mainboard;\r
  53 \r
  54 int main(void)\r
  55 {\r
  56         printf("init\n");\r
  57 \r
  58         scheduler_init();\r
  59         time_init(TIME_PRIO);\r
  60 \r
  61         hostsim_init();\r
  62         robotsim_init();\r
  63 \r
  64         microb_cs_init();\r
  65 \r
  66         gen.logs[0] = E_USER_CS;\r
  67         gen.log_level = 5;\r
  68 \r
  69         mainboard.flags = DO_ENCODERS | DO_RS |\r
  70                 DO_POS | DO_POWER | DO_BD | DO_CS;\r
  71 \r
  72         time_wait_ms(1000);\r
  73         printf("init\n");\r
  74         trajectory_d_rel(&mainboard.traj, 1000);\r
  75         time_wait_ms(2000);\r
  76         printf("init\n");\r
  77         trajectory_goto_xy_abs(&mainboard.traj, 1500, 2000);\r
  78         time_wait_ms(2000);\r
  79         return 0;\r
  80 }\r
  81 \r
  82 \r