AP_ExternalAHRS: Don't send init message till booted up

Signed-off-by: Ryan Friedman <ryanfriedman5410+github@gmail.com>
This commit is contained in:
Ryan Friedman 2024-03-23 17:22:19 -06:00 committed by Andrew Tridgell
parent de6244d078
commit c948863de1

View File

@ -93,11 +93,12 @@ void AP_ExternalAHRS_MicroStrain7::update_thread(void)
void AP_ExternalAHRS_MicroStrain7::check_initialise_state(void)
{
const auto new_init_state = initialised();
if (!last_init_state && new_init_state) {
// Only send the message after fully booted up, otherwise it gets dropped.
if (!last_init_state && new_init_state && AP_HAL::millis() > 5000) {
GCS_SEND_TEXT(MAV_SEVERITY_INFO, "MicroStrain7 ExternalAHRS initialised.");
}
last_init_state = new_init_state;
}
}
// Builds packets by looking at each individual byte, once a full packet has been read in it checks the checksum then handles the packet.