mirror of
https://github.com/Team4388/2026KPopRobotHunters.git
synced 2026-06-09 00:38:03 -06:00
instant commands for testing
This commit is contained in:
@@ -18,11 +18,11 @@ public class Intake extends SubsystemBase {
|
||||
Supplier<Pose2d> m_swervePoseSupplier;
|
||||
|
||||
public Intake(
|
||||
IntakeIO io,
|
||||
Supplier<Pose2d> swervePoseSupplier
|
||||
IntakeIO io
|
||||
// Supplier<Pose2d> swervePoseSupplier
|
||||
) {
|
||||
this.io = io;
|
||||
this.m_swervePoseSupplier = swervePoseSupplier;
|
||||
// this.m_swervePoseSupplier = swervePoseSupplier;
|
||||
}
|
||||
|
||||
public enum IntakeMode {
|
||||
@@ -33,11 +33,11 @@ public class Intake extends SubsystemBase {
|
||||
public void setMode(IntakeMode mode) {
|
||||
switch (mode) {
|
||||
case Up:
|
||||
io.setArmAngle(state, IntakeConstants.ARM_LIMIT_UPPER);
|
||||
// io.setArmAngle(state, IntakeConstants.ARM_LIMIT_UPPER);
|
||||
io.setRollerVelocity(state, IntakeConstants.ROLLER_STOP);
|
||||
break;
|
||||
case Down:
|
||||
io.setArmAngle(state, IntakeConstants.ARM_LIMIT_LOWER);
|
||||
// io.setArmAngle(state, IntakeConstants.ARM_LIMIT_LOWER);
|
||||
io.setRollerVelocity(state, IntakeConstants.ROLLER_MAX_VELOCITY);
|
||||
break;
|
||||
}
|
||||
|
||||
@@ -23,7 +23,6 @@ public class IntakeConstants {
|
||||
|
||||
//IDs
|
||||
|
||||
|
||||
public static final CanDevice ARM_ID = new CanDevice("SHOOTER 1", 20);
|
||||
public static final CanDevice ROLLER_ID = new CanDevice("SHOOTER 2", 21);
|
||||
|
||||
@@ -31,8 +30,11 @@ public class IntakeConstants {
|
||||
|
||||
// 0 is the forward angle on the robot.
|
||||
// negative is left, positive is right
|
||||
public static final Angle ARM_LIMIT_LOWER = Degrees.of(-180);
|
||||
public static final Angle ARM_LIMIT_UPPER = Degrees.of(180);
|
||||
|
||||
//when testing the negative output of 10% made the robot put the intake up
|
||||
|
||||
public static final Angle ARM_LIMIT_LOWER = Degrees.of(90);
|
||||
public static final Angle ARM_LIMIT_UPPER = Degrees.of(-90);
|
||||
public static final AngularVelocity ROLLER_MAX_VELOCITY = RotationsPerSecond.of(4.0);
|
||||
public static final AngularVelocity ROLLER_STOP = RotationsPerSecond.of(0.0);
|
||||
|
||||
|
||||
Reference in New Issue
Block a user