Testing for storage

This commit is contained in:
ryan123rudder
2020-02-28 21:05:40 -07:00
parent b45f66b023
commit f8c2235ea7
2 changed files with 5 additions and 2 deletions
@@ -194,6 +194,10 @@ public class RobotContainer {
new JoystickButton(getOperatorJoystick(), XboxController.B_BUTTON)
.whileHeld(new RunCommand(() -> m_robotShooter.m_angleAdjustMotor.set(-0.2)))
.whenReleased(new RunCommand(() -> m_robotShooter.m_angleAdjustMotor.set(0)));
new JoystickButton(getOperatorJoystick(), XboxController.START_BUTTON)
.whileHeld(new RunCommand(() -> m_robotStorage.runStoragePositionPID(7)))
.whenReleased(new RunCommand(() -> m_robotShooter.m_angleAdjustMotor.set(0)));
}
/**
@@ -31,8 +31,7 @@ public class StoragePositionPID extends CommandBase {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
System.err.println("oooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooooiujgxzxfghjkiujsdasdgioiedsdjkl");
m_storage.runStoragePositionPID(m_storage.getEncoderPos() + StorageConstants.STORAGE_FULL_BALL);
m_storage.runStoragePositionPID(StorageConstants.STORAGE_FULL_BALL);
}
// Called once the command ends or is interrupted.