Rebase of changes to sensor_hil_fixedwing branch.