Finished all PIDs in high gear and added pneumatics subsystem literally everywhere

This commit is contained in:
Aarav Shah
2020-03-01 13:48:18 -07:00
parent 92df6a3d5f
commit 21a7c5517a
6 changed files with 33 additions and 21 deletions
@@ -29,6 +29,7 @@ public class DriveStraightToPositionPID extends CommandBase {
public DriveStraightToPositionPID(Drive subsystem, Pneumatics subsystem2, double targetPos) {
// Use addRequirements() here to declare subsystem dependencies.
m_drive = subsystem;
m_pneumatics = subsystem2;
try {
if (m_pneumatics.m_isSpeedShiftHigh) {
m_targetPosIn = targetPos * DriveConstants.TICKS_PER_INCH_HIGH * 2;