xref: /kernel/linux/linux-5.10/sound/usb/caiaq/audio.c (revision 8c2ecf20)
18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci *   Copyright (c) 2006-2008 Daniel Mack, Karsten Wiese
48c2ecf20Sopenharmony_ci*/
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <linux/device.h>
78c2ecf20Sopenharmony_ci#include <linux/spinlock.h>
88c2ecf20Sopenharmony_ci#include <linux/slab.h>
98c2ecf20Sopenharmony_ci#include <linux/init.h>
108c2ecf20Sopenharmony_ci#include <linux/usb.h>
118c2ecf20Sopenharmony_ci#include <sound/core.h>
128c2ecf20Sopenharmony_ci#include <sound/pcm.h>
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#include "device.h"
158c2ecf20Sopenharmony_ci#include "audio.h"
168c2ecf20Sopenharmony_ci
178c2ecf20Sopenharmony_ci#define N_URBS			32
188c2ecf20Sopenharmony_ci#define CLOCK_DRIFT_TOLERANCE	5
198c2ecf20Sopenharmony_ci#define FRAMES_PER_URB		8
208c2ecf20Sopenharmony_ci#define BYTES_PER_FRAME		512
218c2ecf20Sopenharmony_ci#define CHANNELS_PER_STREAM	2
228c2ecf20Sopenharmony_ci#define BYTES_PER_SAMPLE	3
238c2ecf20Sopenharmony_ci#define BYTES_PER_SAMPLE_USB	4
248c2ecf20Sopenharmony_ci#define MAX_BUFFER_SIZE		(128*1024)
258c2ecf20Sopenharmony_ci#define MAX_ENDPOINT_SIZE	512
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci#define ENDPOINT_CAPTURE	2
288c2ecf20Sopenharmony_ci#define ENDPOINT_PLAYBACK	6
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_ci#define MAKE_CHECKBYTE(cdev,stream,i) \
318c2ecf20Sopenharmony_ci	(stream << 1) | (~(i / (cdev->n_streams * BYTES_PER_SAMPLE_USB)) & 1)
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_cistatic const struct snd_pcm_hardware snd_usb_caiaq_pcm_hardware = {
348c2ecf20Sopenharmony_ci	.info 		= (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
358c2ecf20Sopenharmony_ci			   SNDRV_PCM_INFO_BLOCK_TRANSFER),
368c2ecf20Sopenharmony_ci	.formats 	= SNDRV_PCM_FMTBIT_S24_3BE,
378c2ecf20Sopenharmony_ci	.rates 		= (SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 |
388c2ecf20Sopenharmony_ci			   SNDRV_PCM_RATE_96000),
398c2ecf20Sopenharmony_ci	.rate_min	= 44100,
408c2ecf20Sopenharmony_ci	.rate_max	= 0, /* will overwrite later */
418c2ecf20Sopenharmony_ci	.channels_min	= CHANNELS_PER_STREAM,
428c2ecf20Sopenharmony_ci	.channels_max	= CHANNELS_PER_STREAM,
438c2ecf20Sopenharmony_ci	.buffer_bytes_max = MAX_BUFFER_SIZE,
448c2ecf20Sopenharmony_ci	.period_bytes_min = 128,
458c2ecf20Sopenharmony_ci	.period_bytes_max = MAX_BUFFER_SIZE,
468c2ecf20Sopenharmony_ci	.periods_min	= 1,
478c2ecf20Sopenharmony_ci	.periods_max	= 1024,
488c2ecf20Sopenharmony_ci};
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_cistatic void
518c2ecf20Sopenharmony_ciactivate_substream(struct snd_usb_caiaqdev *cdev,
528c2ecf20Sopenharmony_ci	           struct snd_pcm_substream *sub)
538c2ecf20Sopenharmony_ci{
548c2ecf20Sopenharmony_ci	spin_lock(&cdev->spinlock);
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_ci	if (sub->stream == SNDRV_PCM_STREAM_PLAYBACK)
578c2ecf20Sopenharmony_ci		cdev->sub_playback[sub->number] = sub;
588c2ecf20Sopenharmony_ci	else
598c2ecf20Sopenharmony_ci		cdev->sub_capture[sub->number] = sub;
608c2ecf20Sopenharmony_ci
618c2ecf20Sopenharmony_ci	spin_unlock(&cdev->spinlock);
628c2ecf20Sopenharmony_ci}
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_cistatic void
658c2ecf20Sopenharmony_cideactivate_substream(struct snd_usb_caiaqdev *cdev,
668c2ecf20Sopenharmony_ci		     struct snd_pcm_substream *sub)
678c2ecf20Sopenharmony_ci{
688c2ecf20Sopenharmony_ci	unsigned long flags;
698c2ecf20Sopenharmony_ci	spin_lock_irqsave(&cdev->spinlock, flags);
708c2ecf20Sopenharmony_ci
718c2ecf20Sopenharmony_ci	if (sub->stream == SNDRV_PCM_STREAM_PLAYBACK)
728c2ecf20Sopenharmony_ci		cdev->sub_playback[sub->number] = NULL;
738c2ecf20Sopenharmony_ci	else
748c2ecf20Sopenharmony_ci		cdev->sub_capture[sub->number] = NULL;
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&cdev->spinlock, flags);
778c2ecf20Sopenharmony_ci}
788c2ecf20Sopenharmony_ci
798c2ecf20Sopenharmony_cistatic int
808c2ecf20Sopenharmony_ciall_substreams_zero(struct snd_pcm_substream **subs)
818c2ecf20Sopenharmony_ci{
828c2ecf20Sopenharmony_ci	int i;
838c2ecf20Sopenharmony_ci	for (i = 0; i < MAX_STREAMS; i++)
848c2ecf20Sopenharmony_ci		if (subs[i] != NULL)
858c2ecf20Sopenharmony_ci			return 0;
868c2ecf20Sopenharmony_ci	return 1;
878c2ecf20Sopenharmony_ci}
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_cistatic int stream_start(struct snd_usb_caiaqdev *cdev)
908c2ecf20Sopenharmony_ci{
918c2ecf20Sopenharmony_ci	int i, ret;
928c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
938c2ecf20Sopenharmony_ci
948c2ecf20Sopenharmony_ci	dev_dbg(dev, "%s(%p)\n", __func__, cdev);
958c2ecf20Sopenharmony_ci
968c2ecf20Sopenharmony_ci	if (cdev->streaming)
978c2ecf20Sopenharmony_ci		return -EINVAL;
988c2ecf20Sopenharmony_ci
998c2ecf20Sopenharmony_ci	memset(cdev->sub_playback, 0, sizeof(cdev->sub_playback));
1008c2ecf20Sopenharmony_ci	memset(cdev->sub_capture, 0, sizeof(cdev->sub_capture));
1018c2ecf20Sopenharmony_ci	cdev->input_panic = 0;
1028c2ecf20Sopenharmony_ci	cdev->output_panic = 0;
1038c2ecf20Sopenharmony_ci	cdev->first_packet = 4;
1048c2ecf20Sopenharmony_ci	cdev->streaming = 1;
1058c2ecf20Sopenharmony_ci	cdev->warned = 0;
1068c2ecf20Sopenharmony_ci
1078c2ecf20Sopenharmony_ci	for (i = 0; i < N_URBS; i++) {
1088c2ecf20Sopenharmony_ci		ret = usb_submit_urb(cdev->data_urbs_in[i], GFP_ATOMIC);
1098c2ecf20Sopenharmony_ci		if (ret) {
1108c2ecf20Sopenharmony_ci			dev_err(dev, "unable to trigger read #%d! (ret %d)\n",
1118c2ecf20Sopenharmony_ci				i, ret);
1128c2ecf20Sopenharmony_ci			cdev->streaming = 0;
1138c2ecf20Sopenharmony_ci			return -EPIPE;
1148c2ecf20Sopenharmony_ci		}
1158c2ecf20Sopenharmony_ci	}
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci	return 0;
1188c2ecf20Sopenharmony_ci}
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_cistatic void stream_stop(struct snd_usb_caiaqdev *cdev)
1218c2ecf20Sopenharmony_ci{
1228c2ecf20Sopenharmony_ci	int i;
1238c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
1248c2ecf20Sopenharmony_ci
1258c2ecf20Sopenharmony_ci	dev_dbg(dev, "%s(%p)\n", __func__, cdev);
1268c2ecf20Sopenharmony_ci	if (!cdev->streaming)
1278c2ecf20Sopenharmony_ci		return;
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_ci	cdev->streaming = 0;
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_ci	for (i = 0; i < N_URBS; i++) {
1328c2ecf20Sopenharmony_ci		usb_kill_urb(cdev->data_urbs_in[i]);
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci		if (test_bit(i, &cdev->outurb_active_mask))
1358c2ecf20Sopenharmony_ci			usb_kill_urb(cdev->data_urbs_out[i]);
1368c2ecf20Sopenharmony_ci	}
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci	cdev->outurb_active_mask = 0;
1398c2ecf20Sopenharmony_ci}
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_substream_open(struct snd_pcm_substream *substream)
1428c2ecf20Sopenharmony_ci{
1438c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(substream);
1448c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci	dev_dbg(dev, "%s(%p)\n", __func__, substream);
1478c2ecf20Sopenharmony_ci	substream->runtime->hw = cdev->pcm_info;
1488c2ecf20Sopenharmony_ci	snd_pcm_limit_hw_rates(substream->runtime);
1498c2ecf20Sopenharmony_ci
1508c2ecf20Sopenharmony_ci	return 0;
1518c2ecf20Sopenharmony_ci}
1528c2ecf20Sopenharmony_ci
1538c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_substream_close(struct snd_pcm_substream *substream)
1548c2ecf20Sopenharmony_ci{
1558c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(substream);
1568c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
1578c2ecf20Sopenharmony_ci
1588c2ecf20Sopenharmony_ci	dev_dbg(dev, "%s(%p)\n", __func__, substream);
1598c2ecf20Sopenharmony_ci	if (all_substreams_zero(cdev->sub_playback) &&
1608c2ecf20Sopenharmony_ci	    all_substreams_zero(cdev->sub_capture)) {
1618c2ecf20Sopenharmony_ci		/* when the last client has stopped streaming,
1628c2ecf20Sopenharmony_ci		 * all sample rates are allowed again */
1638c2ecf20Sopenharmony_ci		stream_stop(cdev);
1648c2ecf20Sopenharmony_ci		cdev->pcm_info.rates = cdev->samplerates;
1658c2ecf20Sopenharmony_ci	}
1668c2ecf20Sopenharmony_ci
1678c2ecf20Sopenharmony_ci	return 0;
1688c2ecf20Sopenharmony_ci}
1698c2ecf20Sopenharmony_ci
1708c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_pcm_hw_free(struct snd_pcm_substream *sub)
1718c2ecf20Sopenharmony_ci{
1728c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(sub);
1738c2ecf20Sopenharmony_ci	deactivate_substream(cdev, sub);
1748c2ecf20Sopenharmony_ci	return 0;
1758c2ecf20Sopenharmony_ci}
1768c2ecf20Sopenharmony_ci
1778c2ecf20Sopenharmony_ci/* this should probably go upstream */
1788c2ecf20Sopenharmony_ci#if SNDRV_PCM_RATE_5512 != 1 << 0 || SNDRV_PCM_RATE_192000 != 1 << 12
1798c2ecf20Sopenharmony_ci#error "Change this table"
1808c2ecf20Sopenharmony_ci#endif
1818c2ecf20Sopenharmony_ci
1828c2ecf20Sopenharmony_cistatic const unsigned int rates[] = { 5512, 8000, 11025, 16000, 22050, 32000, 44100,
1838c2ecf20Sopenharmony_ci				48000, 64000, 88200, 96000, 176400, 192000 };
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_pcm_prepare(struct snd_pcm_substream *substream)
1868c2ecf20Sopenharmony_ci{
1878c2ecf20Sopenharmony_ci	int bytes_per_sample, bpp, ret, i;
1888c2ecf20Sopenharmony_ci	int index = substream->number;
1898c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(substream);
1908c2ecf20Sopenharmony_ci	struct snd_pcm_runtime *runtime = substream->runtime;
1918c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
1928c2ecf20Sopenharmony_ci
1938c2ecf20Sopenharmony_ci	dev_dbg(dev, "%s(%p)\n", __func__, substream);
1948c2ecf20Sopenharmony_ci
1958c2ecf20Sopenharmony_ci	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1968c2ecf20Sopenharmony_ci		int out_pos;
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_ci		switch (cdev->spec.data_alignment) {
1998c2ecf20Sopenharmony_ci		case 0:
2008c2ecf20Sopenharmony_ci		case 2:
2018c2ecf20Sopenharmony_ci			out_pos = BYTES_PER_SAMPLE + 1;
2028c2ecf20Sopenharmony_ci			break;
2038c2ecf20Sopenharmony_ci		case 3:
2048c2ecf20Sopenharmony_ci		default:
2058c2ecf20Sopenharmony_ci			out_pos = 0;
2068c2ecf20Sopenharmony_ci			break;
2078c2ecf20Sopenharmony_ci		}
2088c2ecf20Sopenharmony_ci
2098c2ecf20Sopenharmony_ci		cdev->period_out_count[index] = out_pos;
2108c2ecf20Sopenharmony_ci		cdev->audio_out_buf_pos[index] = out_pos;
2118c2ecf20Sopenharmony_ci	} else {
2128c2ecf20Sopenharmony_ci		int in_pos;
2138c2ecf20Sopenharmony_ci
2148c2ecf20Sopenharmony_ci		switch (cdev->spec.data_alignment) {
2158c2ecf20Sopenharmony_ci		case 0:
2168c2ecf20Sopenharmony_ci			in_pos = BYTES_PER_SAMPLE + 2;
2178c2ecf20Sopenharmony_ci			break;
2188c2ecf20Sopenharmony_ci		case 2:
2198c2ecf20Sopenharmony_ci			in_pos = BYTES_PER_SAMPLE;
2208c2ecf20Sopenharmony_ci			break;
2218c2ecf20Sopenharmony_ci		case 3:
2228c2ecf20Sopenharmony_ci		default:
2238c2ecf20Sopenharmony_ci			in_pos = 0;
2248c2ecf20Sopenharmony_ci			break;
2258c2ecf20Sopenharmony_ci		}
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci		cdev->period_in_count[index] = in_pos;
2288c2ecf20Sopenharmony_ci		cdev->audio_in_buf_pos[index] = in_pos;
2298c2ecf20Sopenharmony_ci	}
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci	if (cdev->streaming)
2328c2ecf20Sopenharmony_ci		return 0;
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_ci	/* the first client that opens a stream defines the sample rate
2358c2ecf20Sopenharmony_ci	 * setting for all subsequent calls, until the last client closed. */
2368c2ecf20Sopenharmony_ci	for (i=0; i < ARRAY_SIZE(rates); i++)
2378c2ecf20Sopenharmony_ci		if (runtime->rate == rates[i])
2388c2ecf20Sopenharmony_ci			cdev->pcm_info.rates = 1 << i;
2398c2ecf20Sopenharmony_ci
2408c2ecf20Sopenharmony_ci	snd_pcm_limit_hw_rates(runtime);
2418c2ecf20Sopenharmony_ci
2428c2ecf20Sopenharmony_ci	bytes_per_sample = BYTES_PER_SAMPLE;
2438c2ecf20Sopenharmony_ci	if (cdev->spec.data_alignment >= 2)
2448c2ecf20Sopenharmony_ci		bytes_per_sample++;
2458c2ecf20Sopenharmony_ci
2468c2ecf20Sopenharmony_ci	bpp = ((runtime->rate / 8000) + CLOCK_DRIFT_TOLERANCE)
2478c2ecf20Sopenharmony_ci		* bytes_per_sample * CHANNELS_PER_STREAM * cdev->n_streams;
2488c2ecf20Sopenharmony_ci
2498c2ecf20Sopenharmony_ci	if (bpp > MAX_ENDPOINT_SIZE)
2508c2ecf20Sopenharmony_ci		bpp = MAX_ENDPOINT_SIZE;
2518c2ecf20Sopenharmony_ci
2528c2ecf20Sopenharmony_ci	ret = snd_usb_caiaq_set_audio_params(cdev, runtime->rate,
2538c2ecf20Sopenharmony_ci					     runtime->sample_bits, bpp);
2548c2ecf20Sopenharmony_ci	if (ret)
2558c2ecf20Sopenharmony_ci		return ret;
2568c2ecf20Sopenharmony_ci
2578c2ecf20Sopenharmony_ci	ret = stream_start(cdev);
2588c2ecf20Sopenharmony_ci	if (ret)
2598c2ecf20Sopenharmony_ci		return ret;
2608c2ecf20Sopenharmony_ci
2618c2ecf20Sopenharmony_ci	cdev->output_running = 0;
2628c2ecf20Sopenharmony_ci	wait_event_timeout(cdev->prepare_wait_queue, cdev->output_running, HZ);
2638c2ecf20Sopenharmony_ci	if (!cdev->output_running) {
2648c2ecf20Sopenharmony_ci		stream_stop(cdev);
2658c2ecf20Sopenharmony_ci		return -EPIPE;
2668c2ecf20Sopenharmony_ci	}
2678c2ecf20Sopenharmony_ci
2688c2ecf20Sopenharmony_ci	return 0;
2698c2ecf20Sopenharmony_ci}
2708c2ecf20Sopenharmony_ci
2718c2ecf20Sopenharmony_cistatic int snd_usb_caiaq_pcm_trigger(struct snd_pcm_substream *sub, int cmd)
2728c2ecf20Sopenharmony_ci{
2738c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(sub);
2748c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
2758c2ecf20Sopenharmony_ci
2768c2ecf20Sopenharmony_ci	dev_dbg(dev, "%s(%p) cmd %d\n", __func__, sub, cmd);
2778c2ecf20Sopenharmony_ci
2788c2ecf20Sopenharmony_ci	switch (cmd) {
2798c2ecf20Sopenharmony_ci	case SNDRV_PCM_TRIGGER_START:
2808c2ecf20Sopenharmony_ci	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
2818c2ecf20Sopenharmony_ci		activate_substream(cdev, sub);
2828c2ecf20Sopenharmony_ci		break;
2838c2ecf20Sopenharmony_ci	case SNDRV_PCM_TRIGGER_STOP:
2848c2ecf20Sopenharmony_ci	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
2858c2ecf20Sopenharmony_ci		deactivate_substream(cdev, sub);
2868c2ecf20Sopenharmony_ci		break;
2878c2ecf20Sopenharmony_ci	default:
2888c2ecf20Sopenharmony_ci		return -EINVAL;
2898c2ecf20Sopenharmony_ci	}
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ci	return 0;
2928c2ecf20Sopenharmony_ci}
2938c2ecf20Sopenharmony_ci
2948c2ecf20Sopenharmony_cistatic snd_pcm_uframes_t
2958c2ecf20Sopenharmony_cisnd_usb_caiaq_pcm_pointer(struct snd_pcm_substream *sub)
2968c2ecf20Sopenharmony_ci{
2978c2ecf20Sopenharmony_ci	int index = sub->number;
2988c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev = snd_pcm_substream_chip(sub);
2998c2ecf20Sopenharmony_ci	snd_pcm_uframes_t ptr;
3008c2ecf20Sopenharmony_ci
3018c2ecf20Sopenharmony_ci	spin_lock(&cdev->spinlock);
3028c2ecf20Sopenharmony_ci
3038c2ecf20Sopenharmony_ci	if (cdev->input_panic || cdev->output_panic) {
3048c2ecf20Sopenharmony_ci		ptr = SNDRV_PCM_POS_XRUN;
3058c2ecf20Sopenharmony_ci		goto unlock;
3068c2ecf20Sopenharmony_ci	}
3078c2ecf20Sopenharmony_ci
3088c2ecf20Sopenharmony_ci	if (sub->stream == SNDRV_PCM_STREAM_PLAYBACK)
3098c2ecf20Sopenharmony_ci		ptr = bytes_to_frames(sub->runtime,
3108c2ecf20Sopenharmony_ci					cdev->audio_out_buf_pos[index]);
3118c2ecf20Sopenharmony_ci	else
3128c2ecf20Sopenharmony_ci		ptr = bytes_to_frames(sub->runtime,
3138c2ecf20Sopenharmony_ci					cdev->audio_in_buf_pos[index]);
3148c2ecf20Sopenharmony_ci
3158c2ecf20Sopenharmony_ciunlock:
3168c2ecf20Sopenharmony_ci	spin_unlock(&cdev->spinlock);
3178c2ecf20Sopenharmony_ci	return ptr;
3188c2ecf20Sopenharmony_ci}
3198c2ecf20Sopenharmony_ci
3208c2ecf20Sopenharmony_ci/* operators for both playback and capture */
3218c2ecf20Sopenharmony_cistatic const struct snd_pcm_ops snd_usb_caiaq_ops = {
3228c2ecf20Sopenharmony_ci	.open =		snd_usb_caiaq_substream_open,
3238c2ecf20Sopenharmony_ci	.close =	snd_usb_caiaq_substream_close,
3248c2ecf20Sopenharmony_ci	.hw_free =	snd_usb_caiaq_pcm_hw_free,
3258c2ecf20Sopenharmony_ci	.prepare =	snd_usb_caiaq_pcm_prepare,
3268c2ecf20Sopenharmony_ci	.trigger =	snd_usb_caiaq_pcm_trigger,
3278c2ecf20Sopenharmony_ci	.pointer =	snd_usb_caiaq_pcm_pointer,
3288c2ecf20Sopenharmony_ci};
3298c2ecf20Sopenharmony_ci
3308c2ecf20Sopenharmony_cistatic void check_for_elapsed_periods(struct snd_usb_caiaqdev *cdev,
3318c2ecf20Sopenharmony_ci				      struct snd_pcm_substream **subs)
3328c2ecf20Sopenharmony_ci{
3338c2ecf20Sopenharmony_ci	int stream, pb, *cnt;
3348c2ecf20Sopenharmony_ci	struct snd_pcm_substream *sub;
3358c2ecf20Sopenharmony_ci
3368c2ecf20Sopenharmony_ci	for (stream = 0; stream < cdev->n_streams; stream++) {
3378c2ecf20Sopenharmony_ci		sub = subs[stream];
3388c2ecf20Sopenharmony_ci		if (!sub)
3398c2ecf20Sopenharmony_ci			continue;
3408c2ecf20Sopenharmony_ci
3418c2ecf20Sopenharmony_ci		pb = snd_pcm_lib_period_bytes(sub);
3428c2ecf20Sopenharmony_ci		cnt = (sub->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
3438c2ecf20Sopenharmony_ci					&cdev->period_out_count[stream] :
3448c2ecf20Sopenharmony_ci					&cdev->period_in_count[stream];
3458c2ecf20Sopenharmony_ci
3468c2ecf20Sopenharmony_ci		if (*cnt >= pb) {
3478c2ecf20Sopenharmony_ci			snd_pcm_period_elapsed(sub);
3488c2ecf20Sopenharmony_ci			*cnt %= pb;
3498c2ecf20Sopenharmony_ci		}
3508c2ecf20Sopenharmony_ci	}
3518c2ecf20Sopenharmony_ci}
3528c2ecf20Sopenharmony_ci
3538c2ecf20Sopenharmony_cistatic void read_in_urb_mode0(struct snd_usb_caiaqdev *cdev,
3548c2ecf20Sopenharmony_ci			      const struct urb *urb,
3558c2ecf20Sopenharmony_ci			      const struct usb_iso_packet_descriptor *iso)
3568c2ecf20Sopenharmony_ci{
3578c2ecf20Sopenharmony_ci	unsigned char *usb_buf = urb->transfer_buffer + iso->offset;
3588c2ecf20Sopenharmony_ci	struct snd_pcm_substream *sub;
3598c2ecf20Sopenharmony_ci	int stream, i;
3608c2ecf20Sopenharmony_ci
3618c2ecf20Sopenharmony_ci	if (all_substreams_zero(cdev->sub_capture))
3628c2ecf20Sopenharmony_ci		return;
3638c2ecf20Sopenharmony_ci
3648c2ecf20Sopenharmony_ci	for (i = 0; i < iso->actual_length;) {
3658c2ecf20Sopenharmony_ci		for (stream = 0; stream < cdev->n_streams; stream++, i++) {
3668c2ecf20Sopenharmony_ci			sub = cdev->sub_capture[stream];
3678c2ecf20Sopenharmony_ci			if (sub) {
3688c2ecf20Sopenharmony_ci				struct snd_pcm_runtime *rt = sub->runtime;
3698c2ecf20Sopenharmony_ci				char *audio_buf = rt->dma_area;
3708c2ecf20Sopenharmony_ci				int sz = frames_to_bytes(rt, rt->buffer_size);
3718c2ecf20Sopenharmony_ci				audio_buf[cdev->audio_in_buf_pos[stream]++]
3728c2ecf20Sopenharmony_ci					= usb_buf[i];
3738c2ecf20Sopenharmony_ci				cdev->period_in_count[stream]++;
3748c2ecf20Sopenharmony_ci				if (cdev->audio_in_buf_pos[stream] == sz)
3758c2ecf20Sopenharmony_ci					cdev->audio_in_buf_pos[stream] = 0;
3768c2ecf20Sopenharmony_ci			}
3778c2ecf20Sopenharmony_ci		}
3788c2ecf20Sopenharmony_ci	}
3798c2ecf20Sopenharmony_ci}
3808c2ecf20Sopenharmony_ci
3818c2ecf20Sopenharmony_cistatic void read_in_urb_mode2(struct snd_usb_caiaqdev *cdev,
3828c2ecf20Sopenharmony_ci			      const struct urb *urb,
3838c2ecf20Sopenharmony_ci			      const struct usb_iso_packet_descriptor *iso)
3848c2ecf20Sopenharmony_ci{
3858c2ecf20Sopenharmony_ci	unsigned char *usb_buf = urb->transfer_buffer + iso->offset;
3868c2ecf20Sopenharmony_ci	unsigned char check_byte;
3878c2ecf20Sopenharmony_ci	struct snd_pcm_substream *sub;
3888c2ecf20Sopenharmony_ci	int stream, i;
3898c2ecf20Sopenharmony_ci
3908c2ecf20Sopenharmony_ci	for (i = 0; i < iso->actual_length;) {
3918c2ecf20Sopenharmony_ci		if (i % (cdev->n_streams * BYTES_PER_SAMPLE_USB) == 0) {
3928c2ecf20Sopenharmony_ci			for (stream = 0;
3938c2ecf20Sopenharmony_ci			     stream < cdev->n_streams;
3948c2ecf20Sopenharmony_ci			     stream++, i++) {
3958c2ecf20Sopenharmony_ci				if (cdev->first_packet)
3968c2ecf20Sopenharmony_ci					continue;
3978c2ecf20Sopenharmony_ci
3988c2ecf20Sopenharmony_ci				check_byte = MAKE_CHECKBYTE(cdev, stream, i);
3998c2ecf20Sopenharmony_ci
4008c2ecf20Sopenharmony_ci				if ((usb_buf[i] & 0x3f) != check_byte)
4018c2ecf20Sopenharmony_ci					cdev->input_panic = 1;
4028c2ecf20Sopenharmony_ci
4038c2ecf20Sopenharmony_ci				if (usb_buf[i] & 0x80)
4048c2ecf20Sopenharmony_ci					cdev->output_panic = 1;
4058c2ecf20Sopenharmony_ci			}
4068c2ecf20Sopenharmony_ci		}
4078c2ecf20Sopenharmony_ci		cdev->first_packet = 0;
4088c2ecf20Sopenharmony_ci
4098c2ecf20Sopenharmony_ci		for (stream = 0; stream < cdev->n_streams; stream++, i++) {
4108c2ecf20Sopenharmony_ci			sub = cdev->sub_capture[stream];
4118c2ecf20Sopenharmony_ci			if (cdev->input_panic)
4128c2ecf20Sopenharmony_ci				usb_buf[i] = 0;
4138c2ecf20Sopenharmony_ci
4148c2ecf20Sopenharmony_ci			if (sub) {
4158c2ecf20Sopenharmony_ci				struct snd_pcm_runtime *rt = sub->runtime;
4168c2ecf20Sopenharmony_ci				char *audio_buf = rt->dma_area;
4178c2ecf20Sopenharmony_ci				int sz = frames_to_bytes(rt, rt->buffer_size);
4188c2ecf20Sopenharmony_ci				audio_buf[cdev->audio_in_buf_pos[stream]++] =
4198c2ecf20Sopenharmony_ci					usb_buf[i];
4208c2ecf20Sopenharmony_ci				cdev->period_in_count[stream]++;
4218c2ecf20Sopenharmony_ci				if (cdev->audio_in_buf_pos[stream] == sz)
4228c2ecf20Sopenharmony_ci					cdev->audio_in_buf_pos[stream] = 0;
4238c2ecf20Sopenharmony_ci			}
4248c2ecf20Sopenharmony_ci		}
4258c2ecf20Sopenharmony_ci	}
4268c2ecf20Sopenharmony_ci}
4278c2ecf20Sopenharmony_ci
4288c2ecf20Sopenharmony_cistatic void read_in_urb_mode3(struct snd_usb_caiaqdev *cdev,
4298c2ecf20Sopenharmony_ci			      const struct urb *urb,
4308c2ecf20Sopenharmony_ci			      const struct usb_iso_packet_descriptor *iso)
4318c2ecf20Sopenharmony_ci{
4328c2ecf20Sopenharmony_ci	unsigned char *usb_buf = urb->transfer_buffer + iso->offset;
4338c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
4348c2ecf20Sopenharmony_ci	int stream, i;
4358c2ecf20Sopenharmony_ci
4368c2ecf20Sopenharmony_ci	/* paranoia check */
4378c2ecf20Sopenharmony_ci	if (iso->actual_length % (BYTES_PER_SAMPLE_USB * CHANNELS_PER_STREAM))
4388c2ecf20Sopenharmony_ci		return;
4398c2ecf20Sopenharmony_ci
4408c2ecf20Sopenharmony_ci	for (i = 0; i < iso->actual_length;) {
4418c2ecf20Sopenharmony_ci		for (stream = 0; stream < cdev->n_streams; stream++) {
4428c2ecf20Sopenharmony_ci			struct snd_pcm_substream *sub = cdev->sub_capture[stream];
4438c2ecf20Sopenharmony_ci			char *audio_buf = NULL;
4448c2ecf20Sopenharmony_ci			int c, n, sz = 0;
4458c2ecf20Sopenharmony_ci
4468c2ecf20Sopenharmony_ci			if (sub && !cdev->input_panic) {
4478c2ecf20Sopenharmony_ci				struct snd_pcm_runtime *rt = sub->runtime;
4488c2ecf20Sopenharmony_ci				audio_buf = rt->dma_area;
4498c2ecf20Sopenharmony_ci				sz = frames_to_bytes(rt, rt->buffer_size);
4508c2ecf20Sopenharmony_ci			}
4518c2ecf20Sopenharmony_ci
4528c2ecf20Sopenharmony_ci			for (c = 0; c < CHANNELS_PER_STREAM; c++) {
4538c2ecf20Sopenharmony_ci				/* 3 audio data bytes, followed by 1 check byte */
4548c2ecf20Sopenharmony_ci				if (audio_buf) {
4558c2ecf20Sopenharmony_ci					for (n = 0; n < BYTES_PER_SAMPLE; n++) {
4568c2ecf20Sopenharmony_ci						audio_buf[cdev->audio_in_buf_pos[stream]++] = usb_buf[i+n];
4578c2ecf20Sopenharmony_ci
4588c2ecf20Sopenharmony_ci						if (cdev->audio_in_buf_pos[stream] == sz)
4598c2ecf20Sopenharmony_ci							cdev->audio_in_buf_pos[stream] = 0;
4608c2ecf20Sopenharmony_ci					}
4618c2ecf20Sopenharmony_ci
4628c2ecf20Sopenharmony_ci					cdev->period_in_count[stream] += BYTES_PER_SAMPLE;
4638c2ecf20Sopenharmony_ci				}
4648c2ecf20Sopenharmony_ci
4658c2ecf20Sopenharmony_ci				i += BYTES_PER_SAMPLE;
4668c2ecf20Sopenharmony_ci
4678c2ecf20Sopenharmony_ci				if (usb_buf[i] != ((stream << 1) | c) &&
4688c2ecf20Sopenharmony_ci				    !cdev->first_packet) {
4698c2ecf20Sopenharmony_ci					if (!cdev->input_panic)
4708c2ecf20Sopenharmony_ci						dev_warn(dev, " EXPECTED: %02x got %02x, c %d, stream %d, i %d\n",
4718c2ecf20Sopenharmony_ci							 ((stream << 1) | c), usb_buf[i], c, stream, i);
4728c2ecf20Sopenharmony_ci					cdev->input_panic = 1;
4738c2ecf20Sopenharmony_ci				}
4748c2ecf20Sopenharmony_ci
4758c2ecf20Sopenharmony_ci				i++;
4768c2ecf20Sopenharmony_ci			}
4778c2ecf20Sopenharmony_ci		}
4788c2ecf20Sopenharmony_ci	}
4798c2ecf20Sopenharmony_ci
4808c2ecf20Sopenharmony_ci	if (cdev->first_packet > 0)
4818c2ecf20Sopenharmony_ci		cdev->first_packet--;
4828c2ecf20Sopenharmony_ci}
4838c2ecf20Sopenharmony_ci
4848c2ecf20Sopenharmony_cistatic void read_in_urb(struct snd_usb_caiaqdev *cdev,
4858c2ecf20Sopenharmony_ci			const struct urb *urb,
4868c2ecf20Sopenharmony_ci			const struct usb_iso_packet_descriptor *iso)
4878c2ecf20Sopenharmony_ci{
4888c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
4898c2ecf20Sopenharmony_ci
4908c2ecf20Sopenharmony_ci	if (!cdev->streaming)
4918c2ecf20Sopenharmony_ci		return;
4928c2ecf20Sopenharmony_ci
4938c2ecf20Sopenharmony_ci	if (iso->actual_length < cdev->bpp)
4948c2ecf20Sopenharmony_ci		return;
4958c2ecf20Sopenharmony_ci
4968c2ecf20Sopenharmony_ci	switch (cdev->spec.data_alignment) {
4978c2ecf20Sopenharmony_ci	case 0:
4988c2ecf20Sopenharmony_ci		read_in_urb_mode0(cdev, urb, iso);
4998c2ecf20Sopenharmony_ci		break;
5008c2ecf20Sopenharmony_ci	case 2:
5018c2ecf20Sopenharmony_ci		read_in_urb_mode2(cdev, urb, iso);
5028c2ecf20Sopenharmony_ci		break;
5038c2ecf20Sopenharmony_ci	case 3:
5048c2ecf20Sopenharmony_ci		read_in_urb_mode3(cdev, urb, iso);
5058c2ecf20Sopenharmony_ci		break;
5068c2ecf20Sopenharmony_ci	}
5078c2ecf20Sopenharmony_ci
5088c2ecf20Sopenharmony_ci	if ((cdev->input_panic || cdev->output_panic) && !cdev->warned) {
5098c2ecf20Sopenharmony_ci		dev_warn(dev, "streaming error detected %s %s\n",
5108c2ecf20Sopenharmony_ci				cdev->input_panic ? "(input)" : "",
5118c2ecf20Sopenharmony_ci				cdev->output_panic ? "(output)" : "");
5128c2ecf20Sopenharmony_ci		cdev->warned = 1;
5138c2ecf20Sopenharmony_ci	}
5148c2ecf20Sopenharmony_ci}
5158c2ecf20Sopenharmony_ci
5168c2ecf20Sopenharmony_cistatic void fill_out_urb_mode_0(struct snd_usb_caiaqdev *cdev,
5178c2ecf20Sopenharmony_ci				struct urb *urb,
5188c2ecf20Sopenharmony_ci				const struct usb_iso_packet_descriptor *iso)
5198c2ecf20Sopenharmony_ci{
5208c2ecf20Sopenharmony_ci	unsigned char *usb_buf = urb->transfer_buffer + iso->offset;
5218c2ecf20Sopenharmony_ci	struct snd_pcm_substream *sub;
5228c2ecf20Sopenharmony_ci	int stream, i;
5238c2ecf20Sopenharmony_ci
5248c2ecf20Sopenharmony_ci	for (i = 0; i < iso->length;) {
5258c2ecf20Sopenharmony_ci		for (stream = 0; stream < cdev->n_streams; stream++, i++) {
5268c2ecf20Sopenharmony_ci			sub = cdev->sub_playback[stream];
5278c2ecf20Sopenharmony_ci			if (sub) {
5288c2ecf20Sopenharmony_ci				struct snd_pcm_runtime *rt = sub->runtime;
5298c2ecf20Sopenharmony_ci				char *audio_buf = rt->dma_area;
5308c2ecf20Sopenharmony_ci				int sz = frames_to_bytes(rt, rt->buffer_size);
5318c2ecf20Sopenharmony_ci				usb_buf[i] =
5328c2ecf20Sopenharmony_ci					audio_buf[cdev->audio_out_buf_pos[stream]];
5338c2ecf20Sopenharmony_ci				cdev->period_out_count[stream]++;
5348c2ecf20Sopenharmony_ci				cdev->audio_out_buf_pos[stream]++;
5358c2ecf20Sopenharmony_ci				if (cdev->audio_out_buf_pos[stream] == sz)
5368c2ecf20Sopenharmony_ci					cdev->audio_out_buf_pos[stream] = 0;
5378c2ecf20Sopenharmony_ci			} else
5388c2ecf20Sopenharmony_ci				usb_buf[i] = 0;
5398c2ecf20Sopenharmony_ci		}
5408c2ecf20Sopenharmony_ci
5418c2ecf20Sopenharmony_ci		/* fill in the check bytes */
5428c2ecf20Sopenharmony_ci		if (cdev->spec.data_alignment == 2 &&
5438c2ecf20Sopenharmony_ci		    i % (cdev->n_streams * BYTES_PER_SAMPLE_USB) ==
5448c2ecf20Sopenharmony_ci		        (cdev->n_streams * CHANNELS_PER_STREAM))
5458c2ecf20Sopenharmony_ci			for (stream = 0; stream < cdev->n_streams; stream++, i++)
5468c2ecf20Sopenharmony_ci				usb_buf[i] = MAKE_CHECKBYTE(cdev, stream, i);
5478c2ecf20Sopenharmony_ci	}
5488c2ecf20Sopenharmony_ci}
5498c2ecf20Sopenharmony_ci
5508c2ecf20Sopenharmony_cistatic void fill_out_urb_mode_3(struct snd_usb_caiaqdev *cdev,
5518c2ecf20Sopenharmony_ci				struct urb *urb,
5528c2ecf20Sopenharmony_ci				const struct usb_iso_packet_descriptor *iso)
5538c2ecf20Sopenharmony_ci{
5548c2ecf20Sopenharmony_ci	unsigned char *usb_buf = urb->transfer_buffer + iso->offset;
5558c2ecf20Sopenharmony_ci	int stream, i;
5568c2ecf20Sopenharmony_ci
5578c2ecf20Sopenharmony_ci	for (i = 0; i < iso->length;) {
5588c2ecf20Sopenharmony_ci		for (stream = 0; stream < cdev->n_streams; stream++) {
5598c2ecf20Sopenharmony_ci			struct snd_pcm_substream *sub = cdev->sub_playback[stream];
5608c2ecf20Sopenharmony_ci			char *audio_buf = NULL;
5618c2ecf20Sopenharmony_ci			int c, n, sz = 0;
5628c2ecf20Sopenharmony_ci
5638c2ecf20Sopenharmony_ci			if (sub) {
5648c2ecf20Sopenharmony_ci				struct snd_pcm_runtime *rt = sub->runtime;
5658c2ecf20Sopenharmony_ci				audio_buf = rt->dma_area;
5668c2ecf20Sopenharmony_ci				sz = frames_to_bytes(rt, rt->buffer_size);
5678c2ecf20Sopenharmony_ci			}
5688c2ecf20Sopenharmony_ci
5698c2ecf20Sopenharmony_ci			for (c = 0; c < CHANNELS_PER_STREAM; c++) {
5708c2ecf20Sopenharmony_ci				for (n = 0; n < BYTES_PER_SAMPLE; n++) {
5718c2ecf20Sopenharmony_ci					if (audio_buf) {
5728c2ecf20Sopenharmony_ci						usb_buf[i+n] = audio_buf[cdev->audio_out_buf_pos[stream]++];
5738c2ecf20Sopenharmony_ci
5748c2ecf20Sopenharmony_ci						if (cdev->audio_out_buf_pos[stream] == sz)
5758c2ecf20Sopenharmony_ci							cdev->audio_out_buf_pos[stream] = 0;
5768c2ecf20Sopenharmony_ci					} else {
5778c2ecf20Sopenharmony_ci						usb_buf[i+n] = 0;
5788c2ecf20Sopenharmony_ci					}
5798c2ecf20Sopenharmony_ci				}
5808c2ecf20Sopenharmony_ci
5818c2ecf20Sopenharmony_ci				if (audio_buf)
5828c2ecf20Sopenharmony_ci					cdev->period_out_count[stream] += BYTES_PER_SAMPLE;
5838c2ecf20Sopenharmony_ci
5848c2ecf20Sopenharmony_ci				i += BYTES_PER_SAMPLE;
5858c2ecf20Sopenharmony_ci
5868c2ecf20Sopenharmony_ci				/* fill in the check byte pattern */
5878c2ecf20Sopenharmony_ci				usb_buf[i++] = (stream << 1) | c;
5888c2ecf20Sopenharmony_ci			}
5898c2ecf20Sopenharmony_ci		}
5908c2ecf20Sopenharmony_ci	}
5918c2ecf20Sopenharmony_ci}
5928c2ecf20Sopenharmony_ci
5938c2ecf20Sopenharmony_cistatic inline void fill_out_urb(struct snd_usb_caiaqdev *cdev,
5948c2ecf20Sopenharmony_ci				struct urb *urb,
5958c2ecf20Sopenharmony_ci				const struct usb_iso_packet_descriptor *iso)
5968c2ecf20Sopenharmony_ci{
5978c2ecf20Sopenharmony_ci	switch (cdev->spec.data_alignment) {
5988c2ecf20Sopenharmony_ci	case 0:
5998c2ecf20Sopenharmony_ci	case 2:
6008c2ecf20Sopenharmony_ci		fill_out_urb_mode_0(cdev, urb, iso);
6018c2ecf20Sopenharmony_ci		break;
6028c2ecf20Sopenharmony_ci	case 3:
6038c2ecf20Sopenharmony_ci		fill_out_urb_mode_3(cdev, urb, iso);
6048c2ecf20Sopenharmony_ci		break;
6058c2ecf20Sopenharmony_ci	}
6068c2ecf20Sopenharmony_ci}
6078c2ecf20Sopenharmony_ci
6088c2ecf20Sopenharmony_cistatic void read_completed(struct urb *urb)
6098c2ecf20Sopenharmony_ci{
6108c2ecf20Sopenharmony_ci	struct snd_usb_caiaq_cb_info *info = urb->context;
6118c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev;
6128c2ecf20Sopenharmony_ci	struct device *dev;
6138c2ecf20Sopenharmony_ci	struct urb *out = NULL;
6148c2ecf20Sopenharmony_ci	int i, frame, len, send_it = 0, outframe = 0;
6158c2ecf20Sopenharmony_ci	unsigned long flags;
6168c2ecf20Sopenharmony_ci	size_t offset = 0;
6178c2ecf20Sopenharmony_ci
6188c2ecf20Sopenharmony_ci	if (urb->status || !info)
6198c2ecf20Sopenharmony_ci		return;
6208c2ecf20Sopenharmony_ci
6218c2ecf20Sopenharmony_ci	cdev = info->cdev;
6228c2ecf20Sopenharmony_ci	dev = caiaqdev_to_dev(cdev);
6238c2ecf20Sopenharmony_ci
6248c2ecf20Sopenharmony_ci	if (!cdev->streaming)
6258c2ecf20Sopenharmony_ci		return;
6268c2ecf20Sopenharmony_ci
6278c2ecf20Sopenharmony_ci	/* find an unused output urb that is unused */
6288c2ecf20Sopenharmony_ci	for (i = 0; i < N_URBS; i++)
6298c2ecf20Sopenharmony_ci		if (test_and_set_bit(i, &cdev->outurb_active_mask) == 0) {
6308c2ecf20Sopenharmony_ci			out = cdev->data_urbs_out[i];
6318c2ecf20Sopenharmony_ci			break;
6328c2ecf20Sopenharmony_ci		}
6338c2ecf20Sopenharmony_ci
6348c2ecf20Sopenharmony_ci	if (!out) {
6358c2ecf20Sopenharmony_ci		dev_err(dev, "Unable to find an output urb to use\n");
6368c2ecf20Sopenharmony_ci		goto requeue;
6378c2ecf20Sopenharmony_ci	}
6388c2ecf20Sopenharmony_ci
6398c2ecf20Sopenharmony_ci	/* read the recently received packet and send back one which has
6408c2ecf20Sopenharmony_ci	 * the same layout */
6418c2ecf20Sopenharmony_ci	for (frame = 0; frame < FRAMES_PER_URB; frame++) {
6428c2ecf20Sopenharmony_ci		if (urb->iso_frame_desc[frame].status)
6438c2ecf20Sopenharmony_ci			continue;
6448c2ecf20Sopenharmony_ci
6458c2ecf20Sopenharmony_ci		len = urb->iso_frame_desc[outframe].actual_length;
6468c2ecf20Sopenharmony_ci		out->iso_frame_desc[outframe].length = len;
6478c2ecf20Sopenharmony_ci		out->iso_frame_desc[outframe].actual_length = 0;
6488c2ecf20Sopenharmony_ci		out->iso_frame_desc[outframe].offset = offset;
6498c2ecf20Sopenharmony_ci		offset += len;
6508c2ecf20Sopenharmony_ci
6518c2ecf20Sopenharmony_ci		if (len > 0) {
6528c2ecf20Sopenharmony_ci			spin_lock_irqsave(&cdev->spinlock, flags);
6538c2ecf20Sopenharmony_ci			fill_out_urb(cdev, out, &out->iso_frame_desc[outframe]);
6548c2ecf20Sopenharmony_ci			read_in_urb(cdev, urb, &urb->iso_frame_desc[frame]);
6558c2ecf20Sopenharmony_ci			spin_unlock_irqrestore(&cdev->spinlock, flags);
6568c2ecf20Sopenharmony_ci			check_for_elapsed_periods(cdev, cdev->sub_playback);
6578c2ecf20Sopenharmony_ci			check_for_elapsed_periods(cdev, cdev->sub_capture);
6588c2ecf20Sopenharmony_ci			send_it = 1;
6598c2ecf20Sopenharmony_ci		}
6608c2ecf20Sopenharmony_ci
6618c2ecf20Sopenharmony_ci		outframe++;
6628c2ecf20Sopenharmony_ci	}
6638c2ecf20Sopenharmony_ci
6648c2ecf20Sopenharmony_ci	if (send_it) {
6658c2ecf20Sopenharmony_ci		out->number_of_packets = outframe;
6668c2ecf20Sopenharmony_ci		usb_submit_urb(out, GFP_ATOMIC);
6678c2ecf20Sopenharmony_ci	} else {
6688c2ecf20Sopenharmony_ci		struct snd_usb_caiaq_cb_info *oinfo = out->context;
6698c2ecf20Sopenharmony_ci		clear_bit(oinfo->index, &cdev->outurb_active_mask);
6708c2ecf20Sopenharmony_ci	}
6718c2ecf20Sopenharmony_ci
6728c2ecf20Sopenharmony_cirequeue:
6738c2ecf20Sopenharmony_ci	/* re-submit inbound urb */
6748c2ecf20Sopenharmony_ci	for (frame = 0; frame < FRAMES_PER_URB; frame++) {
6758c2ecf20Sopenharmony_ci		urb->iso_frame_desc[frame].offset = BYTES_PER_FRAME * frame;
6768c2ecf20Sopenharmony_ci		urb->iso_frame_desc[frame].length = BYTES_PER_FRAME;
6778c2ecf20Sopenharmony_ci		urb->iso_frame_desc[frame].actual_length = 0;
6788c2ecf20Sopenharmony_ci	}
6798c2ecf20Sopenharmony_ci
6808c2ecf20Sopenharmony_ci	urb->number_of_packets = FRAMES_PER_URB;
6818c2ecf20Sopenharmony_ci	usb_submit_urb(urb, GFP_ATOMIC);
6828c2ecf20Sopenharmony_ci}
6838c2ecf20Sopenharmony_ci
6848c2ecf20Sopenharmony_cistatic void write_completed(struct urb *urb)
6858c2ecf20Sopenharmony_ci{
6868c2ecf20Sopenharmony_ci	struct snd_usb_caiaq_cb_info *info = urb->context;
6878c2ecf20Sopenharmony_ci	struct snd_usb_caiaqdev *cdev = info->cdev;
6888c2ecf20Sopenharmony_ci
6898c2ecf20Sopenharmony_ci	if (!cdev->output_running) {
6908c2ecf20Sopenharmony_ci		cdev->output_running = 1;
6918c2ecf20Sopenharmony_ci		wake_up(&cdev->prepare_wait_queue);
6928c2ecf20Sopenharmony_ci	}
6938c2ecf20Sopenharmony_ci
6948c2ecf20Sopenharmony_ci	clear_bit(info->index, &cdev->outurb_active_mask);
6958c2ecf20Sopenharmony_ci}
6968c2ecf20Sopenharmony_ci
6978c2ecf20Sopenharmony_cistatic struct urb **alloc_urbs(struct snd_usb_caiaqdev *cdev, int dir, int *ret)
6988c2ecf20Sopenharmony_ci{
6998c2ecf20Sopenharmony_ci	int i, frame;
7008c2ecf20Sopenharmony_ci	struct urb **urbs;
7018c2ecf20Sopenharmony_ci	struct usb_device *usb_dev = cdev->chip.dev;
7028c2ecf20Sopenharmony_ci	unsigned int pipe;
7038c2ecf20Sopenharmony_ci
7048c2ecf20Sopenharmony_ci	pipe = (dir == SNDRV_PCM_STREAM_PLAYBACK) ?
7058c2ecf20Sopenharmony_ci		usb_sndisocpipe(usb_dev, ENDPOINT_PLAYBACK) :
7068c2ecf20Sopenharmony_ci		usb_rcvisocpipe(usb_dev, ENDPOINT_CAPTURE);
7078c2ecf20Sopenharmony_ci
7088c2ecf20Sopenharmony_ci	urbs = kmalloc_array(N_URBS, sizeof(*urbs), GFP_KERNEL);
7098c2ecf20Sopenharmony_ci	if (!urbs) {
7108c2ecf20Sopenharmony_ci		*ret = -ENOMEM;
7118c2ecf20Sopenharmony_ci		return NULL;
7128c2ecf20Sopenharmony_ci	}
7138c2ecf20Sopenharmony_ci
7148c2ecf20Sopenharmony_ci	for (i = 0; i < N_URBS; i++) {
7158c2ecf20Sopenharmony_ci		urbs[i] = usb_alloc_urb(FRAMES_PER_URB, GFP_KERNEL);
7168c2ecf20Sopenharmony_ci		if (!urbs[i]) {
7178c2ecf20Sopenharmony_ci			*ret = -ENOMEM;
7188c2ecf20Sopenharmony_ci			return urbs;
7198c2ecf20Sopenharmony_ci		}
7208c2ecf20Sopenharmony_ci
7218c2ecf20Sopenharmony_ci		urbs[i]->transfer_buffer =
7228c2ecf20Sopenharmony_ci			kmalloc_array(BYTES_PER_FRAME, FRAMES_PER_URB,
7238c2ecf20Sopenharmony_ci				      GFP_KERNEL);
7248c2ecf20Sopenharmony_ci		if (!urbs[i]->transfer_buffer) {
7258c2ecf20Sopenharmony_ci			*ret = -ENOMEM;
7268c2ecf20Sopenharmony_ci			return urbs;
7278c2ecf20Sopenharmony_ci		}
7288c2ecf20Sopenharmony_ci
7298c2ecf20Sopenharmony_ci		for (frame = 0; frame < FRAMES_PER_URB; frame++) {
7308c2ecf20Sopenharmony_ci			struct usb_iso_packet_descriptor *iso =
7318c2ecf20Sopenharmony_ci				&urbs[i]->iso_frame_desc[frame];
7328c2ecf20Sopenharmony_ci
7338c2ecf20Sopenharmony_ci			iso->offset = BYTES_PER_FRAME * frame;
7348c2ecf20Sopenharmony_ci			iso->length = BYTES_PER_FRAME;
7358c2ecf20Sopenharmony_ci		}
7368c2ecf20Sopenharmony_ci
7378c2ecf20Sopenharmony_ci		urbs[i]->dev = usb_dev;
7388c2ecf20Sopenharmony_ci		urbs[i]->pipe = pipe;
7398c2ecf20Sopenharmony_ci		urbs[i]->transfer_buffer_length = FRAMES_PER_URB
7408c2ecf20Sopenharmony_ci						* BYTES_PER_FRAME;
7418c2ecf20Sopenharmony_ci		urbs[i]->context = &cdev->data_cb_info[i];
7428c2ecf20Sopenharmony_ci		urbs[i]->interval = 1;
7438c2ecf20Sopenharmony_ci		urbs[i]->number_of_packets = FRAMES_PER_URB;
7448c2ecf20Sopenharmony_ci		urbs[i]->complete = (dir == SNDRV_PCM_STREAM_CAPTURE) ?
7458c2ecf20Sopenharmony_ci					read_completed : write_completed;
7468c2ecf20Sopenharmony_ci	}
7478c2ecf20Sopenharmony_ci
7488c2ecf20Sopenharmony_ci	*ret = 0;
7498c2ecf20Sopenharmony_ci	return urbs;
7508c2ecf20Sopenharmony_ci}
7518c2ecf20Sopenharmony_ci
7528c2ecf20Sopenharmony_cistatic void free_urbs(struct urb **urbs)
7538c2ecf20Sopenharmony_ci{
7548c2ecf20Sopenharmony_ci	int i;
7558c2ecf20Sopenharmony_ci
7568c2ecf20Sopenharmony_ci	if (!urbs)
7578c2ecf20Sopenharmony_ci		return;
7588c2ecf20Sopenharmony_ci
7598c2ecf20Sopenharmony_ci	for (i = 0; i < N_URBS; i++) {
7608c2ecf20Sopenharmony_ci		if (!urbs[i])
7618c2ecf20Sopenharmony_ci			continue;
7628c2ecf20Sopenharmony_ci
7638c2ecf20Sopenharmony_ci		usb_kill_urb(urbs[i]);
7648c2ecf20Sopenharmony_ci		kfree(urbs[i]->transfer_buffer);
7658c2ecf20Sopenharmony_ci		usb_free_urb(urbs[i]);
7668c2ecf20Sopenharmony_ci	}
7678c2ecf20Sopenharmony_ci
7688c2ecf20Sopenharmony_ci	kfree(urbs);
7698c2ecf20Sopenharmony_ci}
7708c2ecf20Sopenharmony_ci
7718c2ecf20Sopenharmony_ciint snd_usb_caiaq_audio_init(struct snd_usb_caiaqdev *cdev)
7728c2ecf20Sopenharmony_ci{
7738c2ecf20Sopenharmony_ci	int i, ret;
7748c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
7758c2ecf20Sopenharmony_ci
7768c2ecf20Sopenharmony_ci	cdev->n_audio_in  = max(cdev->spec.num_analog_audio_in,
7778c2ecf20Sopenharmony_ci			       cdev->spec.num_digital_audio_in) /
7788c2ecf20Sopenharmony_ci				CHANNELS_PER_STREAM;
7798c2ecf20Sopenharmony_ci	cdev->n_audio_out = max(cdev->spec.num_analog_audio_out,
7808c2ecf20Sopenharmony_ci			       cdev->spec.num_digital_audio_out) /
7818c2ecf20Sopenharmony_ci				CHANNELS_PER_STREAM;
7828c2ecf20Sopenharmony_ci	cdev->n_streams = max(cdev->n_audio_in, cdev->n_audio_out);
7838c2ecf20Sopenharmony_ci
7848c2ecf20Sopenharmony_ci	dev_dbg(dev, "cdev->n_audio_in = %d\n", cdev->n_audio_in);
7858c2ecf20Sopenharmony_ci	dev_dbg(dev, "cdev->n_audio_out = %d\n", cdev->n_audio_out);
7868c2ecf20Sopenharmony_ci	dev_dbg(dev, "cdev->n_streams = %d\n", cdev->n_streams);
7878c2ecf20Sopenharmony_ci
7888c2ecf20Sopenharmony_ci	if (cdev->n_streams > MAX_STREAMS) {
7898c2ecf20Sopenharmony_ci		dev_err(dev, "unable to initialize device, too many streams.\n");
7908c2ecf20Sopenharmony_ci		return -EINVAL;
7918c2ecf20Sopenharmony_ci	}
7928c2ecf20Sopenharmony_ci
7938c2ecf20Sopenharmony_ci	if (cdev->n_streams < 1) {
7948c2ecf20Sopenharmony_ci		dev_err(dev, "bogus number of streams: %d\n", cdev->n_streams);
7958c2ecf20Sopenharmony_ci		return -EINVAL;
7968c2ecf20Sopenharmony_ci	}
7978c2ecf20Sopenharmony_ci
7988c2ecf20Sopenharmony_ci	ret = snd_pcm_new(cdev->chip.card, cdev->product_name, 0,
7998c2ecf20Sopenharmony_ci			cdev->n_audio_out, cdev->n_audio_in, &cdev->pcm);
8008c2ecf20Sopenharmony_ci
8018c2ecf20Sopenharmony_ci	if (ret < 0) {
8028c2ecf20Sopenharmony_ci		dev_err(dev, "snd_pcm_new() returned %d\n", ret);
8038c2ecf20Sopenharmony_ci		return ret;
8048c2ecf20Sopenharmony_ci	}
8058c2ecf20Sopenharmony_ci
8068c2ecf20Sopenharmony_ci	cdev->pcm->private_data = cdev;
8078c2ecf20Sopenharmony_ci	strlcpy(cdev->pcm->name, cdev->product_name, sizeof(cdev->pcm->name));
8088c2ecf20Sopenharmony_ci
8098c2ecf20Sopenharmony_ci	memset(cdev->sub_playback, 0, sizeof(cdev->sub_playback));
8108c2ecf20Sopenharmony_ci	memset(cdev->sub_capture, 0, sizeof(cdev->sub_capture));
8118c2ecf20Sopenharmony_ci
8128c2ecf20Sopenharmony_ci	memcpy(&cdev->pcm_info, &snd_usb_caiaq_pcm_hardware,
8138c2ecf20Sopenharmony_ci			sizeof(snd_usb_caiaq_pcm_hardware));
8148c2ecf20Sopenharmony_ci
8158c2ecf20Sopenharmony_ci	/* setup samplerates */
8168c2ecf20Sopenharmony_ci	cdev->samplerates = cdev->pcm_info.rates;
8178c2ecf20Sopenharmony_ci	switch (cdev->chip.usb_id) {
8188c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AK1):
8198c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_RIGKONTROL3):
8208c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_SESSIONIO):
8218c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_GUITARRIGMOBILE):
8228c2ecf20Sopenharmony_ci		cdev->samplerates |= SNDRV_PCM_RATE_192000;
8238c2ecf20Sopenharmony_ci		fallthrough;
8248c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AUDIO2DJ):
8258c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AUDIO4DJ):
8268c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_AUDIO8DJ):
8278c2ecf20Sopenharmony_ci	case USB_ID(USB_VID_NATIVEINSTRUMENTS, USB_PID_TRAKTORAUDIO2):
8288c2ecf20Sopenharmony_ci		cdev->samplerates |= SNDRV_PCM_RATE_88200;
8298c2ecf20Sopenharmony_ci		break;
8308c2ecf20Sopenharmony_ci	}
8318c2ecf20Sopenharmony_ci
8328c2ecf20Sopenharmony_ci	snd_pcm_set_ops(cdev->pcm, SNDRV_PCM_STREAM_PLAYBACK,
8338c2ecf20Sopenharmony_ci				&snd_usb_caiaq_ops);
8348c2ecf20Sopenharmony_ci	snd_pcm_set_ops(cdev->pcm, SNDRV_PCM_STREAM_CAPTURE,
8358c2ecf20Sopenharmony_ci				&snd_usb_caiaq_ops);
8368c2ecf20Sopenharmony_ci	snd_pcm_set_managed_buffer_all(cdev->pcm, SNDRV_DMA_TYPE_VMALLOC,
8378c2ecf20Sopenharmony_ci				       NULL, 0, 0);
8388c2ecf20Sopenharmony_ci
8398c2ecf20Sopenharmony_ci	cdev->data_cb_info =
8408c2ecf20Sopenharmony_ci		kmalloc_array(N_URBS, sizeof(struct snd_usb_caiaq_cb_info),
8418c2ecf20Sopenharmony_ci					GFP_KERNEL);
8428c2ecf20Sopenharmony_ci
8438c2ecf20Sopenharmony_ci	if (!cdev->data_cb_info)
8448c2ecf20Sopenharmony_ci		return -ENOMEM;
8458c2ecf20Sopenharmony_ci
8468c2ecf20Sopenharmony_ci	cdev->outurb_active_mask = 0;
8478c2ecf20Sopenharmony_ci	BUILD_BUG_ON(N_URBS > (sizeof(cdev->outurb_active_mask) * 8));
8488c2ecf20Sopenharmony_ci
8498c2ecf20Sopenharmony_ci	for (i = 0; i < N_URBS; i++) {
8508c2ecf20Sopenharmony_ci		cdev->data_cb_info[i].cdev = cdev;
8518c2ecf20Sopenharmony_ci		cdev->data_cb_info[i].index = i;
8528c2ecf20Sopenharmony_ci	}
8538c2ecf20Sopenharmony_ci
8548c2ecf20Sopenharmony_ci	cdev->data_urbs_in = alloc_urbs(cdev, SNDRV_PCM_STREAM_CAPTURE, &ret);
8558c2ecf20Sopenharmony_ci	if (ret < 0) {
8568c2ecf20Sopenharmony_ci		kfree(cdev->data_cb_info);
8578c2ecf20Sopenharmony_ci		free_urbs(cdev->data_urbs_in);
8588c2ecf20Sopenharmony_ci		return ret;
8598c2ecf20Sopenharmony_ci	}
8608c2ecf20Sopenharmony_ci
8618c2ecf20Sopenharmony_ci	cdev->data_urbs_out = alloc_urbs(cdev, SNDRV_PCM_STREAM_PLAYBACK, &ret);
8628c2ecf20Sopenharmony_ci	if (ret < 0) {
8638c2ecf20Sopenharmony_ci		kfree(cdev->data_cb_info);
8648c2ecf20Sopenharmony_ci		free_urbs(cdev->data_urbs_in);
8658c2ecf20Sopenharmony_ci		free_urbs(cdev->data_urbs_out);
8668c2ecf20Sopenharmony_ci		return ret;
8678c2ecf20Sopenharmony_ci	}
8688c2ecf20Sopenharmony_ci
8698c2ecf20Sopenharmony_ci	return 0;
8708c2ecf20Sopenharmony_ci}
8718c2ecf20Sopenharmony_ci
8728c2ecf20Sopenharmony_civoid snd_usb_caiaq_audio_free(struct snd_usb_caiaqdev *cdev)
8738c2ecf20Sopenharmony_ci{
8748c2ecf20Sopenharmony_ci	struct device *dev = caiaqdev_to_dev(cdev);
8758c2ecf20Sopenharmony_ci
8768c2ecf20Sopenharmony_ci	dev_dbg(dev, "%s(%p)\n", __func__, cdev);
8778c2ecf20Sopenharmony_ci	stream_stop(cdev);
8788c2ecf20Sopenharmony_ci	free_urbs(cdev->data_urbs_in);
8798c2ecf20Sopenharmony_ci	free_urbs(cdev->data_urbs_out);
8808c2ecf20Sopenharmony_ci	kfree(cdev->data_cb_info);
8818c2ecf20Sopenharmony_ci}
8828c2ecf20Sopenharmony_ci
883