Document angle calculations
Clean up TeleOp
Fix nonscaled rotation bug and rounding bug in Drive.h
Should be the last of the bugs, resolves #33