commit 889fee844fb5dd09f07510229e844b13b4344661
author Austin Schuh <austin.linux@gmail.com> Wed Apr 13 22:16:36 2016 -0700
committer Austin Schuh <austin.linux@gmail.com> Wed Apr 13 22:21:46 2016 -0700
tree d232b2c81e076d7864b834e779274f6139db1321
parent b0099646e19c1785a772360b6989cb0b7b1bda8b

Made down offset a constant.

Change-Id: Ic0e3aa3867dbdce4037cbac23dc26999487c1489

y2016/joystick_reader.cc

diff --git a/y2016/joystick_reader.cc b/y2016/joystick_reader.cc
index dcc528f..8575fdf 100644
--- a/y2016/joystick_reader.cc
+++ b/y2016/joystick_reader.cc
@@ -66,7 +66,6 @@
 const ButtonLocation kChevalDeFrise(3, 8);
 
 const ButtonLocation kVisionAlign(3, 4);
-constexpr double kDownOffset = 0.011;
 
 class Reader : public ::aos::input::JoystickInput {
  public:
@@ -215,7 +214,7 @@
       shoulder_goal_ = M_PI / 2.0 + 0.1;
       wrist_goal_ = M_PI + 0.43;
       if (drivetrain_queue.status.get()) {
-        wrist_goal_ += drivetrain_queue.status->ground_angle + kDownOffset;
+        wrist_goal_ += drivetrain_queue.status->ground_angle;
       }
       shooter_velocity_ = 640.0;
       intake_goal_ = intake_when_shooting;
@@ -224,7 +223,7 @@
       shoulder_goal_ = M_PI / 2.0 + 0.1;
       wrist_goal_ = M_PI + 0.41;
       if (drivetrain_queue.status.get()) {
-        wrist_goal_ += drivetrain_queue.status->ground_angle + kDownOffset;
+        wrist_goal_ += drivetrain_queue.status->ground_angle;
       }
       shooter_velocity_ = 640.0;
       intake_goal_ = intake_when_shooting;
@@ -233,7 +232,7 @@
       shoulder_goal_ = M_PI / 2.0 - 0.4;
       wrist_goal_ = -0.62;
       if (drivetrain_queue.status.get()) {
-        wrist_goal_ += drivetrain_queue.status->ground_angle + kDownOffset;
+        wrist_goal_ += drivetrain_queue.status->ground_angle;
       }
       shooter_velocity_ = 640.0;
       intake_goal_ = intake_when_shooting;