Fix initialization period for MPU6500, would cause strange effects if not followed.