Mtdata2 compatible

Hi,

Yesterday I sent you a message about the xsens ros driver. I already solved the MTData2 message parse problem. It was just missing ':' (as you can see in commit tab) :)
Please no empty line commit (especially here)