Update Robot.java

Author: srimanachanta

src/main/java/frc/robot/Robot.java

@@ -137,9 +137,9 @@ public void testPeriodic() {
     SmartDashboard.putNumber("Testing Flywheel RPM", current_RPM);
 
 
-    // PIDController FlywheelPIDController = new PIDController(RobotInformation.PID_Values.flywheel.kP, RobotInformation.PID_Values.flywheel.kI, RobotInformation.PID_Values.flywheel.kD);
-    // FlywheelPIDController.calculate(shooterFly.getSensorCollection().getIntegratedSensorAbsolutePosition());
-    // FlywheelPIDController.close();
+    PIDController FlywheelPIDController = new PIDController(RobotInformation.PID_Values.flywheel.kP, RobotInformation.PID_Values.flywheel.kI, RobotInformation.PID_Values.flywheel.kD);
+    FlywheelPIDController.calculate(shooterFly.getSensorCollection().getIntegratedSensorVelocity());
+    FlywheelPIDController.close();
     SmartDashboard.putNumber("Wrist Value", wrist.getSensorCollection().getIntegratedSensorAbsolutePosition());
   }