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