commit 00e4227fd886b1bd08cdcd070b4a79c06ba58cf0
author Theo Bafrali <100019017@mvla.net> Tue Feb 12 01:07:46 2019 -0800
committer Austin Schuh <austin@peloton-tech.com> Wed Feb 13 00:09:54 2019 -0800
tree 867d2402f5070f06571f3f29862af275d14e5417
parent a64a3f975cd52d0477328a75cc275912bc36be35

Implement superstructure class and tests

Change-Id: If5a2a296ada3dd625ad7eb74af106b36b36ab932

y2019/joystick_reader.cc

diff --git a/y2019/joystick_reader.cc b/y2019/joystick_reader.cc
index 7bb32b2..ed57a24 100644
--- a/y2019/joystick_reader.cc
+++ b/y2019/joystick_reader.cc
@@ -108,27 +108,27 @@
 
     // TODO(sabina): get accurate angle.
     if (data.IsPressed(kIntakeExtend)) {
-      new_superstructure_goal->intake.joint_angle = 0.5;
+      new_superstructure_goal->intake.unsafe_goal = 0.5;
     } else {
-      new_superstructure_goal->intake.joint_angle = 0.0;
+      new_superstructure_goal->intake.unsafe_goal = 0.0;
     }
 
     if (data.IsPressed(kIntake)) {
       new_superstructure_goal->suction.bottom = true;
       if (superstructure_queue.status->has_piece == false) {
-        new_superstructure_goal->intake.roller_voltage = 12.0;
+        new_superstructure_goal->roller_voltage = 12.0;
       } else {
-        new_superstructure_goal->intake.roller_voltage = 0.0;
+        new_superstructure_goal->roller_voltage = 0.0;
       }
     } else if (data.IsPressed(kSpit)) {
       new_superstructure_goal->suction.bottom = false;
       if (superstructure_queue.status->has_piece == false) {
-        new_superstructure_goal->intake.roller_voltage = 12.0;
+        new_superstructure_goal->roller_voltage = 12.0;
       } else {
-        new_superstructure_goal->intake.roller_voltage = 0.0;
+        new_superstructure_goal->roller_voltage = 0.0;
       }
     } else {
-      new_superstructure_goal->intake.roller_voltage = 0.0;
+      new_superstructure_goal->roller_voltage = 0.0;
     }
 
     // TODO(sabina): decide if we should really have disk suction as its own
@@ -147,9 +147,9 @@
 
     // TODO(sabina): max height please?
     if (data.IsPressed(kDeployStilt)) {
-      new_superstructure_goal->stilts.height = 0;
+      new_superstructure_goal->stilts.unsafe_goal= 0;
     } else if (data.IsPressed(kRetractStilt)) {
-      new_superstructure_goal->stilts.height = 0;
+      new_superstructure_goal->stilts.unsafe_goal = 0;
     } else {
     }
 
@@ -157,8 +157,8 @@
       wrist_angle_ = -wrist_angle_;
     }
 
-    new_superstructure_goal->elevator.height = elevator_height_;
-    new_superstructure_goal->wrist.angle = wrist_angle_;
+    new_superstructure_goal->elevator.unsafe_goal = elevator_height_;
+    new_superstructure_goal->wrist.unsafe_goal = wrist_angle_;
 
     LOG_STRUCT(DEBUG, "sending goal", *new_superstructure_goal);
     if (!new_superstructure_goal.Send()) {