2023-01-24 17:04:19 -07:00
|
|
|
package frc4388.robot.subsystems;
|
2023-03-11 14:03:36 -07:00
|
|
|
import edu.wpi.first.hal.PWMJNI;
|
2023-01-24 17:04:19 -07:00
|
|
|
import edu.wpi.first.wpilibj.PWM;
|
2023-03-06 18:36:32 -07:00
|
|
|
import edu.wpi.first.wpilibj2.command.SubsystemBase;
|
2023-01-24 17:04:19 -07:00
|
|
|
|
2023-03-06 18:36:32 -07:00
|
|
|
public class Claw extends SubsystemBase {
|
2023-01-24 17:04:19 -07:00
|
|
|
private PWM m_clawMotor;
|
2023-03-11 14:03:36 -07:00
|
|
|
private boolean m_open = false;
|
|
|
|
|
private boolean m_disabled = false;
|
2023-01-24 17:04:19 -07:00
|
|
|
|
2023-01-23 19:53:30 -07:00
|
|
|
// Opens claw
|
2023-01-24 17:04:19 -07:00
|
|
|
public Claw(PWM m_clawMotor) {
|
|
|
|
|
this.m_clawMotor = m_clawMotor;
|
|
|
|
|
setClaw(true);
|
|
|
|
|
}
|
2023-01-23 19:53:30 -07:00
|
|
|
|
2023-01-24 17:04:19 -07:00
|
|
|
public void setClaw(boolean open) {
|
|
|
|
|
// Open claw
|
|
|
|
|
m_open = open;
|
2023-03-14 14:26:47 -06:00
|
|
|
m_clawMotor.setRaw(m_open ? 1000 : 2000);
|
2023-01-23 19:53:30 -07:00
|
|
|
}
|
|
|
|
|
|
2023-03-06 19:40:50 -07:00
|
|
|
public void toggle() {
|
|
|
|
|
setClaw(!m_open);
|
|
|
|
|
}
|
|
|
|
|
|
2023-01-24 17:04:19 -07:00
|
|
|
public boolean isClawOpen() {
|
|
|
|
|
return m_open;
|
|
|
|
|
}
|
2023-03-11 14:03:36 -07:00
|
|
|
|
2023-03-14 15:27:53 -06:00
|
|
|
}
|