ALSA: bebob: constify various snd_bebob structures
[deliverable/linux.git] / sound / firewire / amdtp-stream.c
CommitLineData
31ef9134
CL
1/*
2 * Audio and Music Data Transmission Protocol (IEC 61883-6) streams
3 * with Common Isochronous Packet (IEC 61883-1) headers
4 *
5 * Copyright (c) Clemens Ladisch <clemens@ladisch.de>
6 * Licensed under the terms of the GNU General Public License, version 2.
7 */
8
9#include <linux/device.h>
10#include <linux/err.h>
11#include <linux/firewire.h>
12#include <linux/module.h>
13#include <linux/slab.h>
14#include <sound/pcm.h>
7b2d99fa 15#include <sound/pcm_params.h>
d67c46b9 16#include "amdtp-stream.h"
31ef9134
CL
17
18#define TICKS_PER_CYCLE 3072
19#define CYCLES_PER_SECOND 8000
20#define TICKS_PER_SECOND (TICKS_PER_CYCLE * CYCLES_PER_SECOND)
21
ca5b5050 22#define TRANSFER_DELAY_TICKS 0x2e00 /* 479.17 microseconds */
31ef9134 23
b445db44
TS
24/* isochronous header parameters */
25#define ISO_DATA_LENGTH_SHIFT 16
31ef9134
CL
26#define TAG_CIP 1
27
b445db44 28/* common isochronous packet header parameters */
9a2820c1
TS
29#define CIP_EOH_SHIFT 31
30#define CIP_EOH (1u << CIP_EOH_SHIFT)
b445db44 31#define CIP_EOH_MASK 0x80000000
9a2820c1
TS
32#define CIP_SID_SHIFT 24
33#define CIP_SID_MASK 0x3f000000
34#define CIP_DBS_MASK 0x00ff0000
35#define CIP_DBS_SHIFT 16
36#define CIP_DBC_MASK 0x000000ff
37#define CIP_FMT_SHIFT 24
b445db44 38#define CIP_FMT_MASK 0x3f000000
9a2820c1
TS
39#define CIP_FDF_MASK 0x00ff0000
40#define CIP_FDF_SHIFT 16
b445db44
TS
41#define CIP_SYT_MASK 0x0000ffff
42#define CIP_SYT_NO_INFO 0xffff
b445db44 43
51c29fd2 44/* Audio and Music transfer protocol specific parameters */
414ba022 45#define CIP_FMT_AM 0x10
2b3fc456 46#define AMDTP_FDF_NO_DATA 0xff
31ef9134
CL
47
48/* TODO: make these configurable */
49#define INTERRUPT_INTERVAL 16
50#define QUEUE_LENGTH 48
51
2b3fc456 52#define IN_PACKET_HEADER_SIZE 4
4b7da117
TS
53#define OUT_PACKET_HEADER_SIZE 0
54
76fb8789
CL
55static void pcm_period_tasklet(unsigned long data);
56
31ef9134 57/**
be4a2894
TS
58 * amdtp_stream_init - initialize an AMDTP stream structure
59 * @s: the AMDTP stream to initialize
31ef9134 60 * @unit: the target of the stream
3ff7e8f0 61 * @dir: the direction of stream
31ef9134 62 * @flags: the packet transmission method to use
5955815e 63 * @fmt: the value of fmt field in CIP header
df075fee
TS
64 * @process_data_blocks: callback handler to process data blocks
65 * @protocol_size: the size to allocate newly for protocol
31ef9134 66 */
be4a2894 67int amdtp_stream_init(struct amdtp_stream *s, struct fw_unit *unit,
5955815e 68 enum amdtp_stream_direction dir, enum cip_flags flags,
df075fee
TS
69 unsigned int fmt,
70 amdtp_stream_process_data_blocks_t process_data_blocks,
71 unsigned int protocol_size)
31ef9134 72{
df075fee
TS
73 if (process_data_blocks == NULL)
74 return -EINVAL;
75
76 s->protocol = kzalloc(protocol_size, GFP_KERNEL);
77 if (!s->protocol)
78 return -ENOMEM;
79
c6f224dc 80 s->unit = unit;
3ff7e8f0 81 s->direction = dir;
31ef9134
CL
82 s->flags = flags;
83 s->context = ERR_PTR(-1);
84 mutex_init(&s->mutex);
76fb8789 85 tasklet_init(&s->period_tasklet, pcm_period_tasklet, (unsigned long)s);
ec00f5e4 86 s->packet_index = 0;
31ef9134 87
7b3b0d85
TS
88 init_waitqueue_head(&s->callback_wait);
89 s->callbacked = false;
90 s->sync_slave = NULL;
91
5955815e 92 s->fmt = fmt;
df075fee 93 s->process_data_blocks = process_data_blocks;
414ba022 94
31ef9134
CL
95 return 0;
96}
be4a2894 97EXPORT_SYMBOL(amdtp_stream_init);
31ef9134
CL
98
99/**
be4a2894
TS
100 * amdtp_stream_destroy - free stream resources
101 * @s: the AMDTP stream to destroy
31ef9134 102 */
be4a2894 103void amdtp_stream_destroy(struct amdtp_stream *s)
31ef9134 104{
be4a2894 105 WARN_ON(amdtp_stream_running(s));
df075fee 106 kfree(s->protocol);
31ef9134 107 mutex_destroy(&s->mutex);
31ef9134 108}
be4a2894 109EXPORT_SYMBOL(amdtp_stream_destroy);
31ef9134 110
c5280e99 111const unsigned int amdtp_syt_intervals[CIP_SFC_COUNT] = {
a7304e3b
CL
112 [CIP_SFC_32000] = 8,
113 [CIP_SFC_44100] = 8,
114 [CIP_SFC_48000] = 8,
115 [CIP_SFC_88200] = 16,
116 [CIP_SFC_96000] = 16,
117 [CIP_SFC_176400] = 32,
118 [CIP_SFC_192000] = 32,
119};
120EXPORT_SYMBOL(amdtp_syt_intervals);
121
f9503a68 122const unsigned int amdtp_rate_table[CIP_SFC_COUNT] = {
1017abed
TS
123 [CIP_SFC_32000] = 32000,
124 [CIP_SFC_44100] = 44100,
125 [CIP_SFC_48000] = 48000,
126 [CIP_SFC_88200] = 88200,
127 [CIP_SFC_96000] = 96000,
128 [CIP_SFC_176400] = 176400,
129 [CIP_SFC_192000] = 192000,
130};
131EXPORT_SYMBOL(amdtp_rate_table);
132
7b2d99fa
TS
133/**
134 * amdtp_stream_add_pcm_hw_constraints - add hw constraints for PCM substream
135 * @s: the AMDTP stream, which must be initialized.
136 * @runtime: the PCM substream runtime
137 */
138int amdtp_stream_add_pcm_hw_constraints(struct amdtp_stream *s,
139 struct snd_pcm_runtime *runtime)
140{
141 int err;
142
7b2d99fa
TS
143 /*
144 * Currently firewire-lib processes 16 packets in one software
145 * interrupt callback. This equals to 2msec but actually the
146 * interval of the interrupts has a jitter.
147 * Additionally, even if adding a constraint to fit period size to
148 * 2msec, actual calculated frames per period doesn't equal to 2msec,
149 * depending on sampling rate.
150 * Anyway, the interval to call snd_pcm_period_elapsed() cannot 2msec.
151 * Here let us use 5msec for safe period interrupt.
152 */
153 err = snd_pcm_hw_constraint_minmax(runtime,
154 SNDRV_PCM_HW_PARAM_PERIOD_TIME,
155 5000, UINT_MAX);
156 if (err < 0)
157 goto end;
158
159 /* Non-Blocking stream has no more constraints */
160 if (!(s->flags & CIP_BLOCKING))
161 goto end;
162
163 /*
164 * One AMDTP packet can include some frames. In blocking mode, the
165 * number equals to SYT_INTERVAL. So the number is 8, 16 or 32,
166 * depending on its sampling rate. For accurate period interrupt, it's
ce991981 167 * preferrable to align period/buffer sizes to current SYT_INTERVAL.
7b2d99fa 168 *
ce991981
YG
169 * TODO: These constraints can be improved with proper rules.
170 * Currently apply LCM of SYT_INTERVALs.
7b2d99fa
TS
171 */
172 err = snd_pcm_hw_constraint_step(runtime, 0,
173 SNDRV_PCM_HW_PARAM_PERIOD_SIZE, 32);
174 if (err < 0)
175 goto end;
176 err = snd_pcm_hw_constraint_step(runtime, 0,
177 SNDRV_PCM_HW_PARAM_BUFFER_SIZE, 32);
178end:
179 return err;
180}
181EXPORT_SYMBOL(amdtp_stream_add_pcm_hw_constraints);
182
31ef9134 183/**
be4a2894
TS
184 * amdtp_stream_set_parameters - set stream parameters
185 * @s: the AMDTP stream to configure
31ef9134 186 * @rate: the sample rate
df075fee 187 * @data_block_quadlets: the size of a data block in quadlet unit
31ef9134 188 *
a7304e3b 189 * The parameters must be set before the stream is started, and must not be
31ef9134
CL
190 * changed while the stream is running.
191 */
df075fee
TS
192int amdtp_stream_set_parameters(struct amdtp_stream *s, unsigned int rate,
193 unsigned int data_block_quadlets)
31ef9134 194{
df075fee 195 unsigned int sfc;
31ef9134 196
547e631c 197 for (sfc = 0; sfc < ARRAY_SIZE(amdtp_rate_table); ++sfc) {
1017abed 198 if (amdtp_rate_table[sfc] == rate)
547e631c
TS
199 break;
200 }
201 if (sfc == ARRAY_SIZE(amdtp_rate_table))
202 return -EINVAL;
e84d15f6 203
e84d15f6 204 s->sfc = sfc;
df075fee 205 s->data_block_quadlets = data_block_quadlets;
a7304e3b 206 s->syt_interval = amdtp_syt_intervals[sfc];
e84d15f6
CL
207
208 /* default buffering in the device */
209 s->transfer_delay = TRANSFER_DELAY_TICKS - TICKS_PER_CYCLE;
210 if (s->flags & CIP_BLOCKING)
211 /* additional buffering needed to adjust for no-data packets */
212 s->transfer_delay += TICKS_PER_SECOND * s->syt_interval / rate;
77d2a8a4 213
547e631c 214 return 0;
31ef9134 215}
be4a2894 216EXPORT_SYMBOL(amdtp_stream_set_parameters);
31ef9134
CL
217
218/**
be4a2894
TS
219 * amdtp_stream_get_max_payload - get the stream's packet size
220 * @s: the AMDTP stream
31ef9134
CL
221 *
222 * This function must not be called before the stream has been configured
be4a2894 223 * with amdtp_stream_set_parameters().
31ef9134 224 */
be4a2894 225unsigned int amdtp_stream_get_max_payload(struct amdtp_stream *s)
31ef9134 226{
a2064710
TS
227 unsigned int multiplier = 1;
228
229 if (s->flags & CIP_JUMBO_PAYLOAD)
230 multiplier = 5;
231
232 return 8 + s->syt_interval * s->data_block_quadlets * 4 * multiplier;
31ef9134 233}
be4a2894 234EXPORT_SYMBOL(amdtp_stream_get_max_payload);
31ef9134 235
76fb8789 236/**
be4a2894
TS
237 * amdtp_stream_pcm_prepare - prepare PCM device for running
238 * @s: the AMDTP stream
76fb8789
CL
239 *
240 * This function should be called from the PCM device's .prepare callback.
241 */
be4a2894 242void amdtp_stream_pcm_prepare(struct amdtp_stream *s)
76fb8789
CL
243{
244 tasklet_kill(&s->period_tasklet);
245 s->pcm_buffer_pointer = 0;
246 s->pcm_period_pointer = 0;
92b862c7 247 s->pointer_flush = true;
76fb8789 248}
be4a2894 249EXPORT_SYMBOL(amdtp_stream_pcm_prepare);
76fb8789 250
875be091
TS
251static unsigned int calculate_data_blocks(struct amdtp_stream *s,
252 unsigned int syt)
31ef9134
CL
253{
254 unsigned int phase, data_blocks;
255
875be091
TS
256 /* Blocking mode. */
257 if (s->flags & CIP_BLOCKING) {
258 /* This module generate empty packet for 'no data'. */
259 if (syt == CIP_SYT_NO_INFO)
260 data_blocks = 0;
261 else
262 data_blocks = s->syt_interval;
263 /* Non-blocking mode. */
31ef9134 264 } else {
875be091
TS
265 if (!cip_sfc_is_base_44100(s->sfc)) {
266 /* Sample_rate / 8000 is an integer, and precomputed. */
267 data_blocks = s->data_block_state;
268 } else {
269 phase = s->data_block_state;
31ef9134
CL
270
271 /*
272 * This calculates the number of data blocks per packet so that
273 * 1) the overall rate is correct and exactly synchronized to
274 * the bus clock, and
275 * 2) packets with a rounded-up number of blocks occur as early
276 * as possible in the sequence (to prevent underruns of the
277 * device's buffer).
278 */
875be091
TS
279 if (s->sfc == CIP_SFC_44100)
280 /* 6 6 5 6 5 6 5 ... */
281 data_blocks = 5 + ((phase & 1) ^
282 (phase == 0 || phase >= 40));
283 else
284 /* 12 11 11 11 11 ... or 23 22 22 22 22 ... */
285 data_blocks = 11 * (s->sfc >> 1) + (phase == 0);
286 if (++phase >= (80 >> (s->sfc >> 1)))
287 phase = 0;
288 s->data_block_state = phase;
289 }
31ef9134
CL
290 }
291
292 return data_blocks;
293}
294
be4a2894 295static unsigned int calculate_syt(struct amdtp_stream *s,
31ef9134
CL
296 unsigned int cycle)
297{
298 unsigned int syt_offset, phase, index, syt;
299
300 if (s->last_syt_offset < TICKS_PER_CYCLE) {
301 if (!cip_sfc_is_base_44100(s->sfc))
302 syt_offset = s->last_syt_offset + s->syt_offset_state;
303 else {
304 /*
305 * The time, in ticks, of the n'th SYT_INTERVAL sample is:
306 * n * SYT_INTERVAL * 24576000 / sample_rate
307 * Modulo TICKS_PER_CYCLE, the difference between successive
308 * elements is about 1386.23. Rounding the results of this
309 * formula to the SYT precision results in a sequence of
310 * differences that begins with:
311 * 1386 1386 1387 1386 1386 1386 1387 1386 1386 1386 1387 ...
312 * This code generates _exactly_ the same sequence.
313 */
314 phase = s->syt_offset_state;
315 index = phase % 13;
316 syt_offset = s->last_syt_offset;
317 syt_offset += 1386 + ((index && !(index & 3)) ||
318 phase == 146);
319 if (++phase >= 147)
320 phase = 0;
321 s->syt_offset_state = phase;
322 }
323 } else
324 syt_offset = s->last_syt_offset - TICKS_PER_CYCLE;
325 s->last_syt_offset = syt_offset;
326
be454366 327 if (syt_offset < TICKS_PER_CYCLE) {
e84d15f6 328 syt_offset += s->transfer_delay;
be454366
CL
329 syt = (cycle + syt_offset / TICKS_PER_CYCLE) << 12;
330 syt += syt_offset % TICKS_PER_CYCLE;
31ef9134 331
b445db44 332 return syt & CIP_SYT_MASK;
be454366 333 } else {
b445db44 334 return CIP_SYT_NO_INFO;
be454366 335 }
31ef9134
CL
336}
337
4b7da117
TS
338static void update_pcm_pointers(struct amdtp_stream *s,
339 struct snd_pcm_substream *pcm,
340 unsigned int frames)
65845f29
TS
341{
342 unsigned int ptr;
343
4b7da117
TS
344 ptr = s->pcm_buffer_pointer + frames;
345 if (ptr >= pcm->runtime->buffer_size)
346 ptr -= pcm->runtime->buffer_size;
347 ACCESS_ONCE(s->pcm_buffer_pointer) = ptr;
348
349 s->pcm_period_pointer += frames;
350 if (s->pcm_period_pointer >= pcm->runtime->period_size) {
351 s->pcm_period_pointer -= pcm->runtime->period_size;
352 s->pointer_flush = false;
353 tasklet_hi_schedule(&s->period_tasklet);
354 }
355}
356
357static void pcm_period_tasklet(unsigned long data)
358{
359 struct amdtp_stream *s = (void *)data;
360 struct snd_pcm_substream *pcm = ACCESS_ONCE(s->pcm);
361
362 if (pcm)
363 snd_pcm_period_elapsed(pcm);
364}
365
366static int queue_packet(struct amdtp_stream *s,
367 unsigned int header_length,
368 unsigned int payload_length, bool skip)
369{
370 struct fw_iso_packet p = {0};
7b3b0d85
TS
371 int err = 0;
372
373 if (IS_ERR(s->context))
374 goto end;
4b7da117
TS
375
376 p.interrupt = IS_ALIGNED(s->packet_index + 1, INTERRUPT_INTERVAL);
377 p.tag = TAG_CIP;
378 p.header_length = header_length;
379 p.payload_length = (!skip) ? payload_length : 0;
380 p.skip = skip;
381 err = fw_iso_context_queue(s->context, &p, &s->buffer.iso_buffer,
382 s->buffer.packets[s->packet_index].offset);
383 if (err < 0) {
384 dev_err(&s->unit->device, "queueing error: %d\n", err);
385 goto end;
386 }
387
388 if (++s->packet_index >= QUEUE_LENGTH)
389 s->packet_index = 0;
390end:
391 return err;
392}
393
394static inline int queue_out_packet(struct amdtp_stream *s,
395 unsigned int payload_length, bool skip)
396{
397 return queue_packet(s, OUT_PACKET_HEADER_SIZE,
398 payload_length, skip);
399}
400
2b3fc456
TS
401static inline int queue_in_packet(struct amdtp_stream *s)
402{
403 return queue_packet(s, IN_PACKET_HEADER_SIZE,
404 amdtp_stream_get_max_payload(s), false);
405}
406
a4103bd7
TS
407static int handle_out_packet(struct amdtp_stream *s, unsigned int data_blocks,
408 unsigned int syt)
31ef9134
CL
409{
410 __be32 *buffer;
6fc6b9ce 411 unsigned int payload_length;
20e44577 412 unsigned int pcm_frames;
31ef9134 413 struct snd_pcm_substream *pcm;
31ef9134 414
ccccad86 415 buffer = s->buffer.packets[s->packet_index].buffer;
df075fee 416 pcm_frames = s->process_data_blocks(s, buffer + 2, data_blocks, &syt);
20e44577 417
31ef9134 418 buffer[0] = cpu_to_be32(ACCESS_ONCE(s->source_node_id_field) |
9a2820c1 419 (s->data_block_quadlets << CIP_DBS_SHIFT) |
31ef9134 420 s->data_block_counter);
414ba022
TS
421 buffer[1] = cpu_to_be32(CIP_EOH |
422 ((s->fmt << CIP_FMT_SHIFT) & CIP_FMT_MASK) |
423 ((s->fdf << CIP_FDF_SHIFT) & CIP_FDF_MASK) |
424 (syt & CIP_SYT_MASK));
31ef9134
CL
425
426 s->data_block_counter = (s->data_block_counter + data_blocks) & 0xff;
427
4b7da117 428 payload_length = 8 + data_blocks * 4 * s->data_block_quadlets;
a4103bd7
TS
429 if (queue_out_packet(s, payload_length, false) < 0)
430 return -EIO;
31ef9134 431
20e44577
TS
432 pcm = ACCESS_ONCE(s->pcm);
433 if (pcm && pcm_frames > 0)
434 update_pcm_pointers(s, pcm, pcm_frames);
a4103bd7
TS
435
436 /* No need to return the number of handled data blocks. */
437 return 0;
76fb8789
CL
438}
439
6fc6b9ce 440static int handle_in_packet(struct amdtp_stream *s,
31ea49ba 441 unsigned int payload_quadlets, __be32 *buffer,
20e44577 442 unsigned int *data_blocks, unsigned int syt)
2b3fc456
TS
443{
444 u32 cip_header[2];
414ba022 445 unsigned int fmt, fdf;
6fc6b9ce 446 unsigned int data_block_quadlets, data_block_counter, dbc_interval;
20e44577
TS
447 struct snd_pcm_substream *pcm;
448 unsigned int pcm_frames;
c8bdf49b 449 bool lost;
2b3fc456
TS
450
451 cip_header[0] = be32_to_cpu(buffer[0]);
452 cip_header[1] = be32_to_cpu(buffer[1]);
453
454 /*
455 * This module supports 'Two-quadlet CIP header with SYT field'.
77d2a8a4 456 * For convenience, also check FMT field is AM824 or not.
2b3fc456
TS
457 */
458 if (((cip_header[0] & CIP_EOH_MASK) == CIP_EOH) ||
414ba022 459 ((cip_header[1] & CIP_EOH_MASK) != CIP_EOH)) {
2b3fc456
TS
460 dev_info_ratelimited(&s->unit->device,
461 "Invalid CIP header for AMDTP: %08X:%08X\n",
462 cip_header[0], cip_header[1]);
31ea49ba 463 *data_blocks = 0;
20e44577 464 pcm_frames = 0;
2b3fc456
TS
465 goto end;
466 }
467
414ba022
TS
468 /* Check valid protocol or not. */
469 fmt = (cip_header[1] & CIP_FMT_MASK) >> CIP_FMT_SHIFT;
470 if (fmt != s->fmt) {
471 dev_err(&s->unit->device,
472 "Detect unexpected protocol: %08x %08x\n",
473 cip_header[0], cip_header[1]);
474 return -EIO;
475 }
476
2b3fc456 477 /* Calculate data blocks */
414ba022 478 fdf = (cip_header[1] & CIP_FDF_MASK) >> CIP_FDF_SHIFT;
2b3fc456 479 if (payload_quadlets < 3 ||
414ba022 480 (fmt == CIP_FMT_AM && fdf == AMDTP_FDF_NO_DATA)) {
31ea49ba 481 *data_blocks = 0;
2b3fc456
TS
482 } else {
483 data_block_quadlets =
9a2820c1 484 (cip_header[0] & CIP_DBS_MASK) >> CIP_DBS_SHIFT;
2b3fc456
TS
485 /* avoid division by zero */
486 if (data_block_quadlets == 0) {
12e0f438 487 dev_err(&s->unit->device,
2b3fc456
TS
488 "Detect invalid value in dbs field: %08X\n",
489 cip_header[0]);
a9007054 490 return -EPROTO;
2b3fc456 491 }
69702239
TS
492 if (s->flags & CIP_WRONG_DBS)
493 data_block_quadlets = s->data_block_quadlets;
2b3fc456 494
31ea49ba 495 *data_blocks = (payload_quadlets - 2) / data_block_quadlets;
2b3fc456
TS
496 }
497
498 /* Check data block counter continuity */
9a2820c1 499 data_block_counter = cip_header[0] & CIP_DBC_MASK;
31ea49ba 500 if (*data_blocks == 0 && (s->flags & CIP_EMPTY_HAS_WRONG_DBC) &&
9d59124c
TS
501 s->data_block_counter != UINT_MAX)
502 data_block_counter = s->data_block_counter;
503
18f5ed36
TS
504 if (((s->flags & CIP_SKIP_DBC_ZERO_CHECK) &&
505 data_block_counter == s->tx_first_dbc) ||
506 s->data_block_counter == UINT_MAX) {
b84b1a27
TS
507 lost = false;
508 } else if (!(s->flags & CIP_DBC_IS_END_EVENT)) {
c8bdf49b 509 lost = data_block_counter != s->data_block_counter;
d9cd0065 510 } else {
31ea49ba 511 if ((*data_blocks > 0) && (s->tx_dbc_interval > 0))
d9cd0065
TS
512 dbc_interval = s->tx_dbc_interval;
513 else
31ea49ba 514 dbc_interval = *data_blocks;
d9cd0065 515
c8bdf49b 516 lost = data_block_counter !=
d9cd0065
TS
517 ((s->data_block_counter + dbc_interval) & 0xff);
518 }
c8bdf49b
TS
519
520 if (lost) {
12e0f438
TS
521 dev_err(&s->unit->device,
522 "Detect discontinuity of CIP: %02X %02X\n",
523 s->data_block_counter, data_block_counter);
6fc6b9ce 524 return -EIO;
2b3fc456
TS
525 }
526
df075fee 527 pcm_frames = s->process_data_blocks(s, buffer + 2, *data_blocks, &syt);
2b3fc456 528
c8bdf49b
TS
529 if (s->flags & CIP_DBC_IS_END_EVENT)
530 s->data_block_counter = data_block_counter;
531 else
532 s->data_block_counter =
31ea49ba 533 (data_block_counter + *data_blocks) & 0xff;
2b3fc456
TS
534end:
535 if (queue_in_packet(s) < 0)
6fc6b9ce 536 return -EIO;
2b3fc456 537
20e44577
TS
538 pcm = ACCESS_ONCE(s->pcm);
539 if (pcm && pcm_frames > 0)
540 update_pcm_pointers(s, pcm, pcm_frames);
2b3fc456 541
31ea49ba 542 return 0;
2b3fc456
TS
543}
544
4b7da117
TS
545static void out_stream_callback(struct fw_iso_context *context, u32 cycle,
546 size_t header_length, void *header,
547 void *private_data)
31ef9134 548{
be4a2894 549 struct amdtp_stream *s = private_data;
ccccad86 550 unsigned int i, syt, packets = header_length / 4;
6fc6b9ce 551 unsigned int data_blocks;
31ef9134 552
a4103bd7
TS
553 if (s->packet_index < 0)
554 return;
555
31ef9134
CL
556 /*
557 * Compute the cycle of the last queued packet.
558 * (We need only the four lowest bits for the SYT, so we can ignore
559 * that bits 0-11 must wrap around at 3072.)
560 */
561 cycle += QUEUE_LENGTH - packets;
562
ccccad86
TS
563 for (i = 0; i < packets; ++i) {
564 syt = calculate_syt(s, ++cycle);
6fc6b9ce
TS
565 data_blocks = calculate_data_blocks(s, syt);
566
a4103bd7
TS
567 if (handle_out_packet(s, data_blocks, syt) < 0) {
568 s->packet_index = -1;
569 amdtp_stream_pcm_abort(s);
570 return;
571 }
ccccad86 572 }
a4103bd7 573
13882a82 574 fw_iso_context_queue_flush(s->context);
31ef9134
CL
575}
576
2b3fc456
TS
577static void in_stream_callback(struct fw_iso_context *context, u32 cycle,
578 size_t header_length, void *header,
579 void *private_data)
580{
581 struct amdtp_stream *s = private_data;
a2064710
TS
582 unsigned int p, syt, packets;
583 unsigned int payload_quadlets, max_payload_quadlets;
6fc6b9ce 584 unsigned int data_blocks;
2b3fc456
TS
585 __be32 *buffer, *headers = header;
586
a4103bd7
TS
587 if (s->packet_index < 0)
588 return;
589
2b3fc456
TS
590 /* The number of packets in buffer */
591 packets = header_length / IN_PACKET_HEADER_SIZE;
592
a2064710
TS
593 /* For buffer-over-run prevention. */
594 max_payload_quadlets = amdtp_stream_get_max_payload(s) / 4;
595
2b3fc456 596 for (p = 0; p < packets; p++) {
2b3fc456
TS
597 buffer = s->buffer.packets[s->packet_index].buffer;
598
599 /* The number of quadlets in this packet */
600 payload_quadlets =
601 (be32_to_cpu(headers[p]) >> ISO_DATA_LENGTH_SHIFT) / 4;
a2064710
TS
602 if (payload_quadlets > max_payload_quadlets) {
603 dev_err(&s->unit->device,
604 "Detect jumbo payload: %02x %02x\n",
605 payload_quadlets, max_payload_quadlets);
606 s->packet_index = -1;
607 break;
608 }
609
20e44577 610 syt = be32_to_cpu(buffer[1]) & CIP_SYT_MASK;
31ea49ba 611 if (handle_in_packet(s, payload_quadlets, buffer,
20e44577 612 &data_blocks, syt) < 0) {
6fc6b9ce
TS
613 s->packet_index = -1;
614 break;
615 }
616
617 /* Process sync slave stream */
618 if (s->sync_slave && s->sync_slave->callbacked) {
a4103bd7
TS
619 if (handle_out_packet(s->sync_slave,
620 data_blocks, syt) < 0) {
621 s->packet_index = -1;
622 break;
623 }
6fc6b9ce 624 }
2b3fc456
TS
625 }
626
7b3b0d85
TS
627 /* Queueing error or detecting discontinuity */
628 if (s->packet_index < 0) {
6fc6b9ce
TS
629 amdtp_stream_pcm_abort(s);
630
7b3b0d85
TS
631 /* Abort sync slave. */
632 if (s->sync_slave) {
633 s->sync_slave->packet_index = -1;
634 amdtp_stream_pcm_abort(s->sync_slave);
635 }
636 return;
637 }
638
639 /* when sync to device, flush the packets for slave stream */
640 if (s->sync_slave && s->sync_slave->callbacked)
641 fw_iso_context_queue_flush(s->sync_slave->context);
642
2b3fc456
TS
643 fw_iso_context_queue_flush(s->context);
644}
645
7b3b0d85
TS
646/* processing is done by master callback */
647static void slave_stream_callback(struct fw_iso_context *context, u32 cycle,
648 size_t header_length, void *header,
649 void *private_data)
650{
651 return;
652}
653
654/* this is executed one time */
655static void amdtp_stream_first_callback(struct fw_iso_context *context,
656 u32 cycle, size_t header_length,
657 void *header, void *private_data)
658{
659 struct amdtp_stream *s = private_data;
660
661 /*
662 * For in-stream, first packet has come.
663 * For out-stream, prepared to transmit first packet
664 */
665 s->callbacked = true;
666 wake_up(&s->callback_wait);
667
668 if (s->direction == AMDTP_IN_STREAM)
669 context->callback.sc = in_stream_callback;
727d3a0b 670 else if (s->flags & CIP_SYNC_TO_DEVICE)
7b3b0d85
TS
671 context->callback.sc = slave_stream_callback;
672 else
673 context->callback.sc = out_stream_callback;
674
675 context->callback.sc(context, cycle, header_length, header, s);
676}
677
31ef9134 678/**
be4a2894
TS
679 * amdtp_stream_start - start transferring packets
680 * @s: the AMDTP stream to start
31ef9134
CL
681 * @channel: the isochronous channel on the bus
682 * @speed: firewire speed code
683 *
684 * The stream cannot be started until it has been configured with
be4a2894
TS
685 * amdtp_stream_set_parameters() and it must be started before any PCM or MIDI
686 * device can be started.
31ef9134 687 */
be4a2894 688int amdtp_stream_start(struct amdtp_stream *s, int channel, int speed)
31ef9134
CL
689{
690 static const struct {
691 unsigned int data_block;
692 unsigned int syt_offset;
693 } initial_state[] = {
694 [CIP_SFC_32000] = { 4, 3072 },
695 [CIP_SFC_48000] = { 6, 1024 },
696 [CIP_SFC_96000] = { 12, 1024 },
697 [CIP_SFC_192000] = { 24, 1024 },
698 [CIP_SFC_44100] = { 0, 67 },
699 [CIP_SFC_88200] = { 0, 67 },
700 [CIP_SFC_176400] = { 0, 67 },
701 };
2b3fc456
TS
702 unsigned int header_size;
703 enum dma_data_direction dir;
7ab56645 704 int type, tag, err;
31ef9134
CL
705
706 mutex_lock(&s->mutex);
707
be4a2894 708 if (WARN_ON(amdtp_stream_running(s) ||
4b7da117 709 (s->data_block_quadlets < 1))) {
31ef9134
CL
710 err = -EBADFD;
711 goto err_unlock;
712 }
713
b6bc8123
TS
714 if (s->direction == AMDTP_IN_STREAM &&
715 s->flags & CIP_SKIP_INIT_DBC_CHECK)
716 s->data_block_counter = UINT_MAX;
717 else
718 s->data_block_counter = 0;
31ef9134
CL
719 s->data_block_state = initial_state[s->sfc].data_block;
720 s->syt_offset_state = initial_state[s->sfc].syt_offset;
721 s->last_syt_offset = TICKS_PER_CYCLE;
722
2b3fc456
TS
723 /* initialize packet buffer */
724 if (s->direction == AMDTP_IN_STREAM) {
725 dir = DMA_FROM_DEVICE;
726 type = FW_ISO_CONTEXT_RECEIVE;
727 header_size = IN_PACKET_HEADER_SIZE;
2b3fc456
TS
728 } else {
729 dir = DMA_TO_DEVICE;
730 type = FW_ISO_CONTEXT_TRANSMIT;
731 header_size = OUT_PACKET_HEADER_SIZE;
2b3fc456 732 }
31ef9134 733 err = iso_packets_buffer_init(&s->buffer, s->unit, QUEUE_LENGTH,
2b3fc456 734 amdtp_stream_get_max_payload(s), dir);
31ef9134
CL
735 if (err < 0)
736 goto err_unlock;
737
738 s->context = fw_iso_context_create(fw_parent_device(s->unit)->card,
2b3fc456 739 type, channel, speed, header_size,
7b3b0d85 740 amdtp_stream_first_callback, s);
31ef9134
CL
741 if (IS_ERR(s->context)) {
742 err = PTR_ERR(s->context);
743 if (err == -EBUSY)
744 dev_err(&s->unit->device,
be4a2894 745 "no free stream on this controller\n");
31ef9134
CL
746 goto err_buffer;
747 }
748
be4a2894 749 amdtp_stream_update(s);
31ef9134 750
ec00f5e4 751 s->packet_index = 0;
4b7da117 752 do {
2b3fc456
TS
753 if (s->direction == AMDTP_IN_STREAM)
754 err = queue_in_packet(s);
755 else
756 err = queue_out_packet(s, 0, true);
4b7da117
TS
757 if (err < 0)
758 goto err_context;
759 } while (s->packet_index > 0);
31ef9134 760
2b3fc456 761 /* NOTE: TAG1 matches CIP. This just affects in stream. */
7ab56645
TS
762 tag = FW_ISO_CONTEXT_MATCH_TAG1;
763 if (s->flags & CIP_EMPTY_WITH_TAG0)
764 tag |= FW_ISO_CONTEXT_MATCH_TAG0;
765
7b3b0d85 766 s->callbacked = false;
7ab56645 767 err = fw_iso_context_start(s->context, -1, 0, tag);
31ef9134
CL
768 if (err < 0)
769 goto err_context;
770
771 mutex_unlock(&s->mutex);
772
773 return 0;
774
775err_context:
776 fw_iso_context_destroy(s->context);
777 s->context = ERR_PTR(-1);
778err_buffer:
779 iso_packets_buffer_destroy(&s->buffer, s->unit);
780err_unlock:
781 mutex_unlock(&s->mutex);
782
783 return err;
784}
be4a2894 785EXPORT_SYMBOL(amdtp_stream_start);
31ef9134 786
e9148ddd 787/**
be4a2894
TS
788 * amdtp_stream_pcm_pointer - get the PCM buffer position
789 * @s: the AMDTP stream that transports the PCM data
e9148ddd
CL
790 *
791 * Returns the current buffer position, in frames.
792 */
be4a2894 793unsigned long amdtp_stream_pcm_pointer(struct amdtp_stream *s)
e9148ddd 794{
92b862c7 795 /* this optimization is allowed to be racy */
c8de6dbb 796 if (s->pointer_flush && amdtp_stream_running(s))
92b862c7
CL
797 fw_iso_context_flush_completions(s->context);
798 else
799 s->pointer_flush = true;
e9148ddd
CL
800
801 return ACCESS_ONCE(s->pcm_buffer_pointer);
802}
be4a2894 803EXPORT_SYMBOL(amdtp_stream_pcm_pointer);
e9148ddd 804
31ef9134 805/**
be4a2894
TS
806 * amdtp_stream_update - update the stream after a bus reset
807 * @s: the AMDTP stream
31ef9134 808 */
be4a2894 809void amdtp_stream_update(struct amdtp_stream *s)
31ef9134 810{
9a2820c1 811 /* Precomputing. */
31ef9134 812 ACCESS_ONCE(s->source_node_id_field) =
9a2820c1
TS
813 (fw_parent_device(s->unit)->card->node_id << CIP_SID_SHIFT) &
814 CIP_SID_MASK;
31ef9134 815}
be4a2894 816EXPORT_SYMBOL(amdtp_stream_update);
31ef9134
CL
817
818/**
be4a2894
TS
819 * amdtp_stream_stop - stop sending packets
820 * @s: the AMDTP stream to stop
31ef9134
CL
821 *
822 * All PCM and MIDI devices of the stream must be stopped before the stream
823 * itself can be stopped.
824 */
be4a2894 825void amdtp_stream_stop(struct amdtp_stream *s)
31ef9134
CL
826{
827 mutex_lock(&s->mutex);
828
be4a2894 829 if (!amdtp_stream_running(s)) {
31ef9134
CL
830 mutex_unlock(&s->mutex);
831 return;
832 }
833
76fb8789 834 tasklet_kill(&s->period_tasklet);
31ef9134
CL
835 fw_iso_context_stop(s->context);
836 fw_iso_context_destroy(s->context);
837 s->context = ERR_PTR(-1);
838 iso_packets_buffer_destroy(&s->buffer, s->unit);
839
7b3b0d85
TS
840 s->callbacked = false;
841
31ef9134
CL
842 mutex_unlock(&s->mutex);
843}
be4a2894 844EXPORT_SYMBOL(amdtp_stream_stop);
31ef9134
CL
845
846/**
be4a2894 847 * amdtp_stream_pcm_abort - abort the running PCM device
31ef9134
CL
848 * @s: the AMDTP stream about to be stopped
849 *
850 * If the isochronous stream needs to be stopped asynchronously, call this
851 * function first to stop the PCM device.
852 */
be4a2894 853void amdtp_stream_pcm_abort(struct amdtp_stream *s)
31ef9134
CL
854{
855 struct snd_pcm_substream *pcm;
856
857 pcm = ACCESS_ONCE(s->pcm);
1fb8510c
TI
858 if (pcm)
859 snd_pcm_stop_xrun(pcm);
31ef9134 860}
be4a2894 861EXPORT_SYMBOL(amdtp_stream_pcm_abort);
This page took 0.21435 seconds and 5 git commands to generate.