commit 577edf6e0f36c56a4e8449cac16dd63bb97bc3d6
author Austin Schuh <austin@peloton-tech.com> Sun Apr 13 10:33:05 2014 -0700
committer Austin Schuh <austin@peloton-tech.com> Sun Apr 13 10:33:05 2014 -0700
tree 2c44c81fa46ae27261ec161a3dc71e5e65fc8841
parent 333e588f88a45d2789a2146e51af46a048f6c08e

Fixed auto so that it goes straight.

frc971/control_loops/drivetrain/drivetrain.cc

diff --git a/frc971/control_loops/drivetrain/drivetrain.cc b/frc971/control_loops/drivetrain/drivetrain.cc
index 7f50da8..168f87f 100644
--- a/frc971/control_loops/drivetrain/drivetrain.cc
+++ b/frc971/control_loops/drivetrain/drivetrain.cc
@@ -614,6 +614,8 @@
     }
     status->is_done = done;
     status->robot_speed = dt_closedloop.GetEstimatedRobotSpeed();
+    status->filtered_left_position = dt_closedloop.GetEstimatedLeftEncoder();
+    status->filtered_right_position = dt_closedloop.GetEstimatedRightEncoder();
   }
 }
 

frc971/control_loops/drivetrain/drivetrain.q

diff --git a/frc971/control_loops/drivetrain/drivetrain.q b/frc971/control_loops/drivetrain/drivetrain.q
index a3706bc..32eb2fb 100644
--- a/frc971/control_loops/drivetrain/drivetrain.q
+++ b/frc971/control_loops/drivetrain/drivetrain.q
@@ -52,6 +52,8 @@
   message Status {
     bool is_done;
     double robot_speed;
+    double filtered_left_position;
+    double filtered_right_position;
   };
 
   queue Goal goal;