Fixed the IMU senors test programs