Bug fixes in translating from Mavlink to ROS-Mavlink #894

Job	Run time
industrial_ci (humble, main)	13m 24s
industrial_ci (iron, main)	13m 41s
industrial_ci (rolling, testing)	1m 58s
	29m 3s

Provide feedback