diff --git a/.circleci/config.yml b/.circleci/config.yml
index 755088f1e..512e98dc1 100644
--- a/.circleci/config.yml
+++ b/.circleci/config.yml
@@ -16,24 +16,29 @@ jobs:
             apt update -qq && apt install -y build-essential cmake python3-colcon-common-extensions python3-rosdep libeigen3-dev
             apt upgrade -y
             source `find $ROS_WS -maxdepth 2 -name local_setup.bash | sort | head -1`
-            mkdir -p $UNDERLAY_WS/src
+            rosdep update
             mkdir -p $OVERLAY_WS/src/grid_map && mv `find -maxdepth 1 -not -name . -not -name src` $OVERLAY_WS/src/grid_map/
-            cp $OVERLAY_WS/src/grid_map/tools/ros2_dependencies.repos \
+            mkdir -p $UNDERLAY_WS/src && cp $OVERLAY_WS/src/grid_map/tools/ros2_dependencies.repos \
               $UNDERLAY_WS/ros2_dependencies.repos
             cd $UNDERLAY_WS && vcs import src < ros2_dependencies.repos
+            cp $UNDERLAY_WS/src/ros-planning/navigation2/tools/ros2_dependencies.repos \
+              $UNDERLAY_WS/ros2_dependencies.repos
+            vcs import src < ros2_dependencies.repos
+            rosdep install -y --ignore-src --from-paths src
             colcon build --symlink-install --packages-up-to nav2_costmap_2d
             source $UNDERLAY_WS/install/setup.bash
             cd $OVERLAY_WS
-            rosdep update
             rosdep install -y --ignore-src --from-paths src
       - run:
           name: Debug Build
           command: |
+            cd $OVERLAY_WS
             source `find $ROS_WS -maxdepth 2 -name local_setup.bash | sort | head -1`
             colcon build --parallel-workers 1
       - run:
           name: Run Tests
           command: |
+            cd $OVERLAY_WS
             source `find $ROS_WS -maxdepth 2 -name local_setup.bash | sort | head -1`
             colcon test --parallel-workers 1
             colcon test-result --verbose