Fixed bug in yarp_IMU_interface introduced in last commit