Skip to content

Commit c6c0f22

Browse files
committed
clean up
1 parent 6112d59 commit c6c0f22

File tree

2 files changed

+10
-6
lines changed

2 files changed

+10
-6
lines changed

src/modules/sensors/vehicle_air_data/VehicleAirData.cpp

+9-5
Original file line numberDiff line numberDiff line change
@@ -255,7 +255,7 @@ void VehicleAirData::Run()
255255
}
256256

257257
if (!_relative_calibration_done) {
258-
UpdateRelativeCalibrations(time_now_us);
258+
_relative_calibration_done = UpdateRelativeCalibrations(time_now_us);
259259
}
260260

261261
// Publish
@@ -329,13 +329,14 @@ void VehicleAirData::Run()
329329
perf_end(_cycle_perf);
330330
}
331331

332-
void VehicleAirData::UpdateRelativeCalibrations(const hrt_abstime time_now_us)
332+
bool VehicleAirData::UpdateRelativeCalibrations(const hrt_abstime time_now_us)
333333
{
334334
// delay calibration to allow all drivers to start up
335-
_calibration_t_first = _calibration_t_first == 0 ? time_now_us : _calibration_t_first;
335+
if (_calibration_t_first == 0) {
336+
_calibration_t_first = time_now_us;
337+
}
336338

337339
if (time_now_us - _calibration_t_first > 1_s) {
338-
_relative_calibration_done = true;
339340
const float pressure_primary = _data_sum[_selected_sensor_sub_index] / _data_sum_count[_selected_sensor_sub_index];
340341

341342
for (int instance = 0; instance < MAX_SENSOR_COUNT; ++instance) {
@@ -348,10 +349,13 @@ void VehicleAirData::UpdateRelativeCalibrations(const hrt_abstime time_now_us)
348349
_calibration[instance].set_offset(new_offset);
349350
_calibration[instance].ParametersSave(instance);
350351
param_notify_changes();
351-
ParametersUpdate(true);
352352
}
353353
}
354+
355+
return true;
354356
}
357+
358+
return false;
355359
}
356360

357361
void VehicleAirData::CheckFailover(const hrt_abstime &time_now_us)

src/modules/sensors/vehicle_air_data/VehicleAirData.hpp

+1-1
Original file line numberDiff line numberDiff line change
@@ -85,7 +85,7 @@ class VehicleAirData : public ModuleParams, public px4::ScheduledWorkItem
8585
void CheckFailover(const hrt_abstime &time_now_us);
8686
bool ParametersUpdate(bool force = false);
8787
void UpdateStatus();
88-
void UpdateRelativeCalibrations(hrt_abstime time_now_us);
88+
bool UpdateRelativeCalibrations(hrt_abstime time_now_us);
8989

9090
static constexpr int MAX_SENSOR_COUNT = 4;
9191

0 commit comments

Comments
 (0)