Push out back collision bound to give us more room
Auto was lifting the arm IIRC. So let's give it enough range that it
won't. This isn't really an issue during teleop since we never ask it
to go somewhere that weird.
Change-Id: Ifc3cd55ffd0eeade9d5893953dc05a88895e4066
diff --git a/y2019/control_loops/superstructure/collision_avoidance.h b/y2019/control_loops/superstructure/collision_avoidance.h
index 7fc80cd..90a45f6 100644
--- a/y2019/control_loops/superstructure/collision_avoidance.h
+++ b/y2019/control_loops/superstructure/collision_avoidance.h
@@ -60,7 +60,7 @@
// Angle constraints for the wrist when below kElevatorClearDownHeight
static constexpr double kWristMaxAngle = M_PI / 2.0 + 0.05;
- static constexpr double kWristMinAngle = -M_PI / 2.0 - 0.05;
+ static constexpr double kWristMinAngle = -M_PI / 2.0 - 0.25;
// Angles outside of which the intake is fully clear of the wrist.
static constexpr double kIntakeOutAngle = 0.3;