Fix UTM Utils and Get Tests to Build in ROS 2 #379

Job	Run time
industrial_ci (humble, testing)	1m 10s
industrial_ci (humble, testing)	10m 9s
industrial_ci (humble, testing)	1m 4s
industrial_ci (humble, main)	1m 10s
industrial_ci (humble, main)	1m 10s
industrial_ci (humble, main)	1m 5s
industrial_ci (iron, testing)	1m 9s
industrial_ci (iron, testing)	1m 9s
industrial_ci (iron, testing)	1m 4s
industrial_ci (iron, main)	1m 10s
industrial_ci (iron, main)	1m 10s
industrial_ci (iron, main)	1m 6s
industrial_ci (rolling, testing)	1m 0s
industrial_ci (rolling, testing)	1m 0s
industrial_ci (rolling, testing)	54s
industrial_ci (rolling, main)	1m 10s
industrial_ci (rolling, main)	1m 10s
industrial_ci (rolling, main)	54s
	28m 44s

Provide feedback