diff --git a/src/org/usfirst/frc/team4737/robot/Robot.java b/src/org/usfirst/frc/team4737/robot/Robot.java index f44e0da..783d58a 100644 --- a/src/org/usfirst/frc/team4737/robot/Robot.java +++ b/src/org/usfirst/frc/team4737/robot/Robot.java @@ -9,10 +9,7 @@ import org.usfirst.frc.team4737.robot.commands.drivetrain.AutoBlindBaseline; import org.usfirst.frc.team4737.robot.commands.drivetrain.RelaxDrivetrain; -import org.usfirst.frc.team4737.robot.subsystems.Climber; -import org.usfirst.frc.team4737.robot.subsystems.Drivetrain; -import org.usfirst.frc.team4737.robot.subsystems.Elevator; -import org.usfirst.frc.team4737.robot.subsystems.Intake; +import org.usfirst.frc.team4737.robot.subsystems.*; import edu.wpi.first.wpilibj.TimedRobot; import edu.wpi.first.wpilibj.command.Command; @@ -33,6 +30,7 @@ public class Robot extends TimedRobot { public static final Elevator ELEVATOR = new Elevator(); public static final Intake INTAKE = new Intake(); public static final Climber CLIMBER = new Climber(); + public static final ControlSystem CONTROLSYSTEM = new ControlSystem(); public static final OI OI = new OI(); // Must initialize after subsystems diff --git a/src/org/usfirst/frc/team4737/robot/subsystems/ControlSystem.java b/src/org/usfirst/frc/team4737/robot/subsystems/ControlSystem.java new file mode 100644 index 0000000..60635b6 --- /dev/null +++ b/src/org/usfirst/frc/team4737/robot/subsystems/ControlSystem.java @@ -0,0 +1,36 @@ +package org.usfirst.frc.team4737.robot.subsystems; + +import edu.wpi.first.wpilibj.Compressor; +import edu.wpi.first.wpilibj.PowerDistributionPanel; +import edu.wpi.first.wpilibj.command.Subsystem; + +/** + * + */ +public class ControlSystem extends Subsystem { + + private Compressor compressor; + public PowerDistributionPanel pdp; + + public ControlSystem() { + compressor = new Compressor(0); + pdp = new PowerDistributionPanel(); + + // Enable the compressor + enableCompressor(); + } + + public void initDefaultCommand() { + // Set the default command for a subsystem here. + // setDefaultCommand(new MySpecialCommand()); + } + + public void enableCompressor() { + compressor.setClosedLoopControl(true); + } + + public void disableCompressor() { + compressor.setClosedLoopControl(false); + } + +}