xref: /OK3568_Linux_fs/kernel/sound/usb/stream.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  */
4*4882a593Smuzhiyun 
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun #include <linux/init.h>
7*4882a593Smuzhiyun #include <linux/slab.h>
8*4882a593Smuzhiyun #include <linux/usb.h>
9*4882a593Smuzhiyun #include <linux/usb/audio.h>
10*4882a593Smuzhiyun #include <linux/usb/audio-v2.h>
11*4882a593Smuzhiyun #include <linux/usb/audio-v3.h>
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <sound/core.h>
14*4882a593Smuzhiyun #include <sound/pcm.h>
15*4882a593Smuzhiyun #include <sound/control.h>
16*4882a593Smuzhiyun #include <sound/tlv.h>
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #include "usbaudio.h"
19*4882a593Smuzhiyun #include "card.h"
20*4882a593Smuzhiyun #include "proc.h"
21*4882a593Smuzhiyun #include "quirks.h"
22*4882a593Smuzhiyun #include "endpoint.h"
23*4882a593Smuzhiyun #include "pcm.h"
24*4882a593Smuzhiyun #include "helper.h"
25*4882a593Smuzhiyun #include "format.h"
26*4882a593Smuzhiyun #include "clock.h"
27*4882a593Smuzhiyun #include "stream.h"
28*4882a593Smuzhiyun #include "power.h"
29*4882a593Smuzhiyun #include "media.h"
30*4882a593Smuzhiyun 
audioformat_free(struct audioformat * fp)31*4882a593Smuzhiyun static void audioformat_free(struct audioformat *fp)
32*4882a593Smuzhiyun {
33*4882a593Smuzhiyun 	list_del(&fp->list); /* unlink for avoiding double-free */
34*4882a593Smuzhiyun 	kfree(fp->rate_table);
35*4882a593Smuzhiyun 	kfree(fp->chmap);
36*4882a593Smuzhiyun 	kfree(fp);
37*4882a593Smuzhiyun }
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun /*
40*4882a593Smuzhiyun  * free a substream
41*4882a593Smuzhiyun  */
free_substream(struct snd_usb_substream * subs)42*4882a593Smuzhiyun static void free_substream(struct snd_usb_substream *subs)
43*4882a593Smuzhiyun {
44*4882a593Smuzhiyun 	struct audioformat *fp, *n;
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun 	if (!subs->num_formats)
47*4882a593Smuzhiyun 		return; /* not initialized */
48*4882a593Smuzhiyun 	list_for_each_entry_safe(fp, n, &subs->fmt_list, list)
49*4882a593Smuzhiyun 		audioformat_free(fp);
50*4882a593Smuzhiyun 	kfree(subs->rate_list.list);
51*4882a593Smuzhiyun 	kfree(subs->str_pd);
52*4882a593Smuzhiyun 	snd_media_stream_delete(subs);
53*4882a593Smuzhiyun }
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun /*
57*4882a593Smuzhiyun  * free a usb stream instance
58*4882a593Smuzhiyun  */
snd_usb_audio_stream_free(struct snd_usb_stream * stream)59*4882a593Smuzhiyun static void snd_usb_audio_stream_free(struct snd_usb_stream *stream)
60*4882a593Smuzhiyun {
61*4882a593Smuzhiyun 	free_substream(&stream->substream[0]);
62*4882a593Smuzhiyun 	free_substream(&stream->substream[1]);
63*4882a593Smuzhiyun 	list_del(&stream->list);
64*4882a593Smuzhiyun 	kfree(stream);
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun 
snd_usb_audio_pcm_free(struct snd_pcm * pcm)67*4882a593Smuzhiyun static void snd_usb_audio_pcm_free(struct snd_pcm *pcm)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun 	struct snd_usb_stream *stream = pcm->private_data;
70*4882a593Smuzhiyun 	struct snd_usb_audio *chip;
71*4882a593Smuzhiyun 	if (stream) {
72*4882a593Smuzhiyun 		mutex_lock(&stream->chip->dev_lock);
73*4882a593Smuzhiyun 		chip = stream->chip;
74*4882a593Smuzhiyun 		stream->pcm = NULL;
75*4882a593Smuzhiyun 		snd_usb_audio_stream_free(stream);
76*4882a593Smuzhiyun 		mutex_unlock(&chip->dev_lock);
77*4882a593Smuzhiyun 	}
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun /*
81*4882a593Smuzhiyun  * initialize the substream instance.
82*4882a593Smuzhiyun  */
83*4882a593Smuzhiyun 
snd_usb_init_substream(struct snd_usb_stream * as,int stream,struct audioformat * fp,struct snd_usb_power_domain * pd)84*4882a593Smuzhiyun static void snd_usb_init_substream(struct snd_usb_stream *as,
85*4882a593Smuzhiyun 				   int stream,
86*4882a593Smuzhiyun 				   struct audioformat *fp,
87*4882a593Smuzhiyun 				   struct snd_usb_power_domain *pd)
88*4882a593Smuzhiyun {
89*4882a593Smuzhiyun 	struct snd_usb_substream *subs = &as->substream[stream];
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 	INIT_LIST_HEAD(&subs->fmt_list);
92*4882a593Smuzhiyun 	spin_lock_init(&subs->lock);
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	subs->stream = as;
95*4882a593Smuzhiyun 	subs->direction = stream;
96*4882a593Smuzhiyun 	subs->dev = as->chip->dev;
97*4882a593Smuzhiyun 	subs->txfr_quirk = as->chip->txfr_quirk;
98*4882a593Smuzhiyun 	subs->tx_length_quirk = as->chip->tx_length_quirk;
99*4882a593Smuzhiyun 	subs->speed = snd_usb_get_speed(subs->dev);
100*4882a593Smuzhiyun 	subs->pkt_offset_adj = 0;
101*4882a593Smuzhiyun 	subs->stream_offset_adj = 0;
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 	snd_usb_set_pcm_ops(as->pcm, stream);
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	list_add_tail(&fp->list, &subs->fmt_list);
106*4882a593Smuzhiyun 	subs->formats |= fp->formats;
107*4882a593Smuzhiyun 	subs->num_formats++;
108*4882a593Smuzhiyun 	subs->fmt_type = fp->fmt_type;
109*4882a593Smuzhiyun 	subs->ep_num = fp->endpoint;
110*4882a593Smuzhiyun 	if (fp->channels > subs->channels_max)
111*4882a593Smuzhiyun 		subs->channels_max = fp->channels;
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun 	if (pd) {
114*4882a593Smuzhiyun 		subs->str_pd = pd;
115*4882a593Smuzhiyun 		/* Initialize Power Domain to idle status D1 */
116*4882a593Smuzhiyun 		snd_usb_power_domain_set(subs->stream->chip, pd,
117*4882a593Smuzhiyun 					 UAC3_PD_STATE_D1);
118*4882a593Smuzhiyun 	}
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	snd_usb_preallocate_buffer(subs);
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun /* kctl callbacks for usb-audio channel maps */
usb_chmap_ctl_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)124*4882a593Smuzhiyun static int usb_chmap_ctl_info(struct snd_kcontrol *kcontrol,
125*4882a593Smuzhiyun 			      struct snd_ctl_elem_info *uinfo)
126*4882a593Smuzhiyun {
127*4882a593Smuzhiyun 	struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
128*4882a593Smuzhiyun 	struct snd_usb_substream *subs = info->private_data;
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
131*4882a593Smuzhiyun 	uinfo->count = subs->channels_max;
132*4882a593Smuzhiyun 	uinfo->value.integer.min = 0;
133*4882a593Smuzhiyun 	uinfo->value.integer.max = SNDRV_CHMAP_LAST;
134*4882a593Smuzhiyun 	return 0;
135*4882a593Smuzhiyun }
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun /* check whether a duplicated entry exists in the audiofmt list */
have_dup_chmap(struct snd_usb_substream * subs,struct audioformat * fp)138*4882a593Smuzhiyun static bool have_dup_chmap(struct snd_usb_substream *subs,
139*4882a593Smuzhiyun 			   struct audioformat *fp)
140*4882a593Smuzhiyun {
141*4882a593Smuzhiyun 	struct audioformat *prev = fp;
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 	list_for_each_entry_continue_reverse(prev, &subs->fmt_list, list) {
144*4882a593Smuzhiyun 		if (prev->chmap &&
145*4882a593Smuzhiyun 		    !memcmp(prev->chmap, fp->chmap, sizeof(*fp->chmap)))
146*4882a593Smuzhiyun 			return true;
147*4882a593Smuzhiyun 	}
148*4882a593Smuzhiyun 	return false;
149*4882a593Smuzhiyun }
150*4882a593Smuzhiyun 
usb_chmap_ctl_tlv(struct snd_kcontrol * kcontrol,int op_flag,unsigned int size,unsigned int __user * tlv)151*4882a593Smuzhiyun static int usb_chmap_ctl_tlv(struct snd_kcontrol *kcontrol, int op_flag,
152*4882a593Smuzhiyun 			     unsigned int size, unsigned int __user *tlv)
153*4882a593Smuzhiyun {
154*4882a593Smuzhiyun 	struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
155*4882a593Smuzhiyun 	struct snd_usb_substream *subs = info->private_data;
156*4882a593Smuzhiyun 	struct audioformat *fp;
157*4882a593Smuzhiyun 	unsigned int __user *dst;
158*4882a593Smuzhiyun 	int count = 0;
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	if (size < 8)
161*4882a593Smuzhiyun 		return -ENOMEM;
162*4882a593Smuzhiyun 	if (put_user(SNDRV_CTL_TLVT_CONTAINER, tlv))
163*4882a593Smuzhiyun 		return -EFAULT;
164*4882a593Smuzhiyun 	size -= 8;
165*4882a593Smuzhiyun 	dst = tlv + 2;
166*4882a593Smuzhiyun 	list_for_each_entry(fp, &subs->fmt_list, list) {
167*4882a593Smuzhiyun 		int i, ch_bytes;
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 		if (!fp->chmap)
170*4882a593Smuzhiyun 			continue;
171*4882a593Smuzhiyun 		if (have_dup_chmap(subs, fp))
172*4882a593Smuzhiyun 			continue;
173*4882a593Smuzhiyun 		/* copy the entry */
174*4882a593Smuzhiyun 		ch_bytes = fp->chmap->channels * 4;
175*4882a593Smuzhiyun 		if (size < 8 + ch_bytes)
176*4882a593Smuzhiyun 			return -ENOMEM;
177*4882a593Smuzhiyun 		if (put_user(SNDRV_CTL_TLVT_CHMAP_FIXED, dst) ||
178*4882a593Smuzhiyun 		    put_user(ch_bytes, dst + 1))
179*4882a593Smuzhiyun 			return -EFAULT;
180*4882a593Smuzhiyun 		dst += 2;
181*4882a593Smuzhiyun 		for (i = 0; i < fp->chmap->channels; i++, dst++) {
182*4882a593Smuzhiyun 			if (put_user(fp->chmap->map[i], dst))
183*4882a593Smuzhiyun 				return -EFAULT;
184*4882a593Smuzhiyun 		}
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun 		count += 8 + ch_bytes;
187*4882a593Smuzhiyun 		size -= 8 + ch_bytes;
188*4882a593Smuzhiyun 	}
189*4882a593Smuzhiyun 	if (put_user(count, tlv + 1))
190*4882a593Smuzhiyun 		return -EFAULT;
191*4882a593Smuzhiyun 	return 0;
192*4882a593Smuzhiyun }
193*4882a593Smuzhiyun 
usb_chmap_ctl_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)194*4882a593Smuzhiyun static int usb_chmap_ctl_get(struct snd_kcontrol *kcontrol,
195*4882a593Smuzhiyun 			     struct snd_ctl_elem_value *ucontrol)
196*4882a593Smuzhiyun {
197*4882a593Smuzhiyun 	struct snd_pcm_chmap *info = snd_kcontrol_chip(kcontrol);
198*4882a593Smuzhiyun 	struct snd_usb_substream *subs = info->private_data;
199*4882a593Smuzhiyun 	struct snd_pcm_chmap_elem *chmap = NULL;
200*4882a593Smuzhiyun 	int i = 0;
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	if (subs->cur_audiofmt)
203*4882a593Smuzhiyun 		chmap = subs->cur_audiofmt->chmap;
204*4882a593Smuzhiyun 	if (chmap) {
205*4882a593Smuzhiyun 		for (i = 0; i < chmap->channels; i++)
206*4882a593Smuzhiyun 			ucontrol->value.integer.value[i] = chmap->map[i];
207*4882a593Smuzhiyun 	}
208*4882a593Smuzhiyun 	for (; i < subs->channels_max; i++)
209*4882a593Smuzhiyun 		ucontrol->value.integer.value[i] = 0;
210*4882a593Smuzhiyun 	return 0;
211*4882a593Smuzhiyun }
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun /* create a chmap kctl assigned to the given USB substream */
add_chmap(struct snd_pcm * pcm,int stream,struct snd_usb_substream * subs)214*4882a593Smuzhiyun static int add_chmap(struct snd_pcm *pcm, int stream,
215*4882a593Smuzhiyun 		     struct snd_usb_substream *subs)
216*4882a593Smuzhiyun {
217*4882a593Smuzhiyun 	struct audioformat *fp;
218*4882a593Smuzhiyun 	struct snd_pcm_chmap *chmap;
219*4882a593Smuzhiyun 	struct snd_kcontrol *kctl;
220*4882a593Smuzhiyun 	int err;
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	list_for_each_entry(fp, &subs->fmt_list, list)
223*4882a593Smuzhiyun 		if (fp->chmap)
224*4882a593Smuzhiyun 			goto ok;
225*4882a593Smuzhiyun 	/* no chmap is found */
226*4882a593Smuzhiyun 	return 0;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun  ok:
229*4882a593Smuzhiyun 	err = snd_pcm_add_chmap_ctls(pcm, stream, NULL, 0, 0, &chmap);
230*4882a593Smuzhiyun 	if (err < 0)
231*4882a593Smuzhiyun 		return err;
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 	/* override handlers */
234*4882a593Smuzhiyun 	chmap->private_data = subs;
235*4882a593Smuzhiyun 	kctl = chmap->kctl;
236*4882a593Smuzhiyun 	kctl->info = usb_chmap_ctl_info;
237*4882a593Smuzhiyun 	kctl->get = usb_chmap_ctl_get;
238*4882a593Smuzhiyun 	kctl->tlv.c = usb_chmap_ctl_tlv;
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 	return 0;
241*4882a593Smuzhiyun }
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun /* convert from USB ChannelConfig bits to ALSA chmap element */
convert_chmap(int channels,unsigned int bits,int protocol)244*4882a593Smuzhiyun static struct snd_pcm_chmap_elem *convert_chmap(int channels, unsigned int bits,
245*4882a593Smuzhiyun 						int protocol)
246*4882a593Smuzhiyun {
247*4882a593Smuzhiyun 	static const unsigned int uac1_maps[] = {
248*4882a593Smuzhiyun 		SNDRV_CHMAP_FL,		/* left front */
249*4882a593Smuzhiyun 		SNDRV_CHMAP_FR,		/* right front */
250*4882a593Smuzhiyun 		SNDRV_CHMAP_FC,		/* center front */
251*4882a593Smuzhiyun 		SNDRV_CHMAP_LFE,	/* LFE */
252*4882a593Smuzhiyun 		SNDRV_CHMAP_SL,		/* left surround */
253*4882a593Smuzhiyun 		SNDRV_CHMAP_SR,		/* right surround */
254*4882a593Smuzhiyun 		SNDRV_CHMAP_FLC,	/* left of center */
255*4882a593Smuzhiyun 		SNDRV_CHMAP_FRC,	/* right of center */
256*4882a593Smuzhiyun 		SNDRV_CHMAP_RC,		/* surround */
257*4882a593Smuzhiyun 		SNDRV_CHMAP_SL,		/* side left */
258*4882a593Smuzhiyun 		SNDRV_CHMAP_SR,		/* side right */
259*4882a593Smuzhiyun 		SNDRV_CHMAP_TC,		/* top */
260*4882a593Smuzhiyun 		0 /* terminator */
261*4882a593Smuzhiyun 	};
262*4882a593Smuzhiyun 	static const unsigned int uac2_maps[] = {
263*4882a593Smuzhiyun 		SNDRV_CHMAP_FL,		/* front left */
264*4882a593Smuzhiyun 		SNDRV_CHMAP_FR,		/* front right */
265*4882a593Smuzhiyun 		SNDRV_CHMAP_FC,		/* front center */
266*4882a593Smuzhiyun 		SNDRV_CHMAP_LFE,	/* LFE */
267*4882a593Smuzhiyun 		SNDRV_CHMAP_RL,		/* back left */
268*4882a593Smuzhiyun 		SNDRV_CHMAP_RR,		/* back right */
269*4882a593Smuzhiyun 		SNDRV_CHMAP_FLC,	/* front left of center */
270*4882a593Smuzhiyun 		SNDRV_CHMAP_FRC,	/* front right of center */
271*4882a593Smuzhiyun 		SNDRV_CHMAP_RC,		/* back center */
272*4882a593Smuzhiyun 		SNDRV_CHMAP_SL,		/* side left */
273*4882a593Smuzhiyun 		SNDRV_CHMAP_SR,		/* side right */
274*4882a593Smuzhiyun 		SNDRV_CHMAP_TC,		/* top center */
275*4882a593Smuzhiyun 		SNDRV_CHMAP_TFL,	/* top front left */
276*4882a593Smuzhiyun 		SNDRV_CHMAP_TFC,	/* top front center */
277*4882a593Smuzhiyun 		SNDRV_CHMAP_TFR,	/* top front right */
278*4882a593Smuzhiyun 		SNDRV_CHMAP_TRL,	/* top back left */
279*4882a593Smuzhiyun 		SNDRV_CHMAP_TRC,	/* top back center */
280*4882a593Smuzhiyun 		SNDRV_CHMAP_TRR,	/* top back right */
281*4882a593Smuzhiyun 		SNDRV_CHMAP_TFLC,	/* top front left of center */
282*4882a593Smuzhiyun 		SNDRV_CHMAP_TFRC,	/* top front right of center */
283*4882a593Smuzhiyun 		SNDRV_CHMAP_LLFE,	/* left LFE */
284*4882a593Smuzhiyun 		SNDRV_CHMAP_RLFE,	/* right LFE */
285*4882a593Smuzhiyun 		SNDRV_CHMAP_TSL,	/* top side left */
286*4882a593Smuzhiyun 		SNDRV_CHMAP_TSR,	/* top side right */
287*4882a593Smuzhiyun 		SNDRV_CHMAP_BC,		/* bottom center */
288*4882a593Smuzhiyun 		SNDRV_CHMAP_RLC,	/* back left of center */
289*4882a593Smuzhiyun 		SNDRV_CHMAP_RRC,	/* back right of center */
290*4882a593Smuzhiyun 		0 /* terminator */
291*4882a593Smuzhiyun 	};
292*4882a593Smuzhiyun 	struct snd_pcm_chmap_elem *chmap;
293*4882a593Smuzhiyun 	const unsigned int *maps;
294*4882a593Smuzhiyun 	int c;
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	if (channels > ARRAY_SIZE(chmap->map))
297*4882a593Smuzhiyun 		return NULL;
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	chmap = kzalloc(sizeof(*chmap), GFP_KERNEL);
300*4882a593Smuzhiyun 	if (!chmap)
301*4882a593Smuzhiyun 		return NULL;
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun 	maps = protocol == UAC_VERSION_2 ? uac2_maps : uac1_maps;
304*4882a593Smuzhiyun 	chmap->channels = channels;
305*4882a593Smuzhiyun 	c = 0;
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun 	if (bits) {
308*4882a593Smuzhiyun 		for (; bits && *maps; maps++, bits >>= 1)
309*4882a593Smuzhiyun 			if (bits & 1)
310*4882a593Smuzhiyun 				chmap->map[c++] = *maps;
311*4882a593Smuzhiyun 	} else {
312*4882a593Smuzhiyun 		/* If we're missing wChannelConfig, then guess something
313*4882a593Smuzhiyun 		    to make sure the channel map is not skipped entirely */
314*4882a593Smuzhiyun 		if (channels == 1)
315*4882a593Smuzhiyun 			chmap->map[c++] = SNDRV_CHMAP_MONO;
316*4882a593Smuzhiyun 		else
317*4882a593Smuzhiyun 			for (; c < channels && *maps; maps++)
318*4882a593Smuzhiyun 				chmap->map[c++] = *maps;
319*4882a593Smuzhiyun 	}
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 	for (; c < channels; c++)
322*4882a593Smuzhiyun 		chmap->map[c] = SNDRV_CHMAP_UNKNOWN;
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	return chmap;
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun /* UAC3 device stores channels information in Cluster Descriptors */
328*4882a593Smuzhiyun static struct
convert_chmap_v3(struct uac3_cluster_header_descriptor * cluster)329*4882a593Smuzhiyun snd_pcm_chmap_elem *convert_chmap_v3(struct uac3_cluster_header_descriptor
330*4882a593Smuzhiyun 								*cluster)
331*4882a593Smuzhiyun {
332*4882a593Smuzhiyun 	unsigned int channels = cluster->bNrChannels;
333*4882a593Smuzhiyun 	struct snd_pcm_chmap_elem *chmap;
334*4882a593Smuzhiyun 	void *p = cluster;
335*4882a593Smuzhiyun 	int len, c;
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	if (channels > ARRAY_SIZE(chmap->map))
338*4882a593Smuzhiyun 		return NULL;
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	chmap = kzalloc(sizeof(*chmap), GFP_KERNEL);
341*4882a593Smuzhiyun 	if (!chmap)
342*4882a593Smuzhiyun 		return NULL;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	len = le16_to_cpu(cluster->wLength);
345*4882a593Smuzhiyun 	c = 0;
346*4882a593Smuzhiyun 	p += sizeof(struct uac3_cluster_header_descriptor);
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	while (((p - (void *)cluster) < len) && (c < channels)) {
349*4882a593Smuzhiyun 		struct uac3_cluster_segment_descriptor *cs_desc = p;
350*4882a593Smuzhiyun 		u16 cs_len;
351*4882a593Smuzhiyun 		u8 cs_type;
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 		cs_len = le16_to_cpu(cs_desc->wLength);
354*4882a593Smuzhiyun 		cs_type = cs_desc->bSegmentType;
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 		if (cs_type == UAC3_CHANNEL_INFORMATION) {
357*4882a593Smuzhiyun 			struct uac3_cluster_information_segment_descriptor *is = p;
358*4882a593Smuzhiyun 			unsigned char map;
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 			/*
361*4882a593Smuzhiyun 			 * TODO: this conversion is not complete, update it
362*4882a593Smuzhiyun 			 * after adding UAC3 values to asound.h
363*4882a593Smuzhiyun 			 */
364*4882a593Smuzhiyun 			switch (is->bChRelationship) {
365*4882a593Smuzhiyun 			case UAC3_CH_MONO:
366*4882a593Smuzhiyun 				map = SNDRV_CHMAP_MONO;
367*4882a593Smuzhiyun 				break;
368*4882a593Smuzhiyun 			case UAC3_CH_LEFT:
369*4882a593Smuzhiyun 			case UAC3_CH_FRONT_LEFT:
370*4882a593Smuzhiyun 			case UAC3_CH_HEADPHONE_LEFT:
371*4882a593Smuzhiyun 				map = SNDRV_CHMAP_FL;
372*4882a593Smuzhiyun 				break;
373*4882a593Smuzhiyun 			case UAC3_CH_RIGHT:
374*4882a593Smuzhiyun 			case UAC3_CH_FRONT_RIGHT:
375*4882a593Smuzhiyun 			case UAC3_CH_HEADPHONE_RIGHT:
376*4882a593Smuzhiyun 				map = SNDRV_CHMAP_FR;
377*4882a593Smuzhiyun 				break;
378*4882a593Smuzhiyun 			case UAC3_CH_FRONT_CENTER:
379*4882a593Smuzhiyun 				map = SNDRV_CHMAP_FC;
380*4882a593Smuzhiyun 				break;
381*4882a593Smuzhiyun 			case UAC3_CH_FRONT_LEFT_OF_CENTER:
382*4882a593Smuzhiyun 				map = SNDRV_CHMAP_FLC;
383*4882a593Smuzhiyun 				break;
384*4882a593Smuzhiyun 			case UAC3_CH_FRONT_RIGHT_OF_CENTER:
385*4882a593Smuzhiyun 				map = SNDRV_CHMAP_FRC;
386*4882a593Smuzhiyun 				break;
387*4882a593Smuzhiyun 			case UAC3_CH_SIDE_LEFT:
388*4882a593Smuzhiyun 				map = SNDRV_CHMAP_SL;
389*4882a593Smuzhiyun 				break;
390*4882a593Smuzhiyun 			case UAC3_CH_SIDE_RIGHT:
391*4882a593Smuzhiyun 				map = SNDRV_CHMAP_SR;
392*4882a593Smuzhiyun 				break;
393*4882a593Smuzhiyun 			case UAC3_CH_BACK_LEFT:
394*4882a593Smuzhiyun 				map = SNDRV_CHMAP_RL;
395*4882a593Smuzhiyun 				break;
396*4882a593Smuzhiyun 			case UAC3_CH_BACK_RIGHT:
397*4882a593Smuzhiyun 				map = SNDRV_CHMAP_RR;
398*4882a593Smuzhiyun 				break;
399*4882a593Smuzhiyun 			case UAC3_CH_BACK_CENTER:
400*4882a593Smuzhiyun 				map = SNDRV_CHMAP_RC;
401*4882a593Smuzhiyun 				break;
402*4882a593Smuzhiyun 			case UAC3_CH_BACK_LEFT_OF_CENTER:
403*4882a593Smuzhiyun 				map = SNDRV_CHMAP_RLC;
404*4882a593Smuzhiyun 				break;
405*4882a593Smuzhiyun 			case UAC3_CH_BACK_RIGHT_OF_CENTER:
406*4882a593Smuzhiyun 				map = SNDRV_CHMAP_RRC;
407*4882a593Smuzhiyun 				break;
408*4882a593Smuzhiyun 			case UAC3_CH_TOP_CENTER:
409*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TC;
410*4882a593Smuzhiyun 				break;
411*4882a593Smuzhiyun 			case UAC3_CH_TOP_FRONT_LEFT:
412*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TFL;
413*4882a593Smuzhiyun 				break;
414*4882a593Smuzhiyun 			case UAC3_CH_TOP_FRONT_RIGHT:
415*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TFR;
416*4882a593Smuzhiyun 				break;
417*4882a593Smuzhiyun 			case UAC3_CH_TOP_FRONT_CENTER:
418*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TFC;
419*4882a593Smuzhiyun 				break;
420*4882a593Smuzhiyun 			case UAC3_CH_TOP_FRONT_LOC:
421*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TFLC;
422*4882a593Smuzhiyun 				break;
423*4882a593Smuzhiyun 			case UAC3_CH_TOP_FRONT_ROC:
424*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TFRC;
425*4882a593Smuzhiyun 				break;
426*4882a593Smuzhiyun 			case UAC3_CH_TOP_SIDE_LEFT:
427*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TSL;
428*4882a593Smuzhiyun 				break;
429*4882a593Smuzhiyun 			case UAC3_CH_TOP_SIDE_RIGHT:
430*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TSR;
431*4882a593Smuzhiyun 				break;
432*4882a593Smuzhiyun 			case UAC3_CH_TOP_BACK_LEFT:
433*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TRL;
434*4882a593Smuzhiyun 				break;
435*4882a593Smuzhiyun 			case UAC3_CH_TOP_BACK_RIGHT:
436*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TRR;
437*4882a593Smuzhiyun 				break;
438*4882a593Smuzhiyun 			case UAC3_CH_TOP_BACK_CENTER:
439*4882a593Smuzhiyun 				map = SNDRV_CHMAP_TRC;
440*4882a593Smuzhiyun 				break;
441*4882a593Smuzhiyun 			case UAC3_CH_BOTTOM_CENTER:
442*4882a593Smuzhiyun 				map = SNDRV_CHMAP_BC;
443*4882a593Smuzhiyun 				break;
444*4882a593Smuzhiyun 			case UAC3_CH_LOW_FREQUENCY_EFFECTS:
445*4882a593Smuzhiyun 				map = SNDRV_CHMAP_LFE;
446*4882a593Smuzhiyun 				break;
447*4882a593Smuzhiyun 			case UAC3_CH_LFE_LEFT:
448*4882a593Smuzhiyun 				map = SNDRV_CHMAP_LLFE;
449*4882a593Smuzhiyun 				break;
450*4882a593Smuzhiyun 			case UAC3_CH_LFE_RIGHT:
451*4882a593Smuzhiyun 				map = SNDRV_CHMAP_RLFE;
452*4882a593Smuzhiyun 				break;
453*4882a593Smuzhiyun 			case UAC3_CH_RELATIONSHIP_UNDEFINED:
454*4882a593Smuzhiyun 			default:
455*4882a593Smuzhiyun 				map = SNDRV_CHMAP_UNKNOWN;
456*4882a593Smuzhiyun 				break;
457*4882a593Smuzhiyun 			}
458*4882a593Smuzhiyun 			chmap->map[c++] = map;
459*4882a593Smuzhiyun 		}
460*4882a593Smuzhiyun 		p += cs_len;
461*4882a593Smuzhiyun 	}
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	if (channels < c)
464*4882a593Smuzhiyun 		pr_err("%s: channel number mismatch\n", __func__);
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	chmap->channels = channels;
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	for (; c < channels; c++)
469*4882a593Smuzhiyun 		chmap->map[c] = SNDRV_CHMAP_UNKNOWN;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	return chmap;
472*4882a593Smuzhiyun }
473*4882a593Smuzhiyun 
474*4882a593Smuzhiyun /*
475*4882a593Smuzhiyun  * add this endpoint to the chip instance.
476*4882a593Smuzhiyun  * if a stream with the same endpoint already exists, append to it.
477*4882a593Smuzhiyun  * if not, create a new pcm stream. note, fp is added to the substream
478*4882a593Smuzhiyun  * fmt_list and will be freed on the chip instance release. do not free
479*4882a593Smuzhiyun  * fp or do remove it from the substream fmt_list to avoid double-free.
480*4882a593Smuzhiyun  */
__snd_usb_add_audio_stream(struct snd_usb_audio * chip,int stream,struct audioformat * fp,struct snd_usb_power_domain * pd)481*4882a593Smuzhiyun static int __snd_usb_add_audio_stream(struct snd_usb_audio *chip,
482*4882a593Smuzhiyun 				      int stream,
483*4882a593Smuzhiyun 				      struct audioformat *fp,
484*4882a593Smuzhiyun 				      struct snd_usb_power_domain *pd)
485*4882a593Smuzhiyun 
486*4882a593Smuzhiyun {
487*4882a593Smuzhiyun 	struct snd_usb_stream *as;
488*4882a593Smuzhiyun 	struct snd_usb_substream *subs;
489*4882a593Smuzhiyun 	struct snd_pcm *pcm;
490*4882a593Smuzhiyun 	int err;
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun 	list_for_each_entry(as, &chip->pcm_list, list) {
493*4882a593Smuzhiyun 		if (as->fmt_type != fp->fmt_type)
494*4882a593Smuzhiyun 			continue;
495*4882a593Smuzhiyun 		subs = &as->substream[stream];
496*4882a593Smuzhiyun 		if (subs->ep_num == fp->endpoint) {
497*4882a593Smuzhiyun 			list_add_tail(&fp->list, &subs->fmt_list);
498*4882a593Smuzhiyun 			subs->num_formats++;
499*4882a593Smuzhiyun 			subs->formats |= fp->formats;
500*4882a593Smuzhiyun 			return 0;
501*4882a593Smuzhiyun 		}
502*4882a593Smuzhiyun 	}
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	if (chip->card->registered)
505*4882a593Smuzhiyun 		chip->need_delayed_register = true;
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun 	/* look for an empty stream */
508*4882a593Smuzhiyun 	list_for_each_entry(as, &chip->pcm_list, list) {
509*4882a593Smuzhiyun 		if (as->fmt_type != fp->fmt_type)
510*4882a593Smuzhiyun 			continue;
511*4882a593Smuzhiyun 		subs = &as->substream[stream];
512*4882a593Smuzhiyun 		if (subs->ep_num)
513*4882a593Smuzhiyun 			continue;
514*4882a593Smuzhiyun 		err = snd_pcm_new_stream(as->pcm, stream, 1);
515*4882a593Smuzhiyun 		if (err < 0)
516*4882a593Smuzhiyun 			return err;
517*4882a593Smuzhiyun 		snd_usb_init_substream(as, stream, fp, pd);
518*4882a593Smuzhiyun 		return add_chmap(as->pcm, stream, subs);
519*4882a593Smuzhiyun 	}
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	/* create a new pcm */
522*4882a593Smuzhiyun 	as = kzalloc(sizeof(*as), GFP_KERNEL);
523*4882a593Smuzhiyun 	if (!as)
524*4882a593Smuzhiyun 		return -ENOMEM;
525*4882a593Smuzhiyun 	as->pcm_index = chip->pcm_devs;
526*4882a593Smuzhiyun 	as->chip = chip;
527*4882a593Smuzhiyun 	as->fmt_type = fp->fmt_type;
528*4882a593Smuzhiyun 	err = snd_pcm_new(chip->card, "USB Audio", chip->pcm_devs,
529*4882a593Smuzhiyun 			  stream == SNDRV_PCM_STREAM_PLAYBACK ? 1 : 0,
530*4882a593Smuzhiyun 			  stream == SNDRV_PCM_STREAM_PLAYBACK ? 0 : 1,
531*4882a593Smuzhiyun 			  &pcm);
532*4882a593Smuzhiyun 	if (err < 0) {
533*4882a593Smuzhiyun 		kfree(as);
534*4882a593Smuzhiyun 		return err;
535*4882a593Smuzhiyun 	}
536*4882a593Smuzhiyun 	as->pcm = pcm;
537*4882a593Smuzhiyun 	pcm->private_data = as;
538*4882a593Smuzhiyun 	pcm->private_free = snd_usb_audio_pcm_free;
539*4882a593Smuzhiyun 	pcm->info_flags = 0;
540*4882a593Smuzhiyun 	if (chip->pcm_devs > 0)
541*4882a593Smuzhiyun 		sprintf(pcm->name, "USB Audio #%d", chip->pcm_devs);
542*4882a593Smuzhiyun 	else
543*4882a593Smuzhiyun 		strcpy(pcm->name, "USB Audio");
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun 	snd_usb_init_substream(as, stream, fp, pd);
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	/*
548*4882a593Smuzhiyun 	 * Keep using head insertion for M-Audio Audiophile USB (tm) which has a
549*4882a593Smuzhiyun 	 * fix to swap capture stream order in conf/cards/USB-audio.conf
550*4882a593Smuzhiyun 	 */
551*4882a593Smuzhiyun 	if (chip->usb_id == USB_ID(0x0763, 0x2003))
552*4882a593Smuzhiyun 		list_add(&as->list, &chip->pcm_list);
553*4882a593Smuzhiyun 	else
554*4882a593Smuzhiyun 		list_add_tail(&as->list, &chip->pcm_list);
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 	chip->pcm_devs++;
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun 	snd_usb_proc_pcm_format_add(as);
559*4882a593Smuzhiyun 
560*4882a593Smuzhiyun 	return add_chmap(pcm, stream, &as->substream[stream]);
561*4882a593Smuzhiyun }
562*4882a593Smuzhiyun 
snd_usb_add_audio_stream(struct snd_usb_audio * chip,int stream,struct audioformat * fp)563*4882a593Smuzhiyun int snd_usb_add_audio_stream(struct snd_usb_audio *chip,
564*4882a593Smuzhiyun 			     int stream,
565*4882a593Smuzhiyun 			     struct audioformat *fp)
566*4882a593Smuzhiyun {
567*4882a593Smuzhiyun 	return __snd_usb_add_audio_stream(chip, stream, fp, NULL);
568*4882a593Smuzhiyun }
569*4882a593Smuzhiyun 
snd_usb_add_audio_stream_v3(struct snd_usb_audio * chip,int stream,struct audioformat * fp,struct snd_usb_power_domain * pd)570*4882a593Smuzhiyun static int snd_usb_add_audio_stream_v3(struct snd_usb_audio *chip,
571*4882a593Smuzhiyun 				       int stream,
572*4882a593Smuzhiyun 				       struct audioformat *fp,
573*4882a593Smuzhiyun 				       struct snd_usb_power_domain *pd)
574*4882a593Smuzhiyun {
575*4882a593Smuzhiyun 	return __snd_usb_add_audio_stream(chip, stream, fp, pd);
576*4882a593Smuzhiyun }
577*4882a593Smuzhiyun 
parse_uac_endpoint_attributes(struct snd_usb_audio * chip,struct usb_host_interface * alts,int protocol,int iface_no)578*4882a593Smuzhiyun static int parse_uac_endpoint_attributes(struct snd_usb_audio *chip,
579*4882a593Smuzhiyun 					 struct usb_host_interface *alts,
580*4882a593Smuzhiyun 					 int protocol, int iface_no)
581*4882a593Smuzhiyun {
582*4882a593Smuzhiyun 	/* parsed with a v1 header here. that's ok as we only look at the
583*4882a593Smuzhiyun 	 * header first which is the same for both versions */
584*4882a593Smuzhiyun 	struct uac_iso_endpoint_descriptor *csep;
585*4882a593Smuzhiyun 	struct usb_interface_descriptor *altsd = get_iface_desc(alts);
586*4882a593Smuzhiyun 	int attributes = 0;
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun 	csep = snd_usb_find_desc(alts->endpoint[0].extra, alts->endpoint[0].extralen, NULL, USB_DT_CS_ENDPOINT);
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	/* Creamware Noah has this descriptor after the 2nd endpoint */
591*4882a593Smuzhiyun 	if (!csep && altsd->bNumEndpoints >= 2)
592*4882a593Smuzhiyun 		csep = snd_usb_find_desc(alts->endpoint[1].extra, alts->endpoint[1].extralen, NULL, USB_DT_CS_ENDPOINT);
593*4882a593Smuzhiyun 
594*4882a593Smuzhiyun 	/*
595*4882a593Smuzhiyun 	 * If we can't locate the USB_DT_CS_ENDPOINT descriptor in the extra
596*4882a593Smuzhiyun 	 * bytes after the first endpoint, go search the entire interface.
597*4882a593Smuzhiyun 	 * Some devices have it directly *before* the standard endpoint.
598*4882a593Smuzhiyun 	 */
599*4882a593Smuzhiyun 	if (!csep)
600*4882a593Smuzhiyun 		csep = snd_usb_find_desc(alts->extra, alts->extralen, NULL, USB_DT_CS_ENDPOINT);
601*4882a593Smuzhiyun 
602*4882a593Smuzhiyun 	if (!csep || csep->bLength < 7 ||
603*4882a593Smuzhiyun 	    csep->bDescriptorSubtype != UAC_EP_GENERAL)
604*4882a593Smuzhiyun 		goto error;
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 	if (protocol == UAC_VERSION_1) {
607*4882a593Smuzhiyun 		attributes = csep->bmAttributes;
608*4882a593Smuzhiyun 	} else if (protocol == UAC_VERSION_2) {
609*4882a593Smuzhiyun 		struct uac2_iso_endpoint_descriptor *csep2 =
610*4882a593Smuzhiyun 			(struct uac2_iso_endpoint_descriptor *) csep;
611*4882a593Smuzhiyun 
612*4882a593Smuzhiyun 		if (csep2->bLength < sizeof(*csep2))
613*4882a593Smuzhiyun 			goto error;
614*4882a593Smuzhiyun 		attributes = csep->bmAttributes & UAC_EP_CS_ATTR_FILL_MAX;
615*4882a593Smuzhiyun 
616*4882a593Smuzhiyun 		/* emulate the endpoint attributes of a v1 device */
617*4882a593Smuzhiyun 		if (csep2->bmControls & UAC2_CONTROL_PITCH)
618*4882a593Smuzhiyun 			attributes |= UAC_EP_CS_ATTR_PITCH_CONTROL;
619*4882a593Smuzhiyun 	} else { /* UAC_VERSION_3 */
620*4882a593Smuzhiyun 		struct uac3_iso_endpoint_descriptor *csep3 =
621*4882a593Smuzhiyun 			(struct uac3_iso_endpoint_descriptor *) csep;
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 		if (csep3->bLength < sizeof(*csep3))
624*4882a593Smuzhiyun 			goto error;
625*4882a593Smuzhiyun 		/* emulate the endpoint attributes of a v1 device */
626*4882a593Smuzhiyun 		if (le32_to_cpu(csep3->bmControls) & UAC2_CONTROL_PITCH)
627*4882a593Smuzhiyun 			attributes |= UAC_EP_CS_ATTR_PITCH_CONTROL;
628*4882a593Smuzhiyun 	}
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 	return attributes;
631*4882a593Smuzhiyun 
632*4882a593Smuzhiyun  error:
633*4882a593Smuzhiyun 	usb_audio_warn(chip,
634*4882a593Smuzhiyun 		       "%u:%d : no or invalid class specific endpoint descriptor\n",
635*4882a593Smuzhiyun 		       iface_no, altsd->bAlternateSetting);
636*4882a593Smuzhiyun 	return 0;
637*4882a593Smuzhiyun }
638*4882a593Smuzhiyun 
639*4882a593Smuzhiyun /* find an input terminal descriptor (either UAC1 or UAC2) with the given
640*4882a593Smuzhiyun  * terminal id
641*4882a593Smuzhiyun  */
642*4882a593Smuzhiyun static void *
snd_usb_find_input_terminal_descriptor(struct usb_host_interface * ctrl_iface,int terminal_id,int protocol)643*4882a593Smuzhiyun snd_usb_find_input_terminal_descriptor(struct usb_host_interface *ctrl_iface,
644*4882a593Smuzhiyun 				       int terminal_id, int protocol)
645*4882a593Smuzhiyun {
646*4882a593Smuzhiyun 	struct uac2_input_terminal_descriptor *term = NULL;
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	while ((term = snd_usb_find_csint_desc(ctrl_iface->extra,
649*4882a593Smuzhiyun 					       ctrl_iface->extralen,
650*4882a593Smuzhiyun 					       term, UAC_INPUT_TERMINAL))) {
651*4882a593Smuzhiyun 		if (!snd_usb_validate_audio_desc(term, protocol))
652*4882a593Smuzhiyun 			continue;
653*4882a593Smuzhiyun 		if (term->bTerminalID == terminal_id)
654*4882a593Smuzhiyun 			return term;
655*4882a593Smuzhiyun 	}
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun 	return NULL;
658*4882a593Smuzhiyun }
659*4882a593Smuzhiyun 
660*4882a593Smuzhiyun static void *
snd_usb_find_output_terminal_descriptor(struct usb_host_interface * ctrl_iface,int terminal_id,int protocol)661*4882a593Smuzhiyun snd_usb_find_output_terminal_descriptor(struct usb_host_interface *ctrl_iface,
662*4882a593Smuzhiyun 					int terminal_id, int protocol)
663*4882a593Smuzhiyun {
664*4882a593Smuzhiyun 	/* OK to use with both UAC2 and UAC3 */
665*4882a593Smuzhiyun 	struct uac2_output_terminal_descriptor *term = NULL;
666*4882a593Smuzhiyun 
667*4882a593Smuzhiyun 	while ((term = snd_usb_find_csint_desc(ctrl_iface->extra,
668*4882a593Smuzhiyun 					       ctrl_iface->extralen,
669*4882a593Smuzhiyun 					       term, UAC_OUTPUT_TERMINAL))) {
670*4882a593Smuzhiyun 		if (!snd_usb_validate_audio_desc(term, protocol))
671*4882a593Smuzhiyun 			continue;
672*4882a593Smuzhiyun 		if (term->bTerminalID == terminal_id)
673*4882a593Smuzhiyun 			return term;
674*4882a593Smuzhiyun 	}
675*4882a593Smuzhiyun 
676*4882a593Smuzhiyun 	return NULL;
677*4882a593Smuzhiyun }
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun static struct audioformat *
audio_format_alloc_init(struct snd_usb_audio * chip,struct usb_host_interface * alts,int protocol,int iface_no,int altset_idx,int altno,int num_channels,int clock)680*4882a593Smuzhiyun audio_format_alloc_init(struct snd_usb_audio *chip,
681*4882a593Smuzhiyun 		       struct usb_host_interface *alts,
682*4882a593Smuzhiyun 		       int protocol, int iface_no, int altset_idx,
683*4882a593Smuzhiyun 		       int altno, int num_channels, int clock)
684*4882a593Smuzhiyun {
685*4882a593Smuzhiyun 	struct audioformat *fp;
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 	fp = kzalloc(sizeof(*fp), GFP_KERNEL);
688*4882a593Smuzhiyun 	if (!fp)
689*4882a593Smuzhiyun 		return NULL;
690*4882a593Smuzhiyun 
691*4882a593Smuzhiyun 	fp->iface = iface_no;
692*4882a593Smuzhiyun 	fp->altsetting = altno;
693*4882a593Smuzhiyun 	fp->altset_idx = altset_idx;
694*4882a593Smuzhiyun 	fp->endpoint = get_endpoint(alts, 0)->bEndpointAddress;
695*4882a593Smuzhiyun 	fp->ep_attr = get_endpoint(alts, 0)->bmAttributes;
696*4882a593Smuzhiyun 	fp->datainterval = snd_usb_parse_datainterval(chip, alts);
697*4882a593Smuzhiyun 	fp->protocol = protocol;
698*4882a593Smuzhiyun 	fp->maxpacksize = le16_to_cpu(get_endpoint(alts, 0)->wMaxPacketSize);
699*4882a593Smuzhiyun 	fp->channels = num_channels;
700*4882a593Smuzhiyun 	if (snd_usb_get_speed(chip->dev) == USB_SPEED_HIGH)
701*4882a593Smuzhiyun 		fp->maxpacksize = (((fp->maxpacksize >> 11) & 3) + 1)
702*4882a593Smuzhiyun 				* (fp->maxpacksize & 0x7ff);
703*4882a593Smuzhiyun 	fp->clock = clock;
704*4882a593Smuzhiyun 	INIT_LIST_HEAD(&fp->list);
705*4882a593Smuzhiyun 
706*4882a593Smuzhiyun 	return fp;
707*4882a593Smuzhiyun }
708*4882a593Smuzhiyun 
709*4882a593Smuzhiyun static struct audioformat *
snd_usb_get_audioformat_uac12(struct snd_usb_audio * chip,struct usb_host_interface * alts,int protocol,int iface_no,int altset_idx,int altno,int stream,int bm_quirk)710*4882a593Smuzhiyun snd_usb_get_audioformat_uac12(struct snd_usb_audio *chip,
711*4882a593Smuzhiyun 			      struct usb_host_interface *alts,
712*4882a593Smuzhiyun 			      int protocol, int iface_no, int altset_idx,
713*4882a593Smuzhiyun 			      int altno, int stream, int bm_quirk)
714*4882a593Smuzhiyun {
715*4882a593Smuzhiyun 	struct usb_device *dev = chip->dev;
716*4882a593Smuzhiyun 	struct uac_format_type_i_continuous_descriptor *fmt;
717*4882a593Smuzhiyun 	unsigned int num_channels = 0, chconfig = 0;
718*4882a593Smuzhiyun 	struct audioformat *fp;
719*4882a593Smuzhiyun 	int clock = 0;
720*4882a593Smuzhiyun 	u64 format;
721*4882a593Smuzhiyun 
722*4882a593Smuzhiyun 	/* get audio formats */
723*4882a593Smuzhiyun 	if (protocol == UAC_VERSION_1) {
724*4882a593Smuzhiyun 		struct uac1_as_header_descriptor *as =
725*4882a593Smuzhiyun 			snd_usb_find_csint_desc(alts->extra, alts->extralen,
726*4882a593Smuzhiyun 						NULL, UAC_AS_GENERAL);
727*4882a593Smuzhiyun 		struct uac_input_terminal_descriptor *iterm;
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 		if (!as) {
730*4882a593Smuzhiyun 			dev_err(&dev->dev,
731*4882a593Smuzhiyun 				"%u:%d : UAC_AS_GENERAL descriptor not found\n",
732*4882a593Smuzhiyun 				iface_no, altno);
733*4882a593Smuzhiyun 			return NULL;
734*4882a593Smuzhiyun 		}
735*4882a593Smuzhiyun 
736*4882a593Smuzhiyun 		if (as->bLength < sizeof(*as)) {
737*4882a593Smuzhiyun 			dev_err(&dev->dev,
738*4882a593Smuzhiyun 				"%u:%d : invalid UAC_AS_GENERAL desc\n",
739*4882a593Smuzhiyun 				iface_no, altno);
740*4882a593Smuzhiyun 			return NULL;
741*4882a593Smuzhiyun 		}
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun 		format = le16_to_cpu(as->wFormatTag); /* remember the format value */
744*4882a593Smuzhiyun 
745*4882a593Smuzhiyun 		iterm = snd_usb_find_input_terminal_descriptor(chip->ctrl_intf,
746*4882a593Smuzhiyun 							       as->bTerminalLink,
747*4882a593Smuzhiyun 							       protocol);
748*4882a593Smuzhiyun 		if (iterm) {
749*4882a593Smuzhiyun 			num_channels = iterm->bNrChannels;
750*4882a593Smuzhiyun 			chconfig = le16_to_cpu(iterm->wChannelConfig);
751*4882a593Smuzhiyun 		}
752*4882a593Smuzhiyun 	} else { /* UAC_VERSION_2 */
753*4882a593Smuzhiyun 		struct uac2_input_terminal_descriptor *input_term;
754*4882a593Smuzhiyun 		struct uac2_output_terminal_descriptor *output_term;
755*4882a593Smuzhiyun 		struct uac2_as_header_descriptor *as =
756*4882a593Smuzhiyun 			snd_usb_find_csint_desc(alts->extra, alts->extralen,
757*4882a593Smuzhiyun 						NULL, UAC_AS_GENERAL);
758*4882a593Smuzhiyun 
759*4882a593Smuzhiyun 		if (!as) {
760*4882a593Smuzhiyun 			dev_err(&dev->dev,
761*4882a593Smuzhiyun 				"%u:%d : UAC_AS_GENERAL descriptor not found\n",
762*4882a593Smuzhiyun 				iface_no, altno);
763*4882a593Smuzhiyun 			return NULL;
764*4882a593Smuzhiyun 		}
765*4882a593Smuzhiyun 
766*4882a593Smuzhiyun 		if (as->bLength < sizeof(*as)) {
767*4882a593Smuzhiyun 			dev_err(&dev->dev,
768*4882a593Smuzhiyun 				"%u:%d : invalid UAC_AS_GENERAL desc\n",
769*4882a593Smuzhiyun 				iface_no, altno);
770*4882a593Smuzhiyun 			return NULL;
771*4882a593Smuzhiyun 		}
772*4882a593Smuzhiyun 
773*4882a593Smuzhiyun 		num_channels = as->bNrChannels;
774*4882a593Smuzhiyun 		format = le32_to_cpu(as->bmFormats);
775*4882a593Smuzhiyun 		chconfig = le32_to_cpu(as->bmChannelConfig);
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 		/*
778*4882a593Smuzhiyun 		 * lookup the terminal associated to this interface
779*4882a593Smuzhiyun 		 * to extract the clock
780*4882a593Smuzhiyun 		 */
781*4882a593Smuzhiyun 		input_term = snd_usb_find_input_terminal_descriptor(chip->ctrl_intf,
782*4882a593Smuzhiyun 								    as->bTerminalLink,
783*4882a593Smuzhiyun 								    protocol);
784*4882a593Smuzhiyun 		if (input_term) {
785*4882a593Smuzhiyun 			clock = input_term->bCSourceID;
786*4882a593Smuzhiyun 			if (!chconfig && (num_channels == input_term->bNrChannels))
787*4882a593Smuzhiyun 				chconfig = le32_to_cpu(input_term->bmChannelConfig);
788*4882a593Smuzhiyun 			goto found_clock;
789*4882a593Smuzhiyun 		}
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun 		output_term = snd_usb_find_output_terminal_descriptor(chip->ctrl_intf,
792*4882a593Smuzhiyun 								      as->bTerminalLink,
793*4882a593Smuzhiyun 								      protocol);
794*4882a593Smuzhiyun 		if (output_term) {
795*4882a593Smuzhiyun 			clock = output_term->bCSourceID;
796*4882a593Smuzhiyun 			goto found_clock;
797*4882a593Smuzhiyun 		}
798*4882a593Smuzhiyun 
799*4882a593Smuzhiyun 		dev_err(&dev->dev,
800*4882a593Smuzhiyun 			"%u:%d : bogus bTerminalLink %d\n",
801*4882a593Smuzhiyun 			iface_no, altno, as->bTerminalLink);
802*4882a593Smuzhiyun 		return NULL;
803*4882a593Smuzhiyun 	}
804*4882a593Smuzhiyun 
805*4882a593Smuzhiyun found_clock:
806*4882a593Smuzhiyun 	/* get format type */
807*4882a593Smuzhiyun 	fmt = snd_usb_find_csint_desc(alts->extra, alts->extralen,
808*4882a593Smuzhiyun 				      NULL, UAC_FORMAT_TYPE);
809*4882a593Smuzhiyun 	if (!fmt) {
810*4882a593Smuzhiyun 		dev_err(&dev->dev,
811*4882a593Smuzhiyun 			"%u:%d : no UAC_FORMAT_TYPE desc\n",
812*4882a593Smuzhiyun 			iface_no, altno);
813*4882a593Smuzhiyun 		return NULL;
814*4882a593Smuzhiyun 	}
815*4882a593Smuzhiyun 	if (((protocol == UAC_VERSION_1) && (fmt->bLength < 8))
816*4882a593Smuzhiyun 			|| ((protocol == UAC_VERSION_2) &&
817*4882a593Smuzhiyun 					(fmt->bLength < 6))) {
818*4882a593Smuzhiyun 		dev_err(&dev->dev,
819*4882a593Smuzhiyun 			"%u:%d : invalid UAC_FORMAT_TYPE desc\n",
820*4882a593Smuzhiyun 			iface_no, altno);
821*4882a593Smuzhiyun 		return NULL;
822*4882a593Smuzhiyun 	}
823*4882a593Smuzhiyun 
824*4882a593Smuzhiyun 	/*
825*4882a593Smuzhiyun 	 * Blue Microphones workaround: The last altsetting is
826*4882a593Smuzhiyun 	 * identical with the previous one, except for a larger
827*4882a593Smuzhiyun 	 * packet size, but is actually a mislabeled two-channel
828*4882a593Smuzhiyun 	 * setting; ignore it.
829*4882a593Smuzhiyun 	 *
830*4882a593Smuzhiyun 	 * Part 2: analyze quirk flag and format
831*4882a593Smuzhiyun 	 */
832*4882a593Smuzhiyun 	if (bm_quirk && fmt->bNrChannels == 1 && fmt->bSubframeSize == 2)
833*4882a593Smuzhiyun 		return NULL;
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 	fp = audio_format_alloc_init(chip, alts, protocol, iface_no,
836*4882a593Smuzhiyun 				     altset_idx, altno, num_channels, clock);
837*4882a593Smuzhiyun 	if (!fp)
838*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
839*4882a593Smuzhiyun 
840*4882a593Smuzhiyun 	fp->attributes = parse_uac_endpoint_attributes(chip, alts, protocol,
841*4882a593Smuzhiyun 						       iface_no);
842*4882a593Smuzhiyun 
843*4882a593Smuzhiyun 	/* some quirks for attributes here */
844*4882a593Smuzhiyun 	snd_usb_audioformat_attributes_quirk(chip, fp, stream);
845*4882a593Smuzhiyun 
846*4882a593Smuzhiyun 	/* ok, let's parse further... */
847*4882a593Smuzhiyun 	if (snd_usb_parse_audio_format(chip, fp, format,
848*4882a593Smuzhiyun 					fmt, stream) < 0) {
849*4882a593Smuzhiyun 		audioformat_free(fp);
850*4882a593Smuzhiyun 		return NULL;
851*4882a593Smuzhiyun 	}
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 	/* Create chmap */
854*4882a593Smuzhiyun 	if (fp->channels != num_channels)
855*4882a593Smuzhiyun 		chconfig = 0;
856*4882a593Smuzhiyun 
857*4882a593Smuzhiyun 	fp->chmap = convert_chmap(fp->channels, chconfig, protocol);
858*4882a593Smuzhiyun 
859*4882a593Smuzhiyun 	return fp;
860*4882a593Smuzhiyun }
861*4882a593Smuzhiyun 
862*4882a593Smuzhiyun static struct audioformat *
snd_usb_get_audioformat_uac3(struct snd_usb_audio * chip,struct usb_host_interface * alts,struct snd_usb_power_domain ** pd_out,int iface_no,int altset_idx,int altno,int stream)863*4882a593Smuzhiyun snd_usb_get_audioformat_uac3(struct snd_usb_audio *chip,
864*4882a593Smuzhiyun 			     struct usb_host_interface *alts,
865*4882a593Smuzhiyun 			     struct snd_usb_power_domain **pd_out,
866*4882a593Smuzhiyun 			     int iface_no, int altset_idx,
867*4882a593Smuzhiyun 			     int altno, int stream)
868*4882a593Smuzhiyun {
869*4882a593Smuzhiyun 	struct usb_device *dev = chip->dev;
870*4882a593Smuzhiyun 	struct uac3_input_terminal_descriptor *input_term;
871*4882a593Smuzhiyun 	struct uac3_output_terminal_descriptor *output_term;
872*4882a593Smuzhiyun 	struct uac3_cluster_header_descriptor *cluster;
873*4882a593Smuzhiyun 	struct uac3_as_header_descriptor *as = NULL;
874*4882a593Smuzhiyun 	struct uac3_hc_descriptor_header hc_header;
875*4882a593Smuzhiyun 	struct snd_pcm_chmap_elem *chmap;
876*4882a593Smuzhiyun 	struct snd_usb_power_domain *pd;
877*4882a593Smuzhiyun 	unsigned char badd_profile;
878*4882a593Smuzhiyun 	u64 badd_formats = 0;
879*4882a593Smuzhiyun 	unsigned int num_channels;
880*4882a593Smuzhiyun 	struct audioformat *fp;
881*4882a593Smuzhiyun 	u16 cluster_id, wLength;
882*4882a593Smuzhiyun 	int clock = 0;
883*4882a593Smuzhiyun 	int err;
884*4882a593Smuzhiyun 
885*4882a593Smuzhiyun 	badd_profile = chip->badd_profile;
886*4882a593Smuzhiyun 
887*4882a593Smuzhiyun 	if (badd_profile >= UAC3_FUNCTION_SUBCLASS_GENERIC_IO) {
888*4882a593Smuzhiyun 		unsigned int maxpacksize =
889*4882a593Smuzhiyun 			le16_to_cpu(get_endpoint(alts, 0)->wMaxPacketSize);
890*4882a593Smuzhiyun 
891*4882a593Smuzhiyun 		switch (maxpacksize) {
892*4882a593Smuzhiyun 		default:
893*4882a593Smuzhiyun 			dev_err(&dev->dev,
894*4882a593Smuzhiyun 				"%u:%d : incorrect wMaxPacketSize for BADD profile\n",
895*4882a593Smuzhiyun 				iface_no, altno);
896*4882a593Smuzhiyun 			return NULL;
897*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_SYNC_MONO_16:
898*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_ASYNC_MONO_16:
899*4882a593Smuzhiyun 			badd_formats = SNDRV_PCM_FMTBIT_S16_LE;
900*4882a593Smuzhiyun 			num_channels = 1;
901*4882a593Smuzhiyun 			break;
902*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_SYNC_MONO_24:
903*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_ASYNC_MONO_24:
904*4882a593Smuzhiyun 			badd_formats = SNDRV_PCM_FMTBIT_S24_3LE;
905*4882a593Smuzhiyun 			num_channels = 1;
906*4882a593Smuzhiyun 			break;
907*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_SYNC_STEREO_16:
908*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_ASYNC_STEREO_16:
909*4882a593Smuzhiyun 			badd_formats = SNDRV_PCM_FMTBIT_S16_LE;
910*4882a593Smuzhiyun 			num_channels = 2;
911*4882a593Smuzhiyun 			break;
912*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_SYNC_STEREO_24:
913*4882a593Smuzhiyun 		case UAC3_BADD_EP_MAXPSIZE_ASYNC_STEREO_24:
914*4882a593Smuzhiyun 			badd_formats = SNDRV_PCM_FMTBIT_S24_3LE;
915*4882a593Smuzhiyun 			num_channels = 2;
916*4882a593Smuzhiyun 			break;
917*4882a593Smuzhiyun 		}
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 		chmap = kzalloc(sizeof(*chmap), GFP_KERNEL);
920*4882a593Smuzhiyun 		if (!chmap)
921*4882a593Smuzhiyun 			return ERR_PTR(-ENOMEM);
922*4882a593Smuzhiyun 
923*4882a593Smuzhiyun 		if (num_channels == 1) {
924*4882a593Smuzhiyun 			chmap->map[0] = SNDRV_CHMAP_MONO;
925*4882a593Smuzhiyun 		} else {
926*4882a593Smuzhiyun 			chmap->map[0] = SNDRV_CHMAP_FL;
927*4882a593Smuzhiyun 			chmap->map[1] = SNDRV_CHMAP_FR;
928*4882a593Smuzhiyun 		}
929*4882a593Smuzhiyun 
930*4882a593Smuzhiyun 		chmap->channels = num_channels;
931*4882a593Smuzhiyun 		clock = UAC3_BADD_CS_ID9;
932*4882a593Smuzhiyun 		goto found_clock;
933*4882a593Smuzhiyun 	}
934*4882a593Smuzhiyun 
935*4882a593Smuzhiyun 	as = snd_usb_find_csint_desc(alts->extra, alts->extralen,
936*4882a593Smuzhiyun 				     NULL, UAC_AS_GENERAL);
937*4882a593Smuzhiyun 	if (!as) {
938*4882a593Smuzhiyun 		dev_err(&dev->dev,
939*4882a593Smuzhiyun 			"%u:%d : UAC_AS_GENERAL descriptor not found\n",
940*4882a593Smuzhiyun 			iface_no, altno);
941*4882a593Smuzhiyun 		return NULL;
942*4882a593Smuzhiyun 	}
943*4882a593Smuzhiyun 
944*4882a593Smuzhiyun 	if (as->bLength < sizeof(*as)) {
945*4882a593Smuzhiyun 		dev_err(&dev->dev,
946*4882a593Smuzhiyun 			"%u:%d : invalid UAC_AS_GENERAL desc\n",
947*4882a593Smuzhiyun 			iface_no, altno);
948*4882a593Smuzhiyun 		return NULL;
949*4882a593Smuzhiyun 	}
950*4882a593Smuzhiyun 
951*4882a593Smuzhiyun 	cluster_id = le16_to_cpu(as->wClusterDescrID);
952*4882a593Smuzhiyun 	if (!cluster_id) {
953*4882a593Smuzhiyun 		dev_err(&dev->dev,
954*4882a593Smuzhiyun 			"%u:%d : no cluster descriptor\n",
955*4882a593Smuzhiyun 			iface_no, altno);
956*4882a593Smuzhiyun 		return NULL;
957*4882a593Smuzhiyun 	}
958*4882a593Smuzhiyun 
959*4882a593Smuzhiyun 	/*
960*4882a593Smuzhiyun 	 * Get number of channels and channel map through
961*4882a593Smuzhiyun 	 * High Capability Cluster Descriptor
962*4882a593Smuzhiyun 	 *
963*4882a593Smuzhiyun 	 * First step: get High Capability header and
964*4882a593Smuzhiyun 	 * read size of Cluster Descriptor
965*4882a593Smuzhiyun 	 */
966*4882a593Smuzhiyun 	err = snd_usb_ctl_msg(chip->dev,
967*4882a593Smuzhiyun 			usb_rcvctrlpipe(chip->dev, 0),
968*4882a593Smuzhiyun 			UAC3_CS_REQ_HIGH_CAPABILITY_DESCRIPTOR,
969*4882a593Smuzhiyun 			USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
970*4882a593Smuzhiyun 			cluster_id,
971*4882a593Smuzhiyun 			snd_usb_ctrl_intf(chip),
972*4882a593Smuzhiyun 			&hc_header, sizeof(hc_header));
973*4882a593Smuzhiyun 	if (err < 0)
974*4882a593Smuzhiyun 		return ERR_PTR(err);
975*4882a593Smuzhiyun 	else if (err != sizeof(hc_header)) {
976*4882a593Smuzhiyun 		dev_err(&dev->dev,
977*4882a593Smuzhiyun 			"%u:%d : can't get High Capability descriptor\n",
978*4882a593Smuzhiyun 			iface_no, altno);
979*4882a593Smuzhiyun 		return ERR_PTR(-EIO);
980*4882a593Smuzhiyun 	}
981*4882a593Smuzhiyun 
982*4882a593Smuzhiyun 	/*
983*4882a593Smuzhiyun 	 * Second step: allocate needed amount of memory
984*4882a593Smuzhiyun 	 * and request Cluster Descriptor
985*4882a593Smuzhiyun 	 */
986*4882a593Smuzhiyun 	wLength = le16_to_cpu(hc_header.wLength);
987*4882a593Smuzhiyun 	cluster = kzalloc(wLength, GFP_KERNEL);
988*4882a593Smuzhiyun 	if (!cluster)
989*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
990*4882a593Smuzhiyun 	err = snd_usb_ctl_msg(chip->dev,
991*4882a593Smuzhiyun 			usb_rcvctrlpipe(chip->dev, 0),
992*4882a593Smuzhiyun 			UAC3_CS_REQ_HIGH_CAPABILITY_DESCRIPTOR,
993*4882a593Smuzhiyun 			USB_RECIP_INTERFACE | USB_TYPE_CLASS | USB_DIR_IN,
994*4882a593Smuzhiyun 			cluster_id,
995*4882a593Smuzhiyun 			snd_usb_ctrl_intf(chip),
996*4882a593Smuzhiyun 			cluster, wLength);
997*4882a593Smuzhiyun 	if (err < 0) {
998*4882a593Smuzhiyun 		kfree(cluster);
999*4882a593Smuzhiyun 		return ERR_PTR(err);
1000*4882a593Smuzhiyun 	} else if (err != wLength) {
1001*4882a593Smuzhiyun 		dev_err(&dev->dev,
1002*4882a593Smuzhiyun 			"%u:%d : can't get Cluster Descriptor\n",
1003*4882a593Smuzhiyun 			iface_no, altno);
1004*4882a593Smuzhiyun 		kfree(cluster);
1005*4882a593Smuzhiyun 		return ERR_PTR(-EIO);
1006*4882a593Smuzhiyun 	}
1007*4882a593Smuzhiyun 
1008*4882a593Smuzhiyun 	num_channels = cluster->bNrChannels;
1009*4882a593Smuzhiyun 	chmap = convert_chmap_v3(cluster);
1010*4882a593Smuzhiyun 	kfree(cluster);
1011*4882a593Smuzhiyun 
1012*4882a593Smuzhiyun 	/*
1013*4882a593Smuzhiyun 	 * lookup the terminal associated to this interface
1014*4882a593Smuzhiyun 	 * to extract the clock
1015*4882a593Smuzhiyun 	 */
1016*4882a593Smuzhiyun 	input_term = snd_usb_find_input_terminal_descriptor(chip->ctrl_intf,
1017*4882a593Smuzhiyun 							    as->bTerminalLink,
1018*4882a593Smuzhiyun 							    UAC_VERSION_3);
1019*4882a593Smuzhiyun 	if (input_term) {
1020*4882a593Smuzhiyun 		clock = input_term->bCSourceID;
1021*4882a593Smuzhiyun 		goto found_clock;
1022*4882a593Smuzhiyun 	}
1023*4882a593Smuzhiyun 
1024*4882a593Smuzhiyun 	output_term = snd_usb_find_output_terminal_descriptor(chip->ctrl_intf,
1025*4882a593Smuzhiyun 							      as->bTerminalLink,
1026*4882a593Smuzhiyun 							      UAC_VERSION_3);
1027*4882a593Smuzhiyun 	if (output_term) {
1028*4882a593Smuzhiyun 		clock = output_term->bCSourceID;
1029*4882a593Smuzhiyun 		goto found_clock;
1030*4882a593Smuzhiyun 	}
1031*4882a593Smuzhiyun 
1032*4882a593Smuzhiyun 	dev_err(&dev->dev, "%u:%d : bogus bTerminalLink %d\n",
1033*4882a593Smuzhiyun 			iface_no, altno, as->bTerminalLink);
1034*4882a593Smuzhiyun 	kfree(chmap);
1035*4882a593Smuzhiyun 	return NULL;
1036*4882a593Smuzhiyun 
1037*4882a593Smuzhiyun found_clock:
1038*4882a593Smuzhiyun 	fp = audio_format_alloc_init(chip, alts, UAC_VERSION_3, iface_no,
1039*4882a593Smuzhiyun 				     altset_idx, altno, num_channels, clock);
1040*4882a593Smuzhiyun 	if (!fp) {
1041*4882a593Smuzhiyun 		kfree(chmap);
1042*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
1043*4882a593Smuzhiyun 	}
1044*4882a593Smuzhiyun 
1045*4882a593Smuzhiyun 	fp->chmap = chmap;
1046*4882a593Smuzhiyun 
1047*4882a593Smuzhiyun 	if (badd_profile >= UAC3_FUNCTION_SUBCLASS_GENERIC_IO) {
1048*4882a593Smuzhiyun 		fp->attributes = 0; /* No attributes */
1049*4882a593Smuzhiyun 
1050*4882a593Smuzhiyun 		fp->fmt_type = UAC_FORMAT_TYPE_I;
1051*4882a593Smuzhiyun 		fp->formats = badd_formats;
1052*4882a593Smuzhiyun 
1053*4882a593Smuzhiyun 		fp->nr_rates = 0;	/* SNDRV_PCM_RATE_CONTINUOUS */
1054*4882a593Smuzhiyun 		fp->rate_min = UAC3_BADD_SAMPLING_RATE;
1055*4882a593Smuzhiyun 		fp->rate_max = UAC3_BADD_SAMPLING_RATE;
1056*4882a593Smuzhiyun 		fp->rates = SNDRV_PCM_RATE_CONTINUOUS;
1057*4882a593Smuzhiyun 
1058*4882a593Smuzhiyun 		pd = kzalloc(sizeof(*pd), GFP_KERNEL);
1059*4882a593Smuzhiyun 		if (!pd) {
1060*4882a593Smuzhiyun 			audioformat_free(fp);
1061*4882a593Smuzhiyun 			return NULL;
1062*4882a593Smuzhiyun 		}
1063*4882a593Smuzhiyun 		pd->pd_id = (stream == SNDRV_PCM_STREAM_PLAYBACK) ?
1064*4882a593Smuzhiyun 					UAC3_BADD_PD_ID10 : UAC3_BADD_PD_ID11;
1065*4882a593Smuzhiyun 		pd->pd_d1d0_rec = UAC3_BADD_PD_RECOVER_D1D0;
1066*4882a593Smuzhiyun 		pd->pd_d2d0_rec = UAC3_BADD_PD_RECOVER_D2D0;
1067*4882a593Smuzhiyun 
1068*4882a593Smuzhiyun 	} else {
1069*4882a593Smuzhiyun 		fp->attributes = parse_uac_endpoint_attributes(chip, alts,
1070*4882a593Smuzhiyun 							       UAC_VERSION_3,
1071*4882a593Smuzhiyun 							       iface_no);
1072*4882a593Smuzhiyun 
1073*4882a593Smuzhiyun 		pd = snd_usb_find_power_domain(chip->ctrl_intf,
1074*4882a593Smuzhiyun 					       as->bTerminalLink);
1075*4882a593Smuzhiyun 
1076*4882a593Smuzhiyun 		/* ok, let's parse further... */
1077*4882a593Smuzhiyun 		if (snd_usb_parse_audio_format_v3(chip, fp, as, stream) < 0) {
1078*4882a593Smuzhiyun 			kfree(pd);
1079*4882a593Smuzhiyun 			audioformat_free(fp);
1080*4882a593Smuzhiyun 			return NULL;
1081*4882a593Smuzhiyun 		}
1082*4882a593Smuzhiyun 	}
1083*4882a593Smuzhiyun 
1084*4882a593Smuzhiyun 	if (pd)
1085*4882a593Smuzhiyun 		*pd_out = pd;
1086*4882a593Smuzhiyun 
1087*4882a593Smuzhiyun 	return fp;
1088*4882a593Smuzhiyun }
1089*4882a593Smuzhiyun 
__snd_usb_parse_audio_interface(struct snd_usb_audio * chip,int iface_no,bool * has_non_pcm,bool non_pcm)1090*4882a593Smuzhiyun static int __snd_usb_parse_audio_interface(struct snd_usb_audio *chip,
1091*4882a593Smuzhiyun 					   int iface_no,
1092*4882a593Smuzhiyun 					   bool *has_non_pcm, bool non_pcm)
1093*4882a593Smuzhiyun {
1094*4882a593Smuzhiyun 	struct usb_device *dev;
1095*4882a593Smuzhiyun 	struct usb_interface *iface;
1096*4882a593Smuzhiyun 	struct usb_host_interface *alts;
1097*4882a593Smuzhiyun 	struct usb_interface_descriptor *altsd;
1098*4882a593Smuzhiyun 	int i, altno, err, stream;
1099*4882a593Smuzhiyun 	struct audioformat *fp = NULL;
1100*4882a593Smuzhiyun 	struct snd_usb_power_domain *pd = NULL;
1101*4882a593Smuzhiyun 	int num, protocol;
1102*4882a593Smuzhiyun 
1103*4882a593Smuzhiyun 	dev = chip->dev;
1104*4882a593Smuzhiyun 
1105*4882a593Smuzhiyun 	/* parse the interface's altsettings */
1106*4882a593Smuzhiyun 	iface = usb_ifnum_to_if(dev, iface_no);
1107*4882a593Smuzhiyun 
1108*4882a593Smuzhiyun 	num = iface->num_altsetting;
1109*4882a593Smuzhiyun 
1110*4882a593Smuzhiyun 	/*
1111*4882a593Smuzhiyun 	 * Dallas DS4201 workaround: It presents 5 altsettings, but the last
1112*4882a593Smuzhiyun 	 * one misses syncpipe, and does not produce any sound.
1113*4882a593Smuzhiyun 	 */
1114*4882a593Smuzhiyun 	if (chip->usb_id == USB_ID(0x04fa, 0x4201) && num >= 4)
1115*4882a593Smuzhiyun 		num = 4;
1116*4882a593Smuzhiyun 
1117*4882a593Smuzhiyun 	for (i = 0; i < num; i++) {
1118*4882a593Smuzhiyun 		alts = &iface->altsetting[i];
1119*4882a593Smuzhiyun 		altsd = get_iface_desc(alts);
1120*4882a593Smuzhiyun 		protocol = altsd->bInterfaceProtocol;
1121*4882a593Smuzhiyun 		/* skip invalid one */
1122*4882a593Smuzhiyun 		if (((altsd->bInterfaceClass != USB_CLASS_AUDIO ||
1123*4882a593Smuzhiyun 		      (altsd->bInterfaceSubClass != USB_SUBCLASS_AUDIOSTREAMING &&
1124*4882a593Smuzhiyun 		       altsd->bInterfaceSubClass != USB_SUBCLASS_VENDOR_SPEC)) &&
1125*4882a593Smuzhiyun 		     altsd->bInterfaceClass != USB_CLASS_VENDOR_SPEC) ||
1126*4882a593Smuzhiyun 		    altsd->bNumEndpoints < 1 ||
1127*4882a593Smuzhiyun 		    le16_to_cpu(get_endpoint(alts, 0)->wMaxPacketSize) == 0)
1128*4882a593Smuzhiyun 			continue;
1129*4882a593Smuzhiyun 		/* must be isochronous */
1130*4882a593Smuzhiyun 		if ((get_endpoint(alts, 0)->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) !=
1131*4882a593Smuzhiyun 		    USB_ENDPOINT_XFER_ISOC)
1132*4882a593Smuzhiyun 			continue;
1133*4882a593Smuzhiyun 		/* check direction */
1134*4882a593Smuzhiyun 		stream = (get_endpoint(alts, 0)->bEndpointAddress & USB_DIR_IN) ?
1135*4882a593Smuzhiyun 			SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK;
1136*4882a593Smuzhiyun 		altno = altsd->bAlternateSetting;
1137*4882a593Smuzhiyun 
1138*4882a593Smuzhiyun 		if (snd_usb_apply_interface_quirk(chip, iface_no, altno))
1139*4882a593Smuzhiyun 			continue;
1140*4882a593Smuzhiyun 
1141*4882a593Smuzhiyun 		/*
1142*4882a593Smuzhiyun 		 * Roland audio streaming interfaces are marked with protocols
1143*4882a593Smuzhiyun 		 * 0/1/2, but are UAC 1 compatible.
1144*4882a593Smuzhiyun 		 */
1145*4882a593Smuzhiyun 		if (USB_ID_VENDOR(chip->usb_id) == 0x0582 &&
1146*4882a593Smuzhiyun 		    altsd->bInterfaceClass == USB_CLASS_VENDOR_SPEC &&
1147*4882a593Smuzhiyun 		    protocol <= 2)
1148*4882a593Smuzhiyun 			protocol = UAC_VERSION_1;
1149*4882a593Smuzhiyun 
1150*4882a593Smuzhiyun 		switch (protocol) {
1151*4882a593Smuzhiyun 		default:
1152*4882a593Smuzhiyun 			dev_dbg(&dev->dev, "%u:%d: unknown interface protocol %#02x, assuming v1\n",
1153*4882a593Smuzhiyun 				iface_no, altno, protocol);
1154*4882a593Smuzhiyun 			protocol = UAC_VERSION_1;
1155*4882a593Smuzhiyun 			fallthrough;
1156*4882a593Smuzhiyun 		case UAC_VERSION_1:
1157*4882a593Smuzhiyun 		case UAC_VERSION_2: {
1158*4882a593Smuzhiyun 			int bm_quirk = 0;
1159*4882a593Smuzhiyun 
1160*4882a593Smuzhiyun 			/*
1161*4882a593Smuzhiyun 			 * Blue Microphones workaround: The last altsetting is
1162*4882a593Smuzhiyun 			 * identical with the previous one, except for a larger
1163*4882a593Smuzhiyun 			 * packet size, but is actually a mislabeled two-channel
1164*4882a593Smuzhiyun 			 * setting; ignore it.
1165*4882a593Smuzhiyun 			 *
1166*4882a593Smuzhiyun 			 * Part 1: prepare quirk flag
1167*4882a593Smuzhiyun 			 */
1168*4882a593Smuzhiyun 			if (altno == 2 && num == 3 &&
1169*4882a593Smuzhiyun 			    fp && fp->altsetting == 1 && fp->channels == 1 &&
1170*4882a593Smuzhiyun 			    fp->formats == SNDRV_PCM_FMTBIT_S16_LE &&
1171*4882a593Smuzhiyun 			    protocol == UAC_VERSION_1 &&
1172*4882a593Smuzhiyun 			    le16_to_cpu(get_endpoint(alts, 0)->wMaxPacketSize) ==
1173*4882a593Smuzhiyun 							fp->maxpacksize * 2)
1174*4882a593Smuzhiyun 				bm_quirk = 1;
1175*4882a593Smuzhiyun 
1176*4882a593Smuzhiyun 			fp = snd_usb_get_audioformat_uac12(chip, alts, protocol,
1177*4882a593Smuzhiyun 							   iface_no, i, altno,
1178*4882a593Smuzhiyun 							   stream, bm_quirk);
1179*4882a593Smuzhiyun 			break;
1180*4882a593Smuzhiyun 		}
1181*4882a593Smuzhiyun 		case UAC_VERSION_3:
1182*4882a593Smuzhiyun 			fp = snd_usb_get_audioformat_uac3(chip, alts, &pd,
1183*4882a593Smuzhiyun 						iface_no, i, altno, stream);
1184*4882a593Smuzhiyun 			break;
1185*4882a593Smuzhiyun 		}
1186*4882a593Smuzhiyun 
1187*4882a593Smuzhiyun 		if (!fp)
1188*4882a593Smuzhiyun 			continue;
1189*4882a593Smuzhiyun 		else if (IS_ERR(fp))
1190*4882a593Smuzhiyun 			return PTR_ERR(fp);
1191*4882a593Smuzhiyun 
1192*4882a593Smuzhiyun 		if (fp->fmt_type != UAC_FORMAT_TYPE_I)
1193*4882a593Smuzhiyun 			*has_non_pcm = true;
1194*4882a593Smuzhiyun 		if ((fp->fmt_type == UAC_FORMAT_TYPE_I) == non_pcm) {
1195*4882a593Smuzhiyun 			audioformat_free(fp);
1196*4882a593Smuzhiyun 			kfree(pd);
1197*4882a593Smuzhiyun 			fp = NULL;
1198*4882a593Smuzhiyun 			pd = NULL;
1199*4882a593Smuzhiyun 			continue;
1200*4882a593Smuzhiyun 		}
1201*4882a593Smuzhiyun 
1202*4882a593Smuzhiyun 		dev_dbg(&dev->dev, "%u:%d: add audio endpoint %#x\n", iface_no, altno, fp->endpoint);
1203*4882a593Smuzhiyun 		if (protocol == UAC_VERSION_3)
1204*4882a593Smuzhiyun 			err = snd_usb_add_audio_stream_v3(chip, stream, fp, pd);
1205*4882a593Smuzhiyun 		else
1206*4882a593Smuzhiyun 			err = snd_usb_add_audio_stream(chip, stream, fp);
1207*4882a593Smuzhiyun 
1208*4882a593Smuzhiyun 		if (err < 0) {
1209*4882a593Smuzhiyun 			audioformat_free(fp);
1210*4882a593Smuzhiyun 			kfree(pd);
1211*4882a593Smuzhiyun 			return err;
1212*4882a593Smuzhiyun 		}
1213*4882a593Smuzhiyun 		/* try to set the interface... */
1214*4882a593Smuzhiyun 		usb_set_interface(chip->dev, iface_no, altno);
1215*4882a593Smuzhiyun 		snd_usb_init_pitch(chip, iface_no, alts, fp);
1216*4882a593Smuzhiyun 		snd_usb_init_sample_rate(chip, iface_no, alts, fp, fp->rate_max);
1217*4882a593Smuzhiyun 	}
1218*4882a593Smuzhiyun 	return 0;
1219*4882a593Smuzhiyun }
1220*4882a593Smuzhiyun 
snd_usb_parse_audio_interface(struct snd_usb_audio * chip,int iface_no)1221*4882a593Smuzhiyun int snd_usb_parse_audio_interface(struct snd_usb_audio *chip, int iface_no)
1222*4882a593Smuzhiyun {
1223*4882a593Smuzhiyun 	int err;
1224*4882a593Smuzhiyun 	bool has_non_pcm = false;
1225*4882a593Smuzhiyun 
1226*4882a593Smuzhiyun 	/* parse PCM formats */
1227*4882a593Smuzhiyun 	err = __snd_usb_parse_audio_interface(chip, iface_no, &has_non_pcm, false);
1228*4882a593Smuzhiyun 	if (err < 0)
1229*4882a593Smuzhiyun 		return err;
1230*4882a593Smuzhiyun 
1231*4882a593Smuzhiyun 	if (has_non_pcm) {
1232*4882a593Smuzhiyun 		/* parse non-PCM formats */
1233*4882a593Smuzhiyun 		err = __snd_usb_parse_audio_interface(chip, iface_no, &has_non_pcm, true);
1234*4882a593Smuzhiyun 		if (err < 0)
1235*4882a593Smuzhiyun 			return err;
1236*4882a593Smuzhiyun 	}
1237*4882a593Smuzhiyun 
1238*4882a593Smuzhiyun 	return 0;
1239*4882a593Smuzhiyun }
1240*4882a593Smuzhiyun 
1241