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) :)
You should reset the values of the object that are reused otherwise you might publish again old values (MTData2 can and should have varying content).