Fixed cmake macro for xacro in groovy

- Added error handling to execute_process
- Fixed execute_process call to actually convert xacros to urdf