Browse Source

write sysid & compid to telemetry status

sbg
Thomas Gubler 11 years ago
parent
commit
3d01da35d0
  1. 2
      src/modules/mavlink/mavlink_receiver.cpp
  2. 2
      src/modules/uORB/topics/telemetry_status.h

2
src/modules/mavlink/mavlink_receiver.cpp

@ -534,6 +534,8 @@ MavlinkReceiver::handle_message_radio_status(mavlink_message_t *msg) @@ -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);

2
src/modules/uORB/topics/telemetry_status.h

@ -67,6 +67,8 @@ struct telemetry_status_s { @@ -67,6 +67,8 @@ struct telemetry_status_s {
uint8_t noise; /**< background noise level */
uint8_t remote_noise; /**< remote background noise level */
uint8_t txbuf; /**< how full the tx buffer is as a percentage */
uint8_t system_id; /**< system id of the remote system */
uint8_t component_id; /**< component id of the remote system */
};
/**

Loading…
Cancel
Save