+
+static uint8_t strat_harvest(void)
+{
+ return 0;
+}
+
+/* must be called from a terminal line */
+static uint8_t strat_eject(void)
+{
+ uint8_t err;
+ //XXX return vals
+
+ /* go to eject point */
+ trajectory_goto_xy_abs(&mainboard.traj, 2625, COLOR_Y(1847));
+ err = WAIT_COND_OR_TRAJ_END(get_cob_count() >= 5,
+ TRAJ_FLAGS_NO_NEAR);
+ if (err == 0) {
+ want_pack = 1;
+ strat_set_speed(600, SPEED_ANGLE_SLOW);
+ err = wait_traj_end(TRAJ_FLAGS_NO_NEAR);
+ }
+
+ /* pack arms */
+ strat_event_disable();
+ i2c_cobboard_pack(I2C_LEFT_SIDE);
+ i2c_cobboard_pack(I2C_RIGHT_SIDE);
+
+ /* ball ejection */
+ i2c_ballboard_set_mode(I2C_BALLBOARD_MODE_EJECT);
+ trajectory_a_abs(&mainboard.traj, COLOR_A(70));
+ err = wait_traj_end(TRAJ_FLAGS_NO_NEAR);
+
+ DEBUG(E_USER_STRAT, "%s():%d", __FUNCTION__, __LINE__);
+ strat_hardstop();
+ time_wait_ms(2000);
+
+ /* half turn */
+ trajectory_a_rel(&mainboard.traj, COLOR_A(180));
+ err = wait_traj_end(END_INTR|END_TRAJ);
+
+ /* cob ejection */
+ trajectory_d_rel(&mainboard.traj, -70);
+ err = wait_traj_end(END_INTR|END_TRAJ);
+
+ i2c_cobboard_set_mode(I2C_COBBOARD_MODE_EJECT);
+ strat_db_dump(__FUNCTION__);
+ time_wait_ms(2000);
+
+ strat_event_enable();
+ want_pack = 0;
+ return 0;
+}
+