Fixed bug in python, still seems that psi is backwards for mag meas.
Merge branch 'sensor_hil_fixedwing' of github.com:jgoppert/Firmware into sensor_hil_fixedwing