Added a complete path avoiding obstacles