diff --git a/source/armarx/navigation/local_planning/TebObstacleManager.cpp b/source/armarx/navigation/local_planning/TebObstacleManager.cpp
index e2402e121d279599b6968bf8aec2063749b49f5d..e16fffd374d72663e51c6c8609856b88565b68ad 100644
--- a/source/armarx/navigation/local_planning/TebObstacleManager.cpp
+++ b/source/armarx/navigation/local_planning/TebObstacleManager.cpp
@@ -37,7 +37,7 @@ namespace armarx::navigation::local_planning
         obst->pushBackVertex(max.x(), min.y());
 
         obst->finalizePolygon();
-        obst->setUseForOptimization(false);
+        obst->setUseForOptimization(true);
         container.push_back(obst);
 
         // visualize bounding box if layer is available