Added position control and profiling to drivetrain.
Change-Id: I09ad01c46b23f1c7b6e8530bc10b03a733245b95
diff --git a/y2016/autonomous/auto.cc b/y2016/autonomous/auto.cc
index b315223..2b1c8d2 100644
--- a/y2016/autonomous/auto.cc
+++ b/y2016/autonomous/auto.cc
@@ -95,9 +95,9 @@
void InitializeEncoders() {
::frc971::control_loops::drivetrain_queue.status.FetchAnother();
left_initial_position =
- ::frc971::control_loops::drivetrain_queue.status->filtered_left_position;
+ ::frc971::control_loops::drivetrain_queue.status->estimated_left_position;
right_initial_position =
- ::frc971::control_loops::drivetrain_queue.status->filtered_right_position;
+ ::frc971::control_loops::drivetrain_queue.status->estimated_right_position;
}
void HandleAuto() {