diff --git a/ArduPlane/GCS_Mavlink.pde b/ArduPlane/GCS_Mavlink.pde index fce87942a829f007d71fda9ddc2d423ba78e619a..6c5a2036f77f3900eb13965b72f74f271237952b 100644 --- a/ArduPlane/GCS_Mavlink.pde +++ b/ArduPlane/GCS_Mavlink.pde @@ -265,6 +265,16 @@ static NOINLINE void send_extended_status1(mavlink_channel_t chan) } #endif + if (rangefinder.num_sensors() > 0) { + control_sensors_present |= MAV_SYS_STATUS_SENSOR_LASER_POSITION; + if (g.rangefinder_landing) { + control_sensors_enabled |= MAV_SYS_STATUS_SENSOR_LASER_POSITION; + } + if (rangefinder.healthy()) { + control_sensors_health |= MAV_SYS_STATUS_SENSOR_LASER_POSITION; + } + } + mavlink_msg_sys_status_send( chan, control_sensors_present,