XSens driver and ROS wrapper