create and fill getShooterSpeed
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / subsystems / Shooter.java
index 0264c7578e5f34afb6ce0bdfea7abaab0a36fdec..d91b234192218906cb44e1847f22666af90b913b 100755 (executable)
@@ -65,6 +65,12 @@ public class Shooter extends Subsystem {
     return encoder.getRate();
   }
 
+  public double getShooterSpeed() {
+    double distanceToGoal = lidar.getDistance();
+    double shooterSpeed = distanceToGoal; // Function to be determined
+    return shooterSpeed;
+  }
+
   // Use negative # for decrement. Positive for increment.
 
   public void changeSpeed(double change) {