From 20353cdbe049c609a499bc51bba45e35c06d8d85 Mon Sep 17 00:00:00 2001 From: aarav18 Date: Sat, 5 Mar 2022 23:07:12 -0700 Subject: [PATCH] runClaw fixes --- src/main/java/frc4388/robot/subsystems/Claws.java | 9 +++++++-- 1 file changed, 7 insertions(+), 2 deletions(-) diff --git a/src/main/java/frc4388/robot/subsystems/Claws.java b/src/main/java/frc4388/robot/subsystems/Claws.java index cbebc47..0f79620 100644 --- a/src/main/java/frc4388/robot/subsystems/Claws.java +++ b/src/main/java/frc4388/robot/subsystems/Claws.java @@ -56,18 +56,23 @@ public class Claws extends SubsystemBase { * @param open Whether to open or close the claw. */ public void runClaw(ClawType which, boolean open) { + + int direction = open ? 1 : -1; + if (which == Claws.ClawType.LEFT) { // double setPos = open ? ClawsConstants.OPEN_POSITION + m_leftOffset : ClawsConstants.CLOSE_POSITION + m_leftOffset; // m_leftClaw.getEncoder().setPosition(setPos); - m_leftClaw.set(0.1); + m_leftClaw.set(direction * 0.1); } else if (which == Claws.ClawType.RIGHT) { // double setPos = open ? ClawsConstants.OPEN_POSITION + m_rightOffset : ClawsConstants.CLOSE_POSITION + m_rightOffset; // m_rightClaw.getEncoder().setPosition(setPos); - m_rightClaw.set(0.1); + m_rightClaw.set(direction * 0.1); } + + m_open = open; } public void setOpen(boolean open) {