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)
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)