mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-23 13:07:34 +08:00
sensors: vehicle_magnetometer respect publication rate limit SENS_MAG_RATE
This commit is contained in:
@@ -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];
|
||||
|
||||
Reference in New Issue
Block a user