sensors/vehicle_acceleration: update loop limit iteration

PX4 · Mar 4, 2024 · b2a8579 · b2a8579
1 parent 197fa14
commit b2a8579
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/src/modules/sensors/vehicle_acceleration/VehicleAcceleration.cpp b/src/modules/sensors/vehicle_acceleration/VehicleAcceleration.cpp
@@ -231,9 +231,12 @@ void VehicleAcceleration::Run()
 	}
 
 	// process all outstanding messages
+	int sensor_sub_updates = 0;
 	sensor_accel_s sensor_data;
 
-	while (_sensor_sub.update(&sensor_data)) {
+	while ((sensor_sub_updates < sensor_accel_s::ORB_QUEUE_LENGTH) && _sensor_sub.update(&sensor_data)) {
+		sensor_sub_updates++;
+
 		const Vector3f accel_raw{sensor_data.x, sensor_data.y, sensor_data.z};
 
 		if (accel_raw.isAllFinite()) {