added commands for intaking notes (im tweakin)

This commit is contained in:
Abhishrek05
2024-02-10 15:48:00 -07:00
parent 91343469bd
commit fa26da2b2b
3 changed files with 95 additions and 21 deletions
@@ -4,6 +4,8 @@
package frc4388.robot.subsystems;
import java.util.function.BooleanSupplier;
import com.revrobotics.CANSparkMax;
import com.revrobotics.SparkLimitSwitch;
import com.revrobotics.SparkPIDController;
@@ -78,13 +80,36 @@ public class Intake extends SubsystemBase {
}
public void pidIn() {
m_spedController.setReference(8000, CANSparkMax.ControlType.kVelocity);
m_spedController.setReference(2.5, CANSparkMax.ControlType.kPosition);
//SmartDashboard.putNumber("Velocity Output", pivot.getEncoder().getVelocity());
}
public void pidOut() {
m_spedController.setReference(-8000, CANSparkMax.ControlType.kVelocity);
public void limitNote() {
if (intakeforwardLimit.isPressed()) {
rotateArmIn2();
} else {
spinIntakeMotor();
}
}
public void pidOut() {
m_spedController.setReference(-53, CANSparkMax.ControlType.kPosition);
}
public void rotateArmOut2() {
if(reverseLimit.isPressed()){
stopArmMotor();
} else {
pidOut();
}
}
public void rotateArmIn2() {
if(forwardLimit.isPressed()){
stopArmMotor();
} else {
pidIn();
}
}
@@ -131,6 +156,10 @@ public class Intake extends SubsystemBase {
}
public BooleanSupplier getArmFowardLimitState() {
return forwardLimit::isPressed;
}
@Override
public void periodic() {
// This method will be called once per scheduler run