From cd605e9c8089874b351d5127bad96b157f187704 Mon Sep 17 00:00:00 2001 From: Randy Mackay Date: Fri, 28 Jun 2024 13:49:26 +0900 Subject: [PATCH] AP_Mount: Siyi debug of position sent --- libraries/AP_Mount/AP_Mount_Siyi.cpp | 3 +++ 1 file changed, 3 insertions(+) diff --git a/libraries/AP_Mount/AP_Mount_Siyi.cpp b/libraries/AP_Mount/AP_Mount_Siyi.cpp index 3eb22cc7536b67..18355b6f2bca9c 100644 --- a/libraries/AP_Mount/AP_Mount_Siyi.cpp +++ b/libraries/AP_Mount/AP_Mount_Siyi.cpp @@ -65,6 +65,7 @@ void AP_Mount_Siyi::update() if (AP::rtc().get_utc_usec(utc_usec) && send_packet(SiyiCommandId::SET_TIME, (const uint8_t *)&utc_usec, sizeof(utc_usec))) { sent_time_count++; + GCS_SEND_TEXT(MAV_SEVERITY_INFO, "Siyi: sent UTC time %llu", (unsigned long long)utc_usec); } } #endif @@ -1211,6 +1212,8 @@ void AP_Mount_Siyi::send_attitude_position(void) position.alt_ellipsoid = position.alt_msl - undulation*100; send_packet(SiyiCommandId::POSITION_DATA, (const uint8_t *)&position, sizeof(position)); + + GCS_SEND_TEXT(MAV_SEVERITY_INFO, "Siyi: lat:%ld lon:%ld alt:%ld", (long)position.lat, (long)position.lon, (long)position.alt_msl); } #endif // HAL_MOUNT_SIYI_ENABLED