Linux Audio

Check our new training course

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