diff --git a/Dockerfile.full_ros_build b/Dockerfile.full_ros_build
index b6f3e0451800e9c1af00b60b08983d83834bb1ac..a6e41d40c7c29b547b5c5fdb3a1eea49a7886a1f 100644
--- a/Dockerfile.full_ros_build
+++ b/Dockerfile.full_ros_build
@@ -76,12 +76,13 @@ RUN apt-get update && rosdep install -y \
 
 # build source
 ARG MIXINS="build-testing-on release"
-RUN colcon build \
+RUN NAV2_PACKAGES=$(cd src/navigation2 && colcon list -n) \
+    colcon build \
       --symlink-install \
       --mixin \
         $MIXINS \
       --packages-up-to \
-        nav2_system_tests \
+        $NAV2_PACKAGES \
       --cmake-args --no-warn-unused-cli
 
 ARG RUN_TESTS