|
|
|
@ -1502,7 +1502,8 @@ void Plane::load_parameters(void)
@@ -1502,7 +1502,8 @@ void Plane::load_parameters(void)
|
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
if (!ins.gyro_notch_enabled()) { |
|
|
|
|
#if HAL_INS_NUM_HARMONIC_NOTCH_FILTERS > 1 |
|
|
|
|
if (!ins.gyro_harmonic_notch_enabled(1)) { |
|
|
|
|
// notch filter parameter conversions (moved to INS_HNTC2) for 4.2.x, converted from fixed notch
|
|
|
|
|
const AP_Param::ConversionInfo notchfilt_conversion_info[] { |
|
|
|
|
{ Parameters::k_param_ins, 101, AP_PARAM_INT8, "INS_HNTC2_ENABLE" }, |
|
|
|
@ -1514,11 +1515,12 @@ void Plane::load_parameters(void)
@@ -1514,11 +1515,12 @@ void Plane::load_parameters(void)
|
|
|
|
|
for (uint8_t i=0; i<notchfilt_table_size; i++) { |
|
|
|
|
AP_Param::convert_old_parameters(¬chfilt_conversion_info[i], 1.0f); |
|
|
|
|
} |
|
|
|
|
if (ins.gyro_notch_enabled()) { |
|
|
|
|
if (ins.gyro_harmonic_notch_enabled(1)) { |
|
|
|
|
AP_Param::set_default_by_name("INS_HNTC2_MODE", 0); |
|
|
|
|
AP_Param::set_default_by_name("INS_HNTC2_HMNCS", 1); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#endif // HAL_INS_NUM_HARMONIC_NOTCH_FILTERS
|
|
|
|
|
|
|
|
|
|
hal.console->printf("load_all took %uus\n", (unsigned)(micros() - before)); |
|
|
|
|
} |
|
|
|
|