PID! TURN TO ANGLE!

[a-bad-programmer]

Get a fun PID working for mecanum.
We want to turn to an angle.

https://github.com/GraniteCiyGearheads3244/FRC-1519-Mechanical-Mayhem-Drive/blob/master/FRC_1519_Mechanical_Mayhem_Drive/src/org/usfirst/frc3244/MechanicalMayham/subsystems/Drive.java

(Good thing to look at)

[Junie-774]

oh god that code is a pain to read

[gusg21]

private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private private