fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-01 07:51:37 +08:00
Code Issues Packages Projects Releases Wiki Activity

sensors angular velocity and acceleration publishers fix auto usage

Browse Source 
- if the primary gyro or accel change this will cause the callback to be registered multiple times
This commit is contained in:
Daniel Agar
2019-08-08 11:36:27 -04:00
committed by GitHub
parent c66fc85630
commit c6aaa606da
2 changed files with 4 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/sensors/vehicle_acceleration/VehicleAcceleration.cpp
+2 -2
View File
@@ -80,7 +80,7 @@ VehicleAcceleration::Stop()
Deinit(); Deinit();
// clear all registered callbacks // clear all registered callbacks
for (auto sub : _sensor_sub) { for (auto &sub : _sensor_sub) {
sub.unregister_callback(); sub.unregister_callback();
} }
@@ -131,7 +131,7 @@ VehicleAcceleration::SensorCorrectionsUpdate(bool force)
if ((_selected_sensor != corrections.selected_accel_instance) || force) { if ((_selected_sensor != corrections.selected_accel_instance) || force) {
if (corrections.selected_accel_instance < MAX_SENSOR_COUNT) { if (corrections.selected_accel_instance < MAX_SENSOR_COUNT) {
// clear all registered callbacks // clear all registered callbacks
for (auto sub : _sensor_sub) { for (auto &sub : _sensor_sub) {
sub.unregister_callback(); sub.unregister_callback();
} }
src/modules/sensors/vehicle_angular_velocity/VehicleAngularVelocity.cpp
+2 -2
View File
@@ -80,7 +80,7 @@ VehicleAngularVelocity::Stop()
Deinit(); Deinit();
// clear all registered callbacks // clear all registered callbacks
for (auto sub : _sensor_sub) { for (auto &sub : _sensor_sub) {
sub.unregister_callback(); sub.unregister_callback();
} }
@@ -131,7 +131,7 @@ VehicleAngularVelocity::SensorCorrectionsUpdate(bool force)
if ((_selected_sensor != corrections.selected_gyro_instance) || force) { if ((_selected_sensor != corrections.selected_gyro_instance) || force) {
if (corrections.selected_gyro_instance < MAX_SENSOR_COUNT) { if (corrections.selected_gyro_instance < MAX_SENSOR_COUNT) {
// clear all registered callbacks // clear all registered callbacks
for (auto sub : _sensor_sub) { for (auto &sub : _sensor_sub) {
sub.unregister_callback(); sub.unregister_callback();
} }