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_YELLOW)? (y) : (AREA_Y-(y)))
27 #define COLOR_A(a) ((mainboard.our_color==I2C_COLOR_YELLOW)? (a) : (-a))
28 #define COLOR_SIGN(x) ((mainboard.our_color==I2C_COLOR_YELLOW)? (x) : (-x))
29 #define COLOR_INVERT(x) ((mainboard.our_color==I2C_COLOR_YELLOW)? (x) : (!x))
36 #define START_Y COLOR_Y(200)
37 #define START_A COLOR_A(45)
43 #define CORNER_Y COLOR_Y(2100)
50 * 2100 +-----|-----|-----|-----|-----|-----|-----+
61 * 0 +-----+-----------------------------+-----+
65 /* useful traj flags */
66 #define TRAJ_SUCCESS(f) (f & (END_TRAJ|END_NEAR))
67 #define TRAJ_FLAGS_STD (END_TRAJ|END_BLOCKING|END_NEAR|END_OBSTACLE|END_INTR|END_TIMER)
68 #define TRAJ_FLAGS_NO_TIMER (END_TRAJ|END_BLOCKING|END_NEAR|END_OBSTACLE|END_INTR)
69 #define TRAJ_FLAGS_NO_NEAR (END_TRAJ|END_BLOCKING|END_OBSTACLE|END_INTR|END_TIMER)
70 #define TRAJ_FLAGS_NO_NEAR_NO_TIMER (END_TRAJ|END_BLOCKING|END_OBSTACLE|END_INTR)
71 #define TRAJ_FLAGS_SMALL_DIST (END_TRAJ|END_BLOCKING|END_INTR)
78 #define SPEED_DIST_FAST 2500.
79 #define SPEED_ANGLE_FAST 2000.
80 #define SPEED_DIST_SLOW 1000.
81 #define SPEED_ANGLE_SLOW 1000.
82 #define SPEED_DIST_VERY_SLOW 400.
83 #define SPEED_ANGLE_VERY_SLOW 400.
85 /* strat infos structures */
95 #define STRAT_CONF_XXX 0x01
100 #define STRAT_STATUS_LHARVEST 0x01
101 #define STRAT_STATUS_RHARVEST 0x02
105 /* all infos related to strat */
107 uint8_t dump_enabled;
108 struct strat_conf conf;
109 struct strat_bbox area_bbox;
110 struct strat_status status;
112 extern struct strat_infos strat_infos;
115 void strat_dump_infos(const char *caller); /* show current known state
117 void strat_dump_conf(void);
118 void strat_reset_infos(void); /* reset current known state */
119 void strat_preinit(void);
120 void strat_init(void);
121 void strat_exit(void);
122 void strat_dump_flags(void);
123 void strat_goto_near(int16_t x, int16_t y, uint16_t dist);
124 uint8_t strat_main(void);
125 void strat_event(void *dummy);