sensors: vehicle_magnetometer respect publication rate limit SENS_MAG_RATE

This commit is contained in:
Daniel Agar
2021-01-30 21:05:37 -05:00
parent 318c7e83b3
commit ce76c84ce2
@@ -442,7 +442,7 @@ void VehicleMagnetometer::Run()
void VehicleMagnetometer::Publish(uint8_t instance, bool multi)
{
if ((_param_sens_mag_rate.get() > 0) && (_last_publication_timestamp[instance] ||
if ((_param_sens_mag_rate.get() > 0) && ((_last_publication_timestamp[instance] == 0) ||
(hrt_elapsed_time(&_last_publication_timestamp[instance]) >= (1e6f / _param_sens_mag_rate.get())))) {
const Vector3f magnetometer_data = _mag_sum[instance] / _mag_sum_count[instance];