Turn to Angle

[schreiaj]

We either need to tune turn to angle better with multiple states or we can look into using motion profiles driven by the gyro values to turn to an angle. I'd like to see us go with the second approach.

[camilo86]

I'm currently implementing this: https://github.com/Team254/FRC-2015/blob/master/src/com/team254/frc2015/subsystems/controllers/TurnInPlaceController.java So it will basically take in a current pos, speed and angle to turn to