Skip to content

Commit 4b6d321

Browse files
Changed climber controls to use "setInverted()" for left motor, rather than simply negating power commands in "ClimberSetWinchesPower()" command.
1 parent ac70bfe commit 4b6d321

File tree

2 files changed

+8
-2
lines changed

2 files changed

+8
-2
lines changed

src/main/java/org/mayheminc/robot2020/commands/ClimberSetWinchesPower.java

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -31,7 +31,7 @@ public void initialize() {
3131
// Called every time the scheduler runs while the command is scheduled.
3232
@Override
3333
public void execute() {
34-
RobotContainer.climber.setWinchLeftSpeed(-power);
34+
RobotContainer.climber.setWinchLeftSpeed(power);
3535
RobotContainer.climber.setWinchRightSpeed(power);
3636
}
3737

src/main/java/org/mayheminc/robot2020/subsystems/Climber.java

Lines changed: 7 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -29,14 +29,20 @@ public class Climber extends SubsystemBase {
2929
* Creates a new Climber.
3030
*/
3131
public Climber() {
32+
33+
// TODO: Add "soft limit" to top of climber travel to avoid "overwinding"
34+
// TODO: Add position control to go all the way to the top, and nearly all the way in for climbing
35+
3236
winchLeft.setNeutralMode(NeutralMode.Brake);
3337
winchLeft.configNominalOutputVoltage(+0.0f, -0.0f);
3438
winchLeft.configPeakOutputVoltage(+12.0, -12.0);
39+
winchLeft.setInverted(true);
3540

3641
winchRight.setNeutralMode(NeutralMode.Brake);
3742
winchRight.configNominalOutputVoltage(+0.0f, -0.0f);
3843
winchRight.configPeakOutputVoltage(+12.0, -12.0);
39-
44+
winchRight.setInverted(false);
45+
4046
// walkerRight.setNeutralMode(NeutralMode.Brake);
4147
// walkerRight.configNominalOutputVoltage(+0.0f, -0.0f);
4248
// walkerRight.configPeakOutputVoltage(+12.0, -12.0);

0 commit comments

Comments
 (0)