Added sleep in imu loop