Arduino Mega2560 connection with Xsens MTi IMU sensor