Thermal Calibration - add parameter required to control minimum starting temperature

This commit is contained in:
Paul Riseborough
2017-02-12 09:21:37 +01:00
committed by Lorenz Meier
parent 693cc4a533
commit c901c4b39e
9 changed files with 30 additions and 16 deletions
@@ -127,13 +127,16 @@ void TemperatureCalibration::task_main()
param_get(param_find("SYS_CAL_TDEL"), &min_temp_rise);
PX4_INFO("Waiting for %i degrees difference in sensor temperature", min_temp_rise);
int32_t min_start_temp = 5;
param_get(param_find("SYS_CAL_TMIN"), &min_start_temp);
//init calibrators
TemperatureCalibrationBase *calibrators[3];
bool error_reported[3] = {};
int num_calibrators = 0;
if (_accel) {
calibrators[num_calibrators] = new TemperatureCalibrationAccel(min_temp_rise);
calibrators[num_calibrators] = new TemperatureCalibrationAccel(min_temp_rise,min_start_temp);
if (calibrators[num_calibrators]) {
++num_calibrators;
@@ -144,7 +147,7 @@ void TemperatureCalibration::task_main()
}
if (_baro) {
calibrators[num_calibrators] = new TemperatureCalibrationBaro(min_temp_rise);
calibrators[num_calibrators] = new TemperatureCalibrationBaro(min_temp_rise, min_start_temp);
if (calibrators[num_calibrators]) {
++num_calibrators;
@@ -155,7 +158,7 @@ void TemperatureCalibration::task_main()
}
if (_gyro) {
calibrators[num_calibrators] = new TemperatureCalibrationGyro(min_temp_rise, gyro_sub, num_gyro);
calibrators[num_calibrators] = new TemperatureCalibrationGyro(min_temp_rise, min_start_temp, gyro_sub, num_gyro);
if (calibrators[num_calibrators]) {
++num_calibrators;