Add manipulator avoiding obstacles
Add manipulator avoiding obstacles