2 * Copyright Droids Corporation, Microb Technology, Eirbot (2008)
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18 * Revision : $Id: strat.h,v 1.7 2009-11-08 17:24:33 zer0 Exp $
25 /* convert coords according to our color */
26 #define COLOR_Y(y) ((mainboard.our_color==I2C_COLOR_RED)? (y) : (AREA_Y-(y)))
27 #define COLOR_A(a) ((mainboard.our_color==I2C_COLOR_RED)? (a) : (-a))
28 #define COLOR_SIGN(x) ((mainboard.our_color==I2C_COLOR_RED)? (x) : (-x))
29 #define COLOR_INVERT(x) ((mainboard.our_color==I2C_COLOR_RED)? (x) : (!x))
36 #define START_Y COLOR_Y(200)
37 #define START_A COLOR_A(45)
43 #define CORNER_Y COLOR_Y(2100)
50 * +------------------------------------+
60 * +-----+------------------------+-----+
64 /* useful traj flags */
65 #define TRAJ_SUCCESS(f) (f & (END_TRAJ|END_NEAR))
66 #define TRAJ_FLAGS_STD (END_TRAJ|END_BLOCKING|END_NEAR|END_OBSTACLE|END_INTR|END_TIMER)
67 #define TRAJ_FLAGS_NO_TIMER (END_TRAJ|END_BLOCKING|END_NEAR|END_OBSTACLE|END_INTR)
68 #define TRAJ_FLAGS_NO_NEAR (END_TRAJ|END_BLOCKING|END_OBSTACLE|END_INTR|END_TIMER)
69 #define TRAJ_FLAGS_NO_NEAR_NO_TIMER (END_TRAJ|END_BLOCKING|END_OBSTACLE|END_INTR)
70 #define TRAJ_FLAGS_SMALL_DIST (END_TRAJ|END_BLOCKING|END_INTR)
73 #define SPEED_DIST_FAST 2500
74 #define SPEED_ANGLE_FAST 2000
75 #define SPEED_DIST_SLOW 1000
76 #define SPEED_ANGLE_SLOW 1000
77 #define SPEED_DIST_VERY_SLOW 400
78 #define SPEED_ANGLE_VERY_SLOW 400
80 /* strat infos structures */
90 #define STRAT_CONF_XXX 0x01
94 /* all infos related to strat */
98 struct bbox area_bbox;
100 extern struct strat_infos strat_infos;
103 void strat_dump_infos(const char *caller); /* show current known state
105 void strat_dump_conf(void);
106 void strat_reset_infos(void); /* reset current known state */
107 void strat_preinit(void);
108 void strat_init(void);
109 void strat_exit(void);
110 void strat_dump_flags(void);
111 void strat_goto_near(int16_t x, int16_t y, uint16_t dist);
112 uint8_t strat_main(void);
113 void strat_event(void *dummy);