Bunch of updates

Main update is to test auto yaw drift compensation
Tweaked UI to scale head movement (toggle-able)