mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-02 20:28:37 +08:00
mavlink_log: enable queueing
We don't want to drop messages if possible for mavlink log messages, so let's use the orb queueing.
This commit is contained in:
@@ -47,6 +47,7 @@
|
|||||||
#include <uORB/topics/mavlink_log.h>
|
#include <uORB/topics/mavlink_log.h>
|
||||||
#include "mavlink_log.h"
|
#include "mavlink_log.h"
|
||||||
|
|
||||||
|
#define MAVLINK_LOG_QUEUE_SIZE 5
|
||||||
|
|
||||||
|
|
||||||
__EXPORT void mavlink_vasprintf(int severity, orb_advert_t *mavlink_log_pub, const char *fmt, ...)
|
__EXPORT void mavlink_vasprintf(int severity, orb_advert_t *mavlink_log_pub, const char *fmt, ...)
|
||||||
@@ -79,7 +80,9 @@ __EXPORT void mavlink_vasprintf(int severity, orb_advert_t *mavlink_log_pub, con
|
|||||||
orb_publish(ORB_ID(mavlink_log), *mavlink_log_pub, &log_msg);
|
orb_publish(ORB_ID(mavlink_log), *mavlink_log_pub, &log_msg);
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
*mavlink_log_pub = orb_advertise(ORB_ID(mavlink_log), &log_msg);
|
*mavlink_log_pub = orb_advertise_queue(ORB_ID(mavlink_log),
|
||||||
|
&log_msg,
|
||||||
|
MAVLINK_LOG_QUEUE_SIZE);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user