mirror of
https://github.com/Team4388/2019-Hit-or-Miss.git
synced 2026-06-08 16:18:02 -06:00
Change Climber to be Manual
This commit is contained in:
@@ -1,6 +1,7 @@
|
||||
package org.usfirst.frc4388.robot.commands;
|
||||
|
||||
import org.usfirst.frc4388.robot.Robot;
|
||||
import org.usfirst.frc4388.robot.subsystems.Climber;
|
||||
import org.usfirst.frc4388.robot.Constants;
|
||||
|
||||
import edu.wpi.first.wpilibj.command.Command;
|
||||
@@ -15,9 +16,9 @@ public class ratchetFlip extends Command {
|
||||
// Called just before this Command runs the first time
|
||||
@Override
|
||||
protected void initialize() {
|
||||
//if (InitiateClimber.SPEED == 0){
|
||||
if (Climber.SPEED == 0){
|
||||
Robot.climber.flipRatchet(speed);
|
||||
//}
|
||||
}
|
||||
}
|
||||
|
||||
// Called repeatedly when this Command is scheduled to run
|
||||
|
||||
@@ -57,6 +57,8 @@ public class Climber extends Subsystem{
|
||||
//Climb Trigger
|
||||
double rightTriggerInput;
|
||||
double leftTriggerInput;
|
||||
|
||||
public static double SPEED;
|
||||
|
||||
public Climber(){
|
||||
|
||||
@@ -69,6 +71,7 @@ public class Climber extends Subsystem{
|
||||
climberBack.configForwardLimitSwitchSource(limitSwitchSource, LimitSwitchNormal.NormallyOpen, 0);
|
||||
climberBack.configReverseLimitSwitchSource(limitSwitchSource, LimitSwitchNormal.NormallyOpen, 0);
|
||||
climberBack.setNeutralMode(NeutralMode.Brake);
|
||||
climberBack.setInverted(true);
|
||||
climberFront.setNeutralMode(NeutralMode.Brake);
|
||||
FRONT_FREQ = BACK_FREQ * FREQ_RATIO; // Sets the front motor speed to ~1/4 the back motor speed
|
||||
}
|
||||
@@ -88,7 +91,7 @@ public class Climber extends Subsystem{
|
||||
|
||||
rightTriggerInput = OI.getInstance().getDriverController().getRightTriggerAxis();
|
||||
leftTriggerInput = OI.getInstance().getDriverController().getLeftTriggerAxis();
|
||||
double speed = rightTriggerInput - leftTriggerInput;
|
||||
//SPEED = rightTriggerInput - leftTriggerInput;
|
||||
|
||||
// Put code here to be run every loop
|
||||
if (safetySwitch) {
|
||||
@@ -100,14 +103,16 @@ public class Climber extends Subsystem{
|
||||
else if(isPressed.isFwdLimitSwitchClosed() && speed > 0){ //If leg at max height, and the input would extend the leg
|
||||
climberBack.set(0);
|
||||
climberFront.set(FRONT_FREQ * speed);
|
||||
} */
|
||||
if (speed < 0){
|
||||
climberBack.set(-0.3 * speed);
|
||||
} *//*
|
||||
if (SPEED < 0){
|
||||
climberBack.set(0.3 * SPEED);
|
||||
}
|
||||
else { //If leg not at max height
|
||||
climberBack.set(-0.5 * speed);
|
||||
climberFront.set(speed);
|
||||
}
|
||||
climberBack.set(0.5 * SPEED);
|
||||
climberFront.set(SPEED);
|
||||
}*/
|
||||
climberBack.set(rightTriggerInput * 0.1);
|
||||
climberFront.set(leftTriggerInput);
|
||||
}
|
||||
else {
|
||||
climberBack.set(0);
|
||||
|
||||
Reference in New Issue
Block a user