Compile fix
Merge branch 'mavlink2_hil' into paul_estimator_mavlink2