HAL_PX4: fixed startup bug in fmu_only mode