fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

mavlink: STATUSTEXT track missed mavlink_log messages

Browse Source
This commit is contained in:
Daniel Agar 2020-11-16 11:36:02 -05:00
parent e1168070d1
commit 7baeb78964
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/modules/mavlink/streams/STATUSTEXT.hpp
View File

@ -57,14 +57,21 @@ private:
uORB::Subscription _mavlink_log_sub{ORB_ID(mavlink_log)};
uint16_t _id{0};
uint16_t _missed_msg_count{0};
bool send() override
{
if (_mavlink->is_connected() && (_mavlink->get_free_tx_buf() >= get_size())) {
const unsigned last_generation = _mavlink_log_sub.get_last_generation();
mavlink_log_s mavlink_log;
if (_mavlink_log_sub.update(&mavlink_log)) {
if (_mavlink_log_sub.get_last_generation() != (last_generation + 1)) {
_missed_msg_count++;
PX4_ERR("channel %d has missed %d mavlink log messages", _mavlink->get_channel(), _missed_msg_count);
}
mavlink_statustext_t msg{};
const char *text = mavlink_log.text;