Fix Rolling includes (#895)

Signed-off-by: Pablo Garrido <[email protected]>

Author: pablogs9

extras/library_generation/library_generation.sh

@@ -231,9 +231,14 @@ if [[ " ${PLATFORMS[@]} " =~ " esp32 " ]]; then
 fi
 
 ######## Fix include paths  ########
-INCLUDE_ROS2_PACKAGES=( rmw rcl rcl_action rcl_lifecycle rcl_logging_interface rosidl_runtime_c rosidl_typesupport_interface rosidl_typesupport_introspection_c )
-for var in "${INCLUDE_ROS2_PACKAGES[@]}"; do
-  mv /project/src/${var}/${var}/* /project/src/${var}
+pushd firmware/mcu_ws > /dev/null
+    INCLUDE_ROS2_PACKAGES=$(colcon list | awk '{print $1}' | awk -v d=" " '{s=(NR==1?s:s d)$0}END{print s}')
+popd > /dev/null
+
+apt -y install rsync
+for var in ${INCLUDE_ROS2_PACKAGES}; do
+    rsync -r /project/src/${var}/${var}/* /project/src/${var}/
+    rm -rf /project/src/${var}/${var}/
 done
 
 ######## Generate extra files ########