AP_NavEKF3: pre-arm return failure message for correct core

This commit is contained in:
Iampete1 2023-01-30 18:13:09 +00:00 committed by Peter Barker
parent 0b8bc4798a
commit 16b1bd8b9a

View File

@ -1136,7 +1136,7 @@ bool NavEKF3::pre_arm_check(bool requires_position, char *failure_msg, uint8_t f
}
for (uint8_t i = 0; i < num_cores; i++) {
if (!core[i].healthy()) {
const char *failure = core[primary].prearm_failure_reason();
const char *failure = core[i].prearm_failure_reason();
if (failure != nullptr) {
AP::dal().snprintf(failure_msg, failure_msg_len, failure);
} else {