This commit is contained in:
Ryan Manley
2022-03-05 11:04:40 -07:00
parent 4b7740fa44
commit 78f3b47846
6 changed files with 78 additions and 58 deletions
@@ -66,18 +66,26 @@ public double m_fireAngle;
// m_angleAdjusterPIDController.setReference(targetAngle, ControlType.kPosition);
// }
/**
* Runs The Hood
* @param input The Speed Times 0.6
*/
public void runHood(double input) {
input *= .6;
m_angleAdjustMotor.set(input);
}
/**
* Resets The Encoder
*/
public void resetGyroAngleAdj(){
m_angleEncoder.setPosition(0);
}
/**
* Gets The Encoders Position
* @return The Encoders Position
*/
public double getAnglePositionPID() {
return m_angleEncoder.getPosition();
}
@@ -46,19 +46,28 @@ public class Intake extends SubsystemBase {
public void periodic() {
// This method will be called once per scheduler run
}
/**
* Runs The Intake With Triggers.
* @param leftTrigger Left Trigger to Run -
* @param rightTrigger Right Trigger to Run +
*/
public void runWithTriggers(double leftTrigger, double rightTrigger) {
m_intakeMotor.set(rightTrigger - leftTrigger);
}
/**
* Runs The Extender
* @param extended Wether the Extender Is Extended
*/
public void runExtender(boolean extended) { //TODO: Do not bring intake in if there is a ball in the extender (check if intake being in brakes the beam brake?)
double extenderMotorSpeed = extended ? 0.25d : 0.d;
m_extenderMotor.set(extenderMotorSpeed);
}
/**
* Toggles The Extender
*/
public void toggleExtender() {
toggle = !toggle;
extendExtender(toggle);
runExtender(toggle);
}
//Test
}
@@ -23,29 +23,52 @@ public class Serializer extends SubsystemBase{
m_serializerShooterBelt.set(0);
}
/**
* Gets The State Of The Beam
* @return The State Of The Beam
*/
public boolean getBeam() {
return m_serializerBeam.get();
}
public void setSerializerStateWithBeam(boolean ctrlbutter, boolean beambroken) {
boolean total = ctrlbutter || beambroken;
/**
* Sets The Serializer State With The Beam
* @param state Your State Of The Button
* @param beambroken The State of the Beam Senser
*/
public void setSerializerStateWithBeam(boolean state, boolean beambroken) {
boolean total = state || beambroken;
setSerializerState(total);
}
/**
* Sets The Serializer State With The Beam
* @param state Your State Of The Button
*/
public void setSerializerState(boolean state) {
setSerializerBeltState(state);
setSerializerShooterBeltState(state);
serializerState = state;
}
/**
* Sets the Serializer Belt State
* @param state Your State Of The Button
*/
public void setSerializerBeltState(boolean state) {
double serializerBeltSpeed = state ? Constants.SerializerConstants.SERIALIZER_BELT_SPEED : 0.d;
m_serializerBelt.set(serializerBeltSpeed);
}
/**
* Sets the Shooter Belt State
* @param state Your State Of The Button
*/
public void setSerializerShooterBeltState(boolean state) {
double serializerShooterBeltSpeed = state ? Constants.SerializerConstants.SERIALIZER_SHOOTER_BELT_SPEED : 0.d;
m_serializerShooterBelt.set(serializerShooterBeltSpeed);
}
/**
* Gets the Serializer State
* @return The Serializer State
*/
public boolean getSerializerState() {
return serializerState;
}
@@ -19,24 +19,42 @@ public class Storage extends SubsystemBase {
public Storage() {
}
/**
* If The Beam Is Broken, Run Storage
* If Else, Stop Running Storage
*/
public void manageStorage() {
if (m_beamShooter.get()) {
runStorage(1.d);
} else { runStorage(0.d); }
}
/**
* Runs The Storage at a Specifyed Speed
* @param input The Specifyed Speed
*/
public void runStorage(double input) {
m_storageMotor.set(input);
}
/**
* Gets The Beam State On The Shooter
* @return The State Of The Beam on the Shooter
*/
public boolean getBeamShooter(){
return m_beamShooter.get();
}
/**
* Gets The Beam State Of The Intake
* @return The Beam State Of The Intake
*/
public boolean getBeamIntake(){
return m_beamIntake.get();
}
@Override
/**
* Every Robot Tick Manage The Storage
*/
public void periodic() {
manageStorage();
}