|
1 | 1 | package frc.robot; |
2 | 2 |
|
3 | | -// import edu.wpi.first.wpilibj.CameraServer; |
4 | | -// import edu.wpi.first.wpilibj.DriverStation; |
5 | | -// import edu.wpi.first.wpilibj.Spark; |
6 | 3 | import edu.wpi.first.wpilibj.Joystick; |
7 | 4 | import edu.wpi.first.wpilibj.Relay; |
8 | 5 | import edu.wpi.first.wpilibj.TimedRobot; |
@@ -36,6 +33,7 @@ public class Robot extends TimedRobot { |
36 | 33 | public final Color kRedTarget = ColorMatch.makeColor(0.561, 0.232, 0.114); |
37 | 34 | public final Color kYellowTarget = ColorMatch.makeColor(0.361, 0.524, 0.113); |
38 | 35 | public Harvester harvester = new Harvester(); |
| 36 | + int shooterCycle = 0; |
39 | 37 |
|
40 | 38 | @Override |
41 | 39 | public void robotInit() { |
@@ -99,12 +97,21 @@ public void robotPeriodic() { |
99 | 97 | colorString = "Unknown"; |
100 | 98 | } |
101 | 99 |
|
102 | | - if (OI.shoot() == true) { |
| 100 | + if ((shooterCycle == 0) == false) { |
| 101 | + shooterCycle = shooterCycle + 1; |
| 102 | + } else if (OI.shoot() == true) { |
103 | 103 | Shooter.shooterShoot(OI.valueShooterSpeed); |
104 | | - } else if (OI.shoot() == false) { |
| 104 | + shooterCycle = 1; |
| 105 | + } else { |
105 | 106 | Shooter.shooterStop(); |
106 | 107 | } |
107 | 108 |
|
| 109 | + if (shooterCycle == 10) { |
| 110 | + Shooter.initiateShot(); |
| 111 | + } else if (shooterCycle == 20) { |
| 112 | + shooterCycle = 0; |
| 113 | + } |
| 114 | + |
108 | 115 | if (OI.changeShooterSpeed() == 1) { |
109 | 116 | if (OI.valueShooterSpeed < 1) { |
110 | 117 | OI.valueShooterSpeed = OI.valueShooterSpeed + 0.02; |
@@ -141,25 +148,6 @@ public void robotPeriodic() { |
141 | 148 |
|
142 | 149 | @Override |
143 | 150 | public void teleopPeriodic() { |
144 | | - /* |
145 | | - * // Left trigger pressed, end OI commands and start tape script if |
146 | | - * (leftstick.getTriggerPressed() && toggle == false) { |
147 | | - * RobotMap.GreenLED.set(Relay.Value.kForward); |
148 | | - * Scheduler.getInstance().removeAll(); |
149 | | - * Scheduler.getInstance().add(newautonomous(1)); toggle = true; } |
150 | | - * |
151 | | - * // Right trigger pressed, end OI commands and start ball script if |
152 | | - * (rightstick.getTriggerPressed() && toggle == false) { |
153 | | - * Scheduler.getInstance().removeAll(); |
154 | | - * Scheduler.getInstance().add(newautonomous(2)); toggle = true; } |
155 | | - * |
156 | | - * // Both triggers released, end autoomous scripts and start OI scripts if |
157 | | - * (leftstick.getTriggerReleased() && rightstick.getTriggerReleased() && |
158 | | - * toggle){ DriverStation.reportError("TRIGGER", false); |
159 | | - * RobotMap.GreenLED.set(Relay.Value.kReverse); |
160 | | - * Scheduler.getInstance().add(newautonomous(0)); OICommands(); toggle = false; |
161 | | - * } |
162 | | - */ |
163 | 151 | Scheduler.getInstance().run(); |
164 | 152 |
|
165 | 153 | } |
|
0 commit comments