Working on mathlib unit testing.
Merge branch 'sensor_hil_fixedwing' of github.com:jgoppert/Firmware into sensor_hil_fixedwing
Math library fix.
Some kalman tuning.
Gain tuning.
More conservative bank limit.
Some printing cleanup.
Merge branch 'sensor_hil_fixedwing' into hil_attack