diff --git a/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.cpp b/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.cpp index 3258750af8..f7c08f68f4 100644 --- a/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.cpp +++ b/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.cpp @@ -308,7 +308,7 @@ void VehicleMagnetometer::Run() // advertise outputs in order if publishing all if (!_param_sens_mag_mode.get()) { for (int instance = 0; instance < uorb_index; instance++) { - _vehicle_magnetometer_multi_pub[instance].advertise(); + _vehicle_magnetometer_pub[instance].advertise(); } } @@ -463,11 +463,11 @@ void VehicleMagnetometer::Publish(uint8_t instance, bool multi) out.timestamp = hrt_absolute_time(); if (multi) { - _vehicle_magnetometer_multi_pub[instance].publish(out); + _vehicle_magnetometer_pub[instance].publish(out); } else { // otherwise only ever publish the first instance - _vehicle_magnetometer_pub.publish(out); + _vehicle_magnetometer_pub[0].publish(out); } _last_publication_timestamp[instance] = out.timestamp; diff --git a/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.hpp b/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.hpp index 8b16f2402b..ca62cf8b9b 100644 --- a/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.hpp +++ b/src/modules/sensors/vehicle_magnetometer/VehicleMagnetometer.hpp @@ -92,8 +92,7 @@ private: uORB::Publication _sensor_preflight_mag_pub{ORB_ID(sensor_preflight_mag)}; - uORB::Publication _vehicle_magnetometer_pub{ORB_ID(vehicle_magnetometer)}; - uORB::PublicationMulti _vehicle_magnetometer_multi_pub[MAX_SENSOR_COUNT] { + uORB::PublicationMulti _vehicle_magnetometer_pub[MAX_SENSOR_COUNT] { {ORB_ID(vehicle_magnetometer)}, {ORB_ID(vehicle_magnetometer)}, {ORB_ID(vehicle_magnetometer)},