Waypoint loading and rebooting for runhil.
Merge branch 'sensor_hil_fixedwing' of github.com:/jgoppert/Firmware into sensor_hil_fixedwing