Recalibrated shots.
Change-Id: I4b027e8d17b001c22fd0b3b98adfae88b792bf4d
diff --git a/y2016/joystick_reader.cc b/y2016/joystick_reader.cc
index d70215f..859a77b 100644
--- a/y2016/joystick_reader.cc
+++ b/y2016/joystick_reader.cc
@@ -218,7 +218,7 @@
if (data.IsPressed(kHigherFrontLong)) {
// Forwards shot
shoulder_goal_ = M_PI / 2.0 + 0.1;
- wrist_goal_ = M_PI + 0.43;
+ wrist_goal_ = M_PI + 0.43 + 0.02;
if (drivetrain_queue.status.get()) {
wrist_goal_ += drivetrain_queue.status->ground_angle;
}
@@ -227,7 +227,7 @@
} else if (data.IsPressed(kFrontLong)) {
// Forwards shot
shoulder_goal_ = M_PI / 2.0 + 0.1;
- wrist_goal_ = M_PI + 0.41;
+ wrist_goal_ = M_PI + 0.41 + 0.02;
if (drivetrain_queue.status.get()) {
wrist_goal_ += drivetrain_queue.status->ground_angle;
}
@@ -236,7 +236,7 @@
} else if (data.IsPressed(kBackLong)) {
// Backwards shot
shoulder_goal_ = M_PI / 2.0 - 0.4;
- wrist_goal_ = -0.62;
+ wrist_goal_ = -0.62 - 0.02;
if (drivetrain_queue.status.get()) {
wrist_goal_ += drivetrain_queue.status->ground_angle;
}