commit 6a8131ba5d6a3512d97c705f225f0700942f66c2
author Austin Schuh <austin.linux@gmail.com> Sat Apr 08 15:39:22 2017 -0700
committer Austin Schuh <austin.linux@gmail.com> Sun Apr 09 18:04:05 2017 -0700
tree 72cd10c8765e87e2dcc2d9a643db4786502a716a
parent 8e3ac0febb6062809e9a82dd4ee3bbeb54866c5e

Servo now routed for gear.

Change-Id: Ifee31cb80bbdfbcf4ef900fe701f578987e9d7e5

y2017/wpilib_interface.cc

diff --git a/y2017/wpilib_interface.cc b/y2017/wpilib_interface.cc
index 65b2246..293be55 100644
--- a/y2017/wpilib_interface.cc
+++ b/y2017/wpilib_interface.cc
@@ -13,6 +13,7 @@
 #include "Counter.h"
 #include "Encoder.h"
 #include "VictorSP.h"
+#include "Servo.h"
 #include "Relay.h"
 #include "DriverStation.h"
 #include "AnalogInput.h"
@@ -570,6 +571,9 @@
     indexer_roller_victor_ = ::std::move(t);
   }
 
+  void set_gear_servo(::std::unique_ptr<::frc::Servo> t) {
+    gear_servo_ = ::std::move(t);
+  }
   void set_shooter_victor(::std::unique_ptr<VictorSP> t) {
     shooter_victor_ = ::std::move(t);
   }
@@ -615,6 +619,8 @@
     red_light_->Set(queue->red_light_on);
     green_light_->Set(queue->green_light_on);
     blue_light_->Set(queue->blue_light_on);
+
+    gear_servo_->Set(queue->gear_servo);
   }
 
   virtual void Stop() override {
@@ -627,6 +633,8 @@
     hood_victor_->SetDisabled();
     shooter_victor_->SetDisabled();
 
+    gear_servo_->SetOffline();
+
     red_light_->Set(true);
     green_light_->Set(true);
     blue_light_->Set(true);
@@ -636,6 +644,8 @@
       indexer_victor_, indexer_roller_victor_, shooter_victor_,
       turret_victor_, hood_victor_;
 
+  ::std::unique_ptr<::frc::Servo> gear_servo_;
+
   ::std::unique_ptr<DigitalOutput> red_light_, green_light_, blue_light_;
 };
 
@@ -714,6 +724,9 @@
     superstructure_writer.set_shooter_victor(
         ::std::unique_ptr<VictorSP>(new VictorSP(8)));
 
+    superstructure_writer.set_gear_servo(
+        ::std::unique_ptr<Servo>(new Servo(0)));
+
     superstructure_writer.set_red_light(
         ::std::unique_ptr<DigitalOutput>(new DigitalOutput(5)));
     superstructure_writer.set_green_light(