Add object avoidance node in navigation