Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Param: fixed parameter defaults array length handling 

we need to add up the total for all comma separated parameter files
This commit is contained in:
Andrew Tridgell 2023-08-20 07:32:34 +10:00 committed by Peter Barker
parent e2f4ead576
commit b4537312f2
2 changed files with 18 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
libraries/AP_Param/AP_Param.cpp
View File

@ -94,9 +94,10 @@ HAL_Semaphore AP_Param::_count_sem;
// storage and naming information about all types that can be saved
const AP_Param::Info *AP_Param::_var_info;
struct AP_Param::param_override *AP_Param::param_overrides = nullptr;
uint16_t AP_Param::num_param_overrides = 0;
uint16_t AP_Param::num_read_only = 0;
struct AP_Param::param_override *AP_Param::param_overrides;
uint16_t AP_Param::param_overrides_len;
uint16_t AP_Param::num_param_overrides;
uint16_t AP_Param::num_read_only;
ObjectBuffer_TS<AP_Param::param_save> AP_Param::save_queue{30};
bool AP_Param::registered_save_handler;
@ -2168,7 +2169,7 @@ bool AP_Param::count_defaults_in_file(const char *filename, uint16_t &num_defaul
return true;
}
bool AP_Param::read_param_defaults_file(const char *filename, bool last_pass)
bool AP_Param::read_param_defaults_file(const char *filename, bool last_pass, uint16_t &idx)
{
// try opening the file both in the posix filesystem and using AP::FS
int file_apfs = AP::FS().open(filename, O_RDONLY, true);
@ -2177,7 +2178,6 @@ bool AP_Param::read_param_defaults_file(const char *filename, bool last_pass)
return false;
}
uint16_t idx = 0;
char line[100];
while (AP::FS().fgets(line, sizeof(line)-1, file_apfs)) {
char *pname;
@ -2200,6 +2200,10 @@ bool AP_Param::read_param_defaults_file(const char *filename, bool last_pass)
}
continue;
}
if (idx >= param_overrides_len) {
INTERNAL_ERROR(AP_InternalError::error_t::flow_of_control);
break;
}
param_overrides[idx].object_ptr = vp;
param_overrides[idx].value = value;
param_overrides[idx].read_only = read_only;
@ -2243,6 +2247,7 @@ bool AP_Param::load_defaults_file(const char *filename, bool last_pass)
free(mutable_filename);
delete[] param_overrides;
param_overrides_len = 0;
num_param_overrides = 0;
num_read_only = 0;
@ -2251,6 +2256,7 @@ bool AP_Param::load_defaults_file(const char *filename, bool last_pass)
AP_HAL::panic("AP_Param: Failed to allocate overrides");
return false;
}
param_overrides_len = num_defaults;
if (num_defaults == 0) {
return true;
@ -2261,10 +2267,11 @@ bool AP_Param::load_defaults_file(const char *filename, bool last_pass)
if (mutable_filename == nullptr) {
AP_HAL::panic("AP_Param: Failed to allocate mutable string");
}
uint16_t idx = 0;
for (char *pname = strtok_r(mutable_filename, ",", &saveptr);
pname != nullptr;
pname = strtok_r(nullptr, ",", &saveptr)) {
if (!read_param_defaults_file(pname, last_pass)) {
if (!read_param_defaults_file(pname, last_pass, idx)) {
free(mutable_filename);
return false;
}
@ -2335,6 +2342,7 @@ void AP_Param::load_embedded_param_defaults(bool last_pass)
{
delete[] param_overrides;
param_overrides = nullptr;
param_overrides_len = 0;
num_param_overrides = 0;
num_read_only = 0;
@ -2349,6 +2357,8 @@ void AP_Param::load_embedded_param_defaults(bool last_pass)
return;
}
param_overrides_len = num_defaults;
const volatile char *ptr = param_defaults_data.data;
int32_t length = param_defaults_data.length;
uint16_t idx = 0;

3
libraries/AP_Param/AP_Param.h
View File

@ -723,7 +723,7 @@ private:
load a parameter defaults file. This happens as part of load_all()
*/
static bool count_defaults_in_file(const char *filename, uint16_t &num_defaults);
static bool read_param_defaults_file(const char *filename, bool last_pass);
static bool read_param_defaults_file(const char *filename, bool last_pass, uint16_t &idx);
/*
load defaults from embedded parameters
@ -774,6 +774,7 @@ private:
};
static struct param_override *param_overrides;
static uint16_t num_param_overrides;
static uint16_t param_overrides_len;
static uint16_t num_read_only;
// values filled into the EEPROM header