NOT WORKING: Partway done real angles. Still need to add support in head.
Added vertical calibration command.
Will not straighten after calibration anymore.
Fixed calibration, fixed new straightening, fixed diagnostics, finished moving with real angles. Joystick does vertical straighten instead of horizontal.
Last commit after April 6th testing. Fixed even and odd initialization. Hardcoded LED delays.