diff --git a/src/drivers/telemetry/iridiumsbd/IridiumSBD.cpp b/src/drivers/telemetry/iridiumsbd/IridiumSBD.cpp index 9d03bfe8fa..a488e764ed 100644 --- a/src/drivers/telemetry/iridiumsbd/IridiumSBD.cpp +++ b/src/drivers/telemetry/iridiumsbd/IridiumSBD.cpp @@ -47,6 +47,7 @@ #include #include #include +#include #include "drivers/drv_iridiumsbd.h" @@ -590,7 +591,7 @@ ssize_t IridiumSBD::write(struct file *filp, const char *buffer, size_t buflen) if (*buffer == MAVLINK_PACKAGE_START) { if (SATCOM_TX_BUF_LEN - tx_buf_write_idx - SATCOM_MIN_TX_BUF_SPACE - (*(buffer + 1) + 8) < 0) { tx_buf_write_idx = 0; - PX4_INFO("Deleting full TX buffer before writing new message"); + mavlink_log_critical(&_mavlink_log_pub, "Deleting full TX buffer before writing new message"); } } } @@ -598,7 +599,7 @@ ssize_t IridiumSBD::write(struct file *filp, const char *buffer, size_t buflen) // check and reset the remaining buffer space for any non mavlink messages if (SATCOM_TX_BUF_LEN - tx_buf_write_idx - SATCOM_MIN_TX_BUF_SPACE < 0) { tx_buf_write_idx = 0; - PX4_INFO("Deleting full TX buffer"); + mavlink_log_critical(&_mavlink_log_pub, "Deleting full TX buffer"); } VERBOSE_INFO("WRITE: LEN %d, TX WRITTEN: %d", buflen, tx_buf_write_idx); diff --git a/src/drivers/telemetry/iridiumsbd/IridiumSBD.h b/src/drivers/telemetry/iridiumsbd/IridiumSBD.h index b26f49afa1..574ed4e79a 100644 --- a/src/drivers/telemetry/iridiumsbd/IridiumSBD.h +++ b/src/drivers/telemetry/iridiumsbd/IridiumSBD.h @@ -304,4 +304,6 @@ private: pthread_mutex_t tx_buf_mutex = pthread_mutex_t(); bool verbose = false; + + orb_advert_t _mavlink_log_pub{nullptr}; };