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));
diff --git a/frc971/actors/stack_and_hold_actor.cc b/frc971/actors/stack_and_hold_actor.cc
index 2acb415..ab9b077 100644
--- a/frc971/actors/stack_and_hold_actor.cc
+++ b/frc971/actors/stack_and_hold_actor.cc
@@ -23,6 +23,9 @@
: FridgeActorBase<StackAndHoldActionQueueGroup>(queues) {}
bool StackAndHoldActor::RunAction(const StackAndHoldParams ¶ms) {
+ // TODO(ben)): this action is no longer used (source Cameron) and my be broken
+ // by the stack action having the grabbers closed at the end for the fangs. So
+ // here I am disabling it until further information is provided.
if (params.place_not_stack) {
// Move the arm out of the way.
{