Added force lights on shooter queue feature.
Change-Id: I6a463c81770b862ea363cc4dd4737065f72a71cb
diff --git a/y2016/control_loops/shooter/shooter.cc b/y2016/control_loops/shooter/shooter.cc
index 699903d..32ccc7e 100644
--- a/y2016/control_loops/shooter/shooter.cc
+++ b/y2016/control_loops/shooter/shooter.cc
@@ -83,7 +83,7 @@
// Turn the lights on if we are supposed to spin.
if (output) {
- if (::std::abs(goal->angular_velocity) > 0.0) {
+ if (::std::abs(goal->angular_velocity) > 0.0 || goal->force_lights_on) {
output->lights_on = true;
}
}
diff --git a/y2016/control_loops/shooter/shooter.q b/y2016/control_loops/shooter/shooter.q
index 00149a8..6598319 100644
--- a/y2016/control_loops/shooter/shooter.q
+++ b/y2016/control_loops/shooter/shooter.q
@@ -28,6 +28,9 @@
// is up to speed, push the ball into the shooter, and then wait until it
// spins up and down before letting the piston be released.
bool push_to_shooter;
+
+ // Forces the lights on.
+ bool force_lights_on;
};
message Position {