Add back catapult beambreak logic
Signed-off-by: Maxwell Henderson <mxwhenderson@gmail.com>
Change-Id: I9cf032eadf2b64d9e21352568063d9f7621119db
diff --git a/y2024/control_loops/superstructure/superstructure.cc b/y2024/control_loops/superstructure/superstructure.cc
index ebcbf1b..29b4cc9 100644
--- a/y2024/control_loops/superstructure/superstructure.cc
+++ b/y2024/control_loops/superstructure/superstructure.cc
@@ -47,6 +47,8 @@
const monotonic_clock::time_point timestamp =
event_loop()->context().monotonic_event_time;
+ (void)timestamp;
+
if (WasReset()) {
AOS_LOG(ERROR, "WPILib reset, restarting\n");
intake_pivot_.Reset();
@@ -191,7 +193,7 @@
output != nullptr ? &output_struct.altitude_voltage : nullptr,
output != nullptr ? &output_struct.turret_voltage : nullptr,
output != nullptr ? &output_struct.retention_roller_voltage : nullptr,
- robot_state().voltage_battery(), timestamp, &collision_avoidance_,
+ robot_state().voltage_battery(), &collision_avoidance_,
intake_pivot_.estimated_position(), &max_intake_pivot_position,
&min_intake_pivot_position, status->fbb());