Browse Source

Fix NavigationObstacle elevation

FixesNavigationObstacle elevation.

(cherry picked from commit fc4cc27e662114b5395d6a59b398e6b7c3132be1)
smix8 1 year ago
parent
commit
0cf4e79b48
1 changed files with 2 additions and 0 deletions
  1. 2 0
      modules/navigation/nav_map.cpp

+ 2 - 0
modules/navigation/nav_map.cpp

@@ -1126,6 +1126,8 @@ void NavMap::_update_rvo_obstacles_tree_2d() {
 		for (size_t i = 0; i < rvo_2d_vertices.size(); i++) {
 			RVO2D::Obstacle2D *rvo_2d_obstacle = new RVO2D::Obstacle2D();
 			rvo_2d_obstacle->point_ = rvo_2d_vertices[i];
+			rvo_2d_obstacle->elevation_ = _obstacle_position.y;
+
 			rvo_2d_obstacle->avoidance_layers_ = _obstacle_avoidance_layers;
 
 			if (i != 0) {