Fix TurnToAngle command

[gnawinganimal]

Use the left encoder to turn using pid. Has been tested, seems to work with modifications. DO NOT MERGE YET (very important)

[sertbot[bot]]

Hi @Jamdan2, thanks for opening this pull request!

Looks like this is an addition or fix for the robot. To make sure this change goes added in smoothly, make sure the following chores are complete (please check-off items as they are completed):

• [x] Test code changes on the robot (if possible).

• [x] Verify that significant changes have tests and pass successfully.

• [x] Ensure this pull request is appropriately titled.

Maintainers – please review this PR. A review from the @SouthEugeneRoboticsTeam/reviewers team is required before the PR can be merged.

Finally, use @sertbot merge to merge this PR into the appropriate branch.

Thanks!

[andrewda]

Nobody resolve conflicts yet, please, no matter how tempting that button is.