X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fclimber%2FRunWinch.java;h=39149abb14fba12c4c77e24d5aaf2d694da20bf6;hb=refs%2Fheads%2Fmaster;hp=88195a4b2d89227fffaa90ea3bf2ede0cbda4572;hpb=b71b71bc16c83b21d7a4116c6446a07bac0d8569;p=3501%2F2017steamworks diff --git a/src/org/usfirst/frc/team3501/robot/commands/climber/RunWinch.java b/src/org/usfirst/frc/team3501/robot/commands/climber/RunWinch.java index 88195a4..39149ab 100644 --- a/src/org/usfirst/frc/team3501/robot/commands/climber/RunWinch.java +++ b/src/org/usfirst/frc/team3501/robot/commands/climber/RunWinch.java @@ -1,8 +1,8 @@ package org.usfirst.frc.team3501.robot.commands.climber; import org.usfirst.frc.team3501.robot.Robot; +import org.usfirst.frc.team3501.robot.subsystems.Climber; -import edu.wpi.first.wpilibj.Timer; import edu.wpi.first.wpilibj.command.Command; /** @@ -24,7 +24,8 @@ import edu.wpi.first.wpilibj.command.Command; */ public class RunWinch extends Command { - Timer timer; + Climber climber = Robot.getClimber(); + private double time; private double motorVal; @@ -36,31 +37,31 @@ public class RunWinch extends Command { * @param motorVal * value range is from -1 to 1 */ - public RunWinch(double time, double motorVal) { - requires(Robot.getDriveTrain()); + public RunWinch() { + requires(climber); this.time = time; this.motorVal = motorVal; } @Override protected void initialize() { - timer.start(); + climber.setCANTalonsBrakeMode(climber.COAST_MODE); } @Override protected void execute() { - Robot.getDriveTrain().setMotorValues(motorVal, motorVal); - + climber.setMotorValues(climber.CLIMBER_SPEED); } @Override protected boolean isFinished() { - return timer.get() >= time; + // return timeSinceInitialized() >= time; + return false; } @Override protected void end() { - Robot.getDriveTrain().stop(); + climber.stop(); } @Override