xref: /linux/sound/firewire/amdtp-stream.c (revision 274fc3558133d33311b22a962d0f362ddd281b51)
1da607e19SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2d67c46b9STakashi Sakamoto /*
3d67c46b9STakashi Sakamoto  * Audio and Music Data Transmission Protocol (IEC 61883-6) streams
4d67c46b9STakashi Sakamoto  * with Common Isochronous Packet (IEC 61883-1) headers
5d67c46b9STakashi Sakamoto  *
6d67c46b9STakashi Sakamoto  * Copyright (c) Clemens Ladisch <clemens@ladisch.de>
7d67c46b9STakashi Sakamoto  */
8d67c46b9STakashi Sakamoto 
9d67c46b9STakashi Sakamoto #include <linux/device.h>
10d67c46b9STakashi Sakamoto #include <linux/err.h>
11d67c46b9STakashi Sakamoto #include <linux/firewire.h>
12acfedcbeSTakashi Sakamoto #include <linux/firewire-constants.h>
13d67c46b9STakashi Sakamoto #include <linux/module.h>
14d67c46b9STakashi Sakamoto #include <linux/slab.h>
15d67c46b9STakashi Sakamoto #include <sound/pcm.h>
16d67c46b9STakashi Sakamoto #include <sound/pcm_params.h>
17d67c46b9STakashi Sakamoto #include "amdtp-stream.h"
18d67c46b9STakashi Sakamoto 
19d67c46b9STakashi Sakamoto #define TICKS_PER_CYCLE		3072
20d67c46b9STakashi Sakamoto #define CYCLES_PER_SECOND	8000
21d67c46b9STakashi Sakamoto #define TICKS_PER_SECOND	(TICKS_PER_CYCLE * CYCLES_PER_SECOND)
22d67c46b9STakashi Sakamoto 
2310aa8e4aSTakashi Sakamoto #define OHCI_MAX_SECOND		8
2410aa8e4aSTakashi Sakamoto 
250c95c1d6STakashi Sakamoto /* Always support Linux tracing subsystem. */
260c95c1d6STakashi Sakamoto #define CREATE_TRACE_POINTS
270c95c1d6STakashi Sakamoto #include "amdtp-stream-trace.h"
280c95c1d6STakashi Sakamoto 
29d67c46b9STakashi Sakamoto #define TRANSFER_DELAY_TICKS	0x2e00 /* 479.17 microseconds */
30d67c46b9STakashi Sakamoto 
31d67c46b9STakashi Sakamoto /* isochronous header parameters */
32d67c46b9STakashi Sakamoto #define ISO_DATA_LENGTH_SHIFT	16
333b196c39STakashi Sakamoto #define TAG_NO_CIP_HEADER	0
34d67c46b9STakashi Sakamoto #define TAG_CIP			1
35d67c46b9STakashi Sakamoto 
36d67c46b9STakashi Sakamoto /* common isochronous packet header parameters */
37d67c46b9STakashi Sakamoto #define CIP_EOH_SHIFT		31
38d67c46b9STakashi Sakamoto #define CIP_EOH			(1u << CIP_EOH_SHIFT)
39d67c46b9STakashi Sakamoto #define CIP_EOH_MASK		0x80000000
40d67c46b9STakashi Sakamoto #define CIP_SID_SHIFT		24
41d67c46b9STakashi Sakamoto #define CIP_SID_MASK		0x3f000000
42d67c46b9STakashi Sakamoto #define CIP_DBS_MASK		0x00ff0000
43d67c46b9STakashi Sakamoto #define CIP_DBS_SHIFT		16
449863874fSTakashi Sakamoto #define CIP_SPH_MASK		0x00000400
459863874fSTakashi Sakamoto #define CIP_SPH_SHIFT		10
46d67c46b9STakashi Sakamoto #define CIP_DBC_MASK		0x000000ff
47d67c46b9STakashi Sakamoto #define CIP_FMT_SHIFT		24
48d67c46b9STakashi Sakamoto #define CIP_FMT_MASK		0x3f000000
49d67c46b9STakashi Sakamoto #define CIP_FDF_MASK		0x00ff0000
50d67c46b9STakashi Sakamoto #define CIP_FDF_SHIFT		16
51d67c46b9STakashi Sakamoto #define CIP_SYT_MASK		0x0000ffff
52d67c46b9STakashi Sakamoto #define CIP_SYT_NO_INFO		0xffff
53d67c46b9STakashi Sakamoto 
5451c29fd2STakashi Sakamoto /* Audio and Music transfer protocol specific parameters */
55d67c46b9STakashi Sakamoto #define CIP_FMT_AM		0x10
56d67c46b9STakashi Sakamoto #define AMDTP_FDF_NO_DATA	0xff
57d67c46b9STakashi Sakamoto 
58f11453c7STakashi Sakamoto // For iso header, tstamp and 2 CIP header.
59f11453c7STakashi Sakamoto #define IR_CTX_HEADER_SIZE_CIP		16
60f11453c7STakashi Sakamoto // For iso header and tstamp.
61f11453c7STakashi Sakamoto #define IR_CTX_HEADER_SIZE_NO_CIP	8
62cc4f8e91STakashi Sakamoto #define HEADER_TSTAMP_MASK	0x0000ffff
63d67c46b9STakashi Sakamoto 
64b18f0cfaSTakashi Sakamoto #define IT_PKT_HEADER_SIZE_CIP		8 // For 2 CIP header.
65b18f0cfaSTakashi Sakamoto #define IT_PKT_HEADER_SIZE_NO_CIP	0 // Nothing.
66b18f0cfaSTakashi Sakamoto 
67d67c46b9STakashi Sakamoto static void pcm_period_tasklet(unsigned long data);
68d67c46b9STakashi Sakamoto 
69d67c46b9STakashi Sakamoto /**
70d67c46b9STakashi Sakamoto  * amdtp_stream_init - initialize an AMDTP stream structure
71d67c46b9STakashi Sakamoto  * @s: the AMDTP stream to initialize
72d67c46b9STakashi Sakamoto  * @unit: the target of the stream
73d67c46b9STakashi Sakamoto  * @dir: the direction of stream
74d67c46b9STakashi Sakamoto  * @flags: the packet transmission method to use
755955815eSTakashi Sakamoto  * @fmt: the value of fmt field in CIP header
769a738ad1STakashi Sakamoto  * @process_ctx_payloads: callback handler to process payloads of isoc context
77df075feeSTakashi Sakamoto  * @protocol_size: the size to allocate newly for protocol
78d67c46b9STakashi Sakamoto  */
79d67c46b9STakashi Sakamoto int amdtp_stream_init(struct amdtp_stream *s, struct fw_unit *unit,
805955815eSTakashi Sakamoto 		      enum amdtp_stream_direction dir, enum cip_flags flags,
81df075feeSTakashi Sakamoto 		      unsigned int fmt,
829a738ad1STakashi Sakamoto 		      amdtp_stream_process_ctx_payloads_t process_ctx_payloads,
83df075feeSTakashi Sakamoto 		      unsigned int protocol_size)
84d67c46b9STakashi Sakamoto {
859a738ad1STakashi Sakamoto 	if (process_ctx_payloads == NULL)
86df075feeSTakashi Sakamoto 		return -EINVAL;
87df075feeSTakashi Sakamoto 
88df075feeSTakashi Sakamoto 	s->protocol = kzalloc(protocol_size, GFP_KERNEL);
89df075feeSTakashi Sakamoto 	if (!s->protocol)
90df075feeSTakashi Sakamoto 		return -ENOMEM;
91df075feeSTakashi Sakamoto 
92d67c46b9STakashi Sakamoto 	s->unit = unit;
93d67c46b9STakashi Sakamoto 	s->direction = dir;
94d67c46b9STakashi Sakamoto 	s->flags = flags;
95d67c46b9STakashi Sakamoto 	s->context = ERR_PTR(-1);
96d67c46b9STakashi Sakamoto 	mutex_init(&s->mutex);
97d67c46b9STakashi Sakamoto 	tasklet_init(&s->period_tasklet, pcm_period_tasklet, (unsigned long)s);
98d67c46b9STakashi Sakamoto 	s->packet_index = 0;
99d67c46b9STakashi Sakamoto 
100d67c46b9STakashi Sakamoto 	init_waitqueue_head(&s->callback_wait);
101d67c46b9STakashi Sakamoto 	s->callbacked = false;
102d67c46b9STakashi Sakamoto 
1035955815eSTakashi Sakamoto 	s->fmt = fmt;
1049a738ad1STakashi Sakamoto 	s->process_ctx_payloads = process_ctx_payloads;
105d67c46b9STakashi Sakamoto 
1063baf3053STakashi Sakamoto 	if (dir == AMDTP_OUT_STREAM)
1073baf3053STakashi Sakamoto 		s->ctx_data.rx.syt_override = -1;
1083baf3053STakashi Sakamoto 
109d67c46b9STakashi Sakamoto 	return 0;
110d67c46b9STakashi Sakamoto }
111d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_init);
112d67c46b9STakashi Sakamoto 
113d67c46b9STakashi Sakamoto /**
114d67c46b9STakashi Sakamoto  * amdtp_stream_destroy - free stream resources
115d67c46b9STakashi Sakamoto  * @s: the AMDTP stream to destroy
116d67c46b9STakashi Sakamoto  */
117d67c46b9STakashi Sakamoto void amdtp_stream_destroy(struct amdtp_stream *s)
118d67c46b9STakashi Sakamoto {
11944c376b9STakashi Sakamoto 	/* Not initialized. */
12044c376b9STakashi Sakamoto 	if (s->protocol == NULL)
12144c376b9STakashi Sakamoto 		return;
12244c376b9STakashi Sakamoto 
123d67c46b9STakashi Sakamoto 	WARN_ON(amdtp_stream_running(s));
124df075feeSTakashi Sakamoto 	kfree(s->protocol);
125d67c46b9STakashi Sakamoto 	mutex_destroy(&s->mutex);
126d67c46b9STakashi Sakamoto }
127d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_destroy);
128d67c46b9STakashi Sakamoto 
129d67c46b9STakashi Sakamoto const unsigned int amdtp_syt_intervals[CIP_SFC_COUNT] = {
130d67c46b9STakashi Sakamoto 	[CIP_SFC_32000]  =  8,
131d67c46b9STakashi Sakamoto 	[CIP_SFC_44100]  =  8,
132d67c46b9STakashi Sakamoto 	[CIP_SFC_48000]  =  8,
133d67c46b9STakashi Sakamoto 	[CIP_SFC_88200]  = 16,
134d67c46b9STakashi Sakamoto 	[CIP_SFC_96000]  = 16,
135d67c46b9STakashi Sakamoto 	[CIP_SFC_176400] = 32,
136d67c46b9STakashi Sakamoto 	[CIP_SFC_192000] = 32,
137d67c46b9STakashi Sakamoto };
138d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_syt_intervals);
139d67c46b9STakashi Sakamoto 
140d67c46b9STakashi Sakamoto const unsigned int amdtp_rate_table[CIP_SFC_COUNT] = {
141d67c46b9STakashi Sakamoto 	[CIP_SFC_32000]  =  32000,
142d67c46b9STakashi Sakamoto 	[CIP_SFC_44100]  =  44100,
143d67c46b9STakashi Sakamoto 	[CIP_SFC_48000]  =  48000,
144d67c46b9STakashi Sakamoto 	[CIP_SFC_88200]  =  88200,
145d67c46b9STakashi Sakamoto 	[CIP_SFC_96000]  =  96000,
146d67c46b9STakashi Sakamoto 	[CIP_SFC_176400] = 176400,
147d67c46b9STakashi Sakamoto 	[CIP_SFC_192000] = 192000,
148d67c46b9STakashi Sakamoto };
149d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_rate_table);
150d67c46b9STakashi Sakamoto 
15159502295STakashi Sakamoto static int apply_constraint_to_size(struct snd_pcm_hw_params *params,
15259502295STakashi Sakamoto 				    struct snd_pcm_hw_rule *rule)
15359502295STakashi Sakamoto {
15459502295STakashi Sakamoto 	struct snd_interval *s = hw_param_interval(params, rule->var);
15559502295STakashi Sakamoto 	const struct snd_interval *r =
15659502295STakashi Sakamoto 		hw_param_interval_c(params, SNDRV_PCM_HW_PARAM_RATE);
157826b5de9STakashi Sakamoto 	struct snd_interval t = {0};
158826b5de9STakashi Sakamoto 	unsigned int step = 0;
15959502295STakashi Sakamoto 	int i;
16059502295STakashi Sakamoto 
16159502295STakashi Sakamoto 	for (i = 0; i < CIP_SFC_COUNT; ++i) {
162826b5de9STakashi Sakamoto 		if (snd_interval_test(r, amdtp_rate_table[i]))
163826b5de9STakashi Sakamoto 			step = max(step, amdtp_syt_intervals[i]);
16459502295STakashi Sakamoto 	}
16559502295STakashi Sakamoto 
166826b5de9STakashi Sakamoto 	t.min = roundup(s->min, step);
167826b5de9STakashi Sakamoto 	t.max = rounddown(s->max, step);
168826b5de9STakashi Sakamoto 	t.integer = 1;
16959502295STakashi Sakamoto 
17059502295STakashi Sakamoto 	return snd_interval_refine(s, &t);
17159502295STakashi Sakamoto }
17259502295STakashi Sakamoto 
173d67c46b9STakashi Sakamoto /**
174d67c46b9STakashi Sakamoto  * amdtp_stream_add_pcm_hw_constraints - add hw constraints for PCM substream
175d67c46b9STakashi Sakamoto  * @s:		the AMDTP stream, which must be initialized.
176d67c46b9STakashi Sakamoto  * @runtime:	the PCM substream runtime
177d67c46b9STakashi Sakamoto  */
178d67c46b9STakashi Sakamoto int amdtp_stream_add_pcm_hw_constraints(struct amdtp_stream *s,
179d67c46b9STakashi Sakamoto 					struct snd_pcm_runtime *runtime)
180d67c46b9STakashi Sakamoto {
18155799c5aSTakashi Sakamoto 	struct snd_pcm_hardware *hw = &runtime->hw;
18299921ec6STakashi Sakamoto 	unsigned int ctx_header_size;
18399921ec6STakashi Sakamoto 	unsigned int maximum_usec_per_period;
184d67c46b9STakashi Sakamoto 	int err;
185d67c46b9STakashi Sakamoto 
18655799c5aSTakashi Sakamoto 	hw->info = SNDRV_PCM_INFO_BATCH |
18755799c5aSTakashi Sakamoto 		   SNDRV_PCM_INFO_BLOCK_TRANSFER |
18855799c5aSTakashi Sakamoto 		   SNDRV_PCM_INFO_INTERLEAVED |
18955799c5aSTakashi Sakamoto 		   SNDRV_PCM_INFO_JOINT_DUPLEX |
19055799c5aSTakashi Sakamoto 		   SNDRV_PCM_INFO_MMAP |
19155799c5aSTakashi Sakamoto 		   SNDRV_PCM_INFO_MMAP_VALID;
19255799c5aSTakashi Sakamoto 
19355799c5aSTakashi Sakamoto 	/* SNDRV_PCM_INFO_BATCH */
19455799c5aSTakashi Sakamoto 	hw->periods_min = 2;
19555799c5aSTakashi Sakamoto 	hw->periods_max = UINT_MAX;
19655799c5aSTakashi Sakamoto 
19755799c5aSTakashi Sakamoto 	/* bytes for a frame */
19855799c5aSTakashi Sakamoto 	hw->period_bytes_min = 4 * hw->channels_max;
19955799c5aSTakashi Sakamoto 
20055799c5aSTakashi Sakamoto 	/* Just to prevent from allocating much pages. */
20155799c5aSTakashi Sakamoto 	hw->period_bytes_max = hw->period_bytes_min * 2048;
20255799c5aSTakashi Sakamoto 	hw->buffer_bytes_max = hw->period_bytes_max * hw->periods_min;
20355799c5aSTakashi Sakamoto 
20499921ec6STakashi Sakamoto 	// Linux driver for 1394 OHCI controller voluntarily flushes isoc
20599921ec6STakashi Sakamoto 	// context when total size of accumulated context header reaches
20699921ec6STakashi Sakamoto 	// PAGE_SIZE. This kicks tasklet for the isoc context and brings
20799921ec6STakashi Sakamoto 	// callback in the middle of scheduled interrupts.
20899921ec6STakashi Sakamoto 	// Although AMDTP streams in the same domain use the same events per
20999921ec6STakashi Sakamoto 	// IRQ, use the largest size of context header between IT/IR contexts.
21099921ec6STakashi Sakamoto 	// Here, use the value of context header in IR context is for both
21199921ec6STakashi Sakamoto 	// contexts.
21299921ec6STakashi Sakamoto 	if (!(s->flags & CIP_NO_HEADER))
21399921ec6STakashi Sakamoto 		ctx_header_size = IR_CTX_HEADER_SIZE_CIP;
21499921ec6STakashi Sakamoto 	else
21599921ec6STakashi Sakamoto 		ctx_header_size = IR_CTX_HEADER_SIZE_NO_CIP;
21699921ec6STakashi Sakamoto 	maximum_usec_per_period = USEC_PER_SEC * PAGE_SIZE /
21799921ec6STakashi Sakamoto 				  CYCLES_PER_SECOND / ctx_header_size;
21899921ec6STakashi Sakamoto 
219f706df4fSTakashi Sakamoto 	// In IEC 61883-6, one isoc packet can transfer events up to the value
220f706df4fSTakashi Sakamoto 	// of syt interval. This comes from the interval of isoc cycle. As 1394
221f706df4fSTakashi Sakamoto 	// OHCI controller can generate hardware IRQ per isoc packet, the
222f706df4fSTakashi Sakamoto 	// interval is 125 usec.
223f706df4fSTakashi Sakamoto 	// However, there are two ways of transmission in IEC 61883-6; blocking
224f706df4fSTakashi Sakamoto 	// and non-blocking modes. In blocking mode, the sequence of isoc packet
225f706df4fSTakashi Sakamoto 	// includes 'empty' or 'NODATA' packets which include no event. In
226f706df4fSTakashi Sakamoto 	// non-blocking mode, the number of events per packet is variable up to
227f706df4fSTakashi Sakamoto 	// the syt interval.
228f706df4fSTakashi Sakamoto 	// Due to the above protocol design, the minimum PCM frames per
229f706df4fSTakashi Sakamoto 	// interrupt should be double of the value of syt interval, thus it is
230f706df4fSTakashi Sakamoto 	// 250 usec.
231d67c46b9STakashi Sakamoto 	err = snd_pcm_hw_constraint_minmax(runtime,
232d67c46b9STakashi Sakamoto 					   SNDRV_PCM_HW_PARAM_PERIOD_TIME,
233f706df4fSTakashi Sakamoto 					   250, maximum_usec_per_period);
234d67c46b9STakashi Sakamoto 	if (err < 0)
235d67c46b9STakashi Sakamoto 		goto end;
236d67c46b9STakashi Sakamoto 
237d67c46b9STakashi Sakamoto 	/* Non-Blocking stream has no more constraints */
238d67c46b9STakashi Sakamoto 	if (!(s->flags & CIP_BLOCKING))
239d67c46b9STakashi Sakamoto 		goto end;
240d67c46b9STakashi Sakamoto 
241d67c46b9STakashi Sakamoto 	/*
242d67c46b9STakashi Sakamoto 	 * One AMDTP packet can include some frames. In blocking mode, the
243d67c46b9STakashi Sakamoto 	 * number equals to SYT_INTERVAL. So the number is 8, 16 or 32,
244d67c46b9STakashi Sakamoto 	 * depending on its sampling rate. For accurate period interrupt, it's
245d67c46b9STakashi Sakamoto 	 * preferrable to align period/buffer sizes to current SYT_INTERVAL.
246d67c46b9STakashi Sakamoto 	 */
24759502295STakashi Sakamoto 	err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
24859502295STakashi Sakamoto 				  apply_constraint_to_size, NULL,
249826b5de9STakashi Sakamoto 				  SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
25059502295STakashi Sakamoto 				  SNDRV_PCM_HW_PARAM_RATE, -1);
251d67c46b9STakashi Sakamoto 	if (err < 0)
252d67c46b9STakashi Sakamoto 		goto end;
25359502295STakashi Sakamoto 	err = snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
25459502295STakashi Sakamoto 				  apply_constraint_to_size, NULL,
255826b5de9STakashi Sakamoto 				  SNDRV_PCM_HW_PARAM_BUFFER_SIZE,
25659502295STakashi Sakamoto 				  SNDRV_PCM_HW_PARAM_RATE, -1);
25759502295STakashi Sakamoto 	if (err < 0)
25859502295STakashi Sakamoto 		goto end;
259d67c46b9STakashi Sakamoto end:
260d67c46b9STakashi Sakamoto 	return err;
261d67c46b9STakashi Sakamoto }
262d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_add_pcm_hw_constraints);
263d67c46b9STakashi Sakamoto 
264d67c46b9STakashi Sakamoto /**
265d67c46b9STakashi Sakamoto  * amdtp_stream_set_parameters - set stream parameters
266d67c46b9STakashi Sakamoto  * @s: the AMDTP stream to configure
267d67c46b9STakashi Sakamoto  * @rate: the sample rate
268df075feeSTakashi Sakamoto  * @data_block_quadlets: the size of a data block in quadlet unit
269d67c46b9STakashi Sakamoto  *
270d67c46b9STakashi Sakamoto  * The parameters must be set before the stream is started, and must not be
271d67c46b9STakashi Sakamoto  * changed while the stream is running.
272d67c46b9STakashi Sakamoto  */
273df075feeSTakashi Sakamoto int amdtp_stream_set_parameters(struct amdtp_stream *s, unsigned int rate,
274df075feeSTakashi Sakamoto 				unsigned int data_block_quadlets)
275d67c46b9STakashi Sakamoto {
276df075feeSTakashi Sakamoto 	unsigned int sfc;
277d67c46b9STakashi Sakamoto 
278d67c46b9STakashi Sakamoto 	for (sfc = 0; sfc < ARRAY_SIZE(amdtp_rate_table); ++sfc) {
279d67c46b9STakashi Sakamoto 		if (amdtp_rate_table[sfc] == rate)
280d67c46b9STakashi Sakamoto 			break;
281d67c46b9STakashi Sakamoto 	}
282d67c46b9STakashi Sakamoto 	if (sfc == ARRAY_SIZE(amdtp_rate_table))
283d67c46b9STakashi Sakamoto 		return -EINVAL;
284d67c46b9STakashi Sakamoto 
285d67c46b9STakashi Sakamoto 	s->sfc = sfc;
286df075feeSTakashi Sakamoto 	s->data_block_quadlets = data_block_quadlets;
287d67c46b9STakashi Sakamoto 	s->syt_interval = amdtp_syt_intervals[sfc];
288d67c46b9STakashi Sakamoto 
289d3d10a4aSTakashi Sakamoto 	// default buffering in the device.
290d3d10a4aSTakashi Sakamoto 	if (s->direction == AMDTP_OUT_STREAM) {
291d3d10a4aSTakashi Sakamoto 		s->ctx_data.rx.transfer_delay =
292d3d10a4aSTakashi Sakamoto 					TRANSFER_DELAY_TICKS - TICKS_PER_CYCLE;
293d3d10a4aSTakashi Sakamoto 
294d3d10a4aSTakashi Sakamoto 		if (s->flags & CIP_BLOCKING) {
295d3d10a4aSTakashi Sakamoto 			// additional buffering needed to adjust for no-data
296d3d10a4aSTakashi Sakamoto 			// packets.
297d3d10a4aSTakashi Sakamoto 			s->ctx_data.rx.transfer_delay +=
298d3d10a4aSTakashi Sakamoto 				TICKS_PER_SECOND * s->syt_interval / rate;
299d3d10a4aSTakashi Sakamoto 		}
300d3d10a4aSTakashi Sakamoto 	}
301d67c46b9STakashi Sakamoto 
302d67c46b9STakashi Sakamoto 	return 0;
303d67c46b9STakashi Sakamoto }
304d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_set_parameters);
305d67c46b9STakashi Sakamoto 
306d67c46b9STakashi Sakamoto /**
307d67c46b9STakashi Sakamoto  * amdtp_stream_get_max_payload - get the stream's packet size
308d67c46b9STakashi Sakamoto  * @s: the AMDTP stream
309d67c46b9STakashi Sakamoto  *
310d67c46b9STakashi Sakamoto  * This function must not be called before the stream has been configured
311d67c46b9STakashi Sakamoto  * with amdtp_stream_set_parameters().
312d67c46b9STakashi Sakamoto  */
313d67c46b9STakashi Sakamoto unsigned int amdtp_stream_get_max_payload(struct amdtp_stream *s)
314d67c46b9STakashi Sakamoto {
315d67c46b9STakashi Sakamoto 	unsigned int multiplier = 1;
31607ea238cSTakashi Sakamoto 	unsigned int cip_header_size = 0;
317d67c46b9STakashi Sakamoto 
318d67c46b9STakashi Sakamoto 	if (s->flags & CIP_JUMBO_PAYLOAD)
319d67c46b9STakashi Sakamoto 		multiplier = 5;
3203b196c39STakashi Sakamoto 	if (!(s->flags & CIP_NO_HEADER))
32107ea238cSTakashi Sakamoto 		cip_header_size = sizeof(__be32) * 2;
322d67c46b9STakashi Sakamoto 
32307ea238cSTakashi Sakamoto 	return cip_header_size +
32407ea238cSTakashi Sakamoto 		s->syt_interval * s->data_block_quadlets * sizeof(__be32) * multiplier;
325d67c46b9STakashi Sakamoto }
326d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_get_max_payload);
327d67c46b9STakashi Sakamoto 
328d67c46b9STakashi Sakamoto /**
329d67c46b9STakashi Sakamoto  * amdtp_stream_pcm_prepare - prepare PCM device for running
330d67c46b9STakashi Sakamoto  * @s: the AMDTP stream
331d67c46b9STakashi Sakamoto  *
332d67c46b9STakashi Sakamoto  * This function should be called from the PCM device's .prepare callback.
333d67c46b9STakashi Sakamoto  */
334d67c46b9STakashi Sakamoto void amdtp_stream_pcm_prepare(struct amdtp_stream *s)
335d67c46b9STakashi Sakamoto {
336d67c46b9STakashi Sakamoto 	tasklet_kill(&s->period_tasklet);
337d67c46b9STakashi Sakamoto 	s->pcm_buffer_pointer = 0;
338d67c46b9STakashi Sakamoto 	s->pcm_period_pointer = 0;
339d67c46b9STakashi Sakamoto }
340d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_pcm_prepare);
341d67c46b9STakashi Sakamoto 
342*274fc355STakashi Sakamoto static unsigned int calculate_data_blocks(unsigned int *data_block_state,
343*274fc355STakashi Sakamoto 				bool is_blocking, bool is_no_info,
344*274fc355STakashi Sakamoto 				unsigned int syt_interval, enum cip_sfc sfc)
345d67c46b9STakashi Sakamoto {
346*274fc355STakashi Sakamoto 	unsigned int data_blocks;
347d67c46b9STakashi Sakamoto 
348d67c46b9STakashi Sakamoto 	/* Blocking mode. */
349*274fc355STakashi Sakamoto 	if (is_blocking) {
350d67c46b9STakashi Sakamoto 		/* This module generate empty packet for 'no data'. */
351*274fc355STakashi Sakamoto 		if (is_no_info)
352d67c46b9STakashi Sakamoto 			data_blocks = 0;
353d67c46b9STakashi Sakamoto 		else
354*274fc355STakashi Sakamoto 			data_blocks = syt_interval;
355d67c46b9STakashi Sakamoto 	/* Non-blocking mode. */
356d67c46b9STakashi Sakamoto 	} else {
357*274fc355STakashi Sakamoto 		if (!cip_sfc_is_base_44100(sfc)) {
358d3d10a4aSTakashi Sakamoto 			// Sample_rate / 8000 is an integer, and precomputed.
359*274fc355STakashi Sakamoto 			data_blocks = *data_block_state;
360d67c46b9STakashi Sakamoto 		} else {
361*274fc355STakashi Sakamoto 			unsigned int phase = *data_block_state;
362d67c46b9STakashi Sakamoto 
363d67c46b9STakashi Sakamoto 		/*
364d67c46b9STakashi Sakamoto 		 * This calculates the number of data blocks per packet so that
365d67c46b9STakashi Sakamoto 		 * 1) the overall rate is correct and exactly synchronized to
366d67c46b9STakashi Sakamoto 		 *    the bus clock, and
367d67c46b9STakashi Sakamoto 		 * 2) packets with a rounded-up number of blocks occur as early
368d67c46b9STakashi Sakamoto 		 *    as possible in the sequence (to prevent underruns of the
369d67c46b9STakashi Sakamoto 		 *    device's buffer).
370d67c46b9STakashi Sakamoto 		 */
371*274fc355STakashi Sakamoto 			if (sfc == CIP_SFC_44100)
372d67c46b9STakashi Sakamoto 				/* 6 6 5 6 5 6 5 ... */
373d67c46b9STakashi Sakamoto 				data_blocks = 5 + ((phase & 1) ^
374d67c46b9STakashi Sakamoto 						   (phase == 0 || phase >= 40));
375d67c46b9STakashi Sakamoto 			else
376d67c46b9STakashi Sakamoto 				/* 12 11 11 11 11 ... or 23 22 22 22 22 ... */
377*274fc355STakashi Sakamoto 				data_blocks = 11 * (sfc >> 1) + (phase == 0);
378*274fc355STakashi Sakamoto 			if (++phase >= (80 >> (sfc >> 1)))
379d67c46b9STakashi Sakamoto 				phase = 0;
380*274fc355STakashi Sakamoto 			*data_block_state = phase;
381d67c46b9STakashi Sakamoto 		}
382d67c46b9STakashi Sakamoto 	}
383d67c46b9STakashi Sakamoto 
384d67c46b9STakashi Sakamoto 	return data_blocks;
385d67c46b9STakashi Sakamoto }
386d67c46b9STakashi Sakamoto 
387816d8482STakashi Sakamoto static unsigned int calculate_syt_offset(unsigned int *last_syt_offset,
388816d8482STakashi Sakamoto 			unsigned int *syt_offset_state, enum cip_sfc sfc)
389d67c46b9STakashi Sakamoto {
390816d8482STakashi Sakamoto 	unsigned int syt_offset;
391d67c46b9STakashi Sakamoto 
392816d8482STakashi Sakamoto 	if (*last_syt_offset < TICKS_PER_CYCLE) {
393816d8482STakashi Sakamoto 		if (!cip_sfc_is_base_44100(sfc))
394816d8482STakashi Sakamoto 			syt_offset = *last_syt_offset + *syt_offset_state;
395d67c46b9STakashi Sakamoto 		else {
396d67c46b9STakashi Sakamoto 		/*
397d67c46b9STakashi Sakamoto 		 * The time, in ticks, of the n'th SYT_INTERVAL sample is:
398d67c46b9STakashi Sakamoto 		 *   n * SYT_INTERVAL * 24576000 / sample_rate
399d67c46b9STakashi Sakamoto 		 * Modulo TICKS_PER_CYCLE, the difference between successive
400d67c46b9STakashi Sakamoto 		 * elements is about 1386.23.  Rounding the results of this
401d67c46b9STakashi Sakamoto 		 * formula to the SYT precision results in a sequence of
402d67c46b9STakashi Sakamoto 		 * differences that begins with:
403d67c46b9STakashi Sakamoto 		 *   1386 1386 1387 1386 1386 1386 1387 1386 1386 1386 1387 ...
404d67c46b9STakashi Sakamoto 		 * This code generates _exactly_ the same sequence.
405d67c46b9STakashi Sakamoto 		 */
406816d8482STakashi Sakamoto 			unsigned int phase = *syt_offset_state;
407816d8482STakashi Sakamoto 			unsigned int index = phase % 13;
408816d8482STakashi Sakamoto 
409816d8482STakashi Sakamoto 			syt_offset = *last_syt_offset;
410d67c46b9STakashi Sakamoto 			syt_offset += 1386 + ((index && !(index & 3)) ||
411d67c46b9STakashi Sakamoto 					      phase == 146);
412d67c46b9STakashi Sakamoto 			if (++phase >= 147)
413d67c46b9STakashi Sakamoto 				phase = 0;
414816d8482STakashi Sakamoto 			*syt_offset_state = phase;
415d67c46b9STakashi Sakamoto 		}
416d67c46b9STakashi Sakamoto 	} else
417816d8482STakashi Sakamoto 		syt_offset = *last_syt_offset - TICKS_PER_CYCLE;
418816d8482STakashi Sakamoto 	*last_syt_offset = syt_offset;
419d67c46b9STakashi Sakamoto 
42083cfb5c5STakashi Sakamoto 	if (syt_offset >= TICKS_PER_CYCLE)
42183cfb5c5STakashi Sakamoto 		syt_offset = CIP_SYT_NO_INFO;
422d67c46b9STakashi Sakamoto 
42383cfb5c5STakashi Sakamoto 	return syt_offset;
424d67c46b9STakashi Sakamoto }
425d67c46b9STakashi Sakamoto 
426d67c46b9STakashi Sakamoto static void update_pcm_pointers(struct amdtp_stream *s,
427d67c46b9STakashi Sakamoto 				struct snd_pcm_substream *pcm,
428d67c46b9STakashi Sakamoto 				unsigned int frames)
429d67c46b9STakashi Sakamoto {
430d67c46b9STakashi Sakamoto 	unsigned int ptr;
431d67c46b9STakashi Sakamoto 
432d67c46b9STakashi Sakamoto 	ptr = s->pcm_buffer_pointer + frames;
433d67c46b9STakashi Sakamoto 	if (ptr >= pcm->runtime->buffer_size)
434d67c46b9STakashi Sakamoto 		ptr -= pcm->runtime->buffer_size;
4356aa7de05SMark Rutland 	WRITE_ONCE(s->pcm_buffer_pointer, ptr);
436d67c46b9STakashi Sakamoto 
437d67c46b9STakashi Sakamoto 	s->pcm_period_pointer += frames;
438d67c46b9STakashi Sakamoto 	if (s->pcm_period_pointer >= pcm->runtime->period_size) {
439d67c46b9STakashi Sakamoto 		s->pcm_period_pointer -= pcm->runtime->period_size;
440d67c46b9STakashi Sakamoto 		tasklet_hi_schedule(&s->period_tasklet);
441d67c46b9STakashi Sakamoto 	}
442d67c46b9STakashi Sakamoto }
443d67c46b9STakashi Sakamoto 
444d67c46b9STakashi Sakamoto static void pcm_period_tasklet(unsigned long data)
445d67c46b9STakashi Sakamoto {
446d67c46b9STakashi Sakamoto 	struct amdtp_stream *s = (void *)data;
4476aa7de05SMark Rutland 	struct snd_pcm_substream *pcm = READ_ONCE(s->pcm);
448d67c46b9STakashi Sakamoto 
449d67c46b9STakashi Sakamoto 	if (pcm)
450d67c46b9STakashi Sakamoto 		snd_pcm_period_elapsed(pcm);
451d67c46b9STakashi Sakamoto }
452d67c46b9STakashi Sakamoto 
453e229853dSTakashi Sakamoto static int queue_packet(struct amdtp_stream *s, struct fw_iso_packet *params,
454e229853dSTakashi Sakamoto 			bool sched_irq)
455d67c46b9STakashi Sakamoto {
4566007bf54STakashi Sakamoto 	int err;
457d67c46b9STakashi Sakamoto 
458e229853dSTakashi Sakamoto 	params->interrupt = sched_irq;
4596007bf54STakashi Sakamoto 	params->tag = s->tag;
4606007bf54STakashi Sakamoto 	params->sy = 0;
461d67c46b9STakashi Sakamoto 
4626007bf54STakashi Sakamoto 	err = fw_iso_context_queue(s->context, params, &s->buffer.iso_buffer,
463d67c46b9STakashi Sakamoto 				   s->buffer.packets[s->packet_index].offset);
464d67c46b9STakashi Sakamoto 	if (err < 0) {
465d67c46b9STakashi Sakamoto 		dev_err(&s->unit->device, "queueing error: %d\n", err);
466d67c46b9STakashi Sakamoto 		goto end;
467d67c46b9STakashi Sakamoto 	}
468d67c46b9STakashi Sakamoto 
469a0e02331STakashi Sakamoto 	if (++s->packet_index >= s->queue_size)
470d67c46b9STakashi Sakamoto 		s->packet_index = 0;
471d67c46b9STakashi Sakamoto end:
472d67c46b9STakashi Sakamoto 	return err;
473d67c46b9STakashi Sakamoto }
474d67c46b9STakashi Sakamoto 
475d67c46b9STakashi Sakamoto static inline int queue_out_packet(struct amdtp_stream *s,
476e229853dSTakashi Sakamoto 				   struct fw_iso_packet *params, bool sched_irq)
477d67c46b9STakashi Sakamoto {
478b18f0cfaSTakashi Sakamoto 	params->skip =
479b18f0cfaSTakashi Sakamoto 		!!(params->header_length == 0 && params->payload_length == 0);
480e229853dSTakashi Sakamoto 	return queue_packet(s, params, sched_irq);
481d67c46b9STakashi Sakamoto }
482d67c46b9STakashi Sakamoto 
4836007bf54STakashi Sakamoto static inline int queue_in_packet(struct amdtp_stream *s,
48460dd4929STakashi Sakamoto 				  struct fw_iso_packet *params)
485d67c46b9STakashi Sakamoto {
4866007bf54STakashi Sakamoto 	// Queue one packet for IR context.
4876007bf54STakashi Sakamoto 	params->header_length = s->ctx_data.tx.ctx_header_size;
4886007bf54STakashi Sakamoto 	params->payload_length = s->ctx_data.tx.max_ctx_payload_length;
4896007bf54STakashi Sakamoto 	params->skip = false;
49060dd4929STakashi Sakamoto 	return queue_packet(s, params, false);
491d67c46b9STakashi Sakamoto }
492d67c46b9STakashi Sakamoto 
493252219c7STakashi Sakamoto static void generate_cip_header(struct amdtp_stream *s, __be32 cip_header[2],
494860d798cSTakashi Sakamoto 			unsigned int data_block_counter, unsigned int syt)
495252219c7STakashi Sakamoto {
496252219c7STakashi Sakamoto 	cip_header[0] = cpu_to_be32(READ_ONCE(s->source_node_id_field) |
497252219c7STakashi Sakamoto 				(s->data_block_quadlets << CIP_DBS_SHIFT) |
498252219c7STakashi Sakamoto 				((s->sph << CIP_SPH_SHIFT) & CIP_SPH_MASK) |
499860d798cSTakashi Sakamoto 				data_block_counter);
500252219c7STakashi Sakamoto 	cip_header[1] = cpu_to_be32(CIP_EOH |
501252219c7STakashi Sakamoto 			((s->fmt << CIP_FMT_SHIFT) & CIP_FMT_MASK) |
502252219c7STakashi Sakamoto 			((s->ctx_data.rx.fdf << CIP_FDF_SHIFT) & CIP_FDF_MASK) |
503252219c7STakashi Sakamoto 			(syt & CIP_SYT_MASK));
504252219c7STakashi Sakamoto }
505252219c7STakashi Sakamoto 
5066bc1a269STakashi Sakamoto static void build_it_pkt_header(struct amdtp_stream *s, unsigned int cycle,
5076bc1a269STakashi Sakamoto 				struct fw_iso_packet *params,
508860d798cSTakashi Sakamoto 				unsigned int data_blocks,
509860d798cSTakashi Sakamoto 				unsigned int data_block_counter,
510860d798cSTakashi Sakamoto 				unsigned int syt, unsigned int index)
511d67c46b9STakashi Sakamoto {
5120ebf3cebSTakashi Sakamoto 	unsigned int payload_length;
51316be4589STakashi Sakamoto 	__be32 *cip_header;
514d67c46b9STakashi Sakamoto 
5150ebf3cebSTakashi Sakamoto 	payload_length = data_blocks * sizeof(__be32) * s->data_block_quadlets;
5160ebf3cebSTakashi Sakamoto 	params->payload_length = payload_length;
5170ebf3cebSTakashi Sakamoto 
518b18f0cfaSTakashi Sakamoto 	if (!(s->flags & CIP_NO_HEADER)) {
5196bc1a269STakashi Sakamoto 		cip_header = (__be32 *)params->header;
520860d798cSTakashi Sakamoto 		generate_cip_header(s, cip_header, data_block_counter, syt);
5216bc1a269STakashi Sakamoto 		params->header_length = 2 * sizeof(__be32);
5220ebf3cebSTakashi Sakamoto 		payload_length += params->header_length;
523b18f0cfaSTakashi Sakamoto 	} else {
524b18f0cfaSTakashi Sakamoto 		cip_header = NULL;
525b18f0cfaSTakashi Sakamoto 	}
526d67c46b9STakashi Sakamoto 
527213fa989STakashi Sakamoto 	trace_amdtp_packet(s, cycle, cip_header, payload_length, data_blocks,
528860d798cSTakashi Sakamoto 			   data_block_counter, index);
5293b196c39STakashi Sakamoto }
5303b196c39STakashi Sakamoto 
531e335425bSTakashi Sakamoto static int check_cip_header(struct amdtp_stream *s, const __be32 *buf,
532e335425bSTakashi Sakamoto 			    unsigned int payload_length,
533a35463d1STakashi Sakamoto 			    unsigned int *data_blocks,
534a35463d1STakashi Sakamoto 			    unsigned int *data_block_counter, unsigned int *syt)
535d67c46b9STakashi Sakamoto {
536d67c46b9STakashi Sakamoto 	u32 cip_header[2];
537e335425bSTakashi Sakamoto 	unsigned int sph;
538e335425bSTakashi Sakamoto 	unsigned int fmt;
539e335425bSTakashi Sakamoto 	unsigned int fdf;
540a35463d1STakashi Sakamoto 	unsigned int dbc;
541d67c46b9STakashi Sakamoto 	bool lost;
542d67c46b9STakashi Sakamoto 
543e335425bSTakashi Sakamoto 	cip_header[0] = be32_to_cpu(buf[0]);
544e335425bSTakashi Sakamoto 	cip_header[1] = be32_to_cpu(buf[1]);
545d67c46b9STakashi Sakamoto 
546d67c46b9STakashi Sakamoto 	/*
547d67c46b9STakashi Sakamoto 	 * This module supports 'Two-quadlet CIP header with SYT field'.
548d67c46b9STakashi Sakamoto 	 * For convenience, also check FMT field is AM824 or not.
549d67c46b9STakashi Sakamoto 	 */
5502128f78fSTakashi Sakamoto 	if ((((cip_header[0] & CIP_EOH_MASK) == CIP_EOH) ||
5512128f78fSTakashi Sakamoto 	     ((cip_header[1] & CIP_EOH_MASK) != CIP_EOH)) &&
5522128f78fSTakashi Sakamoto 	    (!(s->flags & CIP_HEADER_WITHOUT_EOH))) {
553d67c46b9STakashi Sakamoto 		dev_info_ratelimited(&s->unit->device,
554d67c46b9STakashi Sakamoto 				"Invalid CIP header for AMDTP: %08X:%08X\n",
555d67c46b9STakashi Sakamoto 				cip_header[0], cip_header[1]);
556e335425bSTakashi Sakamoto 		return -EAGAIN;
557d67c46b9STakashi Sakamoto 	}
558d67c46b9STakashi Sakamoto 
559d67c46b9STakashi Sakamoto 	/* Check valid protocol or not. */
5609863874fSTakashi Sakamoto 	sph = (cip_header[0] & CIP_SPH_MASK) >> CIP_SPH_SHIFT;
561d67c46b9STakashi Sakamoto 	fmt = (cip_header[1] & CIP_FMT_MASK) >> CIP_FMT_SHIFT;
5629863874fSTakashi Sakamoto 	if (sph != s->sph || fmt != s->fmt) {
5632a7e1713STakashi Sakamoto 		dev_info_ratelimited(&s->unit->device,
564d67c46b9STakashi Sakamoto 				     "Detect unexpected protocol: %08x %08x\n",
565d67c46b9STakashi Sakamoto 				     cip_header[0], cip_header[1]);
566e335425bSTakashi Sakamoto 		return -EAGAIN;
567d67c46b9STakashi Sakamoto 	}
568d67c46b9STakashi Sakamoto 
569d67c46b9STakashi Sakamoto 	/* Calculate data blocks */
570d67c46b9STakashi Sakamoto 	fdf = (cip_header[1] & CIP_FDF_MASK) >> CIP_FDF_SHIFT;
571e335425bSTakashi Sakamoto 	if (payload_length < sizeof(__be32) * 2 ||
572d67c46b9STakashi Sakamoto 	    (fmt == CIP_FMT_AM && fdf == AMDTP_FDF_NO_DATA)) {
573e335425bSTakashi Sakamoto 		*data_blocks = 0;
574d67c46b9STakashi Sakamoto 	} else {
575e335425bSTakashi Sakamoto 		unsigned int data_block_quadlets =
576d67c46b9STakashi Sakamoto 				(cip_header[0] & CIP_DBS_MASK) >> CIP_DBS_SHIFT;
577d67c46b9STakashi Sakamoto 		/* avoid division by zero */
578d67c46b9STakashi Sakamoto 		if (data_block_quadlets == 0) {
579d67c46b9STakashi Sakamoto 			dev_err(&s->unit->device,
580d67c46b9STakashi Sakamoto 				"Detect invalid value in dbs field: %08X\n",
581d67c46b9STakashi Sakamoto 				cip_header[0]);
582d67c46b9STakashi Sakamoto 			return -EPROTO;
583d67c46b9STakashi Sakamoto 		}
584d67c46b9STakashi Sakamoto 		if (s->flags & CIP_WRONG_DBS)
585d67c46b9STakashi Sakamoto 			data_block_quadlets = s->data_block_quadlets;
586d67c46b9STakashi Sakamoto 
587e335425bSTakashi Sakamoto 		*data_blocks = (payload_length / sizeof(__be32) - 2) /
588ff0fb5aaSTakashi Sakamoto 							data_block_quadlets;
589d67c46b9STakashi Sakamoto 	}
590d67c46b9STakashi Sakamoto 
591d67c46b9STakashi Sakamoto 	/* Check data block counter continuity */
592a35463d1STakashi Sakamoto 	dbc = cip_header[0] & CIP_DBC_MASK;
593e335425bSTakashi Sakamoto 	if (*data_blocks == 0 && (s->flags & CIP_EMPTY_HAS_WRONG_DBC) &&
594a35463d1STakashi Sakamoto 	    *data_block_counter != UINT_MAX)
595a35463d1STakashi Sakamoto 		dbc = *data_block_counter;
596d67c46b9STakashi Sakamoto 
597a35463d1STakashi Sakamoto 	if ((dbc == 0x00 && (s->flags & CIP_SKIP_DBC_ZERO_CHECK)) ||
598a35463d1STakashi Sakamoto 	    *data_block_counter == UINT_MAX) {
599d67c46b9STakashi Sakamoto 		lost = false;
600d67c46b9STakashi Sakamoto 	} else if (!(s->flags & CIP_DBC_IS_END_EVENT)) {
601a35463d1STakashi Sakamoto 		lost = dbc != *data_block_counter;
602d67c46b9STakashi Sakamoto 	} else {
603e335425bSTakashi Sakamoto 		unsigned int dbc_interval;
604e335425bSTakashi Sakamoto 
605e335425bSTakashi Sakamoto 		if (*data_blocks > 0 && s->ctx_data.tx.dbc_interval > 0)
606d3d10a4aSTakashi Sakamoto 			dbc_interval = s->ctx_data.tx.dbc_interval;
607d67c46b9STakashi Sakamoto 		else
608e335425bSTakashi Sakamoto 			dbc_interval = *data_blocks;
609d67c46b9STakashi Sakamoto 
610a35463d1STakashi Sakamoto 		lost = dbc != ((*data_block_counter + dbc_interval) & 0xff);
611d67c46b9STakashi Sakamoto 	}
612d67c46b9STakashi Sakamoto 
613d67c46b9STakashi Sakamoto 	if (lost) {
614d67c46b9STakashi Sakamoto 		dev_err(&s->unit->device,
615d67c46b9STakashi Sakamoto 			"Detect discontinuity of CIP: %02X %02X\n",
616a35463d1STakashi Sakamoto 			*data_block_counter, dbc);
617d67c46b9STakashi Sakamoto 		return -EIO;
618d67c46b9STakashi Sakamoto 	}
619d67c46b9STakashi Sakamoto 
620753e7179STakashi Sakamoto 	*data_block_counter = dbc;
621753e7179STakashi Sakamoto 
622e335425bSTakashi Sakamoto 	*syt = cip_header[1] & CIP_SYT_MASK;
623e335425bSTakashi Sakamoto 
624e335425bSTakashi Sakamoto 	return 0;
625e335425bSTakashi Sakamoto }
626e335425bSTakashi Sakamoto 
62798e3e43bSTakashi Sakamoto static int parse_ir_ctx_header(struct amdtp_stream *s, unsigned int cycle,
62898e3e43bSTakashi Sakamoto 			       const __be32 *ctx_header,
62998e3e43bSTakashi Sakamoto 			       unsigned int *payload_length,
630a35463d1STakashi Sakamoto 			       unsigned int *data_blocks,
631a35463d1STakashi Sakamoto 			       unsigned int *data_block_counter,
632a35463d1STakashi Sakamoto 			       unsigned int *syt, unsigned int index)
633e335425bSTakashi Sakamoto {
634f11453c7STakashi Sakamoto 	const __be32 *cip_header;
635e335425bSTakashi Sakamoto 	int err;
636e335425bSTakashi Sakamoto 
63798e3e43bSTakashi Sakamoto 	*payload_length = be32_to_cpu(ctx_header[0]) >> ISO_DATA_LENGTH_SHIFT;
63898e3e43bSTakashi Sakamoto 	if (*payload_length > s->ctx_data.tx.ctx_header_size +
639f11453c7STakashi Sakamoto 					s->ctx_data.tx.max_ctx_payload_length) {
640e335425bSTakashi Sakamoto 		dev_err(&s->unit->device,
641e335425bSTakashi Sakamoto 			"Detect jumbo payload: %04x %04x\n",
64298e3e43bSTakashi Sakamoto 			*payload_length, s->ctx_data.tx.max_ctx_payload_length);
643e335425bSTakashi Sakamoto 		return -EIO;
644e335425bSTakashi Sakamoto 	}
645e335425bSTakashi Sakamoto 
646947b437eSTakashi Sakamoto 	if (!(s->flags & CIP_NO_HEADER)) {
64798e3e43bSTakashi Sakamoto 		cip_header = ctx_header + 2;
64898e3e43bSTakashi Sakamoto 		err = check_cip_header(s, cip_header, *payload_length,
649a35463d1STakashi Sakamoto 				       data_blocks, data_block_counter, syt);
650b8b0e24cSTakashi Sakamoto 		if (err < 0)
651e335425bSTakashi Sakamoto 			return err;
652947b437eSTakashi Sakamoto 	} else {
653947b437eSTakashi Sakamoto 		cip_header = NULL;
65476864868STakashi Sakamoto 		err = 0;
65598e3e43bSTakashi Sakamoto 		*data_blocks = *payload_length / sizeof(__be32) /
65698e3e43bSTakashi Sakamoto 			       s->data_block_quadlets;
65798e3e43bSTakashi Sakamoto 		*syt = 0;
6587fbf9096STakashi Sakamoto 
659a35463d1STakashi Sakamoto 		if (*data_block_counter == UINT_MAX)
660a35463d1STakashi Sakamoto 			*data_block_counter = 0;
661947b437eSTakashi Sakamoto 	}
662e335425bSTakashi Sakamoto 
66398e3e43bSTakashi Sakamoto 	trace_amdtp_packet(s, cycle, cip_header, *payload_length, *data_blocks,
664a35463d1STakashi Sakamoto 			   *data_block_counter, index);
66564d0bf4dSTakashi Sakamoto 
66676864868STakashi Sakamoto 	return err;
667d67c46b9STakashi Sakamoto }
668d67c46b9STakashi Sakamoto 
66926cd1e58STakashi Sakamoto // In CYCLE_TIMER register of IEEE 1394, 7 bits are used to represent second. On
67026cd1e58STakashi Sakamoto // the other hand, in DMA descriptors of 1394 OHCI, 3 bits are used to represent
67126cd1e58STakashi Sakamoto // it. Thus, via Linux firewire subsystem, we can get the 3 bits for second.
67226cd1e58STakashi Sakamoto static inline u32 compute_cycle_count(__be32 ctx_header_tstamp)
67373fc7f08STakashi Sakamoto {
67426cd1e58STakashi Sakamoto 	u32 tstamp = be32_to_cpu(ctx_header_tstamp) & HEADER_TSTAMP_MASK;
67573fc7f08STakashi Sakamoto 	return (((tstamp >> 13) & 0x07) * 8000) + (tstamp & 0x1fff);
67673fc7f08STakashi Sakamoto }
67773fc7f08STakashi Sakamoto 
67873fc7f08STakashi Sakamoto static inline u32 increment_cycle_count(u32 cycle, unsigned int addend)
67973fc7f08STakashi Sakamoto {
68073fc7f08STakashi Sakamoto 	cycle += addend;
68110aa8e4aSTakashi Sakamoto 	if (cycle >= OHCI_MAX_SECOND * CYCLES_PER_SECOND)
68210aa8e4aSTakashi Sakamoto 		cycle -= OHCI_MAX_SECOND * CYCLES_PER_SECOND;
68373fc7f08STakashi Sakamoto 	return cycle;
68473fc7f08STakashi Sakamoto }
68573fc7f08STakashi Sakamoto 
68626cd1e58STakashi Sakamoto // Align to actual cycle count for the packet which is going to be scheduled.
687a0e02331STakashi Sakamoto // This module queued the same number of isochronous cycle as the size of queue
688a0e02331STakashi Sakamoto // to kip isochronous cycle, therefore it's OK to just increment the cycle by
689a0e02331STakashi Sakamoto // the size of queue for scheduled cycle.
690a0e02331STakashi Sakamoto static inline u32 compute_it_cycle(const __be32 ctx_header_tstamp,
691a0e02331STakashi Sakamoto 				   unsigned int queue_size)
69226cd1e58STakashi Sakamoto {
69326cd1e58STakashi Sakamoto 	u32 cycle = compute_cycle_count(ctx_header_tstamp);
694a0e02331STakashi Sakamoto 	return increment_cycle_count(cycle, queue_size);
69526cd1e58STakashi Sakamoto }
69626cd1e58STakashi Sakamoto 
697753e7179STakashi Sakamoto static int generate_device_pkt_descs(struct amdtp_stream *s,
698753e7179STakashi Sakamoto 				     struct pkt_desc *descs,
699753e7179STakashi Sakamoto 				     const __be32 *ctx_header,
700753e7179STakashi Sakamoto 				     unsigned int packets)
701753e7179STakashi Sakamoto {
702753e7179STakashi Sakamoto 	unsigned int dbc = s->data_block_counter;
703753e7179STakashi Sakamoto 	int i;
704753e7179STakashi Sakamoto 	int err;
705753e7179STakashi Sakamoto 
706753e7179STakashi Sakamoto 	for (i = 0; i < packets; ++i) {
707753e7179STakashi Sakamoto 		struct pkt_desc *desc = descs + i;
708a0e02331STakashi Sakamoto 		unsigned int index = (s->packet_index + i) % s->queue_size;
709753e7179STakashi Sakamoto 		unsigned int cycle;
710753e7179STakashi Sakamoto 		unsigned int payload_length;
711753e7179STakashi Sakamoto 		unsigned int data_blocks;
712753e7179STakashi Sakamoto 		unsigned int syt;
713753e7179STakashi Sakamoto 
714753e7179STakashi Sakamoto 		cycle = compute_cycle_count(ctx_header[1]);
715753e7179STakashi Sakamoto 
716753e7179STakashi Sakamoto 		err = parse_ir_ctx_header(s, cycle, ctx_header, &payload_length,
717753e7179STakashi Sakamoto 					  &data_blocks, &dbc, &syt, i);
718753e7179STakashi Sakamoto 		if (err < 0)
719753e7179STakashi Sakamoto 			return err;
720753e7179STakashi Sakamoto 
721753e7179STakashi Sakamoto 		desc->cycle = cycle;
722753e7179STakashi Sakamoto 		desc->syt = syt;
723753e7179STakashi Sakamoto 		desc->data_blocks = data_blocks;
724753e7179STakashi Sakamoto 		desc->data_block_counter = dbc;
725753e7179STakashi Sakamoto 		desc->ctx_payload = s->buffer.packets[index].buffer;
726753e7179STakashi Sakamoto 
727753e7179STakashi Sakamoto 		if (!(s->flags & CIP_DBC_IS_END_EVENT))
728753e7179STakashi Sakamoto 			dbc = (dbc + desc->data_blocks) & 0xff;
729753e7179STakashi Sakamoto 
730753e7179STakashi Sakamoto 		ctx_header +=
731753e7179STakashi Sakamoto 			s->ctx_data.tx.ctx_header_size / sizeof(*ctx_header);
732753e7179STakashi Sakamoto 	}
733753e7179STakashi Sakamoto 
734753e7179STakashi Sakamoto 	s->data_block_counter = dbc;
735753e7179STakashi Sakamoto 
736753e7179STakashi Sakamoto 	return 0;
737753e7179STakashi Sakamoto }
738753e7179STakashi Sakamoto 
73983cfb5c5STakashi Sakamoto static unsigned int compute_syt(unsigned int syt_offset, unsigned int cycle,
74083cfb5c5STakashi Sakamoto 				unsigned int transfer_delay)
74183cfb5c5STakashi Sakamoto {
74283cfb5c5STakashi Sakamoto 	unsigned int syt;
74383cfb5c5STakashi Sakamoto 
74483cfb5c5STakashi Sakamoto 	syt_offset += transfer_delay;
74583cfb5c5STakashi Sakamoto 	syt = ((cycle + syt_offset / TICKS_PER_CYCLE) << 12) |
74683cfb5c5STakashi Sakamoto 	      (syt_offset % TICKS_PER_CYCLE);
74783cfb5c5STakashi Sakamoto 	return syt & CIP_SYT_MASK;
74883cfb5c5STakashi Sakamoto }
74983cfb5c5STakashi Sakamoto 
750f4f6ae7bSTakashi Sakamoto static void generate_ideal_pkt_descs(struct amdtp_stream *s,
751f4f6ae7bSTakashi Sakamoto 				     struct pkt_desc *descs,
752f4f6ae7bSTakashi Sakamoto 				     const __be32 *ctx_header,
753f4f6ae7bSTakashi Sakamoto 				     unsigned int packets)
754f4f6ae7bSTakashi Sakamoto {
755f4f6ae7bSTakashi Sakamoto 	unsigned int dbc = s->data_block_counter;
756f4f6ae7bSTakashi Sakamoto 	int i;
757f4f6ae7bSTakashi Sakamoto 
758f4f6ae7bSTakashi Sakamoto 	for (i = 0; i < packets; ++i) {
759f4f6ae7bSTakashi Sakamoto 		struct pkt_desc *desc = descs + i;
760a0e02331STakashi Sakamoto 		unsigned int index = (s->packet_index + i) % s->queue_size;
76183cfb5c5STakashi Sakamoto 		unsigned int syt_offset;
762f4f6ae7bSTakashi Sakamoto 
763a0e02331STakashi Sakamoto 		desc->cycle = compute_it_cycle(*ctx_header, s->queue_size);
764816d8482STakashi Sakamoto 		syt_offset = calculate_syt_offset(
765816d8482STakashi Sakamoto 				&s->ctx_data.rx.last_syt_offset,
766816d8482STakashi Sakamoto 				&s->ctx_data.rx.syt_offset_state, s->sfc);
76783cfb5c5STakashi Sakamoto 		if (syt_offset != CIP_SYT_NO_INFO) {
76883cfb5c5STakashi Sakamoto 			desc->syt = compute_syt(syt_offset, desc->cycle,
76983cfb5c5STakashi Sakamoto 						s->ctx_data.rx.transfer_delay);
77083cfb5c5STakashi Sakamoto 		} else {
77183cfb5c5STakashi Sakamoto 			desc->syt = syt_offset;
77283cfb5c5STakashi Sakamoto 		}
773*274fc355STakashi Sakamoto 		desc->data_blocks =
774*274fc355STakashi Sakamoto 			calculate_data_blocks(&s->ctx_data.rx.data_block_state,
775*274fc355STakashi Sakamoto 					      !!(s->flags & CIP_BLOCKING),
776*274fc355STakashi Sakamoto 					      desc->syt == CIP_SYT_NO_INFO,
777*274fc355STakashi Sakamoto 					      s->syt_interval, s->sfc);
778f4f6ae7bSTakashi Sakamoto 
779f4f6ae7bSTakashi Sakamoto 		if (s->flags & CIP_DBC_IS_END_EVENT)
780f4f6ae7bSTakashi Sakamoto 			dbc = (dbc + desc->data_blocks) & 0xff;
781f4f6ae7bSTakashi Sakamoto 
782f4f6ae7bSTakashi Sakamoto 		desc->data_block_counter = dbc;
783f4f6ae7bSTakashi Sakamoto 
784f4f6ae7bSTakashi Sakamoto 		if (!(s->flags & CIP_DBC_IS_END_EVENT))
785f4f6ae7bSTakashi Sakamoto 			dbc = (dbc + desc->data_blocks) & 0xff;
786f4f6ae7bSTakashi Sakamoto 
787f4f6ae7bSTakashi Sakamoto 		desc->ctx_payload = s->buffer.packets[index].buffer;
788f4f6ae7bSTakashi Sakamoto 
789f4f6ae7bSTakashi Sakamoto 		++ctx_header;
790f4f6ae7bSTakashi Sakamoto 	}
791f4f6ae7bSTakashi Sakamoto 
792f4f6ae7bSTakashi Sakamoto 	s->data_block_counter = dbc;
793f4f6ae7bSTakashi Sakamoto }
794f4f6ae7bSTakashi Sakamoto 
795fce9b013STakashi Sakamoto static inline void cancel_stream(struct amdtp_stream *s)
796fce9b013STakashi Sakamoto {
797fce9b013STakashi Sakamoto 	s->packet_index = -1;
798fce9b013STakashi Sakamoto 	if (in_interrupt())
799fce9b013STakashi Sakamoto 		amdtp_stream_pcm_abort(s);
800fce9b013STakashi Sakamoto 	WRITE_ONCE(s->pcm_buffer_pointer, SNDRV_PCM_POS_XRUN);
801fce9b013STakashi Sakamoto }
802fce9b013STakashi Sakamoto 
8030f5cfcb2STakashi Sakamoto static void process_ctx_payloads(struct amdtp_stream *s,
8040f5cfcb2STakashi Sakamoto 				 const struct pkt_desc *descs,
8050f5cfcb2STakashi Sakamoto 				 unsigned int packets)
8060f5cfcb2STakashi Sakamoto {
8079a738ad1STakashi Sakamoto 	struct snd_pcm_substream *pcm;
8080f5cfcb2STakashi Sakamoto 	unsigned int pcm_frames;
8090f5cfcb2STakashi Sakamoto 
8109a738ad1STakashi Sakamoto 	pcm = READ_ONCE(s->pcm);
8119a738ad1STakashi Sakamoto 	pcm_frames = s->process_ctx_payloads(s, descs, packets, pcm);
8129a738ad1STakashi Sakamoto 	if (pcm)
8130f5cfcb2STakashi Sakamoto 		update_pcm_pointers(s, pcm, pcm_frames);
8140f5cfcb2STakashi Sakamoto }
8150f5cfcb2STakashi Sakamoto 
81673fc7f08STakashi Sakamoto static void out_stream_callback(struct fw_iso_context *context, u32 tstamp,
817d67c46b9STakashi Sakamoto 				size_t header_length, void *header,
818d67c46b9STakashi Sakamoto 				void *private_data)
819d67c46b9STakashi Sakamoto {
820d67c46b9STakashi Sakamoto 	struct amdtp_stream *s = private_data;
82126cd1e58STakashi Sakamoto 	const __be32 *ctx_header = header;
82260dd4929STakashi Sakamoto 	unsigned int events_per_period = s->ctx_data.rx.events_per_period;
82360dd4929STakashi Sakamoto 	unsigned int event_count = s->ctx_data.rx.event_count;
824a0e02331STakashi Sakamoto 	unsigned int packets;
8250dcb4efbSTakashi Sakamoto 	int i;
826d67c46b9STakashi Sakamoto 
827d67c46b9STakashi Sakamoto 	if (s->packet_index < 0)
828d67c46b9STakashi Sakamoto 		return;
829d67c46b9STakashi Sakamoto 
830a0e02331STakashi Sakamoto 	// Calculate the number of packets in buffer and check XRUN.
831a0e02331STakashi Sakamoto 	packets = header_length / sizeof(*ctx_header);
832a0e02331STakashi Sakamoto 
833f4f6ae7bSTakashi Sakamoto 	generate_ideal_pkt_descs(s, s->pkt_descs, ctx_header, packets);
834f4f6ae7bSTakashi Sakamoto 
8350f5cfcb2STakashi Sakamoto 	process_ctx_payloads(s, s->pkt_descs, packets);
8365e2ece0fSTakashi Sakamoto 
8375e2ece0fSTakashi Sakamoto 	for (i = 0; i < packets; ++i) {
8385e2ece0fSTakashi Sakamoto 		const struct pkt_desc *desc = s->pkt_descs + i;
839f4f6ae7bSTakashi Sakamoto 		unsigned int syt;
8406bc1a269STakashi Sakamoto 		struct {
8416bc1a269STakashi Sakamoto 			struct fw_iso_packet params;
8426bc1a269STakashi Sakamoto 			__be32 header[IT_PKT_HEADER_SIZE_CIP / sizeof(__be32)];
8436bc1a269STakashi Sakamoto 		} template = { {0}, {0} };
844e229853dSTakashi Sakamoto 		bool sched_irq = false;
845860d798cSTakashi Sakamoto 
846f4f6ae7bSTakashi Sakamoto 		if (s->ctx_data.rx.syt_override < 0)
847f4f6ae7bSTakashi Sakamoto 			syt = desc->syt;
848f4f6ae7bSTakashi Sakamoto 		else
8493baf3053STakashi Sakamoto 			syt = s->ctx_data.rx.syt_override;
8503baf3053STakashi Sakamoto 
851f4f6ae7bSTakashi Sakamoto 		build_it_pkt_header(s, desc->cycle, &template.params,
852f4f6ae7bSTakashi Sakamoto 				    desc->data_blocks, desc->data_block_counter,
853f4f6ae7bSTakashi Sakamoto 				    syt, i);
8546bc1a269STakashi Sakamoto 
8552472cfb3STakashi Sakamoto 		if (s == s->domain->irq_target) {
856e229853dSTakashi Sakamoto 			event_count += desc->data_blocks;
857e229853dSTakashi Sakamoto 			if (event_count >= events_per_period) {
858e229853dSTakashi Sakamoto 				event_count -= events_per_period;
859e229853dSTakashi Sakamoto 				sched_irq = true;
860e229853dSTakashi Sakamoto 			}
86160dd4929STakashi Sakamoto 		}
862e229853dSTakashi Sakamoto 
863e229853dSTakashi Sakamoto 		if (queue_out_packet(s, &template.params, sched_irq) < 0) {
864fce9b013STakashi Sakamoto 			cancel_stream(s);
865d67c46b9STakashi Sakamoto 			return;
866d67c46b9STakashi Sakamoto 		}
867d67c46b9STakashi Sakamoto 	}
868d67c46b9STakashi Sakamoto 
86960dd4929STakashi Sakamoto 	s->ctx_data.rx.event_count = event_count;
870d67c46b9STakashi Sakamoto }
871d67c46b9STakashi Sakamoto 
87273fc7f08STakashi Sakamoto static void in_stream_callback(struct fw_iso_context *context, u32 tstamp,
873d67c46b9STakashi Sakamoto 			       size_t header_length, void *header,
874d67c46b9STakashi Sakamoto 			       void *private_data)
875d67c46b9STakashi Sakamoto {
876d67c46b9STakashi Sakamoto 	struct amdtp_stream *s = private_data;
877cc4f8e91STakashi Sakamoto 	__be32 *ctx_header = header;
878e229853dSTakashi Sakamoto 	unsigned int packets;
879753e7179STakashi Sakamoto 	int i;
880753e7179STakashi Sakamoto 	int err;
881d67c46b9STakashi Sakamoto 
882d67c46b9STakashi Sakamoto 	if (s->packet_index < 0)
883d67c46b9STakashi Sakamoto 		return;
884d67c46b9STakashi Sakamoto 
885a0e02331STakashi Sakamoto 	// Calculate the number of packets in buffer and check XRUN.
886d3d10a4aSTakashi Sakamoto 	packets = header_length / s->ctx_data.tx.ctx_header_size;
887f90e2dedSTakashi Sakamoto 
888753e7179STakashi Sakamoto 	err = generate_device_pkt_descs(s, s->pkt_descs, ctx_header, packets);
889753e7179STakashi Sakamoto 	if (err < 0) {
890753e7179STakashi Sakamoto 		if (err != -EAGAIN) {
891753e7179STakashi Sakamoto 			cancel_stream(s);
892753e7179STakashi Sakamoto 			return;
893753e7179STakashi Sakamoto 		}
8945e2ece0fSTakashi Sakamoto 	} else {
8950f5cfcb2STakashi Sakamoto 		process_ctx_payloads(s, s->pkt_descs, packets);
8965e2ece0fSTakashi Sakamoto 	}
8975e2ece0fSTakashi Sakamoto 
8985e2ece0fSTakashi Sakamoto 	for (i = 0; i < packets; ++i) {
8995e2ece0fSTakashi Sakamoto 		struct fw_iso_packet params = {0};
900a35463d1STakashi Sakamoto 
90160dd4929STakashi Sakamoto 		if (queue_in_packet(s, &params) < 0) {
902753e7179STakashi Sakamoto 			cancel_stream(s);
903753e7179STakashi Sakamoto 			return;
904753e7179STakashi Sakamoto 		}
905d67c46b9STakashi Sakamoto 	}
906d67c46b9STakashi Sakamoto }
907d67c46b9STakashi Sakamoto 
9082472cfb3STakashi Sakamoto static void irq_target_callback(struct fw_iso_context *context, u32 tstamp,
9092472cfb3STakashi Sakamoto 				size_t header_length, void *header,
9102472cfb3STakashi Sakamoto 				void *private_data)
91160dd4929STakashi Sakamoto {
9122472cfb3STakashi Sakamoto 	struct amdtp_stream *irq_target = private_data;
9132472cfb3STakashi Sakamoto 	struct amdtp_domain *d = irq_target->domain;
91460dd4929STakashi Sakamoto 	struct amdtp_stream *s;
91560dd4929STakashi Sakamoto 
91660dd4929STakashi Sakamoto 	out_stream_callback(context, tstamp, header_length, header, irq_target);
91760dd4929STakashi Sakamoto 	if (amdtp_streaming_error(irq_target))
91860dd4929STakashi Sakamoto 		goto error;
91960dd4929STakashi Sakamoto 
92060dd4929STakashi Sakamoto 	list_for_each_entry(s, &d->streams, list) {
92160dd4929STakashi Sakamoto 		if (s != irq_target && amdtp_stream_running(s)) {
92260dd4929STakashi Sakamoto 			fw_iso_context_flush_completions(s->context);
92360dd4929STakashi Sakamoto 			if (amdtp_streaming_error(s))
92460dd4929STakashi Sakamoto 				goto error;
92560dd4929STakashi Sakamoto 		}
92660dd4929STakashi Sakamoto 	}
92760dd4929STakashi Sakamoto 
92860dd4929STakashi Sakamoto 	return;
92960dd4929STakashi Sakamoto error:
93060dd4929STakashi Sakamoto 	if (amdtp_stream_running(irq_target))
93160dd4929STakashi Sakamoto 		cancel_stream(irq_target);
93260dd4929STakashi Sakamoto 
93360dd4929STakashi Sakamoto 	list_for_each_entry(s, &d->streams, list) {
93460dd4929STakashi Sakamoto 		if (amdtp_stream_running(s))
93560dd4929STakashi Sakamoto 			cancel_stream(s);
93660dd4929STakashi Sakamoto 	}
93760dd4929STakashi Sakamoto }
93860dd4929STakashi Sakamoto 
93960dd4929STakashi Sakamoto // this is executed one time.
940d67c46b9STakashi Sakamoto static void amdtp_stream_first_callback(struct fw_iso_context *context,
94173fc7f08STakashi Sakamoto 					u32 tstamp, size_t header_length,
942d67c46b9STakashi Sakamoto 					void *header, void *private_data)
943d67c46b9STakashi Sakamoto {
944d67c46b9STakashi Sakamoto 	struct amdtp_stream *s = private_data;
94526cd1e58STakashi Sakamoto 	const __be32 *ctx_header = header;
946a04513f8STakashi Sakamoto 	u32 cycle;
947d67c46b9STakashi Sakamoto 
948d67c46b9STakashi Sakamoto 	/*
949d67c46b9STakashi Sakamoto 	 * For in-stream, first packet has come.
950d67c46b9STakashi Sakamoto 	 * For out-stream, prepared to transmit first packet
951d67c46b9STakashi Sakamoto 	 */
952d67c46b9STakashi Sakamoto 	s->callbacked = true;
953d67c46b9STakashi Sakamoto 	wake_up(&s->callback_wait);
954d67c46b9STakashi Sakamoto 
955cc4f8e91STakashi Sakamoto 	if (s->direction == AMDTP_IN_STREAM) {
95626cd1e58STakashi Sakamoto 		cycle = compute_cycle_count(ctx_header[1]);
957a04513f8STakashi Sakamoto 
958d67c46b9STakashi Sakamoto 		context->callback.sc = in_stream_callback;
959a04513f8STakashi Sakamoto 	} else {
960a0e02331STakashi Sakamoto 		cycle = compute_it_cycle(*ctx_header, s->queue_size);
96126cd1e58STakashi Sakamoto 
9622472cfb3STakashi Sakamoto 		if (s == s->domain->irq_target)
9632472cfb3STakashi Sakamoto 			context->callback.sc = irq_target_callback;
9642472cfb3STakashi Sakamoto 		else
965d67c46b9STakashi Sakamoto 			context->callback.sc = out_stream_callback;
966a04513f8STakashi Sakamoto 	}
967a04513f8STakashi Sakamoto 
968a04513f8STakashi Sakamoto 	s->start_cycle = cycle;
969d67c46b9STakashi Sakamoto 
97073fc7f08STakashi Sakamoto 	context->callback.sc(context, tstamp, header_length, header, s);
971d67c46b9STakashi Sakamoto }
972d67c46b9STakashi Sakamoto 
973d67c46b9STakashi Sakamoto /**
974d67c46b9STakashi Sakamoto  * amdtp_stream_start - start transferring packets
975d67c46b9STakashi Sakamoto  * @s: the AMDTP stream to start
976d67c46b9STakashi Sakamoto  * @channel: the isochronous channel on the bus
977d67c46b9STakashi Sakamoto  * @speed: firewire speed code
978acfedcbeSTakashi Sakamoto  * @start_cycle: the isochronous cycle to start the context. Start immediately
979acfedcbeSTakashi Sakamoto  *		 if negative value is given.
980af86b0b1STakashi Sakamoto  * @queue_size: The number of packets in the queue.
981af86b0b1STakashi Sakamoto  * @idle_irq_interval: the interval to queue packet during initial state.
982d67c46b9STakashi Sakamoto  *
983d67c46b9STakashi Sakamoto  * The stream cannot be started until it has been configured with
984d67c46b9STakashi Sakamoto  * amdtp_stream_set_parameters() and it must be started before any PCM or MIDI
985d67c46b9STakashi Sakamoto  * device can be started.
986d67c46b9STakashi Sakamoto  */
987a0e02331STakashi Sakamoto static int amdtp_stream_start(struct amdtp_stream *s, int channel, int speed,
988af86b0b1STakashi Sakamoto 			      int start_cycle, unsigned int queue_size,
989af86b0b1STakashi Sakamoto 			      unsigned int idle_irq_interval)
990d67c46b9STakashi Sakamoto {
991d67c46b9STakashi Sakamoto 	static const struct {
992d67c46b9STakashi Sakamoto 		unsigned int data_block;
993d67c46b9STakashi Sakamoto 		unsigned int syt_offset;
994d3d10a4aSTakashi Sakamoto 	} *entry, initial_state[] = {
995d67c46b9STakashi Sakamoto 		[CIP_SFC_32000]  = {  4, 3072 },
996d67c46b9STakashi Sakamoto 		[CIP_SFC_48000]  = {  6, 1024 },
997d67c46b9STakashi Sakamoto 		[CIP_SFC_96000]  = { 12, 1024 },
998d67c46b9STakashi Sakamoto 		[CIP_SFC_192000] = { 24, 1024 },
999d67c46b9STakashi Sakamoto 		[CIP_SFC_44100]  = {  0,   67 },
1000d67c46b9STakashi Sakamoto 		[CIP_SFC_88200]  = {  0,   67 },
1001d67c46b9STakashi Sakamoto 		[CIP_SFC_176400] = {  0,   67 },
1002d67c46b9STakashi Sakamoto 	};
10032472cfb3STakashi Sakamoto 	bool is_irq_target = (s == s->domain->irq_target);
1004d3d10a4aSTakashi Sakamoto 	unsigned int ctx_header_size;
1005f11453c7STakashi Sakamoto 	unsigned int max_ctx_payload_size;
1006d67c46b9STakashi Sakamoto 	enum dma_data_direction dir;
1007d67c46b9STakashi Sakamoto 	int type, tag, err;
1008d67c46b9STakashi Sakamoto 
1009d67c46b9STakashi Sakamoto 	mutex_lock(&s->mutex);
1010d67c46b9STakashi Sakamoto 
1011d67c46b9STakashi Sakamoto 	if (WARN_ON(amdtp_stream_running(s) ||
1012d67c46b9STakashi Sakamoto 		    (s->data_block_quadlets < 1))) {
1013d67c46b9STakashi Sakamoto 		err = -EBADFD;
1014d67c46b9STakashi Sakamoto 		goto err_unlock;
1015d67c46b9STakashi Sakamoto 	}
1016d67c46b9STakashi Sakamoto 
1017d3d10a4aSTakashi Sakamoto 	if (s->direction == AMDTP_IN_STREAM) {
101860dd4929STakashi Sakamoto 		// NOTE: IT context should be used for constant IRQ.
101960dd4929STakashi Sakamoto 		if (is_irq_target) {
102060dd4929STakashi Sakamoto 			err = -EINVAL;
102160dd4929STakashi Sakamoto 			goto err_unlock;
102260dd4929STakashi Sakamoto 		}
102360dd4929STakashi Sakamoto 
1024d67c46b9STakashi Sakamoto 		s->data_block_counter = UINT_MAX;
1025d3d10a4aSTakashi Sakamoto 	} else {
1026d3d10a4aSTakashi Sakamoto 		entry = &initial_state[s->sfc];
1027d3d10a4aSTakashi Sakamoto 
1028d67c46b9STakashi Sakamoto 		s->data_block_counter = 0;
1029d3d10a4aSTakashi Sakamoto 		s->ctx_data.rx.data_block_state = entry->data_block;
1030d3d10a4aSTakashi Sakamoto 		s->ctx_data.rx.syt_offset_state = entry->syt_offset;
1031d3d10a4aSTakashi Sakamoto 		s->ctx_data.rx.last_syt_offset = TICKS_PER_CYCLE;
1032d3d10a4aSTakashi Sakamoto 	}
1033d67c46b9STakashi Sakamoto 
1034d67c46b9STakashi Sakamoto 	/* initialize packet buffer */
1035d67c46b9STakashi Sakamoto 	if (s->direction == AMDTP_IN_STREAM) {
1036d67c46b9STakashi Sakamoto 		dir = DMA_FROM_DEVICE;
1037d67c46b9STakashi Sakamoto 		type = FW_ISO_CONTEXT_RECEIVE;
1038f11453c7STakashi Sakamoto 		if (!(s->flags & CIP_NO_HEADER))
1039f11453c7STakashi Sakamoto 			ctx_header_size = IR_CTX_HEADER_SIZE_CIP;
1040f11453c7STakashi Sakamoto 		else
1041f11453c7STakashi Sakamoto 			ctx_header_size = IR_CTX_HEADER_SIZE_NO_CIP;
1042b18f0cfaSTakashi Sakamoto 
1043b18f0cfaSTakashi Sakamoto 		max_ctx_payload_size = amdtp_stream_get_max_payload(s) -
1044b18f0cfaSTakashi Sakamoto 				       ctx_header_size;
1045d67c46b9STakashi Sakamoto 	} else {
1046d67c46b9STakashi Sakamoto 		dir = DMA_TO_DEVICE;
1047d67c46b9STakashi Sakamoto 		type = FW_ISO_CONTEXT_TRANSMIT;
1048df9160b9STakashi Sakamoto 		ctx_header_size = 0;	// No effect for IT context.
1049f11453c7STakashi Sakamoto 
1050b18f0cfaSTakashi Sakamoto 		max_ctx_payload_size = amdtp_stream_get_max_payload(s);
1051b18f0cfaSTakashi Sakamoto 		if (!(s->flags & CIP_NO_HEADER))
1052b18f0cfaSTakashi Sakamoto 			max_ctx_payload_size -= IT_PKT_HEADER_SIZE_CIP;
1053b18f0cfaSTakashi Sakamoto 	}
1054f11453c7STakashi Sakamoto 
1055af86b0b1STakashi Sakamoto 	err = iso_packets_buffer_init(&s->buffer, s->unit, queue_size,
1056f11453c7STakashi Sakamoto 				      max_ctx_payload_size, dir);
1057d67c46b9STakashi Sakamoto 	if (err < 0)
1058d67c46b9STakashi Sakamoto 		goto err_unlock;
1059af86b0b1STakashi Sakamoto 	s->queue_size = queue_size;
106060dd4929STakashi Sakamoto 
1061d67c46b9STakashi Sakamoto 	s->context = fw_iso_context_create(fw_parent_device(s->unit)->card,
1062d3d10a4aSTakashi Sakamoto 					  type, channel, speed, ctx_header_size,
10632472cfb3STakashi Sakamoto 					  amdtp_stream_first_callback, s);
1064d67c46b9STakashi Sakamoto 	if (IS_ERR(s->context)) {
1065d67c46b9STakashi Sakamoto 		err = PTR_ERR(s->context);
1066d67c46b9STakashi Sakamoto 		if (err == -EBUSY)
1067d67c46b9STakashi Sakamoto 			dev_err(&s->unit->device,
1068d67c46b9STakashi Sakamoto 				"no free stream on this controller\n");
1069d67c46b9STakashi Sakamoto 		goto err_buffer;
1070d67c46b9STakashi Sakamoto 	}
1071d67c46b9STakashi Sakamoto 
1072d67c46b9STakashi Sakamoto 	amdtp_stream_update(s);
1073d67c46b9STakashi Sakamoto 
1074d3d10a4aSTakashi Sakamoto 	if (s->direction == AMDTP_IN_STREAM) {
1075f11453c7STakashi Sakamoto 		s->ctx_data.tx.max_ctx_payload_length = max_ctx_payload_size;
1076d3d10a4aSTakashi Sakamoto 		s->ctx_data.tx.ctx_header_size = ctx_header_size;
1077d3d10a4aSTakashi Sakamoto 	}
107852759c09STakashi Sakamoto 
10793b196c39STakashi Sakamoto 	if (s->flags & CIP_NO_HEADER)
10803b196c39STakashi Sakamoto 		s->tag = TAG_NO_CIP_HEADER;
10813b196c39STakashi Sakamoto 	else
10823b196c39STakashi Sakamoto 		s->tag = TAG_CIP;
10833b196c39STakashi Sakamoto 
1084a0e02331STakashi Sakamoto 	s->pkt_descs = kcalloc(s->queue_size, sizeof(*s->pkt_descs),
108504130cf8STakashi Sakamoto 			       GFP_KERNEL);
108604130cf8STakashi Sakamoto 	if (!s->pkt_descs) {
108704130cf8STakashi Sakamoto 		err = -ENOMEM;
108804130cf8STakashi Sakamoto 		goto err_context;
108904130cf8STakashi Sakamoto 	}
109004130cf8STakashi Sakamoto 
1091d67c46b9STakashi Sakamoto 	s->packet_index = 0;
1092d67c46b9STakashi Sakamoto 	do {
10936007bf54STakashi Sakamoto 		struct fw_iso_packet params;
1094e229853dSTakashi Sakamoto 
1095b18f0cfaSTakashi Sakamoto 		if (s->direction == AMDTP_IN_STREAM) {
109660dd4929STakashi Sakamoto 			err = queue_in_packet(s, &params);
1097b18f0cfaSTakashi Sakamoto 		} else {
109860dd4929STakashi Sakamoto 			bool sched_irq = false;
109960dd4929STakashi Sakamoto 
1100b18f0cfaSTakashi Sakamoto 			params.header_length = 0;
1101b18f0cfaSTakashi Sakamoto 			params.payload_length = 0;
110260dd4929STakashi Sakamoto 
110360dd4929STakashi Sakamoto 			if (is_irq_target) {
110460dd4929STakashi Sakamoto 				sched_irq = !((s->packet_index + 1) %
110560dd4929STakashi Sakamoto 					      idle_irq_interval);
110660dd4929STakashi Sakamoto 			}
110760dd4929STakashi Sakamoto 
1108e229853dSTakashi Sakamoto 			err = queue_out_packet(s, &params, sched_irq);
1109b18f0cfaSTakashi Sakamoto 		}
1110d67c46b9STakashi Sakamoto 		if (err < 0)
111104130cf8STakashi Sakamoto 			goto err_pkt_descs;
1112d67c46b9STakashi Sakamoto 	} while (s->packet_index > 0);
1113d67c46b9STakashi Sakamoto 
1114d67c46b9STakashi Sakamoto 	/* NOTE: TAG1 matches CIP. This just affects in stream. */
1115d67c46b9STakashi Sakamoto 	tag = FW_ISO_CONTEXT_MATCH_TAG1;
11163b196c39STakashi Sakamoto 	if ((s->flags & CIP_EMPTY_WITH_TAG0) || (s->flags & CIP_NO_HEADER))
1117d67c46b9STakashi Sakamoto 		tag |= FW_ISO_CONTEXT_MATCH_TAG0;
1118d67c46b9STakashi Sakamoto 
1119d67c46b9STakashi Sakamoto 	s->callbacked = false;
1120acfedcbeSTakashi Sakamoto 	err = fw_iso_context_start(s->context, start_cycle, 0, tag);
1121d67c46b9STakashi Sakamoto 	if (err < 0)
112204130cf8STakashi Sakamoto 		goto err_pkt_descs;
1123d67c46b9STakashi Sakamoto 
1124d67c46b9STakashi Sakamoto 	mutex_unlock(&s->mutex);
1125d67c46b9STakashi Sakamoto 
1126d67c46b9STakashi Sakamoto 	return 0;
112704130cf8STakashi Sakamoto err_pkt_descs:
112804130cf8STakashi Sakamoto 	kfree(s->pkt_descs);
1129d67c46b9STakashi Sakamoto err_context:
1130d67c46b9STakashi Sakamoto 	fw_iso_context_destroy(s->context);
1131d67c46b9STakashi Sakamoto 	s->context = ERR_PTR(-1);
1132d67c46b9STakashi Sakamoto err_buffer:
1133d67c46b9STakashi Sakamoto 	iso_packets_buffer_destroy(&s->buffer, s->unit);
1134d67c46b9STakashi Sakamoto err_unlock:
1135d67c46b9STakashi Sakamoto 	mutex_unlock(&s->mutex);
1136d67c46b9STakashi Sakamoto 
1137d67c46b9STakashi Sakamoto 	return err;
1138d67c46b9STakashi Sakamoto }
1139d67c46b9STakashi Sakamoto 
1140d67c46b9STakashi Sakamoto /**
1141f890f9a0STakashi Sakamoto  * amdtp_domain_stream_pcm_pointer - get the PCM buffer position
1142f890f9a0STakashi Sakamoto  * @d: the AMDTP domain.
1143d67c46b9STakashi Sakamoto  * @s: the AMDTP stream that transports the PCM data
1144d67c46b9STakashi Sakamoto  *
1145d67c46b9STakashi Sakamoto  * Returns the current buffer position, in frames.
1146d67c46b9STakashi Sakamoto  */
1147f890f9a0STakashi Sakamoto unsigned long amdtp_domain_stream_pcm_pointer(struct amdtp_domain *d,
1148f890f9a0STakashi Sakamoto 					      struct amdtp_stream *s)
1149d67c46b9STakashi Sakamoto {
1150f890f9a0STakashi Sakamoto 	struct amdtp_stream *irq_target = d->irq_target;
1151f890f9a0STakashi Sakamoto 
1152f890f9a0STakashi Sakamoto 	if (irq_target && amdtp_stream_running(irq_target)) {
1153f890f9a0STakashi Sakamoto 		// This function is called in software IRQ context of
1154f890f9a0STakashi Sakamoto 		// period_tasklet or process context.
1155f890f9a0STakashi Sakamoto 		//
1156f890f9a0STakashi Sakamoto 		// When the software IRQ context was scheduled by software IRQ
1157f890f9a0STakashi Sakamoto 		// context of IT contexts, queued packets were already handled.
1158f890f9a0STakashi Sakamoto 		// Therefore, no need to flush the queue in buffer furthermore.
1159f890f9a0STakashi Sakamoto 		//
1160f890f9a0STakashi Sakamoto 		// When the process context reach here, some packets will be
1161f890f9a0STakashi Sakamoto 		// already queued in the buffer. These packets should be handled
1162f890f9a0STakashi Sakamoto 		// immediately to keep better granularity of PCM pointer.
1163f890f9a0STakashi Sakamoto 		//
1164f890f9a0STakashi Sakamoto 		// Later, the process context will sometimes schedules software
1165f890f9a0STakashi Sakamoto 		// IRQ context of the period_tasklet. Then, no need to flush the
1166f890f9a0STakashi Sakamoto 		// queue by the same reason as described in the above
1167f890f9a0STakashi Sakamoto 		if (!in_interrupt()) {
1168f890f9a0STakashi Sakamoto 			// Queued packet should be processed without any kernel
1169f890f9a0STakashi Sakamoto 			// preemption to keep latency against bus cycle.
1170f890f9a0STakashi Sakamoto 			preempt_disable();
1171f890f9a0STakashi Sakamoto 			fw_iso_context_flush_completions(irq_target->context);
1172f890f9a0STakashi Sakamoto 			preempt_enable();
1173f890f9a0STakashi Sakamoto 		}
1174f890f9a0STakashi Sakamoto 	}
1175d67c46b9STakashi Sakamoto 
11766aa7de05SMark Rutland 	return READ_ONCE(s->pcm_buffer_pointer);
1177d67c46b9STakashi Sakamoto }
1178f890f9a0STakashi Sakamoto EXPORT_SYMBOL_GPL(amdtp_domain_stream_pcm_pointer);
1179d67c46b9STakashi Sakamoto 
1180d67c46b9STakashi Sakamoto /**
1181e6dcc92fSTakashi Sakamoto  * amdtp_domain_stream_pcm_ack - acknowledge queued PCM frames
1182e6dcc92fSTakashi Sakamoto  * @d: the AMDTP domain.
1183875becf8STakashi Sakamoto  * @s: the AMDTP stream that transfers the PCM frames
1184875becf8STakashi Sakamoto  *
1185875becf8STakashi Sakamoto  * Returns zero always.
1186875becf8STakashi Sakamoto  */
1187e6dcc92fSTakashi Sakamoto int amdtp_domain_stream_pcm_ack(struct amdtp_domain *d, struct amdtp_stream *s)
1188875becf8STakashi Sakamoto {
1189e6dcc92fSTakashi Sakamoto 	struct amdtp_stream *irq_target = d->irq_target;
1190e6dcc92fSTakashi Sakamoto 
1191e6dcc92fSTakashi Sakamoto 	// Process isochronous packets for recent isochronous cycle to handle
1192e6dcc92fSTakashi Sakamoto 	// queued PCM frames.
1193e6dcc92fSTakashi Sakamoto 	if (irq_target && amdtp_stream_running(irq_target)) {
1194e6dcc92fSTakashi Sakamoto 		// Queued packet should be processed without any kernel
1195e6dcc92fSTakashi Sakamoto 		// preemption to keep latency against bus cycle.
1196e6dcc92fSTakashi Sakamoto 		preempt_disable();
1197e6dcc92fSTakashi Sakamoto 		fw_iso_context_flush_completions(irq_target->context);
1198e6dcc92fSTakashi Sakamoto 		preempt_enable();
1199e6dcc92fSTakashi Sakamoto 	}
1200875becf8STakashi Sakamoto 
1201875becf8STakashi Sakamoto 	return 0;
1202875becf8STakashi Sakamoto }
1203e6dcc92fSTakashi Sakamoto EXPORT_SYMBOL_GPL(amdtp_domain_stream_pcm_ack);
1204875becf8STakashi Sakamoto 
1205875becf8STakashi Sakamoto /**
1206d67c46b9STakashi Sakamoto  * amdtp_stream_update - update the stream after a bus reset
1207d67c46b9STakashi Sakamoto  * @s: the AMDTP stream
1208d67c46b9STakashi Sakamoto  */
1209d67c46b9STakashi Sakamoto void amdtp_stream_update(struct amdtp_stream *s)
1210d67c46b9STakashi Sakamoto {
1211d67c46b9STakashi Sakamoto 	/* Precomputing. */
12126aa7de05SMark Rutland 	WRITE_ONCE(s->source_node_id_field,
12136aa7de05SMark Rutland                    (fw_parent_device(s->unit)->card->node_id << CIP_SID_SHIFT) & CIP_SID_MASK);
1214d67c46b9STakashi Sakamoto }
1215d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_update);
1216d67c46b9STakashi Sakamoto 
1217d67c46b9STakashi Sakamoto /**
1218d67c46b9STakashi Sakamoto  * amdtp_stream_stop - stop sending packets
1219d67c46b9STakashi Sakamoto  * @s: the AMDTP stream to stop
1220d67c46b9STakashi Sakamoto  *
1221d67c46b9STakashi Sakamoto  * All PCM and MIDI devices of the stream must be stopped before the stream
1222d67c46b9STakashi Sakamoto  * itself can be stopped.
1223d67c46b9STakashi Sakamoto  */
122474f94e41STakashi Sakamoto static void amdtp_stream_stop(struct amdtp_stream *s)
1225d67c46b9STakashi Sakamoto {
1226d67c46b9STakashi Sakamoto 	mutex_lock(&s->mutex);
1227d67c46b9STakashi Sakamoto 
1228d67c46b9STakashi Sakamoto 	if (!amdtp_stream_running(s)) {
1229d67c46b9STakashi Sakamoto 		mutex_unlock(&s->mutex);
1230d67c46b9STakashi Sakamoto 		return;
1231d67c46b9STakashi Sakamoto 	}
1232d67c46b9STakashi Sakamoto 
1233d67c46b9STakashi Sakamoto 	tasklet_kill(&s->period_tasklet);
1234d67c46b9STakashi Sakamoto 	fw_iso_context_stop(s->context);
1235d67c46b9STakashi Sakamoto 	fw_iso_context_destroy(s->context);
1236d67c46b9STakashi Sakamoto 	s->context = ERR_PTR(-1);
1237d67c46b9STakashi Sakamoto 	iso_packets_buffer_destroy(&s->buffer, s->unit);
123804130cf8STakashi Sakamoto 	kfree(s->pkt_descs);
1239d67c46b9STakashi Sakamoto 
1240d67c46b9STakashi Sakamoto 	s->callbacked = false;
1241d67c46b9STakashi Sakamoto 
1242d67c46b9STakashi Sakamoto 	mutex_unlock(&s->mutex);
1243d67c46b9STakashi Sakamoto }
1244d67c46b9STakashi Sakamoto 
1245d67c46b9STakashi Sakamoto /**
1246d67c46b9STakashi Sakamoto  * amdtp_stream_pcm_abort - abort the running PCM device
1247d67c46b9STakashi Sakamoto  * @s: the AMDTP stream about to be stopped
1248d67c46b9STakashi Sakamoto  *
1249d67c46b9STakashi Sakamoto  * If the isochronous stream needs to be stopped asynchronously, call this
1250d67c46b9STakashi Sakamoto  * function first to stop the PCM device.
1251d67c46b9STakashi Sakamoto  */
1252d67c46b9STakashi Sakamoto void amdtp_stream_pcm_abort(struct amdtp_stream *s)
1253d67c46b9STakashi Sakamoto {
1254d67c46b9STakashi Sakamoto 	struct snd_pcm_substream *pcm;
1255d67c46b9STakashi Sakamoto 
12566aa7de05SMark Rutland 	pcm = READ_ONCE(s->pcm);
1257d67c46b9STakashi Sakamoto 	if (pcm)
1258d67c46b9STakashi Sakamoto 		snd_pcm_stop_xrun(pcm);
1259d67c46b9STakashi Sakamoto }
1260d67c46b9STakashi Sakamoto EXPORT_SYMBOL(amdtp_stream_pcm_abort);
12613ec3d7a3STakashi Sakamoto 
12623ec3d7a3STakashi Sakamoto /**
12633ec3d7a3STakashi Sakamoto  * amdtp_domain_init - initialize an AMDTP domain structure
12643ec3d7a3STakashi Sakamoto  * @d: the AMDTP domain to initialize.
12653ec3d7a3STakashi Sakamoto  */
12663ec3d7a3STakashi Sakamoto int amdtp_domain_init(struct amdtp_domain *d)
12673ec3d7a3STakashi Sakamoto {
12683ec3d7a3STakashi Sakamoto 	INIT_LIST_HEAD(&d->streams);
12693ec3d7a3STakashi Sakamoto 
1270d68c3123STakashi Sakamoto 	d->events_per_period = 0;
1271d68c3123STakashi Sakamoto 
12723ec3d7a3STakashi Sakamoto 	return 0;
12733ec3d7a3STakashi Sakamoto }
12743ec3d7a3STakashi Sakamoto EXPORT_SYMBOL_GPL(amdtp_domain_init);
12753ec3d7a3STakashi Sakamoto 
12763ec3d7a3STakashi Sakamoto /**
12773ec3d7a3STakashi Sakamoto  * amdtp_domain_destroy - destroy an AMDTP domain structure
12783ec3d7a3STakashi Sakamoto  * @d: the AMDTP domain to destroy.
12793ec3d7a3STakashi Sakamoto  */
12803ec3d7a3STakashi Sakamoto void amdtp_domain_destroy(struct amdtp_domain *d)
12813ec3d7a3STakashi Sakamoto {
12828d0d5c3fSTakashi Sakamoto 	// At present nothing to do.
12838d0d5c3fSTakashi Sakamoto 	return;
12843ec3d7a3STakashi Sakamoto }
12853ec3d7a3STakashi Sakamoto EXPORT_SYMBOL_GPL(amdtp_domain_destroy);
12866261f90bSTakashi Sakamoto 
12876261f90bSTakashi Sakamoto /**
1288157a53eeSTakashi Sakamoto  * amdtp_domain_add_stream - register isoc context into the domain.
1289157a53eeSTakashi Sakamoto  * @d: the AMDTP domain.
1290157a53eeSTakashi Sakamoto  * @s: the AMDTP stream.
1291157a53eeSTakashi Sakamoto  * @channel: the isochronous channel on the bus.
1292157a53eeSTakashi Sakamoto  * @speed: firewire speed code.
1293157a53eeSTakashi Sakamoto  */
1294157a53eeSTakashi Sakamoto int amdtp_domain_add_stream(struct amdtp_domain *d, struct amdtp_stream *s,
1295157a53eeSTakashi Sakamoto 			    int channel, int speed)
1296157a53eeSTakashi Sakamoto {
1297157a53eeSTakashi Sakamoto 	struct amdtp_stream *tmp;
1298157a53eeSTakashi Sakamoto 
1299157a53eeSTakashi Sakamoto 	list_for_each_entry(tmp, &d->streams, list) {
1300157a53eeSTakashi Sakamoto 		if (s == tmp)
1301157a53eeSTakashi Sakamoto 			return -EBUSY;
1302157a53eeSTakashi Sakamoto 	}
1303157a53eeSTakashi Sakamoto 
1304157a53eeSTakashi Sakamoto 	list_add(&s->list, &d->streams);
1305157a53eeSTakashi Sakamoto 
1306157a53eeSTakashi Sakamoto 	s->channel = channel;
1307157a53eeSTakashi Sakamoto 	s->speed = speed;
13082472cfb3STakashi Sakamoto 	s->domain = d;
1309157a53eeSTakashi Sakamoto 
1310157a53eeSTakashi Sakamoto 	return 0;
1311157a53eeSTakashi Sakamoto }
1312157a53eeSTakashi Sakamoto EXPORT_SYMBOL_GPL(amdtp_domain_add_stream);
1313157a53eeSTakashi Sakamoto 
1314acfedcbeSTakashi Sakamoto static int get_current_cycle_time(struct fw_card *fw_card, int *cur_cycle)
1315acfedcbeSTakashi Sakamoto {
1316acfedcbeSTakashi Sakamoto 	int generation;
1317acfedcbeSTakashi Sakamoto 	int rcode;
1318acfedcbeSTakashi Sakamoto 	__be32 reg;
1319acfedcbeSTakashi Sakamoto 	u32 data;
1320acfedcbeSTakashi Sakamoto 
1321acfedcbeSTakashi Sakamoto 	// This is a request to local 1394 OHCI controller and expected to
1322acfedcbeSTakashi Sakamoto 	// complete without any event waiting.
1323acfedcbeSTakashi Sakamoto 	generation = fw_card->generation;
1324acfedcbeSTakashi Sakamoto 	smp_rmb();	// node_id vs. generation.
1325acfedcbeSTakashi Sakamoto 	rcode = fw_run_transaction(fw_card, TCODE_READ_QUADLET_REQUEST,
1326acfedcbeSTakashi Sakamoto 				   fw_card->node_id, generation, SCODE_100,
1327acfedcbeSTakashi Sakamoto 				   CSR_REGISTER_BASE + CSR_CYCLE_TIME,
1328acfedcbeSTakashi Sakamoto 				   &reg, sizeof(reg));
1329acfedcbeSTakashi Sakamoto 	if (rcode != RCODE_COMPLETE)
1330acfedcbeSTakashi Sakamoto 		return -EIO;
1331acfedcbeSTakashi Sakamoto 
1332acfedcbeSTakashi Sakamoto 	data = be32_to_cpu(reg);
1333acfedcbeSTakashi Sakamoto 	*cur_cycle = data >> 12;
1334acfedcbeSTakashi Sakamoto 
1335acfedcbeSTakashi Sakamoto 	return 0;
1336acfedcbeSTakashi Sakamoto }
1337acfedcbeSTakashi Sakamoto 
1338157a53eeSTakashi Sakamoto /**
13399b4702b0STakashi Sakamoto  * amdtp_domain_start - start sending packets for isoc context in the domain.
13409b4702b0STakashi Sakamoto  * @d: the AMDTP domain.
1341acfedcbeSTakashi Sakamoto  * @ir_delay_cycle: the cycle delay to start all IR contexts.
13429b4702b0STakashi Sakamoto  */
1343acfedcbeSTakashi Sakamoto int amdtp_domain_start(struct amdtp_domain *d, unsigned int ir_delay_cycle)
13449b4702b0STakashi Sakamoto {
1345af86b0b1STakashi Sakamoto 	unsigned int events_per_buffer = d->events_per_buffer;
1346af86b0b1STakashi Sakamoto 	unsigned int events_per_period = d->events_per_period;
1347af86b0b1STakashi Sakamoto 	unsigned int idle_irq_interval;
1348af86b0b1STakashi Sakamoto 	unsigned int queue_size;
13499b4702b0STakashi Sakamoto 	struct amdtp_stream *s;
1350acfedcbeSTakashi Sakamoto 	int cycle;
1351acfedcbeSTakashi Sakamoto 	int err;
13529b4702b0STakashi Sakamoto 
135360dd4929STakashi Sakamoto 	// Select an IT context as IRQ target.
13549b4702b0STakashi Sakamoto 	list_for_each_entry(s, &d->streams, list) {
135560dd4929STakashi Sakamoto 		if (s->direction == AMDTP_OUT_STREAM)
13569b4702b0STakashi Sakamoto 			break;
13579b4702b0STakashi Sakamoto 	}
135860dd4929STakashi Sakamoto 	if (!s)
135960dd4929STakashi Sakamoto 		return -ENXIO;
136060dd4929STakashi Sakamoto 	d->irq_target = s;
13619b4702b0STakashi Sakamoto 
1362af86b0b1STakashi Sakamoto 	// This is a case that AMDTP streams in domain run just for MIDI
1363af86b0b1STakashi Sakamoto 	// substream. Use the number of events equivalent to 10 msec as
1364af86b0b1STakashi Sakamoto 	// interval of hardware IRQ.
1365af86b0b1STakashi Sakamoto 	if (events_per_period == 0)
1366af86b0b1STakashi Sakamoto 		events_per_period = amdtp_rate_table[d->irq_target->sfc] / 100;
1367af86b0b1STakashi Sakamoto 	if (events_per_buffer == 0)
1368af86b0b1STakashi Sakamoto 		events_per_buffer = events_per_period * 3;
1369af86b0b1STakashi Sakamoto 
1370af86b0b1STakashi Sakamoto 	queue_size = DIV_ROUND_UP(CYCLES_PER_SECOND * events_per_buffer,
1371af86b0b1STakashi Sakamoto 				  amdtp_rate_table[d->irq_target->sfc]);
1372af86b0b1STakashi Sakamoto 
1373acfedcbeSTakashi Sakamoto 	if (ir_delay_cycle > 0) {
1374acfedcbeSTakashi Sakamoto 		struct fw_card *fw_card = fw_parent_device(s->unit)->card;
1375acfedcbeSTakashi Sakamoto 
1376acfedcbeSTakashi Sakamoto 		err = get_current_cycle_time(fw_card, &cycle);
1377acfedcbeSTakashi Sakamoto 		if (err < 0)
1378acfedcbeSTakashi Sakamoto 			return err;
1379acfedcbeSTakashi Sakamoto 
1380acfedcbeSTakashi Sakamoto 		// No need to care overflow in cycle field because of enough
1381acfedcbeSTakashi Sakamoto 		// width.
1382acfedcbeSTakashi Sakamoto 		cycle += ir_delay_cycle;
1383acfedcbeSTakashi Sakamoto 
1384acfedcbeSTakashi Sakamoto 		// Round up to sec field.
1385acfedcbeSTakashi Sakamoto 		if ((cycle & 0x00001fff) >= CYCLES_PER_SECOND) {
1386acfedcbeSTakashi Sakamoto 			unsigned int sec;
1387acfedcbeSTakashi Sakamoto 
1388acfedcbeSTakashi Sakamoto 			// The sec field can overflow.
1389acfedcbeSTakashi Sakamoto 			sec = (cycle & 0xffffe000) >> 13;
1390acfedcbeSTakashi Sakamoto 			cycle = (++sec << 13) |
1391acfedcbeSTakashi Sakamoto 				((cycle & 0x00001fff) / CYCLES_PER_SECOND);
1392acfedcbeSTakashi Sakamoto 		}
1393acfedcbeSTakashi Sakamoto 
1394acfedcbeSTakashi Sakamoto 		// In OHCI 1394 specification, lower 2 bits are available for
1395acfedcbeSTakashi Sakamoto 		// sec field.
1396acfedcbeSTakashi Sakamoto 		cycle &= 0x00007fff;
1397acfedcbeSTakashi Sakamoto 	} else {
1398acfedcbeSTakashi Sakamoto 		cycle = -1;
1399acfedcbeSTakashi Sakamoto 	}
1400acfedcbeSTakashi Sakamoto 
140160dd4929STakashi Sakamoto 	list_for_each_entry(s, &d->streams, list) {
1402acfedcbeSTakashi Sakamoto 		int cycle_match;
1403acfedcbeSTakashi Sakamoto 
1404acfedcbeSTakashi Sakamoto 		if (s->direction == AMDTP_IN_STREAM) {
1405acfedcbeSTakashi Sakamoto 			cycle_match = cycle;
1406acfedcbeSTakashi Sakamoto 		} else {
1407acfedcbeSTakashi Sakamoto 			// IT context starts immediately.
1408acfedcbeSTakashi Sakamoto 			cycle_match = -1;
1409acfedcbeSTakashi Sakamoto 		}
1410acfedcbeSTakashi Sakamoto 
141160dd4929STakashi Sakamoto 		if (s != d->irq_target) {
14122472cfb3STakashi Sakamoto 			err = amdtp_stream_start(s, s->channel, s->speed,
1413af86b0b1STakashi Sakamoto 						 cycle_match, queue_size, 0);
141460dd4929STakashi Sakamoto 			if (err < 0)
141560dd4929STakashi Sakamoto 				goto error;
141660dd4929STakashi Sakamoto 		}
14179b4702b0STakashi Sakamoto 	}
14189b4702b0STakashi Sakamoto 
141960dd4929STakashi Sakamoto 	s = d->irq_target;
1420af86b0b1STakashi Sakamoto 	s->ctx_data.rx.events_per_period = events_per_period;
1421af86b0b1STakashi Sakamoto 	s->ctx_data.rx.event_count = 0;
1422af86b0b1STakashi Sakamoto 
1423af86b0b1STakashi Sakamoto 	idle_irq_interval = DIV_ROUND_UP(CYCLES_PER_SECOND * events_per_period,
1424af86b0b1STakashi Sakamoto 					 amdtp_rate_table[d->irq_target->sfc]);
1425af86b0b1STakashi Sakamoto 	err = amdtp_stream_start(s, s->channel, s->speed, -1, queue_size,
1426af86b0b1STakashi Sakamoto 				 idle_irq_interval);
142760dd4929STakashi Sakamoto 	if (err < 0)
142860dd4929STakashi Sakamoto 		goto error;
142960dd4929STakashi Sakamoto 
143060dd4929STakashi Sakamoto 	return 0;
143160dd4929STakashi Sakamoto error:
143260dd4929STakashi Sakamoto 	list_for_each_entry(s, &d->streams, list)
143360dd4929STakashi Sakamoto 		amdtp_stream_stop(s);
14349b4702b0STakashi Sakamoto 	return err;
14359b4702b0STakashi Sakamoto }
14369b4702b0STakashi Sakamoto EXPORT_SYMBOL_GPL(amdtp_domain_start);
14379b4702b0STakashi Sakamoto 
14389b4702b0STakashi Sakamoto /**
14396261f90bSTakashi Sakamoto  * amdtp_domain_stop - stop sending packets for isoc context in the same domain.
14406261f90bSTakashi Sakamoto  * @d: the AMDTP domain to which the isoc contexts belong.
14416261f90bSTakashi Sakamoto  */
14426261f90bSTakashi Sakamoto void amdtp_domain_stop(struct amdtp_domain *d)
14436261f90bSTakashi Sakamoto {
14446261f90bSTakashi Sakamoto 	struct amdtp_stream *s, *next;
14456261f90bSTakashi Sakamoto 
144660dd4929STakashi Sakamoto 	if (d->irq_target)
144760dd4929STakashi Sakamoto 		amdtp_stream_stop(d->irq_target);
144860dd4929STakashi Sakamoto 
14496261f90bSTakashi Sakamoto 	list_for_each_entry_safe(s, next, &d->streams, list) {
14506261f90bSTakashi Sakamoto 		list_del(&s->list);
14516261f90bSTakashi Sakamoto 
145260dd4929STakashi Sakamoto 		if (s != d->irq_target)
14536261f90bSTakashi Sakamoto 			amdtp_stream_stop(s);
14546261f90bSTakashi Sakamoto 	}
1455d68c3123STakashi Sakamoto 
1456d68c3123STakashi Sakamoto 	d->events_per_period = 0;
145760dd4929STakashi Sakamoto 	d->irq_target = NULL;
14586261f90bSTakashi Sakamoto }
14596261f90bSTakashi Sakamoto EXPORT_SYMBOL_GPL(amdtp_domain_stop);
1460