commit 25db126343102eebf65caaf8a5790f80293a2760
author Austin Schuh <austin.linux@gmail.com> Wed Apr 05 19:39:55 2017 -0700
committer Austin Schuh <austin.linux@gmail.com> Sun Apr 09 16:16:31 2017 -0700
tree 13e31cfae544cb356c5740c7f05b3ee74a517d1a
parent 8e4a7ee0614c8b8ba7d85d8bd8a850d2f5516906

Calibrated camera offset.

Change-Id: I10113c9b80695c0b2407cd1df6fd3fe40d6390ca

y2017/control_loops/superstructure/column/column.cc

diff --git a/y2017/control_loops/superstructure/column/column.cc b/y2017/control_loops/superstructure/column/column.cc
index e57a646..e248739 100644
--- a/y2017/control_loops/superstructure/column/column.cc
+++ b/y2017/control_loops/superstructure/column/column.cc
@@ -375,7 +375,8 @@
               new ::frc971::control_loops::SimpleCappedStateFeedbackLoop<
                   6, 2, 2>(MakeIntegralColumnLoop())),
           constants::GetValues().column, constants::Values::kTurretRange, 7.0,
-          50.0) {}
+          50.0),
+      vision_error_(constants::GetValues().vision_error) {}
 
 void Column::Reset() {
   state_ = State::UNINITIALIZED;
@@ -531,7 +532,7 @@
           if (vision_time_adjuster_.valid()) {
             LOG(INFO, "Vision aligning to %f\n", vision_time_adjuster_.goal());
             profiled_subsystem_.set_turret_unprofiled_goal(
-                vision_time_adjuster_.goal());
+                vision_time_adjuster_.goal() + vision_error_);
           }
         }
 

y2017/control_loops/superstructure/column/column.h

diff --git a/y2017/control_loops/superstructure/column/column.h b/y2017/control_loops/superstructure/column/column.h
index b952a78..092e253 100644
--- a/y2017/control_loops/superstructure/column/column.h
+++ b/y2017/control_loops/superstructure/column/column.h
@@ -222,6 +222,8 @@
       ::aos::monotonic_clock::min_time;
 
   ColumnProfiledSubsystem profiled_subsystem_;
+
+  const double vision_error_;
 };
 
 }  // namespace column