Process xacro file test

.gitignore

@@ -6,3 +6,6 @@
 
 # Visual Studio Code files
 .vscode
+
+# PyCache
+*.pyc

andino_description/CMakeLists.txt

@@ -2,6 +2,7 @@ cmake_minimum_required(VERSION 3.8)
 project(andino_description)
 
 find_package(ament_cmake REQUIRED)
+find_package(ament_cmake_python REQUIRED)
 
 install(
   DIRECTORY
@@ -14,4 +15,21 @@ install(
     share/${PROJECT_NAME}/
 )
 
+if(BUILD_TESTING)
+  find_package(ament_cmake_pytest REQUIRED)
+  set(_pytest_tests
+    test/test_xacro_processing.py
+  )
+  foreach(_test_path ${_pytest_tests})
+    get_filename_component(_test_name ${_test_path} NAME_WE)
+    ament_add_pytest_test(${_test_name} ${_test_path}
+      APPEND_ENV PYTHONPATH=${CMAKE_CURRENT_BINARY_DIR}
+      TIMEOUT 60
+      WORKING_DIRECTORY ${CMAKE_SOURCE_DIR}
+    )
+  endforeach()
+endif()
+
+# ament_python_install_package(${PROJECT_NAME})
+
 ament_package()

andino_description/package.xml

@@ -9,13 +9,16 @@
   <license file="LICENSE">BSD Clause 3</license>
 
   <buildtool_depend>ament_cmake</buildtool_depend>
+  <buildtool_depend>ament_cmake_python</buildtool_depend>
 
   <exec_depend>joint_state_publisher_gui</exec_depend>
   <exec_depend>robot_state_publisher</exec_depend>
   <exec_depend>ros2launch</exec_depend>
   <exec_depend>rviz2</exec_depend>
   <exec_depend>xacro</exec_depend>
 
+  <test_depend>ament_cmake_pytest</test_depend>
+
   <export>
     <build_type>ament_cmake</build_type>
   </export>

andino_description/test/test_xacro_processing.py

@@ -0,0 +1,16 @@
+import os
+import pytest
+import xacro
+from ament_index_python.packages import get_package_share_directory
+
+andino_description_pkg = get_package_share_directory("andino_description")
+
+def test_xacro_processing():
+    # Get the file path
+    xacro_file_path = os.path.join(andino_description_pkg, 'urdf', 'andino.urdf.xacro')
+
+    # Test xacro processing
+    try:
+        xacro.process_file(xacro_file_path)
+    except Exception as e:
+        pytest.fail(f"Xacro processing failed: {e}")