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) :)
It should be `for n, o in data.items():` sorry.