fix include path (#790)

* fix include path (#781)

* fix include path

* Trigger CI

Signed-off-by: Carlosespicur <carlosespicur@proton.me>

---------

Signed-off-by: Carlosespicur <carlosespicur@proton.me>
Co-authored-by: Carlosespicur <carlosespicur@proton.me>
(cherry picked from commit 22cf5e0)

* Remove rsync & execute only in non-host scenario

Signed-off-by: Eugenio Collado <eugeniocollado@eprosima.com>

---------

Signed-off-by: Carlosespicur <carlosespicur@proton.me>
Signed-off-by: Eugenio Collado <eugeniocollado@eprosima.com>
Co-authored-by: DedSecer <ded5ec@icloud.com>
Co-authored-by: Carlosespicur <carlosespicur@proton.me>
Co-authored-by: Eugenio Collado <eugeniocollado@eprosima.com>

Author: 4 people

scripts/build_firmware.sh

@@ -76,3 +76,17 @@ else
     . $PREFIX/config/$RTOS/$PLATFORM/build.sh
 fi
 
+######## Fix include paths  ########
+if [ "$RTOS" != "host" ]; then
+    cd "$FW_TARGETDIR/mcu_ws"
+    INCLUDE_ROS2_PACKAGES=$(colcon list | awk '{print $1}' | awk -v d=" " '{s=(NR==1?s:s d)$0}END{print s}')
+
+    for var in ${INCLUDE_ROS2_PACKAGES}; do
+        if [ -d "$FW_TARGETDIR/build/include/${var}/${var}" ]; then
+            mkdir -p "$FW_TARGETDIR/build/include/${var}"
+            cp -a "$FW_TARGETDIR/build/include/${var}/${var}/". "$FW_TARGETDIR/build/include/${var}/"
+            rm -rf "$FW_TARGETDIR/build/include/${var}/${var}"
+        fi
+    done
+fi
+