162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci */
462306a36Sopenharmony_ci
562306a36Sopenharmony_ci#include <linux/gfp.h>
662306a36Sopenharmony_ci#include <linux/init.h>
762306a36Sopenharmony_ci#include <linux/ratelimit.h>
862306a36Sopenharmony_ci#include <linux/usb.h>
962306a36Sopenharmony_ci#include <linux/usb/audio.h>
1062306a36Sopenharmony_ci#include <linux/slab.h>
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci#include <sound/core.h>
1362306a36Sopenharmony_ci#include <sound/pcm.h>
1462306a36Sopenharmony_ci#include <sound/pcm_params.h>
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ci#include "usbaudio.h"
1762306a36Sopenharmony_ci#include "helper.h"
1862306a36Sopenharmony_ci#include "card.h"
1962306a36Sopenharmony_ci#include "endpoint.h"
2062306a36Sopenharmony_ci#include "pcm.h"
2162306a36Sopenharmony_ci#include "clock.h"
2262306a36Sopenharmony_ci#include "quirks.h"
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_cienum {
2562306a36Sopenharmony_ci	EP_STATE_STOPPED,
2662306a36Sopenharmony_ci	EP_STATE_RUNNING,
2762306a36Sopenharmony_ci	EP_STATE_STOPPING,
2862306a36Sopenharmony_ci};
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_ci/* interface refcounting */
3162306a36Sopenharmony_cistruct snd_usb_iface_ref {
3262306a36Sopenharmony_ci	unsigned char iface;
3362306a36Sopenharmony_ci	bool need_setup;
3462306a36Sopenharmony_ci	int opened;
3562306a36Sopenharmony_ci	int altset;
3662306a36Sopenharmony_ci	struct list_head list;
3762306a36Sopenharmony_ci};
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci/* clock refcounting */
4062306a36Sopenharmony_cistruct snd_usb_clock_ref {
4162306a36Sopenharmony_ci	unsigned char clock;
4262306a36Sopenharmony_ci	atomic_t locked;
4362306a36Sopenharmony_ci	int opened;
4462306a36Sopenharmony_ci	int rate;
4562306a36Sopenharmony_ci	bool need_setup;
4662306a36Sopenharmony_ci	struct list_head list;
4762306a36Sopenharmony_ci};
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_ci/*
5062306a36Sopenharmony_ci * snd_usb_endpoint is a model that abstracts everything related to an
5162306a36Sopenharmony_ci * USB endpoint and its streaming.
5262306a36Sopenharmony_ci *
5362306a36Sopenharmony_ci * There are functions to activate and deactivate the streaming URBs and
5462306a36Sopenharmony_ci * optional callbacks to let the pcm logic handle the actual content of the
5562306a36Sopenharmony_ci * packets for playback and record. Thus, the bus streaming and the audio
5662306a36Sopenharmony_ci * handlers are fully decoupled.
5762306a36Sopenharmony_ci *
5862306a36Sopenharmony_ci * There are two different types of endpoints in audio applications.
5962306a36Sopenharmony_ci *
6062306a36Sopenharmony_ci * SND_USB_ENDPOINT_TYPE_DATA handles full audio data payload for both
6162306a36Sopenharmony_ci * inbound and outbound traffic.
6262306a36Sopenharmony_ci *
6362306a36Sopenharmony_ci * SND_USB_ENDPOINT_TYPE_SYNC endpoints are for inbound traffic only and
6462306a36Sopenharmony_ci * expect the payload to carry Q10.14 / Q16.16 formatted sync information
6562306a36Sopenharmony_ci * (3 or 4 bytes).
6662306a36Sopenharmony_ci *
6762306a36Sopenharmony_ci * Each endpoint has to be configured prior to being used by calling
6862306a36Sopenharmony_ci * snd_usb_endpoint_set_params().
6962306a36Sopenharmony_ci *
7062306a36Sopenharmony_ci * The model incorporates a reference counting, so that multiple users
7162306a36Sopenharmony_ci * can call snd_usb_endpoint_start() and snd_usb_endpoint_stop(), and
7262306a36Sopenharmony_ci * only the first user will effectively start the URBs, and only the last
7362306a36Sopenharmony_ci * one to stop it will tear the URBs down again.
7462306a36Sopenharmony_ci */
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci/*
7762306a36Sopenharmony_ci * convert a sampling rate into our full speed format (fs/1000 in Q16.16)
7862306a36Sopenharmony_ci * this will overflow at approx 524 kHz
7962306a36Sopenharmony_ci */
8062306a36Sopenharmony_cistatic inline unsigned get_usb_full_speed_rate(unsigned int rate)
8162306a36Sopenharmony_ci{
8262306a36Sopenharmony_ci	return ((rate << 13) + 62) / 125;
8362306a36Sopenharmony_ci}
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci/*
8662306a36Sopenharmony_ci * convert a sampling rate into USB high speed format (fs/8000 in Q16.16)
8762306a36Sopenharmony_ci * this will overflow at approx 4 MHz
8862306a36Sopenharmony_ci */
8962306a36Sopenharmony_cistatic inline unsigned get_usb_high_speed_rate(unsigned int rate)
9062306a36Sopenharmony_ci{
9162306a36Sopenharmony_ci	return ((rate << 10) + 62) / 125;
9262306a36Sopenharmony_ci}
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci/*
9562306a36Sopenharmony_ci * release a urb data
9662306a36Sopenharmony_ci */
9762306a36Sopenharmony_cistatic void release_urb_ctx(struct snd_urb_ctx *u)
9862306a36Sopenharmony_ci{
9962306a36Sopenharmony_ci	if (u->urb && u->buffer_size)
10062306a36Sopenharmony_ci		usb_free_coherent(u->ep->chip->dev, u->buffer_size,
10162306a36Sopenharmony_ci				  u->urb->transfer_buffer,
10262306a36Sopenharmony_ci				  u->urb->transfer_dma);
10362306a36Sopenharmony_ci	usb_free_urb(u->urb);
10462306a36Sopenharmony_ci	u->urb = NULL;
10562306a36Sopenharmony_ci	u->buffer_size = 0;
10662306a36Sopenharmony_ci}
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_cistatic const char *usb_error_string(int err)
10962306a36Sopenharmony_ci{
11062306a36Sopenharmony_ci	switch (err) {
11162306a36Sopenharmony_ci	case -ENODEV:
11262306a36Sopenharmony_ci		return "no device";
11362306a36Sopenharmony_ci	case -ENOENT:
11462306a36Sopenharmony_ci		return "endpoint not enabled";
11562306a36Sopenharmony_ci	case -EPIPE:
11662306a36Sopenharmony_ci		return "endpoint stalled";
11762306a36Sopenharmony_ci	case -ENOSPC:
11862306a36Sopenharmony_ci		return "not enough bandwidth";
11962306a36Sopenharmony_ci	case -ESHUTDOWN:
12062306a36Sopenharmony_ci		return "device disabled";
12162306a36Sopenharmony_ci	case -EHOSTUNREACH:
12262306a36Sopenharmony_ci		return "device suspended";
12362306a36Sopenharmony_ci	case -EINVAL:
12462306a36Sopenharmony_ci	case -EAGAIN:
12562306a36Sopenharmony_ci	case -EFBIG:
12662306a36Sopenharmony_ci	case -EMSGSIZE:
12762306a36Sopenharmony_ci		return "internal error";
12862306a36Sopenharmony_ci	default:
12962306a36Sopenharmony_ci		return "unknown error";
13062306a36Sopenharmony_ci	}
13162306a36Sopenharmony_ci}
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_cistatic inline bool ep_state_running(struct snd_usb_endpoint *ep)
13462306a36Sopenharmony_ci{
13562306a36Sopenharmony_ci	return atomic_read(&ep->state) == EP_STATE_RUNNING;
13662306a36Sopenharmony_ci}
13762306a36Sopenharmony_ci
13862306a36Sopenharmony_cistatic inline bool ep_state_update(struct snd_usb_endpoint *ep, int old, int new)
13962306a36Sopenharmony_ci{
14062306a36Sopenharmony_ci	return atomic_try_cmpxchg(&ep->state, &old, new);
14162306a36Sopenharmony_ci}
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci/**
14462306a36Sopenharmony_ci * snd_usb_endpoint_implicit_feedback_sink: Report endpoint usage type
14562306a36Sopenharmony_ci *
14662306a36Sopenharmony_ci * @ep: The snd_usb_endpoint
14762306a36Sopenharmony_ci *
14862306a36Sopenharmony_ci * Determine whether an endpoint is driven by an implicit feedback
14962306a36Sopenharmony_ci * data endpoint source.
15062306a36Sopenharmony_ci */
15162306a36Sopenharmony_ciint snd_usb_endpoint_implicit_feedback_sink(struct snd_usb_endpoint *ep)
15262306a36Sopenharmony_ci{
15362306a36Sopenharmony_ci	return  ep->implicit_fb_sync && usb_pipeout(ep->pipe);
15462306a36Sopenharmony_ci}
15562306a36Sopenharmony_ci
15662306a36Sopenharmony_ci/*
15762306a36Sopenharmony_ci * Return the number of samples to be sent in the next packet
15862306a36Sopenharmony_ci * for streaming based on information derived from sync endpoints
15962306a36Sopenharmony_ci *
16062306a36Sopenharmony_ci * This won't be used for implicit feedback which takes the packet size
16162306a36Sopenharmony_ci * returned from the sync source
16262306a36Sopenharmony_ci */
16362306a36Sopenharmony_cistatic int slave_next_packet_size(struct snd_usb_endpoint *ep,
16462306a36Sopenharmony_ci				  unsigned int avail)
16562306a36Sopenharmony_ci{
16662306a36Sopenharmony_ci	unsigned long flags;
16762306a36Sopenharmony_ci	unsigned int phase;
16862306a36Sopenharmony_ci	int ret;
16962306a36Sopenharmony_ci
17062306a36Sopenharmony_ci	if (ep->fill_max)
17162306a36Sopenharmony_ci		return ep->maxframesize;
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	spin_lock_irqsave(&ep->lock, flags);
17462306a36Sopenharmony_ci	phase = (ep->phase & 0xffff) + (ep->freqm << ep->datainterval);
17562306a36Sopenharmony_ci	ret = min(phase >> 16, ep->maxframesize);
17662306a36Sopenharmony_ci	if (avail && ret >= avail)
17762306a36Sopenharmony_ci		ret = -EAGAIN;
17862306a36Sopenharmony_ci	else
17962306a36Sopenharmony_ci		ep->phase = phase;
18062306a36Sopenharmony_ci	spin_unlock_irqrestore(&ep->lock, flags);
18162306a36Sopenharmony_ci
18262306a36Sopenharmony_ci	return ret;
18362306a36Sopenharmony_ci}
18462306a36Sopenharmony_ci
18562306a36Sopenharmony_ci/*
18662306a36Sopenharmony_ci * Return the number of samples to be sent in the next packet
18762306a36Sopenharmony_ci * for adaptive and synchronous endpoints
18862306a36Sopenharmony_ci */
18962306a36Sopenharmony_cistatic int next_packet_size(struct snd_usb_endpoint *ep, unsigned int avail)
19062306a36Sopenharmony_ci{
19162306a36Sopenharmony_ci	unsigned int sample_accum;
19262306a36Sopenharmony_ci	int ret;
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci	if (ep->fill_max)
19562306a36Sopenharmony_ci		return ep->maxframesize;
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci	sample_accum = ep->sample_accum + ep->sample_rem;
19862306a36Sopenharmony_ci	if (sample_accum >= ep->pps) {
19962306a36Sopenharmony_ci		sample_accum -= ep->pps;
20062306a36Sopenharmony_ci		ret = ep->packsize[1];
20162306a36Sopenharmony_ci	} else {
20262306a36Sopenharmony_ci		ret = ep->packsize[0];
20362306a36Sopenharmony_ci	}
20462306a36Sopenharmony_ci	if (avail && ret >= avail)
20562306a36Sopenharmony_ci		ret = -EAGAIN;
20662306a36Sopenharmony_ci	else
20762306a36Sopenharmony_ci		ep->sample_accum = sample_accum;
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ci	return ret;
21062306a36Sopenharmony_ci}
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci/*
21362306a36Sopenharmony_ci * snd_usb_endpoint_next_packet_size: Return the number of samples to be sent
21462306a36Sopenharmony_ci * in the next packet
21562306a36Sopenharmony_ci *
21662306a36Sopenharmony_ci * If the size is equal or exceeds @avail, don't proceed but return -EAGAIN
21762306a36Sopenharmony_ci * Exception: @avail = 0 for skipping the check.
21862306a36Sopenharmony_ci */
21962306a36Sopenharmony_ciint snd_usb_endpoint_next_packet_size(struct snd_usb_endpoint *ep,
22062306a36Sopenharmony_ci				      struct snd_urb_ctx *ctx, int idx,
22162306a36Sopenharmony_ci				      unsigned int avail)
22262306a36Sopenharmony_ci{
22362306a36Sopenharmony_ci	unsigned int packet;
22462306a36Sopenharmony_ci
22562306a36Sopenharmony_ci	packet = ctx->packet_size[idx];
22662306a36Sopenharmony_ci	if (packet) {
22762306a36Sopenharmony_ci		if (avail && packet >= avail)
22862306a36Sopenharmony_ci			return -EAGAIN;
22962306a36Sopenharmony_ci		return packet;
23062306a36Sopenharmony_ci	}
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	if (ep->sync_source)
23362306a36Sopenharmony_ci		return slave_next_packet_size(ep, avail);
23462306a36Sopenharmony_ci	else
23562306a36Sopenharmony_ci		return next_packet_size(ep, avail);
23662306a36Sopenharmony_ci}
23762306a36Sopenharmony_ci
23862306a36Sopenharmony_cistatic void call_retire_callback(struct snd_usb_endpoint *ep,
23962306a36Sopenharmony_ci				 struct urb *urb)
24062306a36Sopenharmony_ci{
24162306a36Sopenharmony_ci	struct snd_usb_substream *data_subs;
24262306a36Sopenharmony_ci
24362306a36Sopenharmony_ci	data_subs = READ_ONCE(ep->data_subs);
24462306a36Sopenharmony_ci	if (data_subs && ep->retire_data_urb)
24562306a36Sopenharmony_ci		ep->retire_data_urb(data_subs, urb);
24662306a36Sopenharmony_ci}
24762306a36Sopenharmony_ci
24862306a36Sopenharmony_cistatic void retire_outbound_urb(struct snd_usb_endpoint *ep,
24962306a36Sopenharmony_ci				struct snd_urb_ctx *urb_ctx)
25062306a36Sopenharmony_ci{
25162306a36Sopenharmony_ci	call_retire_callback(ep, urb_ctx->urb);
25262306a36Sopenharmony_ci}
25362306a36Sopenharmony_ci
25462306a36Sopenharmony_cistatic void snd_usb_handle_sync_urb(struct snd_usb_endpoint *ep,
25562306a36Sopenharmony_ci				    struct snd_usb_endpoint *sender,
25662306a36Sopenharmony_ci				    const struct urb *urb);
25762306a36Sopenharmony_ci
25862306a36Sopenharmony_cistatic void retire_inbound_urb(struct snd_usb_endpoint *ep,
25962306a36Sopenharmony_ci			       struct snd_urb_ctx *urb_ctx)
26062306a36Sopenharmony_ci{
26162306a36Sopenharmony_ci	struct urb *urb = urb_ctx->urb;
26262306a36Sopenharmony_ci	struct snd_usb_endpoint *sync_sink;
26362306a36Sopenharmony_ci
26462306a36Sopenharmony_ci	if (unlikely(ep->skip_packets > 0)) {
26562306a36Sopenharmony_ci		ep->skip_packets--;
26662306a36Sopenharmony_ci		return;
26762306a36Sopenharmony_ci	}
26862306a36Sopenharmony_ci
26962306a36Sopenharmony_ci	sync_sink = READ_ONCE(ep->sync_sink);
27062306a36Sopenharmony_ci	if (sync_sink)
27162306a36Sopenharmony_ci		snd_usb_handle_sync_urb(sync_sink, ep, urb);
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_ci	call_retire_callback(ep, urb);
27462306a36Sopenharmony_ci}
27562306a36Sopenharmony_ci
27662306a36Sopenharmony_cistatic inline bool has_tx_length_quirk(struct snd_usb_audio *chip)
27762306a36Sopenharmony_ci{
27862306a36Sopenharmony_ci	return chip->quirk_flags & QUIRK_FLAG_TX_LENGTH;
27962306a36Sopenharmony_ci}
28062306a36Sopenharmony_ci
28162306a36Sopenharmony_cistatic void prepare_silent_urb(struct snd_usb_endpoint *ep,
28262306a36Sopenharmony_ci			       struct snd_urb_ctx *ctx)
28362306a36Sopenharmony_ci{
28462306a36Sopenharmony_ci	struct urb *urb = ctx->urb;
28562306a36Sopenharmony_ci	unsigned int offs = 0;
28662306a36Sopenharmony_ci	unsigned int extra = 0;
28762306a36Sopenharmony_ci	__le32 packet_length;
28862306a36Sopenharmony_ci	int i;
28962306a36Sopenharmony_ci
29062306a36Sopenharmony_ci	/* For tx_length_quirk, put packet length at start of packet */
29162306a36Sopenharmony_ci	if (has_tx_length_quirk(ep->chip))
29262306a36Sopenharmony_ci		extra = sizeof(packet_length);
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci	for (i = 0; i < ctx->packets; ++i) {
29562306a36Sopenharmony_ci		unsigned int offset;
29662306a36Sopenharmony_ci		unsigned int length;
29762306a36Sopenharmony_ci		int counts;
29862306a36Sopenharmony_ci
29962306a36Sopenharmony_ci		counts = snd_usb_endpoint_next_packet_size(ep, ctx, i, 0);
30062306a36Sopenharmony_ci		length = counts * ep->stride; /* number of silent bytes */
30162306a36Sopenharmony_ci		offset = offs * ep->stride + extra * i;
30262306a36Sopenharmony_ci		urb->iso_frame_desc[i].offset = offset;
30362306a36Sopenharmony_ci		urb->iso_frame_desc[i].length = length + extra;
30462306a36Sopenharmony_ci		if (extra) {
30562306a36Sopenharmony_ci			packet_length = cpu_to_le32(length);
30662306a36Sopenharmony_ci			memcpy(urb->transfer_buffer + offset,
30762306a36Sopenharmony_ci			       &packet_length, sizeof(packet_length));
30862306a36Sopenharmony_ci		}
30962306a36Sopenharmony_ci		memset(urb->transfer_buffer + offset + extra,
31062306a36Sopenharmony_ci		       ep->silence_value, length);
31162306a36Sopenharmony_ci		offs += counts;
31262306a36Sopenharmony_ci	}
31362306a36Sopenharmony_ci
31462306a36Sopenharmony_ci	urb->number_of_packets = ctx->packets;
31562306a36Sopenharmony_ci	urb->transfer_buffer_length = offs * ep->stride + ctx->packets * extra;
31662306a36Sopenharmony_ci	ctx->queued = 0;
31762306a36Sopenharmony_ci}
31862306a36Sopenharmony_ci
31962306a36Sopenharmony_ci/*
32062306a36Sopenharmony_ci * Prepare a PLAYBACK urb for submission to the bus.
32162306a36Sopenharmony_ci */
32262306a36Sopenharmony_cistatic int prepare_outbound_urb(struct snd_usb_endpoint *ep,
32362306a36Sopenharmony_ci				struct snd_urb_ctx *ctx,
32462306a36Sopenharmony_ci				bool in_stream_lock)
32562306a36Sopenharmony_ci{
32662306a36Sopenharmony_ci	struct urb *urb = ctx->urb;
32762306a36Sopenharmony_ci	unsigned char *cp = urb->transfer_buffer;
32862306a36Sopenharmony_ci	struct snd_usb_substream *data_subs;
32962306a36Sopenharmony_ci
33062306a36Sopenharmony_ci	urb->dev = ep->chip->dev; /* we need to set this at each time */
33162306a36Sopenharmony_ci
33262306a36Sopenharmony_ci	switch (ep->type) {
33362306a36Sopenharmony_ci	case SND_USB_ENDPOINT_TYPE_DATA:
33462306a36Sopenharmony_ci		data_subs = READ_ONCE(ep->data_subs);
33562306a36Sopenharmony_ci		if (data_subs && ep->prepare_data_urb)
33662306a36Sopenharmony_ci			return ep->prepare_data_urb(data_subs, urb, in_stream_lock);
33762306a36Sopenharmony_ci		/* no data provider, so send silence */
33862306a36Sopenharmony_ci		prepare_silent_urb(ep, ctx);
33962306a36Sopenharmony_ci		break;
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_ci	case SND_USB_ENDPOINT_TYPE_SYNC:
34262306a36Sopenharmony_ci		if (snd_usb_get_speed(ep->chip->dev) >= USB_SPEED_HIGH) {
34362306a36Sopenharmony_ci			/*
34462306a36Sopenharmony_ci			 * fill the length and offset of each urb descriptor.
34562306a36Sopenharmony_ci			 * the fixed 12.13 frequency is passed as 16.16 through the pipe.
34662306a36Sopenharmony_ci			 */
34762306a36Sopenharmony_ci			urb->iso_frame_desc[0].length = 4;
34862306a36Sopenharmony_ci			urb->iso_frame_desc[0].offset = 0;
34962306a36Sopenharmony_ci			cp[0] = ep->freqn;
35062306a36Sopenharmony_ci			cp[1] = ep->freqn >> 8;
35162306a36Sopenharmony_ci			cp[2] = ep->freqn >> 16;
35262306a36Sopenharmony_ci			cp[3] = ep->freqn >> 24;
35362306a36Sopenharmony_ci		} else {
35462306a36Sopenharmony_ci			/*
35562306a36Sopenharmony_ci			 * fill the length and offset of each urb descriptor.
35662306a36Sopenharmony_ci			 * the fixed 10.14 frequency is passed through the pipe.
35762306a36Sopenharmony_ci			 */
35862306a36Sopenharmony_ci			urb->iso_frame_desc[0].length = 3;
35962306a36Sopenharmony_ci			urb->iso_frame_desc[0].offset = 0;
36062306a36Sopenharmony_ci			cp[0] = ep->freqn >> 2;
36162306a36Sopenharmony_ci			cp[1] = ep->freqn >> 10;
36262306a36Sopenharmony_ci			cp[2] = ep->freqn >> 18;
36362306a36Sopenharmony_ci		}
36462306a36Sopenharmony_ci
36562306a36Sopenharmony_ci		break;
36662306a36Sopenharmony_ci	}
36762306a36Sopenharmony_ci	return 0;
36862306a36Sopenharmony_ci}
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_ci/*
37162306a36Sopenharmony_ci * Prepare a CAPTURE or SYNC urb for submission to the bus.
37262306a36Sopenharmony_ci */
37362306a36Sopenharmony_cistatic int prepare_inbound_urb(struct snd_usb_endpoint *ep,
37462306a36Sopenharmony_ci			       struct snd_urb_ctx *urb_ctx)
37562306a36Sopenharmony_ci{
37662306a36Sopenharmony_ci	int i, offs;
37762306a36Sopenharmony_ci	struct urb *urb = urb_ctx->urb;
37862306a36Sopenharmony_ci
37962306a36Sopenharmony_ci	urb->dev = ep->chip->dev; /* we need to set this at each time */
38062306a36Sopenharmony_ci
38162306a36Sopenharmony_ci	switch (ep->type) {
38262306a36Sopenharmony_ci	case SND_USB_ENDPOINT_TYPE_DATA:
38362306a36Sopenharmony_ci		offs = 0;
38462306a36Sopenharmony_ci		for (i = 0; i < urb_ctx->packets; i++) {
38562306a36Sopenharmony_ci			urb->iso_frame_desc[i].offset = offs;
38662306a36Sopenharmony_ci			urb->iso_frame_desc[i].length = ep->curpacksize;
38762306a36Sopenharmony_ci			offs += ep->curpacksize;
38862306a36Sopenharmony_ci		}
38962306a36Sopenharmony_ci
39062306a36Sopenharmony_ci		urb->transfer_buffer_length = offs;
39162306a36Sopenharmony_ci		urb->number_of_packets = urb_ctx->packets;
39262306a36Sopenharmony_ci		break;
39362306a36Sopenharmony_ci
39462306a36Sopenharmony_ci	case SND_USB_ENDPOINT_TYPE_SYNC:
39562306a36Sopenharmony_ci		urb->iso_frame_desc[0].length = min(4u, ep->syncmaxsize);
39662306a36Sopenharmony_ci		urb->iso_frame_desc[0].offset = 0;
39762306a36Sopenharmony_ci		break;
39862306a36Sopenharmony_ci	}
39962306a36Sopenharmony_ci	return 0;
40062306a36Sopenharmony_ci}
40162306a36Sopenharmony_ci
40262306a36Sopenharmony_ci/* notify an error as XRUN to the assigned PCM data substream */
40362306a36Sopenharmony_cistatic void notify_xrun(struct snd_usb_endpoint *ep)
40462306a36Sopenharmony_ci{
40562306a36Sopenharmony_ci	struct snd_usb_substream *data_subs;
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_ci	data_subs = READ_ONCE(ep->data_subs);
40862306a36Sopenharmony_ci	if (data_subs && data_subs->pcm_substream)
40962306a36Sopenharmony_ci		snd_pcm_stop_xrun(data_subs->pcm_substream);
41062306a36Sopenharmony_ci}
41162306a36Sopenharmony_ci
41262306a36Sopenharmony_cistatic struct snd_usb_packet_info *
41362306a36Sopenharmony_cinext_packet_fifo_enqueue(struct snd_usb_endpoint *ep)
41462306a36Sopenharmony_ci{
41562306a36Sopenharmony_ci	struct snd_usb_packet_info *p;
41662306a36Sopenharmony_ci
41762306a36Sopenharmony_ci	p = ep->next_packet + (ep->next_packet_head + ep->next_packet_queued) %
41862306a36Sopenharmony_ci		ARRAY_SIZE(ep->next_packet);
41962306a36Sopenharmony_ci	ep->next_packet_queued++;
42062306a36Sopenharmony_ci	return p;
42162306a36Sopenharmony_ci}
42262306a36Sopenharmony_ci
42362306a36Sopenharmony_cistatic struct snd_usb_packet_info *
42462306a36Sopenharmony_cinext_packet_fifo_dequeue(struct snd_usb_endpoint *ep)
42562306a36Sopenharmony_ci{
42662306a36Sopenharmony_ci	struct snd_usb_packet_info *p;
42762306a36Sopenharmony_ci
42862306a36Sopenharmony_ci	p = ep->next_packet + ep->next_packet_head;
42962306a36Sopenharmony_ci	ep->next_packet_head++;
43062306a36Sopenharmony_ci	ep->next_packet_head %= ARRAY_SIZE(ep->next_packet);
43162306a36Sopenharmony_ci	ep->next_packet_queued--;
43262306a36Sopenharmony_ci	return p;
43362306a36Sopenharmony_ci}
43462306a36Sopenharmony_ci
43562306a36Sopenharmony_cistatic void push_back_to_ready_list(struct snd_usb_endpoint *ep,
43662306a36Sopenharmony_ci				    struct snd_urb_ctx *ctx)
43762306a36Sopenharmony_ci{
43862306a36Sopenharmony_ci	unsigned long flags;
43962306a36Sopenharmony_ci
44062306a36Sopenharmony_ci	spin_lock_irqsave(&ep->lock, flags);
44162306a36Sopenharmony_ci	list_add_tail(&ctx->ready_list, &ep->ready_playback_urbs);
44262306a36Sopenharmony_ci	spin_unlock_irqrestore(&ep->lock, flags);
44362306a36Sopenharmony_ci}
44462306a36Sopenharmony_ci
44562306a36Sopenharmony_ci/*
44662306a36Sopenharmony_ci * Send output urbs that have been prepared previously. URBs are dequeued
44762306a36Sopenharmony_ci * from ep->ready_playback_urbs and in case there aren't any available
44862306a36Sopenharmony_ci * or there are no packets that have been prepared, this function does
44962306a36Sopenharmony_ci * nothing.
45062306a36Sopenharmony_ci *
45162306a36Sopenharmony_ci * The reason why the functionality of sending and preparing URBs is separated
45262306a36Sopenharmony_ci * is that host controllers don't guarantee the order in which they return
45362306a36Sopenharmony_ci * inbound and outbound packets to their submitters.
45462306a36Sopenharmony_ci *
45562306a36Sopenharmony_ci * This function is used both for implicit feedback endpoints and in low-
45662306a36Sopenharmony_ci * latency playback mode.
45762306a36Sopenharmony_ci */
45862306a36Sopenharmony_ciint snd_usb_queue_pending_output_urbs(struct snd_usb_endpoint *ep,
45962306a36Sopenharmony_ci				      bool in_stream_lock)
46062306a36Sopenharmony_ci{
46162306a36Sopenharmony_ci	bool implicit_fb = snd_usb_endpoint_implicit_feedback_sink(ep);
46262306a36Sopenharmony_ci
46362306a36Sopenharmony_ci	while (ep_state_running(ep)) {
46462306a36Sopenharmony_ci
46562306a36Sopenharmony_ci		unsigned long flags;
46662306a36Sopenharmony_ci		struct snd_usb_packet_info *packet;
46762306a36Sopenharmony_ci		struct snd_urb_ctx *ctx = NULL;
46862306a36Sopenharmony_ci		int err, i;
46962306a36Sopenharmony_ci
47062306a36Sopenharmony_ci		spin_lock_irqsave(&ep->lock, flags);
47162306a36Sopenharmony_ci		if ((!implicit_fb || ep->next_packet_queued > 0) &&
47262306a36Sopenharmony_ci		    !list_empty(&ep->ready_playback_urbs)) {
47362306a36Sopenharmony_ci			/* take URB out of FIFO */
47462306a36Sopenharmony_ci			ctx = list_first_entry(&ep->ready_playback_urbs,
47562306a36Sopenharmony_ci					       struct snd_urb_ctx, ready_list);
47662306a36Sopenharmony_ci			list_del_init(&ctx->ready_list);
47762306a36Sopenharmony_ci			if (implicit_fb)
47862306a36Sopenharmony_ci				packet = next_packet_fifo_dequeue(ep);
47962306a36Sopenharmony_ci		}
48062306a36Sopenharmony_ci		spin_unlock_irqrestore(&ep->lock, flags);
48162306a36Sopenharmony_ci
48262306a36Sopenharmony_ci		if (ctx == NULL)
48362306a36Sopenharmony_ci			break;
48462306a36Sopenharmony_ci
48562306a36Sopenharmony_ci		/* copy over the length information */
48662306a36Sopenharmony_ci		if (implicit_fb) {
48762306a36Sopenharmony_ci			for (i = 0; i < packet->packets; i++)
48862306a36Sopenharmony_ci				ctx->packet_size[i] = packet->packet_size[i];
48962306a36Sopenharmony_ci		}
49062306a36Sopenharmony_ci
49162306a36Sopenharmony_ci		/* call the data handler to fill in playback data */
49262306a36Sopenharmony_ci		err = prepare_outbound_urb(ep, ctx, in_stream_lock);
49362306a36Sopenharmony_ci		/* can be stopped during prepare callback */
49462306a36Sopenharmony_ci		if (unlikely(!ep_state_running(ep)))
49562306a36Sopenharmony_ci			break;
49662306a36Sopenharmony_ci		if (err < 0) {
49762306a36Sopenharmony_ci			/* push back to ready list again for -EAGAIN */
49862306a36Sopenharmony_ci			if (err == -EAGAIN) {
49962306a36Sopenharmony_ci				push_back_to_ready_list(ep, ctx);
50062306a36Sopenharmony_ci				break;
50162306a36Sopenharmony_ci			}
50262306a36Sopenharmony_ci
50362306a36Sopenharmony_ci			if (!in_stream_lock)
50462306a36Sopenharmony_ci				notify_xrun(ep);
50562306a36Sopenharmony_ci			return -EPIPE;
50662306a36Sopenharmony_ci		}
50762306a36Sopenharmony_ci
50862306a36Sopenharmony_ci		if (!atomic_read(&ep->chip->shutdown))
50962306a36Sopenharmony_ci			err = usb_submit_urb(ctx->urb, GFP_ATOMIC);
51062306a36Sopenharmony_ci		else
51162306a36Sopenharmony_ci			err = -ENODEV;
51262306a36Sopenharmony_ci		if (err < 0) {
51362306a36Sopenharmony_ci			if (!atomic_read(&ep->chip->shutdown)) {
51462306a36Sopenharmony_ci				usb_audio_err(ep->chip,
51562306a36Sopenharmony_ci					      "Unable to submit urb #%d: %d at %s\n",
51662306a36Sopenharmony_ci					      ctx->index, err, __func__);
51762306a36Sopenharmony_ci				if (!in_stream_lock)
51862306a36Sopenharmony_ci					notify_xrun(ep);
51962306a36Sopenharmony_ci			}
52062306a36Sopenharmony_ci			return -EPIPE;
52162306a36Sopenharmony_ci		}
52262306a36Sopenharmony_ci
52362306a36Sopenharmony_ci		set_bit(ctx->index, &ep->active_mask);
52462306a36Sopenharmony_ci		atomic_inc(&ep->submitted_urbs);
52562306a36Sopenharmony_ci	}
52662306a36Sopenharmony_ci
52762306a36Sopenharmony_ci	return 0;
52862306a36Sopenharmony_ci}
52962306a36Sopenharmony_ci
53062306a36Sopenharmony_ci/*
53162306a36Sopenharmony_ci * complete callback for urbs
53262306a36Sopenharmony_ci */
53362306a36Sopenharmony_cistatic void snd_complete_urb(struct urb *urb)
53462306a36Sopenharmony_ci{
53562306a36Sopenharmony_ci	struct snd_urb_ctx *ctx = urb->context;
53662306a36Sopenharmony_ci	struct snd_usb_endpoint *ep = ctx->ep;
53762306a36Sopenharmony_ci	int err;
53862306a36Sopenharmony_ci
53962306a36Sopenharmony_ci	if (unlikely(urb->status == -ENOENT ||		/* unlinked */
54062306a36Sopenharmony_ci		     urb->status == -ENODEV ||		/* device removed */
54162306a36Sopenharmony_ci		     urb->status == -ECONNRESET ||	/* unlinked */
54262306a36Sopenharmony_ci		     urb->status == -ESHUTDOWN))	/* device disabled */
54362306a36Sopenharmony_ci		goto exit_clear;
54462306a36Sopenharmony_ci	/* device disconnected */
54562306a36Sopenharmony_ci	if (unlikely(atomic_read(&ep->chip->shutdown)))
54662306a36Sopenharmony_ci		goto exit_clear;
54762306a36Sopenharmony_ci
54862306a36Sopenharmony_ci	if (unlikely(!ep_state_running(ep)))
54962306a36Sopenharmony_ci		goto exit_clear;
55062306a36Sopenharmony_ci
55162306a36Sopenharmony_ci	if (usb_pipeout(ep->pipe)) {
55262306a36Sopenharmony_ci		retire_outbound_urb(ep, ctx);
55362306a36Sopenharmony_ci		/* can be stopped during retire callback */
55462306a36Sopenharmony_ci		if (unlikely(!ep_state_running(ep)))
55562306a36Sopenharmony_ci			goto exit_clear;
55662306a36Sopenharmony_ci
55762306a36Sopenharmony_ci		/* in low-latency and implicit-feedback modes, push back the
55862306a36Sopenharmony_ci		 * URB to ready list at first, then process as much as possible
55962306a36Sopenharmony_ci		 */
56062306a36Sopenharmony_ci		if (ep->lowlatency_playback ||
56162306a36Sopenharmony_ci		     snd_usb_endpoint_implicit_feedback_sink(ep)) {
56262306a36Sopenharmony_ci			push_back_to_ready_list(ep, ctx);
56362306a36Sopenharmony_ci			clear_bit(ctx->index, &ep->active_mask);
56462306a36Sopenharmony_ci			snd_usb_queue_pending_output_urbs(ep, false);
56562306a36Sopenharmony_ci			atomic_dec(&ep->submitted_urbs); /* decrement at last */
56662306a36Sopenharmony_ci			return;
56762306a36Sopenharmony_ci		}
56862306a36Sopenharmony_ci
56962306a36Sopenharmony_ci		/* in non-lowlatency mode, no error handling for prepare */
57062306a36Sopenharmony_ci		prepare_outbound_urb(ep, ctx, false);
57162306a36Sopenharmony_ci		/* can be stopped during prepare callback */
57262306a36Sopenharmony_ci		if (unlikely(!ep_state_running(ep)))
57362306a36Sopenharmony_ci			goto exit_clear;
57462306a36Sopenharmony_ci	} else {
57562306a36Sopenharmony_ci		retire_inbound_urb(ep, ctx);
57662306a36Sopenharmony_ci		/* can be stopped during retire callback */
57762306a36Sopenharmony_ci		if (unlikely(!ep_state_running(ep)))
57862306a36Sopenharmony_ci			goto exit_clear;
57962306a36Sopenharmony_ci
58062306a36Sopenharmony_ci		prepare_inbound_urb(ep, ctx);
58162306a36Sopenharmony_ci	}
58262306a36Sopenharmony_ci
58362306a36Sopenharmony_ci	if (!atomic_read(&ep->chip->shutdown))
58462306a36Sopenharmony_ci		err = usb_submit_urb(urb, GFP_ATOMIC);
58562306a36Sopenharmony_ci	else
58662306a36Sopenharmony_ci		err = -ENODEV;
58762306a36Sopenharmony_ci	if (err == 0)
58862306a36Sopenharmony_ci		return;
58962306a36Sopenharmony_ci
59062306a36Sopenharmony_ci	if (!atomic_read(&ep->chip->shutdown)) {
59162306a36Sopenharmony_ci		usb_audio_err(ep->chip, "cannot submit urb (err = %d)\n", err);
59262306a36Sopenharmony_ci		notify_xrun(ep);
59362306a36Sopenharmony_ci	}
59462306a36Sopenharmony_ci
59562306a36Sopenharmony_ciexit_clear:
59662306a36Sopenharmony_ci	clear_bit(ctx->index, &ep->active_mask);
59762306a36Sopenharmony_ci	atomic_dec(&ep->submitted_urbs);
59862306a36Sopenharmony_ci}
59962306a36Sopenharmony_ci
60062306a36Sopenharmony_ci/*
60162306a36Sopenharmony_ci * Find or create a refcount object for the given interface
60262306a36Sopenharmony_ci *
60362306a36Sopenharmony_ci * The objects are released altogether in snd_usb_endpoint_free_all()
60462306a36Sopenharmony_ci */
60562306a36Sopenharmony_cistatic struct snd_usb_iface_ref *
60662306a36Sopenharmony_ciiface_ref_find(struct snd_usb_audio *chip, int iface)
60762306a36Sopenharmony_ci{
60862306a36Sopenharmony_ci	struct snd_usb_iface_ref *ip;
60962306a36Sopenharmony_ci
61062306a36Sopenharmony_ci	list_for_each_entry(ip, &chip->iface_ref_list, list)
61162306a36Sopenharmony_ci		if (ip->iface == iface)
61262306a36Sopenharmony_ci			return ip;
61362306a36Sopenharmony_ci
61462306a36Sopenharmony_ci	ip = kzalloc(sizeof(*ip), GFP_KERNEL);
61562306a36Sopenharmony_ci	if (!ip)
61662306a36Sopenharmony_ci		return NULL;
61762306a36Sopenharmony_ci	ip->iface = iface;
61862306a36Sopenharmony_ci	list_add_tail(&ip->list, &chip->iface_ref_list);
61962306a36Sopenharmony_ci	return ip;
62062306a36Sopenharmony_ci}
62162306a36Sopenharmony_ci
62262306a36Sopenharmony_ci/* Similarly, a refcount object for clock */
62362306a36Sopenharmony_cistatic struct snd_usb_clock_ref *
62462306a36Sopenharmony_ciclock_ref_find(struct snd_usb_audio *chip, int clock)
62562306a36Sopenharmony_ci{
62662306a36Sopenharmony_ci	struct snd_usb_clock_ref *ref;
62762306a36Sopenharmony_ci
62862306a36Sopenharmony_ci	list_for_each_entry(ref, &chip->clock_ref_list, list)
62962306a36Sopenharmony_ci		if (ref->clock == clock)
63062306a36Sopenharmony_ci			return ref;
63162306a36Sopenharmony_ci
63262306a36Sopenharmony_ci	ref = kzalloc(sizeof(*ref), GFP_KERNEL);
63362306a36Sopenharmony_ci	if (!ref)
63462306a36Sopenharmony_ci		return NULL;
63562306a36Sopenharmony_ci	ref->clock = clock;
63662306a36Sopenharmony_ci	atomic_set(&ref->locked, 0);
63762306a36Sopenharmony_ci	list_add_tail(&ref->list, &chip->clock_ref_list);
63862306a36Sopenharmony_ci	return ref;
63962306a36Sopenharmony_ci}
64062306a36Sopenharmony_ci
64162306a36Sopenharmony_ci/*
64262306a36Sopenharmony_ci * Get the existing endpoint object corresponding EP
64362306a36Sopenharmony_ci * Returns NULL if not present.
64462306a36Sopenharmony_ci */
64562306a36Sopenharmony_cistruct snd_usb_endpoint *
64662306a36Sopenharmony_cisnd_usb_get_endpoint(struct snd_usb_audio *chip, int ep_num)
64762306a36Sopenharmony_ci{
64862306a36Sopenharmony_ci	struct snd_usb_endpoint *ep;
64962306a36Sopenharmony_ci
65062306a36Sopenharmony_ci	list_for_each_entry(ep, &chip->ep_list, list) {
65162306a36Sopenharmony_ci		if (ep->ep_num == ep_num)
65262306a36Sopenharmony_ci			return ep;
65362306a36Sopenharmony_ci	}
65462306a36Sopenharmony_ci
65562306a36Sopenharmony_ci	return NULL;
65662306a36Sopenharmony_ci}
65762306a36Sopenharmony_ci
65862306a36Sopenharmony_ci#define ep_type_name(type) \
65962306a36Sopenharmony_ci	(type == SND_USB_ENDPOINT_TYPE_DATA ? "data" : "sync")
66062306a36Sopenharmony_ci
66162306a36Sopenharmony_ci/**
66262306a36Sopenharmony_ci * snd_usb_add_endpoint: Add an endpoint to an USB audio chip
66362306a36Sopenharmony_ci *
66462306a36Sopenharmony_ci * @chip: The chip
66562306a36Sopenharmony_ci * @ep_num: The number of the endpoint to use
66662306a36Sopenharmony_ci * @type: SND_USB_ENDPOINT_TYPE_DATA or SND_USB_ENDPOINT_TYPE_SYNC
66762306a36Sopenharmony_ci *
66862306a36Sopenharmony_ci * If the requested endpoint has not been added to the given chip before,
66962306a36Sopenharmony_ci * a new instance is created.
67062306a36Sopenharmony_ci *
67162306a36Sopenharmony_ci * Returns zero on success or a negative error code.
67262306a36Sopenharmony_ci *
67362306a36Sopenharmony_ci * New endpoints will be added to chip->ep_list and freed by
67462306a36Sopenharmony_ci * calling snd_usb_endpoint_free_all().
67562306a36Sopenharmony_ci *
67662306a36Sopenharmony_ci * For SND_USB_ENDPOINT_TYPE_SYNC, the caller needs to guarantee that
67762306a36Sopenharmony_ci * bNumEndpoints > 1 beforehand.
67862306a36Sopenharmony_ci */
67962306a36Sopenharmony_ciint snd_usb_add_endpoint(struct snd_usb_audio *chip, int ep_num, int type)
68062306a36Sopenharmony_ci{
68162306a36Sopenharmony_ci	struct snd_usb_endpoint *ep;
68262306a36Sopenharmony_ci	bool is_playback;
68362306a36Sopenharmony_ci
68462306a36Sopenharmony_ci	ep = snd_usb_get_endpoint(chip, ep_num);
68562306a36Sopenharmony_ci	if (ep)
68662306a36Sopenharmony_ci		return 0;
68762306a36Sopenharmony_ci
68862306a36Sopenharmony_ci	usb_audio_dbg(chip, "Creating new %s endpoint #%x\n",
68962306a36Sopenharmony_ci		      ep_type_name(type),
69062306a36Sopenharmony_ci		      ep_num);
69162306a36Sopenharmony_ci	ep = kzalloc(sizeof(*ep), GFP_KERNEL);
69262306a36Sopenharmony_ci	if (!ep)
69362306a36Sopenharmony_ci		return -ENOMEM;
69462306a36Sopenharmony_ci
69562306a36Sopenharmony_ci	ep->chip = chip;
69662306a36Sopenharmony_ci	spin_lock_init(&ep->lock);
69762306a36Sopenharmony_ci	ep->type = type;
69862306a36Sopenharmony_ci	ep->ep_num = ep_num;
69962306a36Sopenharmony_ci	INIT_LIST_HEAD(&ep->ready_playback_urbs);
70062306a36Sopenharmony_ci	atomic_set(&ep->submitted_urbs, 0);
70162306a36Sopenharmony_ci
70262306a36Sopenharmony_ci	is_playback = ((ep_num & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT);
70362306a36Sopenharmony_ci	ep_num &= USB_ENDPOINT_NUMBER_MASK;
70462306a36Sopenharmony_ci	if (is_playback)
70562306a36Sopenharmony_ci		ep->pipe = usb_sndisocpipe(chip->dev, ep_num);
70662306a36Sopenharmony_ci	else
70762306a36Sopenharmony_ci		ep->pipe = usb_rcvisocpipe(chip->dev, ep_num);
70862306a36Sopenharmony_ci
70962306a36Sopenharmony_ci	list_add_tail(&ep->list, &chip->ep_list);
71062306a36Sopenharmony_ci	return 0;
71162306a36Sopenharmony_ci}
71262306a36Sopenharmony_ci
71362306a36Sopenharmony_ci/* Set up syncinterval and maxsyncsize for a sync EP */
71462306a36Sopenharmony_cistatic void endpoint_set_syncinterval(struct snd_usb_audio *chip,
71562306a36Sopenharmony_ci				      struct snd_usb_endpoint *ep)
71662306a36Sopenharmony_ci{
71762306a36Sopenharmony_ci	struct usb_host_interface *alts;
71862306a36Sopenharmony_ci	struct usb_endpoint_descriptor *desc;
71962306a36Sopenharmony_ci
72062306a36Sopenharmony_ci	alts = snd_usb_get_host_interface(chip, ep->iface, ep->altsetting);
72162306a36Sopenharmony_ci	if (!alts)
72262306a36Sopenharmony_ci		return;
72362306a36Sopenharmony_ci
72462306a36Sopenharmony_ci	desc = get_endpoint(alts, ep->ep_idx);
72562306a36Sopenharmony_ci	if (desc->bLength >= USB_DT_ENDPOINT_AUDIO_SIZE &&
72662306a36Sopenharmony_ci	    desc->bRefresh >= 1 && desc->bRefresh <= 9)
72762306a36Sopenharmony_ci		ep->syncinterval = desc->bRefresh;
72862306a36Sopenharmony_ci	else if (snd_usb_get_speed(chip->dev) == USB_SPEED_FULL)
72962306a36Sopenharmony_ci		ep->syncinterval = 1;
73062306a36Sopenharmony_ci	else if (desc->bInterval >= 1 && desc->bInterval <= 16)
73162306a36Sopenharmony_ci		ep->syncinterval = desc->bInterval - 1;
73262306a36Sopenharmony_ci	else
73362306a36Sopenharmony_ci		ep->syncinterval = 3;
73462306a36Sopenharmony_ci
73562306a36Sopenharmony_ci	ep->syncmaxsize = le16_to_cpu(desc->wMaxPacketSize);
73662306a36Sopenharmony_ci}
73762306a36Sopenharmony_ci
73862306a36Sopenharmony_cistatic bool endpoint_compatible(struct snd_usb_endpoint *ep,
73962306a36Sopenharmony_ci				const struct audioformat *fp,
74062306a36Sopenharmony_ci				const struct snd_pcm_hw_params *params)
74162306a36Sopenharmony_ci{
74262306a36Sopenharmony_ci	if (!ep->opened)
74362306a36Sopenharmony_ci		return false;
74462306a36Sopenharmony_ci	if (ep->cur_audiofmt != fp)
74562306a36Sopenharmony_ci		return false;
74662306a36Sopenharmony_ci	if (ep->cur_rate != params_rate(params) ||
74762306a36Sopenharmony_ci	    ep->cur_format != params_format(params) ||
74862306a36Sopenharmony_ci	    ep->cur_period_frames != params_period_size(params) ||
74962306a36Sopenharmony_ci	    ep->cur_buffer_periods != params_periods(params))
75062306a36Sopenharmony_ci		return false;
75162306a36Sopenharmony_ci	return true;
75262306a36Sopenharmony_ci}
75362306a36Sopenharmony_ci
75462306a36Sopenharmony_ci/*
75562306a36Sopenharmony_ci * Check whether the given fp and hw params are compatible with the current
75662306a36Sopenharmony_ci * setup of the target EP for implicit feedback sync
75762306a36Sopenharmony_ci */
75862306a36Sopenharmony_cibool snd_usb_endpoint_compatible(struct snd_usb_audio *chip,
75962306a36Sopenharmony_ci				 struct snd_usb_endpoint *ep,
76062306a36Sopenharmony_ci				 const struct audioformat *fp,
76162306a36Sopenharmony_ci				 const struct snd_pcm_hw_params *params)
76262306a36Sopenharmony_ci{
76362306a36Sopenharmony_ci	bool ret;
76462306a36Sopenharmony_ci
76562306a36Sopenharmony_ci	mutex_lock(&chip->mutex);
76662306a36Sopenharmony_ci	ret = endpoint_compatible(ep, fp, params);
76762306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
76862306a36Sopenharmony_ci	return ret;
76962306a36Sopenharmony_ci}
77062306a36Sopenharmony_ci
77162306a36Sopenharmony_ci/*
77262306a36Sopenharmony_ci * snd_usb_endpoint_open: Open the endpoint
77362306a36Sopenharmony_ci *
77462306a36Sopenharmony_ci * Called from hw_params to assign the endpoint to the substream.
77562306a36Sopenharmony_ci * It's reference-counted, and only the first opener is allowed to set up
77662306a36Sopenharmony_ci * arbitrary parameters.  The later opener must be compatible with the
77762306a36Sopenharmony_ci * former opened parameters.
77862306a36Sopenharmony_ci * The endpoint needs to be closed via snd_usb_endpoint_close() later.
77962306a36Sopenharmony_ci *
78062306a36Sopenharmony_ci * Note that this function doesn't configure the endpoint.  The substream
78162306a36Sopenharmony_ci * needs to set it up later via snd_usb_endpoint_set_params() and
78262306a36Sopenharmony_ci * snd_usb_endpoint_prepare().
78362306a36Sopenharmony_ci */
78462306a36Sopenharmony_cistruct snd_usb_endpoint *
78562306a36Sopenharmony_cisnd_usb_endpoint_open(struct snd_usb_audio *chip,
78662306a36Sopenharmony_ci		      const struct audioformat *fp,
78762306a36Sopenharmony_ci		      const struct snd_pcm_hw_params *params,
78862306a36Sopenharmony_ci		      bool is_sync_ep,
78962306a36Sopenharmony_ci		      bool fixed_rate)
79062306a36Sopenharmony_ci{
79162306a36Sopenharmony_ci	struct snd_usb_endpoint *ep;
79262306a36Sopenharmony_ci	int ep_num = is_sync_ep ? fp->sync_ep : fp->endpoint;
79362306a36Sopenharmony_ci
79462306a36Sopenharmony_ci	mutex_lock(&chip->mutex);
79562306a36Sopenharmony_ci	ep = snd_usb_get_endpoint(chip, ep_num);
79662306a36Sopenharmony_ci	if (!ep) {
79762306a36Sopenharmony_ci		usb_audio_err(chip, "Cannot find EP 0x%x to open\n", ep_num);
79862306a36Sopenharmony_ci		goto unlock;
79962306a36Sopenharmony_ci	}
80062306a36Sopenharmony_ci
80162306a36Sopenharmony_ci	if (!ep->opened) {
80262306a36Sopenharmony_ci		if (is_sync_ep) {
80362306a36Sopenharmony_ci			ep->iface = fp->sync_iface;
80462306a36Sopenharmony_ci			ep->altsetting = fp->sync_altsetting;
80562306a36Sopenharmony_ci			ep->ep_idx = fp->sync_ep_idx;
80662306a36Sopenharmony_ci		} else {
80762306a36Sopenharmony_ci			ep->iface = fp->iface;
80862306a36Sopenharmony_ci			ep->altsetting = fp->altsetting;
80962306a36Sopenharmony_ci			ep->ep_idx = fp->ep_idx;
81062306a36Sopenharmony_ci		}
81162306a36Sopenharmony_ci		usb_audio_dbg(chip, "Open EP 0x%x, iface=%d:%d, idx=%d\n",
81262306a36Sopenharmony_ci			      ep_num, ep->iface, ep->altsetting, ep->ep_idx);
81362306a36Sopenharmony_ci
81462306a36Sopenharmony_ci		ep->iface_ref = iface_ref_find(chip, ep->iface);
81562306a36Sopenharmony_ci		if (!ep->iface_ref) {
81662306a36Sopenharmony_ci			ep = NULL;
81762306a36Sopenharmony_ci			goto unlock;
81862306a36Sopenharmony_ci		}
81962306a36Sopenharmony_ci
82062306a36Sopenharmony_ci		if (fp->protocol != UAC_VERSION_1) {
82162306a36Sopenharmony_ci			ep->clock_ref = clock_ref_find(chip, fp->clock);
82262306a36Sopenharmony_ci			if (!ep->clock_ref) {
82362306a36Sopenharmony_ci				ep = NULL;
82462306a36Sopenharmony_ci				goto unlock;
82562306a36Sopenharmony_ci			}
82662306a36Sopenharmony_ci			ep->clock_ref->opened++;
82762306a36Sopenharmony_ci		}
82862306a36Sopenharmony_ci
82962306a36Sopenharmony_ci		ep->cur_audiofmt = fp;
83062306a36Sopenharmony_ci		ep->cur_channels = fp->channels;
83162306a36Sopenharmony_ci		ep->cur_rate = params_rate(params);
83262306a36Sopenharmony_ci		ep->cur_format = params_format(params);
83362306a36Sopenharmony_ci		ep->cur_frame_bytes = snd_pcm_format_physical_width(ep->cur_format) *
83462306a36Sopenharmony_ci			ep->cur_channels / 8;
83562306a36Sopenharmony_ci		ep->cur_period_frames = params_period_size(params);
83662306a36Sopenharmony_ci		ep->cur_period_bytes = ep->cur_period_frames * ep->cur_frame_bytes;
83762306a36Sopenharmony_ci		ep->cur_buffer_periods = params_periods(params);
83862306a36Sopenharmony_ci
83962306a36Sopenharmony_ci		if (ep->type == SND_USB_ENDPOINT_TYPE_SYNC)
84062306a36Sopenharmony_ci			endpoint_set_syncinterval(chip, ep);
84162306a36Sopenharmony_ci
84262306a36Sopenharmony_ci		ep->implicit_fb_sync = fp->implicit_fb;
84362306a36Sopenharmony_ci		ep->need_setup = true;
84462306a36Sopenharmony_ci		ep->need_prepare = true;
84562306a36Sopenharmony_ci		ep->fixed_rate = fixed_rate;
84662306a36Sopenharmony_ci
84762306a36Sopenharmony_ci		usb_audio_dbg(chip, "  channels=%d, rate=%d, format=%s, period_bytes=%d, periods=%d, implicit_fb=%d\n",
84862306a36Sopenharmony_ci			      ep->cur_channels, ep->cur_rate,
84962306a36Sopenharmony_ci			      snd_pcm_format_name(ep->cur_format),
85062306a36Sopenharmony_ci			      ep->cur_period_bytes, ep->cur_buffer_periods,
85162306a36Sopenharmony_ci			      ep->implicit_fb_sync);
85262306a36Sopenharmony_ci
85362306a36Sopenharmony_ci	} else {
85462306a36Sopenharmony_ci		if (WARN_ON(!ep->iface_ref)) {
85562306a36Sopenharmony_ci			ep = NULL;
85662306a36Sopenharmony_ci			goto unlock;
85762306a36Sopenharmony_ci		}
85862306a36Sopenharmony_ci
85962306a36Sopenharmony_ci		if (!endpoint_compatible(ep, fp, params)) {
86062306a36Sopenharmony_ci			usb_audio_err(chip, "Incompatible EP setup for 0x%x\n",
86162306a36Sopenharmony_ci				      ep_num);
86262306a36Sopenharmony_ci			ep = NULL;
86362306a36Sopenharmony_ci			goto unlock;
86462306a36Sopenharmony_ci		}
86562306a36Sopenharmony_ci
86662306a36Sopenharmony_ci		usb_audio_dbg(chip, "Reopened EP 0x%x (count %d)\n",
86762306a36Sopenharmony_ci			      ep_num, ep->opened);
86862306a36Sopenharmony_ci	}
86962306a36Sopenharmony_ci
87062306a36Sopenharmony_ci	if (!ep->iface_ref->opened++)
87162306a36Sopenharmony_ci		ep->iface_ref->need_setup = true;
87262306a36Sopenharmony_ci
87362306a36Sopenharmony_ci	ep->opened++;
87462306a36Sopenharmony_ci
87562306a36Sopenharmony_ci unlock:
87662306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
87762306a36Sopenharmony_ci	return ep;
87862306a36Sopenharmony_ci}
87962306a36Sopenharmony_ci
88062306a36Sopenharmony_ci/*
88162306a36Sopenharmony_ci * snd_usb_endpoint_set_sync: Link data and sync endpoints
88262306a36Sopenharmony_ci *
88362306a36Sopenharmony_ci * Pass NULL to sync_ep to unlink again
88462306a36Sopenharmony_ci */
88562306a36Sopenharmony_civoid snd_usb_endpoint_set_sync(struct snd_usb_audio *chip,
88662306a36Sopenharmony_ci			       struct snd_usb_endpoint *data_ep,
88762306a36Sopenharmony_ci			       struct snd_usb_endpoint *sync_ep)
88862306a36Sopenharmony_ci{
88962306a36Sopenharmony_ci	data_ep->sync_source = sync_ep;
89062306a36Sopenharmony_ci}
89162306a36Sopenharmony_ci
89262306a36Sopenharmony_ci/*
89362306a36Sopenharmony_ci * Set data endpoint callbacks and the assigned data stream
89462306a36Sopenharmony_ci *
89562306a36Sopenharmony_ci * Called at PCM trigger and cleanups.
89662306a36Sopenharmony_ci * Pass NULL to deactivate each callback.
89762306a36Sopenharmony_ci */
89862306a36Sopenharmony_civoid snd_usb_endpoint_set_callback(struct snd_usb_endpoint *ep,
89962306a36Sopenharmony_ci				   int (*prepare)(struct snd_usb_substream *subs,
90062306a36Sopenharmony_ci						  struct urb *urb,
90162306a36Sopenharmony_ci						  bool in_stream_lock),
90262306a36Sopenharmony_ci				   void (*retire)(struct snd_usb_substream *subs,
90362306a36Sopenharmony_ci						  struct urb *urb),
90462306a36Sopenharmony_ci				   struct snd_usb_substream *data_subs)
90562306a36Sopenharmony_ci{
90662306a36Sopenharmony_ci	ep->prepare_data_urb = prepare;
90762306a36Sopenharmony_ci	ep->retire_data_urb = retire;
90862306a36Sopenharmony_ci	if (data_subs)
90962306a36Sopenharmony_ci		ep->lowlatency_playback = data_subs->lowlatency_playback;
91062306a36Sopenharmony_ci	else
91162306a36Sopenharmony_ci		ep->lowlatency_playback = false;
91262306a36Sopenharmony_ci	WRITE_ONCE(ep->data_subs, data_subs);
91362306a36Sopenharmony_ci}
91462306a36Sopenharmony_ci
91562306a36Sopenharmony_cistatic int endpoint_set_interface(struct snd_usb_audio *chip,
91662306a36Sopenharmony_ci				  struct snd_usb_endpoint *ep,
91762306a36Sopenharmony_ci				  bool set)
91862306a36Sopenharmony_ci{
91962306a36Sopenharmony_ci	int altset = set ? ep->altsetting : 0;
92062306a36Sopenharmony_ci	int err;
92162306a36Sopenharmony_ci
92262306a36Sopenharmony_ci	if (ep->iface_ref->altset == altset)
92362306a36Sopenharmony_ci		return 0;
92462306a36Sopenharmony_ci
92562306a36Sopenharmony_ci	usb_audio_dbg(chip, "Setting usb interface %d:%d for EP 0x%x\n",
92662306a36Sopenharmony_ci		      ep->iface, altset, ep->ep_num);
92762306a36Sopenharmony_ci	err = usb_set_interface(chip->dev, ep->iface, altset);
92862306a36Sopenharmony_ci	if (err < 0) {
92962306a36Sopenharmony_ci		usb_audio_err_ratelimited(
93062306a36Sopenharmony_ci			chip, "%d:%d: usb_set_interface failed (%d)\n",
93162306a36Sopenharmony_ci			ep->iface, altset, err);
93262306a36Sopenharmony_ci		return err;
93362306a36Sopenharmony_ci	}
93462306a36Sopenharmony_ci
93562306a36Sopenharmony_ci	if (chip->quirk_flags & QUIRK_FLAG_IFACE_DELAY)
93662306a36Sopenharmony_ci		msleep(50);
93762306a36Sopenharmony_ci	ep->iface_ref->altset = altset;
93862306a36Sopenharmony_ci	return 0;
93962306a36Sopenharmony_ci}
94062306a36Sopenharmony_ci
94162306a36Sopenharmony_ci/*
94262306a36Sopenharmony_ci * snd_usb_endpoint_close: Close the endpoint
94362306a36Sopenharmony_ci *
94462306a36Sopenharmony_ci * Unreference the already opened endpoint via snd_usb_endpoint_open().
94562306a36Sopenharmony_ci */
94662306a36Sopenharmony_civoid snd_usb_endpoint_close(struct snd_usb_audio *chip,
94762306a36Sopenharmony_ci			    struct snd_usb_endpoint *ep)
94862306a36Sopenharmony_ci{
94962306a36Sopenharmony_ci	mutex_lock(&chip->mutex);
95062306a36Sopenharmony_ci	usb_audio_dbg(chip, "Closing EP 0x%x (count %d)\n",
95162306a36Sopenharmony_ci		      ep->ep_num, ep->opened);
95262306a36Sopenharmony_ci
95362306a36Sopenharmony_ci	if (!--ep->iface_ref->opened &&
95462306a36Sopenharmony_ci		!(chip->quirk_flags & QUIRK_FLAG_IFACE_SKIP_CLOSE))
95562306a36Sopenharmony_ci		endpoint_set_interface(chip, ep, false);
95662306a36Sopenharmony_ci
95762306a36Sopenharmony_ci	if (!--ep->opened) {
95862306a36Sopenharmony_ci		if (ep->clock_ref) {
95962306a36Sopenharmony_ci			if (!--ep->clock_ref->opened)
96062306a36Sopenharmony_ci				ep->clock_ref->rate = 0;
96162306a36Sopenharmony_ci		}
96262306a36Sopenharmony_ci		ep->iface = 0;
96362306a36Sopenharmony_ci		ep->altsetting = 0;
96462306a36Sopenharmony_ci		ep->cur_audiofmt = NULL;
96562306a36Sopenharmony_ci		ep->cur_rate = 0;
96662306a36Sopenharmony_ci		ep->iface_ref = NULL;
96762306a36Sopenharmony_ci		ep->clock_ref = NULL;
96862306a36Sopenharmony_ci		usb_audio_dbg(chip, "EP 0x%x closed\n", ep->ep_num);
96962306a36Sopenharmony_ci	}
97062306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
97162306a36Sopenharmony_ci}
97262306a36Sopenharmony_ci
97362306a36Sopenharmony_ci/* Prepare for suspening EP, called from the main suspend handler */
97462306a36Sopenharmony_civoid snd_usb_endpoint_suspend(struct snd_usb_endpoint *ep)
97562306a36Sopenharmony_ci{
97662306a36Sopenharmony_ci	ep->need_prepare = true;
97762306a36Sopenharmony_ci	if (ep->iface_ref)
97862306a36Sopenharmony_ci		ep->iface_ref->need_setup = true;
97962306a36Sopenharmony_ci	if (ep->clock_ref)
98062306a36Sopenharmony_ci		ep->clock_ref->rate = 0;
98162306a36Sopenharmony_ci}
98262306a36Sopenharmony_ci
98362306a36Sopenharmony_ci/*
98462306a36Sopenharmony_ci *  wait until all urbs are processed.
98562306a36Sopenharmony_ci */
98662306a36Sopenharmony_cistatic int wait_clear_urbs(struct snd_usb_endpoint *ep)
98762306a36Sopenharmony_ci{
98862306a36Sopenharmony_ci	unsigned long end_time = jiffies + msecs_to_jiffies(1000);
98962306a36Sopenharmony_ci	int alive;
99062306a36Sopenharmony_ci
99162306a36Sopenharmony_ci	if (atomic_read(&ep->state) != EP_STATE_STOPPING)
99262306a36Sopenharmony_ci		return 0;
99362306a36Sopenharmony_ci
99462306a36Sopenharmony_ci	do {
99562306a36Sopenharmony_ci		alive = atomic_read(&ep->submitted_urbs);
99662306a36Sopenharmony_ci		if (!alive)
99762306a36Sopenharmony_ci			break;
99862306a36Sopenharmony_ci
99962306a36Sopenharmony_ci		schedule_timeout_uninterruptible(1);
100062306a36Sopenharmony_ci	} while (time_before(jiffies, end_time));
100162306a36Sopenharmony_ci
100262306a36Sopenharmony_ci	if (alive)
100362306a36Sopenharmony_ci		usb_audio_err(ep->chip,
100462306a36Sopenharmony_ci			"timeout: still %d active urbs on EP #%x\n",
100562306a36Sopenharmony_ci			alive, ep->ep_num);
100662306a36Sopenharmony_ci
100762306a36Sopenharmony_ci	if (ep_state_update(ep, EP_STATE_STOPPING, EP_STATE_STOPPED)) {
100862306a36Sopenharmony_ci		ep->sync_sink = NULL;
100962306a36Sopenharmony_ci		snd_usb_endpoint_set_callback(ep, NULL, NULL, NULL);
101062306a36Sopenharmony_ci	}
101162306a36Sopenharmony_ci
101262306a36Sopenharmony_ci	return 0;
101362306a36Sopenharmony_ci}
101462306a36Sopenharmony_ci
101562306a36Sopenharmony_ci/* sync the pending stop operation;
101662306a36Sopenharmony_ci * this function itself doesn't trigger the stop operation
101762306a36Sopenharmony_ci */
101862306a36Sopenharmony_civoid snd_usb_endpoint_sync_pending_stop(struct snd_usb_endpoint *ep)
101962306a36Sopenharmony_ci{
102062306a36Sopenharmony_ci	if (ep)
102162306a36Sopenharmony_ci		wait_clear_urbs(ep);
102262306a36Sopenharmony_ci}
102362306a36Sopenharmony_ci
102462306a36Sopenharmony_ci/*
102562306a36Sopenharmony_ci * Stop active urbs
102662306a36Sopenharmony_ci *
102762306a36Sopenharmony_ci * This function moves the EP to STOPPING state if it's being RUNNING.
102862306a36Sopenharmony_ci */
102962306a36Sopenharmony_cistatic int stop_urbs(struct snd_usb_endpoint *ep, bool force, bool keep_pending)
103062306a36Sopenharmony_ci{
103162306a36Sopenharmony_ci	unsigned int i;
103262306a36Sopenharmony_ci	unsigned long flags;
103362306a36Sopenharmony_ci
103462306a36Sopenharmony_ci	if (!force && atomic_read(&ep->running))
103562306a36Sopenharmony_ci		return -EBUSY;
103662306a36Sopenharmony_ci
103762306a36Sopenharmony_ci	if (!ep_state_update(ep, EP_STATE_RUNNING, EP_STATE_STOPPING))
103862306a36Sopenharmony_ci		return 0;
103962306a36Sopenharmony_ci
104062306a36Sopenharmony_ci	spin_lock_irqsave(&ep->lock, flags);
104162306a36Sopenharmony_ci	INIT_LIST_HEAD(&ep->ready_playback_urbs);
104262306a36Sopenharmony_ci	ep->next_packet_head = 0;
104362306a36Sopenharmony_ci	ep->next_packet_queued = 0;
104462306a36Sopenharmony_ci	spin_unlock_irqrestore(&ep->lock, flags);
104562306a36Sopenharmony_ci
104662306a36Sopenharmony_ci	if (keep_pending)
104762306a36Sopenharmony_ci		return 0;
104862306a36Sopenharmony_ci
104962306a36Sopenharmony_ci	for (i = 0; i < ep->nurbs; i++) {
105062306a36Sopenharmony_ci		if (test_bit(i, &ep->active_mask)) {
105162306a36Sopenharmony_ci			if (!test_and_set_bit(i, &ep->unlink_mask)) {
105262306a36Sopenharmony_ci				struct urb *u = ep->urb[i].urb;
105362306a36Sopenharmony_ci				usb_unlink_urb(u);
105462306a36Sopenharmony_ci			}
105562306a36Sopenharmony_ci		}
105662306a36Sopenharmony_ci	}
105762306a36Sopenharmony_ci
105862306a36Sopenharmony_ci	return 0;
105962306a36Sopenharmony_ci}
106062306a36Sopenharmony_ci
106162306a36Sopenharmony_ci/*
106262306a36Sopenharmony_ci * release an endpoint's urbs
106362306a36Sopenharmony_ci */
106462306a36Sopenharmony_cistatic int release_urbs(struct snd_usb_endpoint *ep, bool force)
106562306a36Sopenharmony_ci{
106662306a36Sopenharmony_ci	int i, err;
106762306a36Sopenharmony_ci
106862306a36Sopenharmony_ci	/* route incoming urbs to nirvana */
106962306a36Sopenharmony_ci	snd_usb_endpoint_set_callback(ep, NULL, NULL, NULL);
107062306a36Sopenharmony_ci
107162306a36Sopenharmony_ci	/* stop and unlink urbs */
107262306a36Sopenharmony_ci	err = stop_urbs(ep, force, false);
107362306a36Sopenharmony_ci	if (err)
107462306a36Sopenharmony_ci		return err;
107562306a36Sopenharmony_ci
107662306a36Sopenharmony_ci	wait_clear_urbs(ep);
107762306a36Sopenharmony_ci
107862306a36Sopenharmony_ci	for (i = 0; i < ep->nurbs; i++)
107962306a36Sopenharmony_ci		release_urb_ctx(&ep->urb[i]);
108062306a36Sopenharmony_ci
108162306a36Sopenharmony_ci	usb_free_coherent(ep->chip->dev, SYNC_URBS * 4,
108262306a36Sopenharmony_ci			  ep->syncbuf, ep->sync_dma);
108362306a36Sopenharmony_ci
108462306a36Sopenharmony_ci	ep->syncbuf = NULL;
108562306a36Sopenharmony_ci	ep->nurbs = 0;
108662306a36Sopenharmony_ci	return 0;
108762306a36Sopenharmony_ci}
108862306a36Sopenharmony_ci
108962306a36Sopenharmony_ci/*
109062306a36Sopenharmony_ci * configure a data endpoint
109162306a36Sopenharmony_ci */
109262306a36Sopenharmony_cistatic int data_ep_set_params(struct snd_usb_endpoint *ep)
109362306a36Sopenharmony_ci{
109462306a36Sopenharmony_ci	struct snd_usb_audio *chip = ep->chip;
109562306a36Sopenharmony_ci	unsigned int maxsize, minsize, packs_per_ms, max_packs_per_urb;
109662306a36Sopenharmony_ci	unsigned int max_packs_per_period, urbs_per_period, urb_packs;
109762306a36Sopenharmony_ci	unsigned int max_urbs, i;
109862306a36Sopenharmony_ci	const struct audioformat *fmt = ep->cur_audiofmt;
109962306a36Sopenharmony_ci	int frame_bits = ep->cur_frame_bytes * 8;
110062306a36Sopenharmony_ci	int tx_length_quirk = (has_tx_length_quirk(chip) &&
110162306a36Sopenharmony_ci			       usb_pipeout(ep->pipe));
110262306a36Sopenharmony_ci
110362306a36Sopenharmony_ci	usb_audio_dbg(chip, "Setting params for data EP 0x%x, pipe 0x%x\n",
110462306a36Sopenharmony_ci		      ep->ep_num, ep->pipe);
110562306a36Sopenharmony_ci
110662306a36Sopenharmony_ci	if (ep->cur_format == SNDRV_PCM_FORMAT_DSD_U16_LE && fmt->dsd_dop) {
110762306a36Sopenharmony_ci		/*
110862306a36Sopenharmony_ci		 * When operating in DSD DOP mode, the size of a sample frame
110962306a36Sopenharmony_ci		 * in hardware differs from the actual physical format width
111062306a36Sopenharmony_ci		 * because we need to make room for the DOP markers.
111162306a36Sopenharmony_ci		 */
111262306a36Sopenharmony_ci		frame_bits += ep->cur_channels << 3;
111362306a36Sopenharmony_ci	}
111462306a36Sopenharmony_ci
111562306a36Sopenharmony_ci	ep->datainterval = fmt->datainterval;
111662306a36Sopenharmony_ci	ep->stride = frame_bits >> 3;
111762306a36Sopenharmony_ci
111862306a36Sopenharmony_ci	switch (ep->cur_format) {
111962306a36Sopenharmony_ci	case SNDRV_PCM_FORMAT_U8:
112062306a36Sopenharmony_ci		ep->silence_value = 0x80;
112162306a36Sopenharmony_ci		break;
112262306a36Sopenharmony_ci	case SNDRV_PCM_FORMAT_DSD_U8:
112362306a36Sopenharmony_ci	case SNDRV_PCM_FORMAT_DSD_U16_LE:
112462306a36Sopenharmony_ci	case SNDRV_PCM_FORMAT_DSD_U32_LE:
112562306a36Sopenharmony_ci	case SNDRV_PCM_FORMAT_DSD_U16_BE:
112662306a36Sopenharmony_ci	case SNDRV_PCM_FORMAT_DSD_U32_BE:
112762306a36Sopenharmony_ci		ep->silence_value = 0x69;
112862306a36Sopenharmony_ci		break;
112962306a36Sopenharmony_ci	default:
113062306a36Sopenharmony_ci		ep->silence_value = 0;
113162306a36Sopenharmony_ci	}
113262306a36Sopenharmony_ci
113362306a36Sopenharmony_ci	/* assume max. frequency is 50% higher than nominal */
113462306a36Sopenharmony_ci	ep->freqmax = ep->freqn + (ep->freqn >> 1);
113562306a36Sopenharmony_ci	/* Round up freqmax to nearest integer in order to calculate maximum
113662306a36Sopenharmony_ci	 * packet size, which must represent a whole number of frames.
113762306a36Sopenharmony_ci	 * This is accomplished by adding 0x0.ffff before converting the
113862306a36Sopenharmony_ci	 * Q16.16 format into integer.
113962306a36Sopenharmony_ci	 * In order to accurately calculate the maximum packet size when
114062306a36Sopenharmony_ci	 * the data interval is more than 1 (i.e. ep->datainterval > 0),
114162306a36Sopenharmony_ci	 * multiply by the data interval prior to rounding. For instance,
114262306a36Sopenharmony_ci	 * a freqmax of 41 kHz will result in a max packet size of 6 (5.125)
114362306a36Sopenharmony_ci	 * frames with a data interval of 1, but 11 (10.25) frames with a
114462306a36Sopenharmony_ci	 * data interval of 2.
114562306a36Sopenharmony_ci	 * (ep->freqmax << ep->datainterval overflows at 8.192 MHz for the
114662306a36Sopenharmony_ci	 * maximum datainterval value of 3, at USB full speed, higher for
114762306a36Sopenharmony_ci	 * USB high speed, noting that ep->freqmax is in units of
114862306a36Sopenharmony_ci	 * frames per packet in Q16.16 format.)
114962306a36Sopenharmony_ci	 */
115062306a36Sopenharmony_ci	maxsize = (((ep->freqmax << ep->datainterval) + 0xffff) >> 16) *
115162306a36Sopenharmony_ci			 (frame_bits >> 3);
115262306a36Sopenharmony_ci	if (tx_length_quirk)
115362306a36Sopenharmony_ci		maxsize += sizeof(__le32); /* Space for length descriptor */
115462306a36Sopenharmony_ci	/* but wMaxPacketSize might reduce this */
115562306a36Sopenharmony_ci	if (ep->maxpacksize && ep->maxpacksize < maxsize) {
115662306a36Sopenharmony_ci		/* whatever fits into a max. size packet */
115762306a36Sopenharmony_ci		unsigned int data_maxsize = maxsize = ep->maxpacksize;
115862306a36Sopenharmony_ci
115962306a36Sopenharmony_ci		if (tx_length_quirk)
116062306a36Sopenharmony_ci			/* Need to remove the length descriptor to calc freq */
116162306a36Sopenharmony_ci			data_maxsize -= sizeof(__le32);
116262306a36Sopenharmony_ci		ep->freqmax = (data_maxsize / (frame_bits >> 3))
116362306a36Sopenharmony_ci				<< (16 - ep->datainterval);
116462306a36Sopenharmony_ci	}
116562306a36Sopenharmony_ci
116662306a36Sopenharmony_ci	if (ep->fill_max)
116762306a36Sopenharmony_ci		ep->curpacksize = ep->maxpacksize;
116862306a36Sopenharmony_ci	else
116962306a36Sopenharmony_ci		ep->curpacksize = maxsize;
117062306a36Sopenharmony_ci
117162306a36Sopenharmony_ci	if (snd_usb_get_speed(chip->dev) != USB_SPEED_FULL) {
117262306a36Sopenharmony_ci		packs_per_ms = 8 >> ep->datainterval;
117362306a36Sopenharmony_ci		max_packs_per_urb = MAX_PACKS_HS;
117462306a36Sopenharmony_ci	} else {
117562306a36Sopenharmony_ci		packs_per_ms = 1;
117662306a36Sopenharmony_ci		max_packs_per_urb = MAX_PACKS;
117762306a36Sopenharmony_ci	}
117862306a36Sopenharmony_ci	if (ep->sync_source && !ep->implicit_fb_sync)
117962306a36Sopenharmony_ci		max_packs_per_urb = min(max_packs_per_urb,
118062306a36Sopenharmony_ci					1U << ep->sync_source->syncinterval);
118162306a36Sopenharmony_ci	max_packs_per_urb = max(1u, max_packs_per_urb >> ep->datainterval);
118262306a36Sopenharmony_ci
118362306a36Sopenharmony_ci	/*
118462306a36Sopenharmony_ci	 * Capture endpoints need to use small URBs because there's no way
118562306a36Sopenharmony_ci	 * to tell in advance where the next period will end, and we don't
118662306a36Sopenharmony_ci	 * want the next URB to complete much after the period ends.
118762306a36Sopenharmony_ci	 *
118862306a36Sopenharmony_ci	 * Playback endpoints with implicit sync much use the same parameters
118962306a36Sopenharmony_ci	 * as their corresponding capture endpoint.
119062306a36Sopenharmony_ci	 */
119162306a36Sopenharmony_ci	if (usb_pipein(ep->pipe) || ep->implicit_fb_sync) {
119262306a36Sopenharmony_ci
119362306a36Sopenharmony_ci		/* make capture URBs <= 1 ms and smaller than a period */
119462306a36Sopenharmony_ci		urb_packs = min(max_packs_per_urb, packs_per_ms);
119562306a36Sopenharmony_ci		while (urb_packs > 1 && urb_packs * maxsize >= ep->cur_period_bytes)
119662306a36Sopenharmony_ci			urb_packs >>= 1;
119762306a36Sopenharmony_ci		ep->nurbs = MAX_URBS;
119862306a36Sopenharmony_ci
119962306a36Sopenharmony_ci	/*
120062306a36Sopenharmony_ci	 * Playback endpoints without implicit sync are adjusted so that
120162306a36Sopenharmony_ci	 * a period fits as evenly as possible in the smallest number of
120262306a36Sopenharmony_ci	 * URBs.  The total number of URBs is adjusted to the size of the
120362306a36Sopenharmony_ci	 * ALSA buffer, subject to the MAX_URBS and MAX_QUEUE limits.
120462306a36Sopenharmony_ci	 */
120562306a36Sopenharmony_ci	} else {
120662306a36Sopenharmony_ci		/* determine how small a packet can be */
120762306a36Sopenharmony_ci		minsize = (ep->freqn >> (16 - ep->datainterval)) *
120862306a36Sopenharmony_ci				(frame_bits >> 3);
120962306a36Sopenharmony_ci		/* with sync from device, assume it can be 12% lower */
121062306a36Sopenharmony_ci		if (ep->sync_source)
121162306a36Sopenharmony_ci			minsize -= minsize >> 3;
121262306a36Sopenharmony_ci		minsize = max(minsize, 1u);
121362306a36Sopenharmony_ci
121462306a36Sopenharmony_ci		/* how many packets will contain an entire ALSA period? */
121562306a36Sopenharmony_ci		max_packs_per_period = DIV_ROUND_UP(ep->cur_period_bytes, minsize);
121662306a36Sopenharmony_ci
121762306a36Sopenharmony_ci		/* how many URBs will contain a period? */
121862306a36Sopenharmony_ci		urbs_per_period = DIV_ROUND_UP(max_packs_per_period,
121962306a36Sopenharmony_ci				max_packs_per_urb);
122062306a36Sopenharmony_ci		/* how many packets are needed in each URB? */
122162306a36Sopenharmony_ci		urb_packs = DIV_ROUND_UP(max_packs_per_period, urbs_per_period);
122262306a36Sopenharmony_ci
122362306a36Sopenharmony_ci		/* limit the number of frames in a single URB */
122462306a36Sopenharmony_ci		ep->max_urb_frames = DIV_ROUND_UP(ep->cur_period_frames,
122562306a36Sopenharmony_ci						  urbs_per_period);
122662306a36Sopenharmony_ci
122762306a36Sopenharmony_ci		/* try to use enough URBs to contain an entire ALSA buffer */
122862306a36Sopenharmony_ci		max_urbs = min((unsigned) MAX_URBS,
122962306a36Sopenharmony_ci				MAX_QUEUE * packs_per_ms / urb_packs);
123062306a36Sopenharmony_ci		ep->nurbs = min(max_urbs, urbs_per_period * ep->cur_buffer_periods);
123162306a36Sopenharmony_ci	}
123262306a36Sopenharmony_ci
123362306a36Sopenharmony_ci	/* allocate and initialize data urbs */
123462306a36Sopenharmony_ci	for (i = 0; i < ep->nurbs; i++) {
123562306a36Sopenharmony_ci		struct snd_urb_ctx *u = &ep->urb[i];
123662306a36Sopenharmony_ci		u->index = i;
123762306a36Sopenharmony_ci		u->ep = ep;
123862306a36Sopenharmony_ci		u->packets = urb_packs;
123962306a36Sopenharmony_ci		u->buffer_size = maxsize * u->packets;
124062306a36Sopenharmony_ci
124162306a36Sopenharmony_ci		if (fmt->fmt_type == UAC_FORMAT_TYPE_II)
124262306a36Sopenharmony_ci			u->packets++; /* for transfer delimiter */
124362306a36Sopenharmony_ci		u->urb = usb_alloc_urb(u->packets, GFP_KERNEL);
124462306a36Sopenharmony_ci		if (!u->urb)
124562306a36Sopenharmony_ci			goto out_of_memory;
124662306a36Sopenharmony_ci
124762306a36Sopenharmony_ci		u->urb->transfer_buffer =
124862306a36Sopenharmony_ci			usb_alloc_coherent(chip->dev, u->buffer_size,
124962306a36Sopenharmony_ci					   GFP_KERNEL, &u->urb->transfer_dma);
125062306a36Sopenharmony_ci		if (!u->urb->transfer_buffer)
125162306a36Sopenharmony_ci			goto out_of_memory;
125262306a36Sopenharmony_ci		u->urb->pipe = ep->pipe;
125362306a36Sopenharmony_ci		u->urb->transfer_flags = URB_NO_TRANSFER_DMA_MAP;
125462306a36Sopenharmony_ci		u->urb->interval = 1 << ep->datainterval;
125562306a36Sopenharmony_ci		u->urb->context = u;
125662306a36Sopenharmony_ci		u->urb->complete = snd_complete_urb;
125762306a36Sopenharmony_ci		INIT_LIST_HEAD(&u->ready_list);
125862306a36Sopenharmony_ci	}
125962306a36Sopenharmony_ci
126062306a36Sopenharmony_ci	return 0;
126162306a36Sopenharmony_ci
126262306a36Sopenharmony_ciout_of_memory:
126362306a36Sopenharmony_ci	release_urbs(ep, false);
126462306a36Sopenharmony_ci	return -ENOMEM;
126562306a36Sopenharmony_ci}
126662306a36Sopenharmony_ci
126762306a36Sopenharmony_ci/*
126862306a36Sopenharmony_ci * configure a sync endpoint
126962306a36Sopenharmony_ci */
127062306a36Sopenharmony_cistatic int sync_ep_set_params(struct snd_usb_endpoint *ep)
127162306a36Sopenharmony_ci{
127262306a36Sopenharmony_ci	struct snd_usb_audio *chip = ep->chip;
127362306a36Sopenharmony_ci	int i;
127462306a36Sopenharmony_ci
127562306a36Sopenharmony_ci	usb_audio_dbg(chip, "Setting params for sync EP 0x%x, pipe 0x%x\n",
127662306a36Sopenharmony_ci		      ep->ep_num, ep->pipe);
127762306a36Sopenharmony_ci
127862306a36Sopenharmony_ci	ep->syncbuf = usb_alloc_coherent(chip->dev, SYNC_URBS * 4,
127962306a36Sopenharmony_ci					 GFP_KERNEL, &ep->sync_dma);
128062306a36Sopenharmony_ci	if (!ep->syncbuf)
128162306a36Sopenharmony_ci		return -ENOMEM;
128262306a36Sopenharmony_ci
128362306a36Sopenharmony_ci	ep->nurbs = SYNC_URBS;
128462306a36Sopenharmony_ci	for (i = 0; i < SYNC_URBS; i++) {
128562306a36Sopenharmony_ci		struct snd_urb_ctx *u = &ep->urb[i];
128662306a36Sopenharmony_ci		u->index = i;
128762306a36Sopenharmony_ci		u->ep = ep;
128862306a36Sopenharmony_ci		u->packets = 1;
128962306a36Sopenharmony_ci		u->urb = usb_alloc_urb(1, GFP_KERNEL);
129062306a36Sopenharmony_ci		if (!u->urb)
129162306a36Sopenharmony_ci			goto out_of_memory;
129262306a36Sopenharmony_ci		u->urb->transfer_buffer = ep->syncbuf + i * 4;
129362306a36Sopenharmony_ci		u->urb->transfer_dma = ep->sync_dma + i * 4;
129462306a36Sopenharmony_ci		u->urb->transfer_buffer_length = 4;
129562306a36Sopenharmony_ci		u->urb->pipe = ep->pipe;
129662306a36Sopenharmony_ci		u->urb->transfer_flags = URB_NO_TRANSFER_DMA_MAP;
129762306a36Sopenharmony_ci		u->urb->number_of_packets = 1;
129862306a36Sopenharmony_ci		u->urb->interval = 1 << ep->syncinterval;
129962306a36Sopenharmony_ci		u->urb->context = u;
130062306a36Sopenharmony_ci		u->urb->complete = snd_complete_urb;
130162306a36Sopenharmony_ci	}
130262306a36Sopenharmony_ci
130362306a36Sopenharmony_ci	return 0;
130462306a36Sopenharmony_ci
130562306a36Sopenharmony_ciout_of_memory:
130662306a36Sopenharmony_ci	release_urbs(ep, false);
130762306a36Sopenharmony_ci	return -ENOMEM;
130862306a36Sopenharmony_ci}
130962306a36Sopenharmony_ci
131062306a36Sopenharmony_ci/* update the rate of the referred clock; return the actual rate */
131162306a36Sopenharmony_cistatic int update_clock_ref_rate(struct snd_usb_audio *chip,
131262306a36Sopenharmony_ci				 struct snd_usb_endpoint *ep)
131362306a36Sopenharmony_ci{
131462306a36Sopenharmony_ci	struct snd_usb_clock_ref *clock = ep->clock_ref;
131562306a36Sopenharmony_ci	int rate = ep->cur_rate;
131662306a36Sopenharmony_ci
131762306a36Sopenharmony_ci	if (!clock || clock->rate == rate)
131862306a36Sopenharmony_ci		return rate;
131962306a36Sopenharmony_ci	if (clock->rate) {
132062306a36Sopenharmony_ci		if (atomic_read(&clock->locked))
132162306a36Sopenharmony_ci			return clock->rate;
132262306a36Sopenharmony_ci		if (clock->rate != rate) {
132362306a36Sopenharmony_ci			usb_audio_err(chip, "Mismatched sample rate %d vs %d for EP 0x%x\n",
132462306a36Sopenharmony_ci				      clock->rate, rate, ep->ep_num);
132562306a36Sopenharmony_ci			return clock->rate;
132662306a36Sopenharmony_ci		}
132762306a36Sopenharmony_ci	}
132862306a36Sopenharmony_ci	clock->rate = rate;
132962306a36Sopenharmony_ci	clock->need_setup = true;
133062306a36Sopenharmony_ci	return rate;
133162306a36Sopenharmony_ci}
133262306a36Sopenharmony_ci
133362306a36Sopenharmony_ci/*
133462306a36Sopenharmony_ci * snd_usb_endpoint_set_params: configure an snd_usb_endpoint
133562306a36Sopenharmony_ci *
133662306a36Sopenharmony_ci * It's called either from hw_params callback.
133762306a36Sopenharmony_ci * Determine the number of URBs to be used on this endpoint.
133862306a36Sopenharmony_ci * An endpoint must be configured before it can be started.
133962306a36Sopenharmony_ci * An endpoint that is already running can not be reconfigured.
134062306a36Sopenharmony_ci */
134162306a36Sopenharmony_ciint snd_usb_endpoint_set_params(struct snd_usb_audio *chip,
134262306a36Sopenharmony_ci				struct snd_usb_endpoint *ep)
134362306a36Sopenharmony_ci{
134462306a36Sopenharmony_ci	const struct audioformat *fmt = ep->cur_audiofmt;
134562306a36Sopenharmony_ci	int err = 0;
134662306a36Sopenharmony_ci
134762306a36Sopenharmony_ci	mutex_lock(&chip->mutex);
134862306a36Sopenharmony_ci	if (!ep->need_setup)
134962306a36Sopenharmony_ci		goto unlock;
135062306a36Sopenharmony_ci
135162306a36Sopenharmony_ci	/* release old buffers, if any */
135262306a36Sopenharmony_ci	err = release_urbs(ep, false);
135362306a36Sopenharmony_ci	if (err < 0)
135462306a36Sopenharmony_ci		goto unlock;
135562306a36Sopenharmony_ci
135662306a36Sopenharmony_ci	ep->datainterval = fmt->datainterval;
135762306a36Sopenharmony_ci	ep->maxpacksize = fmt->maxpacksize;
135862306a36Sopenharmony_ci	ep->fill_max = !!(fmt->attributes & UAC_EP_CS_ATTR_FILL_MAX);
135962306a36Sopenharmony_ci
136062306a36Sopenharmony_ci	if (snd_usb_get_speed(chip->dev) == USB_SPEED_FULL) {
136162306a36Sopenharmony_ci		ep->freqn = get_usb_full_speed_rate(ep->cur_rate);
136262306a36Sopenharmony_ci		ep->pps = 1000 >> ep->datainterval;
136362306a36Sopenharmony_ci	} else {
136462306a36Sopenharmony_ci		ep->freqn = get_usb_high_speed_rate(ep->cur_rate);
136562306a36Sopenharmony_ci		ep->pps = 8000 >> ep->datainterval;
136662306a36Sopenharmony_ci	}
136762306a36Sopenharmony_ci
136862306a36Sopenharmony_ci	ep->sample_rem = ep->cur_rate % ep->pps;
136962306a36Sopenharmony_ci	ep->packsize[0] = ep->cur_rate / ep->pps;
137062306a36Sopenharmony_ci	ep->packsize[1] = (ep->cur_rate + (ep->pps - 1)) / ep->pps;
137162306a36Sopenharmony_ci
137262306a36Sopenharmony_ci	/* calculate the frequency in 16.16 format */
137362306a36Sopenharmony_ci	ep->freqm = ep->freqn;
137462306a36Sopenharmony_ci	ep->freqshift = INT_MIN;
137562306a36Sopenharmony_ci
137662306a36Sopenharmony_ci	ep->phase = 0;
137762306a36Sopenharmony_ci
137862306a36Sopenharmony_ci	switch (ep->type) {
137962306a36Sopenharmony_ci	case  SND_USB_ENDPOINT_TYPE_DATA:
138062306a36Sopenharmony_ci		err = data_ep_set_params(ep);
138162306a36Sopenharmony_ci		break;
138262306a36Sopenharmony_ci	case  SND_USB_ENDPOINT_TYPE_SYNC:
138362306a36Sopenharmony_ci		err = sync_ep_set_params(ep);
138462306a36Sopenharmony_ci		break;
138562306a36Sopenharmony_ci	default:
138662306a36Sopenharmony_ci		err = -EINVAL;
138762306a36Sopenharmony_ci	}
138862306a36Sopenharmony_ci
138962306a36Sopenharmony_ci	usb_audio_dbg(chip, "Set up %d URBS, ret=%d\n", ep->nurbs, err);
139062306a36Sopenharmony_ci
139162306a36Sopenharmony_ci	if (err < 0)
139262306a36Sopenharmony_ci		goto unlock;
139362306a36Sopenharmony_ci
139462306a36Sopenharmony_ci	/* some unit conversions in runtime */
139562306a36Sopenharmony_ci	ep->maxframesize = ep->maxpacksize / ep->cur_frame_bytes;
139662306a36Sopenharmony_ci	ep->curframesize = ep->curpacksize / ep->cur_frame_bytes;
139762306a36Sopenharmony_ci
139862306a36Sopenharmony_ci	err = update_clock_ref_rate(chip, ep);
139962306a36Sopenharmony_ci	if (err >= 0) {
140062306a36Sopenharmony_ci		ep->need_setup = false;
140162306a36Sopenharmony_ci		err = 0;
140262306a36Sopenharmony_ci	}
140362306a36Sopenharmony_ci
140462306a36Sopenharmony_ci unlock:
140562306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
140662306a36Sopenharmony_ci	return err;
140762306a36Sopenharmony_ci}
140862306a36Sopenharmony_ci
140962306a36Sopenharmony_cistatic int init_sample_rate(struct snd_usb_audio *chip,
141062306a36Sopenharmony_ci			    struct snd_usb_endpoint *ep)
141162306a36Sopenharmony_ci{
141262306a36Sopenharmony_ci	struct snd_usb_clock_ref *clock = ep->clock_ref;
141362306a36Sopenharmony_ci	int rate, err;
141462306a36Sopenharmony_ci
141562306a36Sopenharmony_ci	rate = update_clock_ref_rate(chip, ep);
141662306a36Sopenharmony_ci	if (rate < 0)
141762306a36Sopenharmony_ci		return rate;
141862306a36Sopenharmony_ci	if (clock && !clock->need_setup)
141962306a36Sopenharmony_ci		return 0;
142062306a36Sopenharmony_ci
142162306a36Sopenharmony_ci	if (!ep->fixed_rate) {
142262306a36Sopenharmony_ci		err = snd_usb_init_sample_rate(chip, ep->cur_audiofmt, rate);
142362306a36Sopenharmony_ci		if (err < 0) {
142462306a36Sopenharmony_ci			if (clock)
142562306a36Sopenharmony_ci				clock->rate = 0; /* reset rate */
142662306a36Sopenharmony_ci			return err;
142762306a36Sopenharmony_ci		}
142862306a36Sopenharmony_ci	}
142962306a36Sopenharmony_ci
143062306a36Sopenharmony_ci	if (clock)
143162306a36Sopenharmony_ci		clock->need_setup = false;
143262306a36Sopenharmony_ci	return 0;
143362306a36Sopenharmony_ci}
143462306a36Sopenharmony_ci
143562306a36Sopenharmony_ci/*
143662306a36Sopenharmony_ci * snd_usb_endpoint_prepare: Prepare the endpoint
143762306a36Sopenharmony_ci *
143862306a36Sopenharmony_ci * This function sets up the EP to be fully usable state.
143962306a36Sopenharmony_ci * It's called either from prepare callback.
144062306a36Sopenharmony_ci * The function checks need_setup flag, and performs nothing unless needed,
144162306a36Sopenharmony_ci * so it's safe to call this multiple times.
144262306a36Sopenharmony_ci *
144362306a36Sopenharmony_ci * This returns zero if unchanged, 1 if the configuration has changed,
144462306a36Sopenharmony_ci * or a negative error code.
144562306a36Sopenharmony_ci */
144662306a36Sopenharmony_ciint snd_usb_endpoint_prepare(struct snd_usb_audio *chip,
144762306a36Sopenharmony_ci			     struct snd_usb_endpoint *ep)
144862306a36Sopenharmony_ci{
144962306a36Sopenharmony_ci	bool iface_first;
145062306a36Sopenharmony_ci	int err = 0;
145162306a36Sopenharmony_ci
145262306a36Sopenharmony_ci	mutex_lock(&chip->mutex);
145362306a36Sopenharmony_ci	if (WARN_ON(!ep->iface_ref))
145462306a36Sopenharmony_ci		goto unlock;
145562306a36Sopenharmony_ci	if (!ep->need_prepare)
145662306a36Sopenharmony_ci		goto unlock;
145762306a36Sopenharmony_ci
145862306a36Sopenharmony_ci	/* If the interface has been already set up, just set EP parameters */
145962306a36Sopenharmony_ci	if (!ep->iface_ref->need_setup) {
146062306a36Sopenharmony_ci		/* sample rate setup of UAC1 is per endpoint, and we need
146162306a36Sopenharmony_ci		 * to update at each EP configuration
146262306a36Sopenharmony_ci		 */
146362306a36Sopenharmony_ci		if (ep->cur_audiofmt->protocol == UAC_VERSION_1) {
146462306a36Sopenharmony_ci			err = init_sample_rate(chip, ep);
146562306a36Sopenharmony_ci			if (err < 0)
146662306a36Sopenharmony_ci				goto unlock;
146762306a36Sopenharmony_ci		}
146862306a36Sopenharmony_ci		goto done;
146962306a36Sopenharmony_ci	}
147062306a36Sopenharmony_ci
147162306a36Sopenharmony_ci	/* Need to deselect altsetting at first */
147262306a36Sopenharmony_ci	endpoint_set_interface(chip, ep, false);
147362306a36Sopenharmony_ci
147462306a36Sopenharmony_ci	/* Some UAC1 devices (e.g. Yamaha THR10) need the host interface
147562306a36Sopenharmony_ci	 * to be set up before parameter setups
147662306a36Sopenharmony_ci	 */
147762306a36Sopenharmony_ci	iface_first = ep->cur_audiofmt->protocol == UAC_VERSION_1;
147862306a36Sopenharmony_ci	/* Workaround for devices that require the interface setup at first like UAC1 */
147962306a36Sopenharmony_ci	if (chip->quirk_flags & QUIRK_FLAG_SET_IFACE_FIRST)
148062306a36Sopenharmony_ci		iface_first = true;
148162306a36Sopenharmony_ci	if (iface_first) {
148262306a36Sopenharmony_ci		err = endpoint_set_interface(chip, ep, true);
148362306a36Sopenharmony_ci		if (err < 0)
148462306a36Sopenharmony_ci			goto unlock;
148562306a36Sopenharmony_ci	}
148662306a36Sopenharmony_ci
148762306a36Sopenharmony_ci	err = snd_usb_init_pitch(chip, ep->cur_audiofmt);
148862306a36Sopenharmony_ci	if (err < 0)
148962306a36Sopenharmony_ci		goto unlock;
149062306a36Sopenharmony_ci
149162306a36Sopenharmony_ci	err = init_sample_rate(chip, ep);
149262306a36Sopenharmony_ci	if (err < 0)
149362306a36Sopenharmony_ci		goto unlock;
149462306a36Sopenharmony_ci
149562306a36Sopenharmony_ci	err = snd_usb_select_mode_quirk(chip, ep->cur_audiofmt);
149662306a36Sopenharmony_ci	if (err < 0)
149762306a36Sopenharmony_ci		goto unlock;
149862306a36Sopenharmony_ci
149962306a36Sopenharmony_ci	/* for UAC2/3, enable the interface altset here at last */
150062306a36Sopenharmony_ci	if (!iface_first) {
150162306a36Sopenharmony_ci		err = endpoint_set_interface(chip, ep, true);
150262306a36Sopenharmony_ci		if (err < 0)
150362306a36Sopenharmony_ci			goto unlock;
150462306a36Sopenharmony_ci	}
150562306a36Sopenharmony_ci
150662306a36Sopenharmony_ci	ep->iface_ref->need_setup = false;
150762306a36Sopenharmony_ci
150862306a36Sopenharmony_ci done:
150962306a36Sopenharmony_ci	ep->need_prepare = false;
151062306a36Sopenharmony_ci	err = 1;
151162306a36Sopenharmony_ci
151262306a36Sopenharmony_ciunlock:
151362306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
151462306a36Sopenharmony_ci	return err;
151562306a36Sopenharmony_ci}
151662306a36Sopenharmony_ci
151762306a36Sopenharmony_ci/* get the current rate set to the given clock by any endpoint */
151862306a36Sopenharmony_ciint snd_usb_endpoint_get_clock_rate(struct snd_usb_audio *chip, int clock)
151962306a36Sopenharmony_ci{
152062306a36Sopenharmony_ci	struct snd_usb_clock_ref *ref;
152162306a36Sopenharmony_ci	int rate = 0;
152262306a36Sopenharmony_ci
152362306a36Sopenharmony_ci	if (!clock)
152462306a36Sopenharmony_ci		return 0;
152562306a36Sopenharmony_ci	mutex_lock(&chip->mutex);
152662306a36Sopenharmony_ci	list_for_each_entry(ref, &chip->clock_ref_list, list) {
152762306a36Sopenharmony_ci		if (ref->clock == clock) {
152862306a36Sopenharmony_ci			rate = ref->rate;
152962306a36Sopenharmony_ci			break;
153062306a36Sopenharmony_ci		}
153162306a36Sopenharmony_ci	}
153262306a36Sopenharmony_ci	mutex_unlock(&chip->mutex);
153362306a36Sopenharmony_ci	return rate;
153462306a36Sopenharmony_ci}
153562306a36Sopenharmony_ci
153662306a36Sopenharmony_ci/**
153762306a36Sopenharmony_ci * snd_usb_endpoint_start: start an snd_usb_endpoint
153862306a36Sopenharmony_ci *
153962306a36Sopenharmony_ci * @ep: the endpoint to start
154062306a36Sopenharmony_ci *
154162306a36Sopenharmony_ci * A call to this function will increment the running count of the endpoint.
154262306a36Sopenharmony_ci * In case it is not already running, the URBs for this endpoint will be
154362306a36Sopenharmony_ci * submitted. Otherwise, this function does nothing.
154462306a36Sopenharmony_ci *
154562306a36Sopenharmony_ci * Must be balanced to calls of snd_usb_endpoint_stop().
154662306a36Sopenharmony_ci *
154762306a36Sopenharmony_ci * Returns an error if the URB submission failed, 0 in all other cases.
154862306a36Sopenharmony_ci */
154962306a36Sopenharmony_ciint snd_usb_endpoint_start(struct snd_usb_endpoint *ep)
155062306a36Sopenharmony_ci{
155162306a36Sopenharmony_ci	bool is_playback = usb_pipeout(ep->pipe);
155262306a36Sopenharmony_ci	int err;
155362306a36Sopenharmony_ci	unsigned int i;
155462306a36Sopenharmony_ci
155562306a36Sopenharmony_ci	if (atomic_read(&ep->chip->shutdown))
155662306a36Sopenharmony_ci		return -EBADFD;
155762306a36Sopenharmony_ci
155862306a36Sopenharmony_ci	if (ep->sync_source)
155962306a36Sopenharmony_ci		WRITE_ONCE(ep->sync_source->sync_sink, ep);
156062306a36Sopenharmony_ci
156162306a36Sopenharmony_ci	usb_audio_dbg(ep->chip, "Starting %s EP 0x%x (running %d)\n",
156262306a36Sopenharmony_ci		      ep_type_name(ep->type), ep->ep_num,
156362306a36Sopenharmony_ci		      atomic_read(&ep->running));
156462306a36Sopenharmony_ci
156562306a36Sopenharmony_ci	/* already running? */
156662306a36Sopenharmony_ci	if (atomic_inc_return(&ep->running) != 1)
156762306a36Sopenharmony_ci		return 0;
156862306a36Sopenharmony_ci
156962306a36Sopenharmony_ci	if (ep->clock_ref)
157062306a36Sopenharmony_ci		atomic_inc(&ep->clock_ref->locked);
157162306a36Sopenharmony_ci
157262306a36Sopenharmony_ci	ep->active_mask = 0;
157362306a36Sopenharmony_ci	ep->unlink_mask = 0;
157462306a36Sopenharmony_ci	ep->phase = 0;
157562306a36Sopenharmony_ci	ep->sample_accum = 0;
157662306a36Sopenharmony_ci
157762306a36Sopenharmony_ci	snd_usb_endpoint_start_quirk(ep);
157862306a36Sopenharmony_ci
157962306a36Sopenharmony_ci	/*
158062306a36Sopenharmony_ci	 * If this endpoint has a data endpoint as implicit feedback source,
158162306a36Sopenharmony_ci	 * don't start the urbs here. Instead, mark them all as available,
158262306a36Sopenharmony_ci	 * wait for the record urbs to return and queue the playback urbs
158362306a36Sopenharmony_ci	 * from that context.
158462306a36Sopenharmony_ci	 */
158562306a36Sopenharmony_ci
158662306a36Sopenharmony_ci	if (!ep_state_update(ep, EP_STATE_STOPPED, EP_STATE_RUNNING))
158762306a36Sopenharmony_ci		goto __error;
158862306a36Sopenharmony_ci
158962306a36Sopenharmony_ci	if (snd_usb_endpoint_implicit_feedback_sink(ep) &&
159062306a36Sopenharmony_ci	    !(ep->chip->quirk_flags & QUIRK_FLAG_PLAYBACK_FIRST)) {
159162306a36Sopenharmony_ci		usb_audio_dbg(ep->chip, "No URB submission due to implicit fb sync\n");
159262306a36Sopenharmony_ci		i = 0;
159362306a36Sopenharmony_ci		goto fill_rest;
159462306a36Sopenharmony_ci	}
159562306a36Sopenharmony_ci
159662306a36Sopenharmony_ci	for (i = 0; i < ep->nurbs; i++) {
159762306a36Sopenharmony_ci		struct urb *urb = ep->urb[i].urb;
159862306a36Sopenharmony_ci
159962306a36Sopenharmony_ci		if (snd_BUG_ON(!urb))
160062306a36Sopenharmony_ci			goto __error;
160162306a36Sopenharmony_ci
160262306a36Sopenharmony_ci		if (is_playback)
160362306a36Sopenharmony_ci			err = prepare_outbound_urb(ep, urb->context, true);
160462306a36Sopenharmony_ci		else
160562306a36Sopenharmony_ci			err = prepare_inbound_urb(ep, urb->context);
160662306a36Sopenharmony_ci		if (err < 0) {
160762306a36Sopenharmony_ci			/* stop filling at applptr */
160862306a36Sopenharmony_ci			if (err == -EAGAIN)
160962306a36Sopenharmony_ci				break;
161062306a36Sopenharmony_ci			usb_audio_dbg(ep->chip,
161162306a36Sopenharmony_ci				      "EP 0x%x: failed to prepare urb: %d\n",
161262306a36Sopenharmony_ci				      ep->ep_num, err);
161362306a36Sopenharmony_ci			goto __error;
161462306a36Sopenharmony_ci		}
161562306a36Sopenharmony_ci
161662306a36Sopenharmony_ci		if (!atomic_read(&ep->chip->shutdown))
161762306a36Sopenharmony_ci			err = usb_submit_urb(urb, GFP_ATOMIC);
161862306a36Sopenharmony_ci		else
161962306a36Sopenharmony_ci			err = -ENODEV;
162062306a36Sopenharmony_ci		if (err < 0) {
162162306a36Sopenharmony_ci			if (!atomic_read(&ep->chip->shutdown))
162262306a36Sopenharmony_ci				usb_audio_err(ep->chip,
162362306a36Sopenharmony_ci					      "cannot submit urb %d, error %d: %s\n",
162462306a36Sopenharmony_ci					      i, err, usb_error_string(err));
162562306a36Sopenharmony_ci			goto __error;
162662306a36Sopenharmony_ci		}
162762306a36Sopenharmony_ci		set_bit(i, &ep->active_mask);
162862306a36Sopenharmony_ci		atomic_inc(&ep->submitted_urbs);
162962306a36Sopenharmony_ci	}
163062306a36Sopenharmony_ci
163162306a36Sopenharmony_ci	if (!i) {
163262306a36Sopenharmony_ci		usb_audio_dbg(ep->chip, "XRUN at starting EP 0x%x\n",
163362306a36Sopenharmony_ci			      ep->ep_num);
163462306a36Sopenharmony_ci		goto __error;
163562306a36Sopenharmony_ci	}
163662306a36Sopenharmony_ci
163762306a36Sopenharmony_ci	usb_audio_dbg(ep->chip, "%d URBs submitted for EP 0x%x\n",
163862306a36Sopenharmony_ci		      i, ep->ep_num);
163962306a36Sopenharmony_ci
164062306a36Sopenharmony_ci fill_rest:
164162306a36Sopenharmony_ci	/* put the remaining URBs to ready list */
164262306a36Sopenharmony_ci	if (is_playback) {
164362306a36Sopenharmony_ci		for (; i < ep->nurbs; i++)
164462306a36Sopenharmony_ci			push_back_to_ready_list(ep, ep->urb + i);
164562306a36Sopenharmony_ci	}
164662306a36Sopenharmony_ci
164762306a36Sopenharmony_ci	return 0;
164862306a36Sopenharmony_ci
164962306a36Sopenharmony_ci__error:
165062306a36Sopenharmony_ci	snd_usb_endpoint_stop(ep, false);
165162306a36Sopenharmony_ci	return -EPIPE;
165262306a36Sopenharmony_ci}
165362306a36Sopenharmony_ci
165462306a36Sopenharmony_ci/**
165562306a36Sopenharmony_ci * snd_usb_endpoint_stop: stop an snd_usb_endpoint
165662306a36Sopenharmony_ci *
165762306a36Sopenharmony_ci * @ep: the endpoint to stop (may be NULL)
165862306a36Sopenharmony_ci * @keep_pending: keep in-flight URBs
165962306a36Sopenharmony_ci *
166062306a36Sopenharmony_ci * A call to this function will decrement the running count of the endpoint.
166162306a36Sopenharmony_ci * In case the last user has requested the endpoint stop, the URBs will
166262306a36Sopenharmony_ci * actually be deactivated.
166362306a36Sopenharmony_ci *
166462306a36Sopenharmony_ci * Must be balanced to calls of snd_usb_endpoint_start().
166562306a36Sopenharmony_ci *
166662306a36Sopenharmony_ci * The caller needs to synchronize the pending stop operation via
166762306a36Sopenharmony_ci * snd_usb_endpoint_sync_pending_stop().
166862306a36Sopenharmony_ci */
166962306a36Sopenharmony_civoid snd_usb_endpoint_stop(struct snd_usb_endpoint *ep, bool keep_pending)
167062306a36Sopenharmony_ci{
167162306a36Sopenharmony_ci	if (!ep)
167262306a36Sopenharmony_ci		return;
167362306a36Sopenharmony_ci
167462306a36Sopenharmony_ci	usb_audio_dbg(ep->chip, "Stopping %s EP 0x%x (running %d)\n",
167562306a36Sopenharmony_ci		      ep_type_name(ep->type), ep->ep_num,
167662306a36Sopenharmony_ci		      atomic_read(&ep->running));
167762306a36Sopenharmony_ci
167862306a36Sopenharmony_ci	if (snd_BUG_ON(!atomic_read(&ep->running)))
167962306a36Sopenharmony_ci		return;
168062306a36Sopenharmony_ci
168162306a36Sopenharmony_ci	if (!atomic_dec_return(&ep->running)) {
168262306a36Sopenharmony_ci		if (ep->sync_source)
168362306a36Sopenharmony_ci			WRITE_ONCE(ep->sync_source->sync_sink, NULL);
168462306a36Sopenharmony_ci		stop_urbs(ep, false, keep_pending);
168562306a36Sopenharmony_ci		if (ep->clock_ref)
168662306a36Sopenharmony_ci			atomic_dec(&ep->clock_ref->locked);
168762306a36Sopenharmony_ci
168862306a36Sopenharmony_ci		if (ep->chip->quirk_flags & QUIRK_FLAG_FORCE_IFACE_RESET &&
168962306a36Sopenharmony_ci		    usb_pipeout(ep->pipe)) {
169062306a36Sopenharmony_ci			ep->need_prepare = true;
169162306a36Sopenharmony_ci			if (ep->iface_ref)
169262306a36Sopenharmony_ci				ep->iface_ref->need_setup = true;
169362306a36Sopenharmony_ci		}
169462306a36Sopenharmony_ci	}
169562306a36Sopenharmony_ci}
169662306a36Sopenharmony_ci
169762306a36Sopenharmony_ci/**
169862306a36Sopenharmony_ci * snd_usb_endpoint_release: Tear down an snd_usb_endpoint
169962306a36Sopenharmony_ci *
170062306a36Sopenharmony_ci * @ep: the endpoint to release
170162306a36Sopenharmony_ci *
170262306a36Sopenharmony_ci * This function does not care for the endpoint's running count but will tear
170362306a36Sopenharmony_ci * down all the streaming URBs immediately.
170462306a36Sopenharmony_ci */
170562306a36Sopenharmony_civoid snd_usb_endpoint_release(struct snd_usb_endpoint *ep)
170662306a36Sopenharmony_ci{
170762306a36Sopenharmony_ci	release_urbs(ep, true);
170862306a36Sopenharmony_ci}
170962306a36Sopenharmony_ci
171062306a36Sopenharmony_ci/**
171162306a36Sopenharmony_ci * snd_usb_endpoint_free_all: Free the resources of an snd_usb_endpoint
171262306a36Sopenharmony_ci * @chip: The chip
171362306a36Sopenharmony_ci *
171462306a36Sopenharmony_ci * This free all endpoints and those resources
171562306a36Sopenharmony_ci */
171662306a36Sopenharmony_civoid snd_usb_endpoint_free_all(struct snd_usb_audio *chip)
171762306a36Sopenharmony_ci{
171862306a36Sopenharmony_ci	struct snd_usb_endpoint *ep, *en;
171962306a36Sopenharmony_ci	struct snd_usb_iface_ref *ip, *in;
172062306a36Sopenharmony_ci	struct snd_usb_clock_ref *cp, *cn;
172162306a36Sopenharmony_ci
172262306a36Sopenharmony_ci	list_for_each_entry_safe(ep, en, &chip->ep_list, list)
172362306a36Sopenharmony_ci		kfree(ep);
172462306a36Sopenharmony_ci
172562306a36Sopenharmony_ci	list_for_each_entry_safe(ip, in, &chip->iface_ref_list, list)
172662306a36Sopenharmony_ci		kfree(ip);
172762306a36Sopenharmony_ci
172862306a36Sopenharmony_ci	list_for_each_entry_safe(cp, cn, &chip->clock_ref_list, list)
172962306a36Sopenharmony_ci		kfree(cp);
173062306a36Sopenharmony_ci}
173162306a36Sopenharmony_ci
173262306a36Sopenharmony_ci/*
173362306a36Sopenharmony_ci * snd_usb_handle_sync_urb: parse an USB sync packet
173462306a36Sopenharmony_ci *
173562306a36Sopenharmony_ci * @ep: the endpoint to handle the packet
173662306a36Sopenharmony_ci * @sender: the sending endpoint
173762306a36Sopenharmony_ci * @urb: the received packet
173862306a36Sopenharmony_ci *
173962306a36Sopenharmony_ci * This function is called from the context of an endpoint that received
174062306a36Sopenharmony_ci * the packet and is used to let another endpoint object handle the payload.
174162306a36Sopenharmony_ci */
174262306a36Sopenharmony_cistatic void snd_usb_handle_sync_urb(struct snd_usb_endpoint *ep,
174362306a36Sopenharmony_ci				    struct snd_usb_endpoint *sender,
174462306a36Sopenharmony_ci				    const struct urb *urb)
174562306a36Sopenharmony_ci{
174662306a36Sopenharmony_ci	int shift;
174762306a36Sopenharmony_ci	unsigned int f;
174862306a36Sopenharmony_ci	unsigned long flags;
174962306a36Sopenharmony_ci
175062306a36Sopenharmony_ci	snd_BUG_ON(ep == sender);
175162306a36Sopenharmony_ci
175262306a36Sopenharmony_ci	/*
175362306a36Sopenharmony_ci	 * In case the endpoint is operating in implicit feedback mode, prepare
175462306a36Sopenharmony_ci	 * a new outbound URB that has the same layout as the received packet
175562306a36Sopenharmony_ci	 * and add it to the list of pending urbs. queue_pending_output_urbs()
175662306a36Sopenharmony_ci	 * will take care of them later.
175762306a36Sopenharmony_ci	 */
175862306a36Sopenharmony_ci	if (snd_usb_endpoint_implicit_feedback_sink(ep) &&
175962306a36Sopenharmony_ci	    atomic_read(&ep->running)) {
176062306a36Sopenharmony_ci
176162306a36Sopenharmony_ci		/* implicit feedback case */
176262306a36Sopenharmony_ci		int i, bytes = 0;
176362306a36Sopenharmony_ci		struct snd_urb_ctx *in_ctx;
176462306a36Sopenharmony_ci		struct snd_usb_packet_info *out_packet;
176562306a36Sopenharmony_ci
176662306a36Sopenharmony_ci		in_ctx = urb->context;
176762306a36Sopenharmony_ci
176862306a36Sopenharmony_ci		/* Count overall packet size */
176962306a36Sopenharmony_ci		for (i = 0; i < in_ctx->packets; i++)
177062306a36Sopenharmony_ci			if (urb->iso_frame_desc[i].status == 0)
177162306a36Sopenharmony_ci				bytes += urb->iso_frame_desc[i].actual_length;
177262306a36Sopenharmony_ci
177362306a36Sopenharmony_ci		/*
177462306a36Sopenharmony_ci		 * skip empty packets. At least M-Audio's Fast Track Ultra stops
177562306a36Sopenharmony_ci		 * streaming once it received a 0-byte OUT URB
177662306a36Sopenharmony_ci		 */
177762306a36Sopenharmony_ci		if (bytes == 0)
177862306a36Sopenharmony_ci			return;
177962306a36Sopenharmony_ci
178062306a36Sopenharmony_ci		spin_lock_irqsave(&ep->lock, flags);
178162306a36Sopenharmony_ci		if (ep->next_packet_queued >= ARRAY_SIZE(ep->next_packet)) {
178262306a36Sopenharmony_ci			spin_unlock_irqrestore(&ep->lock, flags);
178362306a36Sopenharmony_ci			usb_audio_err(ep->chip,
178462306a36Sopenharmony_ci				      "next package FIFO overflow EP 0x%x\n",
178562306a36Sopenharmony_ci				      ep->ep_num);
178662306a36Sopenharmony_ci			notify_xrun(ep);
178762306a36Sopenharmony_ci			return;
178862306a36Sopenharmony_ci		}
178962306a36Sopenharmony_ci
179062306a36Sopenharmony_ci		out_packet = next_packet_fifo_enqueue(ep);
179162306a36Sopenharmony_ci
179262306a36Sopenharmony_ci		/*
179362306a36Sopenharmony_ci		 * Iterate through the inbound packet and prepare the lengths
179462306a36Sopenharmony_ci		 * for the output packet. The OUT packet we are about to send
179562306a36Sopenharmony_ci		 * will have the same amount of payload bytes per stride as the
179662306a36Sopenharmony_ci		 * IN packet we just received. Since the actual size is scaled
179762306a36Sopenharmony_ci		 * by the stride, use the sender stride to calculate the length
179862306a36Sopenharmony_ci		 * in case the number of channels differ between the implicitly
179962306a36Sopenharmony_ci		 * fed-back endpoint and the synchronizing endpoint.
180062306a36Sopenharmony_ci		 */
180162306a36Sopenharmony_ci
180262306a36Sopenharmony_ci		out_packet->packets = in_ctx->packets;
180362306a36Sopenharmony_ci		for (i = 0; i < in_ctx->packets; i++) {
180462306a36Sopenharmony_ci			if (urb->iso_frame_desc[i].status == 0)
180562306a36Sopenharmony_ci				out_packet->packet_size[i] =
180662306a36Sopenharmony_ci					urb->iso_frame_desc[i].actual_length / sender->stride;
180762306a36Sopenharmony_ci			else
180862306a36Sopenharmony_ci				out_packet->packet_size[i] = 0;
180962306a36Sopenharmony_ci		}
181062306a36Sopenharmony_ci
181162306a36Sopenharmony_ci		spin_unlock_irqrestore(&ep->lock, flags);
181262306a36Sopenharmony_ci		snd_usb_queue_pending_output_urbs(ep, false);
181362306a36Sopenharmony_ci
181462306a36Sopenharmony_ci		return;
181562306a36Sopenharmony_ci	}
181662306a36Sopenharmony_ci
181762306a36Sopenharmony_ci	/*
181862306a36Sopenharmony_ci	 * process after playback sync complete
181962306a36Sopenharmony_ci	 *
182062306a36Sopenharmony_ci	 * Full speed devices report feedback values in 10.14 format as samples
182162306a36Sopenharmony_ci	 * per frame, high speed devices in 16.16 format as samples per
182262306a36Sopenharmony_ci	 * microframe.
182362306a36Sopenharmony_ci	 *
182462306a36Sopenharmony_ci	 * Because the Audio Class 1 spec was written before USB 2.0, many high
182562306a36Sopenharmony_ci	 * speed devices use a wrong interpretation, some others use an
182662306a36Sopenharmony_ci	 * entirely different format.
182762306a36Sopenharmony_ci	 *
182862306a36Sopenharmony_ci	 * Therefore, we cannot predict what format any particular device uses
182962306a36Sopenharmony_ci	 * and must detect it automatically.
183062306a36Sopenharmony_ci	 */
183162306a36Sopenharmony_ci
183262306a36Sopenharmony_ci	if (urb->iso_frame_desc[0].status != 0 ||
183362306a36Sopenharmony_ci	    urb->iso_frame_desc[0].actual_length < 3)
183462306a36Sopenharmony_ci		return;
183562306a36Sopenharmony_ci
183662306a36Sopenharmony_ci	f = le32_to_cpup(urb->transfer_buffer);
183762306a36Sopenharmony_ci	if (urb->iso_frame_desc[0].actual_length == 3)
183862306a36Sopenharmony_ci		f &= 0x00ffffff;
183962306a36Sopenharmony_ci	else
184062306a36Sopenharmony_ci		f &= 0x0fffffff;
184162306a36Sopenharmony_ci
184262306a36Sopenharmony_ci	if (f == 0)
184362306a36Sopenharmony_ci		return;
184462306a36Sopenharmony_ci
184562306a36Sopenharmony_ci	if (unlikely(sender->tenor_fb_quirk)) {
184662306a36Sopenharmony_ci		/*
184762306a36Sopenharmony_ci		 * Devices based on Tenor 8802 chipsets (TEAC UD-H01
184862306a36Sopenharmony_ci		 * and others) sometimes change the feedback value
184962306a36Sopenharmony_ci		 * by +/- 0x1.0000.
185062306a36Sopenharmony_ci		 */
185162306a36Sopenharmony_ci		if (f < ep->freqn - 0x8000)
185262306a36Sopenharmony_ci			f += 0xf000;
185362306a36Sopenharmony_ci		else if (f > ep->freqn + 0x8000)
185462306a36Sopenharmony_ci			f -= 0xf000;
185562306a36Sopenharmony_ci	} else if (unlikely(ep->freqshift == INT_MIN)) {
185662306a36Sopenharmony_ci		/*
185762306a36Sopenharmony_ci		 * The first time we see a feedback value, determine its format
185862306a36Sopenharmony_ci		 * by shifting it left or right until it matches the nominal
185962306a36Sopenharmony_ci		 * frequency value.  This assumes that the feedback does not
186062306a36Sopenharmony_ci		 * differ from the nominal value more than +50% or -25%.
186162306a36Sopenharmony_ci		 */
186262306a36Sopenharmony_ci		shift = 0;
186362306a36Sopenharmony_ci		while (f < ep->freqn - ep->freqn / 4) {
186462306a36Sopenharmony_ci			f <<= 1;
186562306a36Sopenharmony_ci			shift++;
186662306a36Sopenharmony_ci		}
186762306a36Sopenharmony_ci		while (f > ep->freqn + ep->freqn / 2) {
186862306a36Sopenharmony_ci			f >>= 1;
186962306a36Sopenharmony_ci			shift--;
187062306a36Sopenharmony_ci		}
187162306a36Sopenharmony_ci		ep->freqshift = shift;
187262306a36Sopenharmony_ci	} else if (ep->freqshift >= 0)
187362306a36Sopenharmony_ci		f <<= ep->freqshift;
187462306a36Sopenharmony_ci	else
187562306a36Sopenharmony_ci		f >>= -ep->freqshift;
187662306a36Sopenharmony_ci
187762306a36Sopenharmony_ci	if (likely(f >= ep->freqn - ep->freqn / 8 && f <= ep->freqmax)) {
187862306a36Sopenharmony_ci		/*
187962306a36Sopenharmony_ci		 * If the frequency looks valid, set it.
188062306a36Sopenharmony_ci		 * This value is referred to in prepare_playback_urb().
188162306a36Sopenharmony_ci		 */
188262306a36Sopenharmony_ci		spin_lock_irqsave(&ep->lock, flags);
188362306a36Sopenharmony_ci		ep->freqm = f;
188462306a36Sopenharmony_ci		spin_unlock_irqrestore(&ep->lock, flags);
188562306a36Sopenharmony_ci	} else {
188662306a36Sopenharmony_ci		/*
188762306a36Sopenharmony_ci		 * Out of range; maybe the shift value is wrong.
188862306a36Sopenharmony_ci		 * Reset it so that we autodetect again the next time.
188962306a36Sopenharmony_ci		 */
189062306a36Sopenharmony_ci		ep->freqshift = INT_MIN;
189162306a36Sopenharmony_ci	}
189262306a36Sopenharmony_ci}
189362306a36Sopenharmony_ci
1894