Added a 90 degree right turn for manual input.
Edited monitor.cpp with imu calculations