From eedddcb40586d5a0d38bf12b53fa24f488122068 Mon Sep 17 00:00:00 2001 From: Rohan Rodrigues Date: Sun, 19 Feb 2017 14:02:23 -0800 Subject: [PATCH] Add code to alternate piston values every second while the index wheel is running continuously --- .../commands/shooter/RunIndexWheelContinuous.java | 12 ++++++++++++ 1 file changed, 12 insertions(+) diff --git a/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java b/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java index 815577e..8a640e7 100644 --- a/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java +++ b/src/org/usfirst/frc/team3501/robot/commands/shooter/RunIndexWheelContinuous.java @@ -1,8 +1,10 @@ package org.usfirst.frc.team3501.robot.commands.shooter; +import org.usfirst.frc.team3501.robot.Constants; import org.usfirst.frc.team3501.robot.Robot; import org.usfirst.frc.team3501.robot.subsystems.Shooter; +import edu.wpi.first.wpilibj.Timer; import edu.wpi.first.wpilibj.command.Command; /** @@ -19,6 +21,7 @@ import edu.wpi.first.wpilibj.command.Command; */ public class RunIndexWheelContinuous extends Command { private Shooter shooter = Robot.getShooter(); + private Timer t = new Timer(); /** * See JavaDoc comment in class for details @@ -29,10 +32,19 @@ public class RunIndexWheelContinuous extends Command { @Override protected void initialize() { + t.reset(); } @Override protected void execute() { + if (t.get() % 1 == 0) { + if (Shooter.getShooter().getPistonValue() == Constants.Shooter.LOW_GEAR) { + Shooter.getShooter().setHighGear(); + } else { + Shooter.getShooter().setLowGear(); + } + } + double shooterSpeed = shooter.getShooterRPM(); double targetShooterSpeed = shooter.getTargetShootingSpeed(); double threshold = shooter.getRPMThreshold(); -- 2.30.2