control changes
This commit is contained in:
parent
4dc406583a
commit
c89b0f299b
|
|
@ -79,6 +79,9 @@ public class RobotContainer {
|
|||
|
||||
m_driverController.x().onTrue(intakeSubsystem.killSpeedCommand());
|
||||
m_driverController.a().onTrue(intakeSubsystem.startSpeedCommand());
|
||||
m_driverController.b().onTrue(intakeSubsystem.revSpeedCommand());
|
||||
m_driverController.b().onTrue(hopperSubsystem.revSpeedCommand());
|
||||
m_driverController.b().onTrue(turretSubsystem.revSpeedCommand());
|
||||
|
||||
intakeSubsystem.setDefaultCommand(new ManualIntake(intakeSubsystem, m_driverController.getHID()));
|
||||
}
|
||||
|
|
|
|||
|
|
@ -36,18 +36,10 @@ public class ManualIntake extends Command {
|
|||
// Called every time the scheduler runs while the command is scheduled.
|
||||
@Override
|
||||
public void execute() {
|
||||
if(m_XboxController.getLeftBumper()==true)
|
||||
if(m_XboxController.getYButton()==true)
|
||||
{
|
||||
m_subsystem.extend();
|
||||
}
|
||||
else if(m_XboxController.getRightBumper()==true)
|
||||
{
|
||||
m_subsystem.retract();
|
||||
}
|
||||
else
|
||||
{
|
||||
m_subsystem.neutral();
|
||||
}
|
||||
}
|
||||
|
||||
// Called once the command ends or is interrupted.
|
||||
|
|
|
|||
|
|
@ -13,6 +13,7 @@ import edu.wpi.first.wpilibj2.command.Command;
|
|||
public class ManualShootCommand extends Command {
|
||||
private final TurretSubsystem m_subsystem;
|
||||
private final XboxController m_controller;
|
||||
private double tempAng;
|
||||
|
||||
public ManualShootCommand(TurretSubsystem subsystem, XboxController controller) {
|
||||
m_subsystem = subsystem;
|
||||
|
|
|
|||
|
|
@ -9,6 +9,8 @@ import org.fairportrobotics.frc.posty.test.PostTest;
|
|||
|
||||
import com.ctre.phoenix6.hardware.TalonFX;
|
||||
|
||||
import edu.wpi.first.wpilibj2.command.Command;
|
||||
|
||||
import static org.fairportrobotics.frc.posty.assertions.Assertions.*;
|
||||
import static org.fairportrobotics.frc.robolib.motors.Utils.*;
|
||||
import frc.robot.Constants;
|
||||
|
|
@ -34,6 +36,11 @@ public class HopperSubsystem extends TestableSubsystem {
|
|||
|
||||
public void spin(double speed) {spindexerMotor.set(speed);}
|
||||
|
||||
public Command revSpeedCommand()
|
||||
{
|
||||
return this.runOnce(() -> reverse());
|
||||
}
|
||||
|
||||
@PostTest(name = "A friendly name", enabled = true)
|
||||
public void myFailingPostTest(){
|
||||
assertThat(true).isFalse();
|
||||
|
|
|
|||
|
|
@ -37,51 +37,16 @@ public class IntakeSubsystem extends TestableSubsystem {
|
|||
deployMotor.setInverted(Constants.IntakeConstants.DEPLOY_MOTOR_INVERTED);
|
||||
}
|
||||
|
||||
public void neutral()
|
||||
{
|
||||
deployMotor.set(0);
|
||||
}
|
||||
|
||||
public void extend()
|
||||
{
|
||||
deployMotor.set(1);
|
||||
}
|
||||
|
||||
public void retract()
|
||||
{
|
||||
deployMotor.set(-1);
|
||||
}
|
||||
|
||||
public void setSpeed(double speed)
|
||||
{
|
||||
intakeMotor.set(speed);
|
||||
}
|
||||
|
||||
public boolean isDeployed()
|
||||
{
|
||||
return deployMotor.isFwdLimitSwitchClosed()==1;
|
||||
}
|
||||
|
||||
public boolean isRetracted()
|
||||
{
|
||||
return deployMotor.isRevLimitSwitchClosed()==1;
|
||||
}
|
||||
|
||||
public Command deployCommand()
|
||||
{
|
||||
return new FunctionalCommand(this::extend, this::extend, interrupted -> neutral(), this::isDeployed, this).andThen(Commands.startEnd(() -> setSpeed(.5), () -> setSpeed(0), this));
|
||||
}
|
||||
|
||||
public Command reverseCommand()
|
||||
{
|
||||
return new FunctionalCommand(this::extend, this::extend, interrupted -> neutral(), this::isDeployed, this).andThen(Commands.startEnd(() -> setSpeed(-.5), () -> setSpeed(0), this));
|
||||
}
|
||||
|
||||
public Command retractCommand()
|
||||
{
|
||||
return this.runOnce(() -> setSpeed(0)).andThen(new FunctionalCommand(this::retract, this::retract, interrupted -> neutral(), this::isRetracted, this));
|
||||
}
|
||||
|
||||
public Command startSpeedCommand()
|
||||
{
|
||||
return this.runOnce(() -> setSpeed(-.5));
|
||||
|
|
|
|||
|
|
@ -25,6 +25,7 @@ import edu.wpi.first.units.measure.Angle;
|
|||
import edu.wpi.first.units.measure.Velocity;
|
||||
import edu.wpi.first.wpilibj.DigitalInput;
|
||||
import edu.wpi.first.wpilibj.Servo;
|
||||
import edu.wpi.first.wpilibj2.command.Command;
|
||||
|
||||
public class TurretSubsystem extends TestableSubsystem {
|
||||
public enum TurretState {
|
||||
|
|
@ -76,6 +77,11 @@ public class TurretSubsystem extends TestableSubsystem {
|
|||
hood.setAngle(elev.in(Units.Degrees));
|
||||
}
|
||||
|
||||
public Command revSpeedCommand()
|
||||
{
|
||||
return this.runOnce(() -> setLauncher(-.5));
|
||||
}
|
||||
|
||||
public void startHoming()
|
||||
{
|
||||
//turretMotor.set(Constants.ShooterConstants.HOMING_SPEED);
|
||||
|
|
|
|||
Loading…
Reference in New Issue