Team4388/2023WayOfTheRobot
1
0
Fork 0
mirror of https://github.com/Team4388/2023WayOfTheRobot.git synced 2026-06-09 00:37:59 -06:00
Code Issues Packages Projects Releases Wiki Activity

commit

Browse Source
This commit is contained in:
Aarav
2023-03-11 14:03:36 -07:00
parent dfc6978186
commit 5521349510
7 changed files with 143 additions and 30 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/subsystems/Claw.java
+25 -2
View File
@@ -1,10 +1,12 @@
package frc4388.robot.subsystems;
import edu.wpi.first.hal.PWMJNI;
import edu.wpi.first.wpilibj.PWM;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class Claw extends SubsystemBase {
private PWM m_clawMotor;
private boolean m_open = false;
private boolean m_open = false;
private boolean m_disabled = false;
// Opens claw
public Claw(PWM m_clawMotor) {
@@ -13,16 +15,37 @@ public class Claw extends SubsystemBase {
}
public void setClaw(boolean open) {
if (m_disabled) return;
// Open claw
// m_clawMotor.setRaw(150);
m_open = open;
m_clawMotor.setRaw(open ? 0 : 2000);
System.out.println("setClaw()");
// m_clawMotor.setPosition(0.5);
// m_clawMotor.setRaw(0);
// m_clawMotor.setRaw(m_open ? 0 : 255);
// m_clawMotor.setSpeed(m_open ? -1 : 1);
PWMJNI.setPWMSpeed(m_clawMotor.getHandle(), m_open ? -1 : 1);
// PWMJNI.setPWMDisabled(0);
System.out.println("Claw Pos: " + m_clawMotor.getRaw());
}
public void toggle() {
System.out.println("toggle()");
setClaw(!m_open);
}
public boolean isClawOpen() {
return m_open;
}
public void disable() {
m_disabled = true;
// PWMJNI.setPWMRaw(m_clawMotor.getHandle(), PWMJNI.getPWMRaw(m_clawMotor.getHandle()));
PWMJNI.setPWMSpeed(m_clawMotor.getHandle(), 0.5);
// PWMJNI.setPWMDisabled(m_clawMotor.getHandle());
}
public void enable() {
m_disabled = false;
}
}