added stuff (im geekin)

This commit is contained in:
Abhishrek05
2024-01-26 20:56:02 -07:00
parent e4d22570bd
commit 330ee25b1a
3 changed files with 10 additions and 5 deletions
@@ -162,6 +162,7 @@ public final class Constants {
public static final int INTAKE_MOTOR_ID = 17; //TODO:
public static final int PIVOT_MOTOR_ID = 18; //TODO:
public static final double INTAKE_SPEED = 0.2; //TODO:
public static final double HANDOFF_SPEED = 0.2; //TODO:
public static final double PIVOT_SPEED = 0.2; //TODO:
}
@@ -13,9 +13,11 @@ import edu.wpi.first.wpilibj2.command.SubsystemBase;
import frc4388.robot.Constants.IntakeConstants;
public class Intake extends SubsystemBase {
/** Creates a new Intake. */
private CANSparkMax intakeMotor;
private CANSparkMax pivot;
/** Creates a new Intake. */
public Intake(CANSparkMax intakeMotor, CANSparkMax pivot) {
this.intakeMotor = intakeMotor;
this.pivot = pivot;
@@ -28,23 +30,24 @@ public class Intake extends SubsystemBase {
//Rotate robot in for handoff
public void rotateArmIn() {
//TODO
pivot.set(IntakeConstants.PIVOT_SPEED);
}
//Rotates robot out for intake
public void rotateArmOut() {
//TODO
pivot.set(-IntakeConstants.INTAKE_SPEED);
pivot.set(-IntakeConstants.PIVOT_SPEED);
}
public void handoff() {
intakeMotor.set(-IntakeConstants.INTAKE_SPEED);
}
public void stopIntakeMotors() {
intakeMotor.set(0);
}
public void rotateArm() {
//TODO
}
@Override
@@ -14,6 +14,7 @@ import com.ctre.phoenix.motorcontrol.NeutralMode;
public class Shooter extends SubsystemBase {
private TalonFX leftShooter;
private TalonFX rightShooter;