optimize
A function that calculates the which way a wheel should be facing for the least rotation.
Return
The optimized angle.
Parameters
desired
The angle you want to face towards.
current
The angle you are currently at.