Removed open of the grabber for stack action compatability with the fangs
Change-Id: I5bff1860f7ff6dafe1dd37b398fe3d125b5111d7
diff --git a/frc971/actors/stack_actor.cc b/frc971/actors/stack_actor.cc
index 3b80184..49fbf98 100644
--- a/frc971/actors/stack_actor.cc
+++ b/frc971/actors/stack_actor.cc
@@ -75,20 +75,25 @@
}
if (params.only_place) {
+ // open grabber for place only
DoFridgeProfile(params.bottom + values.tote_height, 0.0, kFastElevatorMove,
kFastArmMove, false);
// Finish early if we aren't supposed to grab.
return true;
}
- DoFridgeProfile(params.bottom + values.tote_height, params.arm_clearance,
+ // TODO(ben): I'm not sure why this liitle jog is here. we are removing it for
+ // the fangs, but I want to keep the code here so austin can explain.
+ /*DoFridgeProfile(params.bottom + values.tote_height, params.arm_clearance,
kFastElevatorMove, kFastArmMove, false);
if (ShouldCancel()) return true;
DoFridgeProfile(params.bottom, params.arm_clearance, kFastElevatorMove,
- kFastArmMove, false);
+ kFastArmMove, false);*/
if (ShouldCancel()) return true;
- DoFridgeProfile(params.bottom, 0.0, kFastElevatorMove, kFastArmMove, false);
+ // grab can (if in fang mode the grabber stays closed)
+ DoFridgeProfile(params.bottom, 0.0, kFastElevatorMove, kFastArmMove, false,
+ true, true);
if (ShouldCancel()) return true;
aos::time::SleepFor(aos::time::Time::InMS(200));