Updated GUI for Odometry readout
Some refactoring and PID stabilizing
Catchup commit. Lots of pitch estimation experiments.