X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fsubsystems%2FClimber.java;h=d9268cb8f2705e921549d3f12abd2602dd51ad80;hb=ba9f0b126afd5973b11a22dd6640d8d6f0822f5a;hp=f68c6795bd55fd3a10fb562c0fc2fb0b3b30b5e5;hpb=9738295a69eb289e0c590b236bab1843ad5e5a4c;p=3501%2F2017steamworks diff --git a/src/org/usfirst/frc/team3501/robot/subsystems/Climber.java b/src/org/usfirst/frc/team3501/robot/subsystems/Climber.java index f68c679..d9268cb 100644 --- a/src/org/usfirst/frc/team3501/robot/subsystems/Climber.java +++ b/src/org/usfirst/frc/team3501/robot/subsystems/Climber.java @@ -1,16 +1,47 @@ package org.usfirst.frc.team3501.robot.subsystems; -public class Climber { - private static Climber climber; +import org.usfirst.frc.team3501.robot.Constants; +import org.usfirst.frc.team3501.robot.MathLib; - private Climber() { +import com.ctre.CANTalon; +import edu.wpi.first.wpilibj.command.Subsystem; + +public class Climber extends Subsystem { + public static Climber climber; + + public static final boolean BRAKE_MODE = true; + public static final boolean COAST_MODE = false; + + public static final double CLIMBER_SPEED = 1.0; + public boolean shouldBeClimbing = false; + + private CANTalon winch; + + public Climber() { + winch = new CANTalon(Constants.Climber.WINCH_PORT); } public static Climber getClimber() { if (climber == null) { - climber = climber(); + climber = new Climber(); } return climber; } + + public void setMotorValues(double climbingSpeed) { + winch.set(MathLib.limitValue(climbingSpeed, 0.0, 1.0)); + } + + public void stop() { + winch.set(0); + } + + public void setCANTalonsBrakeMode(boolean mode) { + winch.enableBrakeMode(mode); + } + + @Override + protected void initDefaultCommand() { + } }