AP_NavEKF2: handle core setup failure

ensure num_cores is left as zero so that calls such as Log_Write don't
de-reference nullptr
This commit is contained in:
Andrew Tridgell 2023-05-02 10:39:16 +10:00 committed by Randy Mackay
parent 6d5c34dfa8
commit d7c90c5a5b
1 changed files with 2 additions and 0 deletions

View File

@ -662,6 +662,7 @@ bool NavEKF2::InitialiseFilter(void)
if (AP::dal().available_memory() < sizeof(NavEKF2_core)*num_cores + 4096) {
initFailure = InitFailures::NO_MEM;
core_malloc_failed = true;
num_cores = 0;
GCS_SEND_TEXT(MAV_SEVERITY_CRITICAL, "NavEKF2: not enough memory available");
return false;
}
@ -671,6 +672,7 @@ bool NavEKF2::InitialiseFilter(void)
if (core == nullptr) {
initFailure = InitFailures::NO_MEM;
core_malloc_failed = true;
num_cores = 0;
GCS_SEND_TEXT(MAV_SEVERITY_CRITICAL, "NavEKF2: memory allocation failed");
return false;
}