Revert navigation to ros-planning repository