#define CORNER_X 3000
#define CORNER_Y COLOR_Y(2100)
+/* XXX these offset are not related to corn, but to waypoints */
+#define OFFSET_CORN_X 150
+#define OFFSET_CORN_Y 222
+#define STEP_CORN_X 225
+#define STEP_CORN_Y 250
+
+#define CORN_NB 18
+#define TOMATO_NB 14
+
+#define WAYPOINTS_NBX 13
+#define WAYPOINTS_NBY 8
+
/*
+ * Corn position and lines, valid for YELLOW.
+ *
+ * vertical lines
+ * O 1 2 3 4 5
+ * 2100 +-----|-----|-----|-----|-----|-----|-----+
+ * | c5 c9 c14 |
+ * | c2 c7 c11 c17 | diag
+ * | c4 c8 c13 | lines
+ * 0/ c1 c6 c10 c16 \0
+ * y | c3 c12 |
+ * 1/ c0 c15 \1
+ * |-----+ +-----|
+ * 2/ | | \2
+ * | Yellow Blue |
+ * 0 +-----+-----------------------------+-----+
+ * 0 x 3000
+ *
+ * Ball (tomato) and i,j coords (for waypoints)
+ *
+ * 2100 +--0--1--2--3--4--5--6--7--8--9-10-11-12--+
+ * 7 t5 t9 |
+ * 6 t3 t7 t11 |
+ * 5 t1 t4 t8 t13 |
+ * 4 t2 t6 t10 |
+ * y 3 t0 t12 |
+ * 2 |
+ * 1-----+ +-----|
+ * 0 | | |
+ * | Yellow Blue |
+ * 0 +-----+-----------------------------+-----+
+ * 0 x 3000
+ *
+ *
+ * Corn position and lines, valid for BLUE.
*
+ * vertical lines
+ * 5 4 3 2 1 0
+ * 0 +-----|-----|-----|-----|-----|-----|-----+
+ * | c14 c9 c5 |
+ * | c17 c11 c7 c2 | diag
+ * | c13 c8 c4 | lines
+ * 0/ c16 c10 c6 c1 \0
+ * y | c12 c3 |
+ * 1/ c15 c0 \1
+ * |-----+ +-----|
+ * 2/ | | \2
+ * | Yellow Blue |
+ * 2100 +-----+-----------------------------+-----+
+ * 3000 x 0
*
+ * Ball (tomato) and i,j coords (for waypoints)
*
+ * 0 +-12-11-10--9--8--7--6--5--4--3--2--1--0--+
+ * 7 t9 t5 |
+ * 6 t11 t7 t3 |
+ * 5 t13 t8 t4 t1 |
+ * 4 t10 t6 t2 |
+ * y 3 t12 t0 |
+ * 2 |
+ * 1-----+ +-----|
+ * 0 | | |
+ * | Yellow Blue |
+ * 2100 +-----+-----------------------------+-----+
+ * 3000 x 0
*
- * +------------------------------------+
- * | |
- * | |
- * | |
- * | |
- * y | |
- * | |
- * |------ ------|
- * | | | |
- * | | | |
- * +-----+------------------------+-----+
- * x
*/
/* useful traj flags */
#define TRAJ_FLAGS_NO_NEAR_NO_TIMER (END_TRAJ|END_BLOCKING|END_OBSTACLE|END_INTR)
#define TRAJ_FLAGS_SMALL_DIST (END_TRAJ|END_BLOCKING|END_INTR)
+/* default acc */
+#define ACC_DIST 12.
+#define ACC_ANGLE 16.
+
/* default speeds */
-#define SPEED_DIST_FAST 2500
-#define SPEED_ANGLE_FAST 2000
-#define SPEED_DIST_SLOW 1000
-#define SPEED_ANGLE_SLOW 1000
-#define SPEED_DIST_VERY_SLOW 400
-#define SPEED_ANGLE_VERY_SLOW 400
+#define SPEED_DIST_FAST 1200.
+#define SPEED_ANGLE_FAST 800.
+#define SPEED_DIST_SLOW 500.
+#define SPEED_ANGLE_SLOW 500.
+#define SPEED_DIST_VERY_SLOW 200.
+#define SPEED_ANGLE_VERY_SLOW 200.
+
+#define SPEED_CLITOID_SLOW 250.
+#define SPEED_CLITOID_FAST 500.
+
/* strat infos structures */
+struct strat_conf {
+ uint8_t dump_enabled;
-struct bbox {
- int32_t x1;
- int32_t y1;
- int32_t x2;
- int32_t y2;
-};
+ uint8_t opp_orange;
+ uint8_t orphan_tomato;
+
+ int8_t prev_wait_obstacle;
-struct conf {
-#define STRAT_CONF_XXX 0x01
+#define STRAT_CONF_OUR_ORANGE 0x01
+#define STRAT_CONF_WAIT_OBSTACLE 0x02
+#define STRAT_CONF_STRAIGHT_BEGIN 0x04
uint8_t flags;
};
-/* all infos related to strat */
-struct strat_infos {
- uint8_t dump_enabled;
- struct conf conf;
- struct bbox area_bbox;
-};
-extern struct strat_infos strat_infos;
+extern struct strat_conf strat_conf;
+extern volatile uint8_t strat_lpack60;
+extern volatile uint8_t strat_rpack60;
+extern volatile uint8_t strat_want_pack;
/* in strat.c */
-void strat_dump_infos(const char *caller); /* show current known state
- of area */
-void strat_dump_conf(void);
+void strat_conf_dump(const char *caller);
void strat_reset_infos(void); /* reset current known state */
void strat_preinit(void);
void strat_init(void);
void strat_goto_near(int16_t x, int16_t y, uint16_t dist);
uint8_t strat_main(void);
void strat_event(void *dummy);
+void strat_event_enable(void);
+void strat_event_disable(void);
+uint8_t prepare_hill(uint8_t orange_color, int16_t posx);
+uint8_t run_to_the_hills(uint8_t orange_color);
+uint8_t get_orphan_tomatoes(void);
#endif