diff --git a/Dockerfile.debian11 b/Dockerfile.debian11
index bcaf7b3..ad23c98 100644
--- a/Dockerfile.debian11
+++ b/Dockerfile.debian11
@@ -147,9 +147,10 @@ RUN colcon \
     build \
     --mixin release build-testing-off \
     --cmake-args --no-warn-unused-cli \
-    --packages-up-to robot_state_publisher tf2_ros tf2_eigen_kdl yaml_cpp_vendor tf2_geometry_msgs filters \
+    --packages-up-to robot_state_publisher tf2_ros tf2_eigen_kdl yaml_cpp_vendor filters \
       ros2param ros2interface ros2topic ros2action ros2lifecycle ros2launch ros2run \
-      xacro trajectory_msgs diagnostic_updater backward_ros generate_parameter_library angles && \
+      xacro diagnostic_updater backward_ros generate_parameter_library \
+      trajectory_msgs tf2_msgs tf2_geometry_msgs sensor_msgs geometry_msgs nav_msgs && \
     rm -rf log src build
 
 # set up sourcing of ros
diff --git a/Dockerfile.debian12 b/Dockerfile.debian12
index c3640dc..0279bd6 100644
--- a/Dockerfile.debian12
+++ b/Dockerfile.debian12
@@ -128,7 +128,8 @@ RUN colcon \
     --cmake-args --no-warn-unused-cli \
     --packages-up-to robot_state_publisher tf2_ros tf2_eigen_kdl yaml_cpp_vendor tf2_geometry_msgs filters \
       ros2param ros2interface ros2topic ros2action ros2lifecycle ros2launch ros2run angles \
-      xacro trajectory_msgs diagnostic_updater backward_ros generate_parameter_library && \
+      xacro diagnostic_updater backward_ros generate_parameter_library \
+      trajectory_msgs tf2_msgs tf2_geometry_msgs sensor_msgs geometry_msgs nav_msgs && \
     rm -rf log src build
 
 # set up sourcing of ros