write sysid & compid to telemetry status

This commit is contained in:
Thomas Gubler
2014-09-03 10:34:27 +02:00
parent e5650df321
commit 3d01da35d0
2 changed files with 4 additions and 0 deletions
+2
View File
@@ -534,6 +534,8 @@ MavlinkReceiver::handle_message_radio_status(mavlink_message_t *msg)
tstatus.remote_noise = rstatus.remnoise;
tstatus.rxerrors = rstatus.rxerrors;
tstatus.fixed = rstatus.fixed;
tstatus.system_id = msg->sysid;
tstatus.component_id = msg->compid;
if (_telemetry_status_pub < 0) {
_telemetry_status_pub = orb_advertise(telemetry_status_orb_id[_mavlink->get_channel()], &tstatus);