Fix IMU lib and improve IMU test sketch