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