Add up and down for storage thingy

This commit is contained in:
Rishabh
2020-02-13 19:07:36 -07:00
parent ee9bd4d301
commit 1463bd2094
2 changed files with 20 additions and 2 deletions
@@ -65,7 +65,7 @@ public class Storage extends SubsystemBase {
} else {
System.err.println("Beam off");
}
}
public void resetEncoder()
@@ -96,7 +96,21 @@ public class Storage extends SubsystemBase {
* Prepares storage for shooting
*/
public void storageAim() {
//runStoragePositionPID(targetPos, kP, kI, kD, kIz, kF, kmaxOutput, kminOutput);
if (m_beamSensors[0].get() == false){
m_storageMotor.set(0.5);
}
else{
m_storageMotor.set(0);
}
}
public void storageIntake() {
if (m_beamSensors[2].get() == false){
m_storageMotor.set(-0.5);
}
else{
m_storageMotor.set(0);
}
/*
*If shooting move storage motor until top sensor is tripped
@@ -104,3 +118,4 @@ public class Storage extends SubsystemBase {
*
*/
}
}