commit ff3e51d927a26fa971db2c48c9eeba941096879c
author Sabina Davis <sabina1109@gmail.com> Thu Oct 26 21:40:22 2017 -0700
committer Sabina Davis <sabina1109@gmail.com> Sat Nov 18 15:36:35 2017 -0800
tree 6aab80d59018450eb9c3194800f770743186a363
parent 92d2efa41e97cab0271c55359de26ecb8457df6e

Added joystick reader to y2017_bot3

Change-Id: Ic1b9e6344d43acce889650e49c22aaea420b8f5c

y2017_bot3/joystick_reader.cc

diff --git a/y2017_bot3/joystick_reader.cc b/y2017_bot3/joystick_reader.cc
index 0d43efd..40a8d12 100644
--- a/y2017_bot3/joystick_reader.cc
+++ b/y2017_bot3/joystick_reader.cc
@@ -14,7 +14,6 @@
 #include "frc971/autonomous/auto.q.h"
 #include "frc971/autonomous/base_autonomous_actor.h"
 #include "frc971/control_loops/drivetrain/drivetrain.q.h"
-#include "y2017_bot3/actors/autonomous_actor.h"
 #include "y2017_bot3/control_loops/superstructure/superstructure.q.h"
 
 using ::frc971::control_loops::drivetrain_queue;
@@ -46,7 +45,12 @@
   }
 
   void RunIteration(const ::aos::input::driver_station::Data &data) override {
-    bool last_auto_running = auto_running_;
+    if (!data.GetControlBit(ControlBit::kEnabled)) {
+      action_queue_.CancelAllActions();
+      LOG(DEBUG, "Canceling\n");
+    }
+
+    const bool last_auto_running = auto_running_;
     auto_running_ = data.GetControlBit(ControlBit::kAutonomous) &&
                     data.GetControlBit(ControlBit::kEnabled);
     if (auto_running_ != last_auto_running) {
@@ -67,11 +71,6 @@
     was_running_ = action_queue_.Running();
   }
 
-  if (!data.GetControlBit(ControlBit::kEnabled)) {
-    action_queue_.CancelAllActions();
-    LOG(DEBUG, "Canceling\n");
-  }
-
   void HandleDrivetrain(const ::aos::input::driver_station::Data &data) {
     drivetrain_input_reader_->HandleDrivetrain(data);
     robot_velocity_ = drivetrain_input_reader_->robot_velocity();