format fix
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / subsystems / Scaler.java
CommitLineData
31f6cd19
K
1package org.usfirst.frc.team3501.robot.subsystems;
2import org.usfirst.frc.team3501.robot.Constants;
3
cb16c238 4import edu.wpi.first.wpilibj.CANTalon;
31f6cd19
K
5import edu.wpi.first.wpilibj.DoubleSolenoid;
6import edu.wpi.first.wpilibj.DoubleSolenoid.Value;
7import edu.wpi.first.wpilibj.command.Subsystem;
8
9public class Scaler extends Subsystem {
10 //Scaler related objects
11 private DoubleSolenoid piston;
cb16c238 12 private CANTalon winch;
31f6cd19 13
31f6cd19
K
14 public Scaler() {
15 piston = new DoubleSolenoid(Constants.Scaler.FORWARD_CHANNEL, Constants.Scaler.REVERSE_CHANNEL);
cb16c238 16 winch = new CANTalon(Constants.Scaler.WINCH_MOTOR);
31f6cd19
K
17 }
18
19 @Override
20 protected void initDefaultCommand() {
21
22 }
b6083719 23
31f6cd19
K
24 public Value getSolenoidValue(){
25 return piston.get();
26 }
27
b6083719 28 public void liftScissorLift(){
31f6cd19
K
29 piston.set(DoubleSolenoid.Value.kReverse);
30 }
31
b6083719 32 public void lowerScissorLift(){
31f6cd19
K
33 piston.set(DoubleSolenoid.Value.kForward);
34 }
35
36 public void disengageHook(){
31f6cd19
K
37 }
38
e90640ae
K
39 public void runWinch(double speed){
40 if( speed > 1)
41 speed = 1;
42 if(speed < -1)
43 speed = -1;
31f6cd19 44
e90640ae 45 winch.set(speed);
31f6cd19 46 }
31f6cd19 47}