Fixed error in IMUThread