AP_Proximity: RPLidarA2: correct face distances are assigned to

4 years ago · ee2f615352
1 changed files with 1 additions and 1 deletions
--- a/libraries/AP_Proximity/AP_Proximity_RPLidarA2.cpp
+++ b/libraries/AP_Proximity/AP_Proximity_RPLidarA2.cpp
@ -317,7 +317,7 @@ void AP_Proximity_RPLidarA2::parse_response_data()
				@@ -317,7 +317,7 @@ void AP_Proximity_RPLidarA2::parse_response_data()
                    if (face != _last_face) {
                        // distance is for a new face, the previous one can be updated now
                        if (_last_distance_valid) {
-                            boundary.set_face_attributes(face, _last_angle_deg, _last_distance_m);
+                            boundary.set_face_attributes(_last_face, _last_angle_deg, _last_distance_m);
                        } else {
                            // reset distance from last face
                            boundary.reset_face(face);