Added state machinery for picking next imu sensor