Tune Rotation Controller

[allengregoryiv]

Make the rotation controller on the practice robot run better. It should snap to turns better and adjust small heading errors better.

This is one of the things we know we will need to do every year and getting better at this is helpful.

This needs to have a real robot to test.