commit 225f0b93e9094c4c8fc0c0e1e71841c4e785cf60
author Comran Morshed <comranmorsh@gmail.com> Wed Feb 10 20:34:27 2016 +0000
committer Comran Morshed <comranmorsh@gmail.com> Sun Feb 14 16:50:11 2016 +0000
tree cad42b809576188ce0dc2b801d635cefb234cd6c
parent 10c2d11ec8c7839f0d8b7a7f75147b364fdf19f9

Add stuff we have so far to wpilib_interface.

Change-Id: If880956affacf585d12f4df799f3c6426cf677f1

y2016/control_loops/drivetrain/BUILD

diff --git a/y2016/control_loops/drivetrain/BUILD b/y2016/control_loops/drivetrain/BUILD
index 1150426..cfdcf42 100644
--- a/y2016/control_loops/drivetrain/BUILD
+++ b/y2016/control_loops/drivetrain/BUILD
@@ -60,6 +60,7 @@
   deps = [
     ':polydrivetrain_plants',
     '//frc971/control_loops/drivetrain:drivetrain_config',
+    '//frc971:shifter_hall_effect',
     '//y2016:constants',
   ],
 )

y2016/control_loops/drivetrain/drivetrain_base.cc

diff --git a/y2016/control_loops/drivetrain/drivetrain_base.cc b/y2016/control_loops/drivetrain/drivetrain_base.cc
index 2e5138c..ae2e62f 100644
--- a/y2016/control_loops/drivetrain/drivetrain_base.cc
+++ b/y2016/control_loops/drivetrain/drivetrain_base.cc
@@ -2,6 +2,7 @@
 
 #include "frc971/control_loops/drivetrain/drivetrain_config.h"
 
+#include "frc971/control_loops/state_feedback_loop.h"
 #include "y2016/control_loops/drivetrain/drivetrain_dog_motor_plant.h"
 #include "y2016/control_loops/drivetrain/polydrivetrain_dog_motor_plant.h"
 #include "y2016/control_loops/drivetrain/kalman_drivetrain_motor_plant.h"
@@ -12,6 +13,10 @@
 namespace y2016 {
 namespace control_loops {
 
+using ::frc971::constants::ShifterHallEffect;
+
+const ShifterHallEffect kThreeStateDriveShifter{0.0, 0.0, 0.0, 0.0, 0.5, 0.5};
+
 const DrivetrainConfig &GetDrivetrainConfig() {
   static DrivetrainConfig kDrivetrainConfig{
       ::frc971::control_loops::drivetrain::ShifterType::HALL_EFFECT_SHIFTER,
@@ -33,11 +38,11 @@
       drivetrain::kV,
       drivetrain::kT,
 
-      constants::GetValues().turn_width,
-      constants::GetValues().high_gear_ratio,
-      constants::GetValues().low_gear_ratio,
-      constants::GetValues().left_drive,
-      constants::GetValues().right_drive};
+      constants::Values::kTurnWidth,
+      constants::Values::kHighGearRatio,
+      constants::Values::kLowGearRatio,
+      kThreeStateDriveShifter,
+      kThreeStateDriveShifter};
 
   return kDrivetrainConfig;
 };