Lines Matching +full:sfc +full:- +full:no +full:- +full:dma
1 // SPDX-License-Identifier: GPL-2.0-only
3 * Audio and Music Data Transmission Protocol (IEC 61883-6) streams
4 * with Common Isochronous Packet (IEC 61883-1) headers
12 #include <linux/firewire-constants.h>
17 #include "amdtp-stream.h"
27 #include "amdtp-stream-trace.h"
81 * amdtp_stream_init - initialize an AMDTP stream structure
85 * @flags: the details of the streaming protocol consist of cip_flags enumeration-constants.
97 return -EINVAL; in amdtp_stream_init()
99 s->protocol = kzalloc(protocol_size, GFP_KERNEL); in amdtp_stream_init()
100 if (!s->protocol) in amdtp_stream_init()
101 return -ENOMEM; in amdtp_stream_init()
103 s->unit = unit; in amdtp_stream_init()
104 s->direction = dir; in amdtp_stream_init()
105 s->flags = flags; in amdtp_stream_init()
106 s->context = ERR_PTR(-1); in amdtp_stream_init()
107 mutex_init(&s->mutex); in amdtp_stream_init()
108 s->packet_index = 0; in amdtp_stream_init()
110 init_waitqueue_head(&s->ready_wait); in amdtp_stream_init()
112 s->fmt = fmt; in amdtp_stream_init()
113 s->process_ctx_payloads = process_ctx_payloads; in amdtp_stream_init()
120 * amdtp_stream_destroy - free stream resources
126 if (s->protocol == NULL) in amdtp_stream_destroy()
130 kfree(s->protocol); in amdtp_stream_destroy()
131 mutex_destroy(&s->mutex); in amdtp_stream_destroy()
160 struct snd_interval *s = hw_param_interval(params, rule->var); in apply_constraint_to_size()
172 t.min = roundup(s->min, step); in apply_constraint_to_size()
173 t.max = rounddown(s->max, step); in apply_constraint_to_size()
180 * amdtp_stream_add_pcm_hw_constraints - add hw constraints for PCM substream
187 struct snd_pcm_hardware *hw = &runtime->hw; in amdtp_stream_add_pcm_hw_constraints()
192 hw->info = SNDRV_PCM_INFO_BLOCK_TRANSFER | in amdtp_stream_add_pcm_hw_constraints()
199 hw->periods_min = 2; in amdtp_stream_add_pcm_hw_constraints()
200 hw->periods_max = UINT_MAX; in amdtp_stream_add_pcm_hw_constraints()
203 hw->period_bytes_min = 4 * hw->channels_max; in amdtp_stream_add_pcm_hw_constraints()
206 hw->period_bytes_max = hw->period_bytes_min * 2048; in amdtp_stream_add_pcm_hw_constraints()
207 hw->buffer_bytes_max = hw->period_bytes_max * hw->periods_min; in amdtp_stream_add_pcm_hw_constraints()
217 if (!(s->flags & CIP_NO_HEADER)) in amdtp_stream_add_pcm_hw_constraints()
224 // In IEC 61883-6, one isoc packet can transfer events up to the value in amdtp_stream_add_pcm_hw_constraints()
228 // However, there are two ways of transmission in IEC 61883-6; blocking in amdtp_stream_add_pcm_hw_constraints()
229 // and non-blocking modes. In blocking mode, the sequence of isoc packet in amdtp_stream_add_pcm_hw_constraints()
230 // includes 'empty' or 'NODATA' packets which include no event. In in amdtp_stream_add_pcm_hw_constraints()
231 // non-blocking mode, the number of events per packet is variable up to in amdtp_stream_add_pcm_hw_constraints()
242 /* Non-Blocking stream has no more constraints */ in amdtp_stream_add_pcm_hw_constraints()
243 if (!(s->flags & CIP_BLOCKING)) in amdtp_stream_add_pcm_hw_constraints()
255 SNDRV_PCM_HW_PARAM_RATE, -1); in amdtp_stream_add_pcm_hw_constraints()
261 SNDRV_PCM_HW_PARAM_RATE, -1); in amdtp_stream_add_pcm_hw_constraints()
270 * amdtp_stream_set_parameters - set stream parameters
281 unsigned int sfc; in amdtp_stream_set_parameters() local
283 for (sfc = 0; sfc < ARRAY_SIZE(amdtp_rate_table); ++sfc) { in amdtp_stream_set_parameters()
284 if (amdtp_rate_table[sfc] == rate) in amdtp_stream_set_parameters()
287 if (sfc == ARRAY_SIZE(amdtp_rate_table)) in amdtp_stream_set_parameters()
288 return -EINVAL; in amdtp_stream_set_parameters()
290 s->sfc = sfc; in amdtp_stream_set_parameters()
291 s->data_block_quadlets = data_block_quadlets; in amdtp_stream_set_parameters()
292 s->syt_interval = amdtp_syt_intervals[sfc]; in amdtp_stream_set_parameters()
295 s->transfer_delay = TRANSFER_DELAY_TICKS - TICKS_PER_CYCLE; in amdtp_stream_set_parameters()
297 // additional buffering needed to adjust for no-data packets. in amdtp_stream_set_parameters()
298 if (s->flags & CIP_BLOCKING) in amdtp_stream_set_parameters()
299 s->transfer_delay += TICKS_PER_SECOND * s->syt_interval / rate; in amdtp_stream_set_parameters()
310 if (s->flags & CIP_JUMBO_PAYLOAD) in amdtp_stream_get_max_ctx_payload_size()
315 return s->syt_interval * s->data_block_quadlets * sizeof(__be32) * multiplier; in amdtp_stream_get_max_ctx_payload_size()
319 * amdtp_stream_get_max_payload - get the stream's packet size
329 if (!(s->flags & CIP_NO_HEADER)) in amdtp_stream_get_max_payload()
339 * amdtp_stream_pcm_prepare - prepare PCM device for running
346 s->pcm_buffer_pointer = 0; in amdtp_stream_pcm_prepare()
347 s->pcm_period_pointer = 0; in amdtp_stream_pcm_prepare()
355 const unsigned int syt_interval = s->syt_interval; in pool_blocking_data_blocks()
361 if (desc->syt_offset != CIP_SYT_NO_INFO) in pool_blocking_data_blocks()
362 desc->data_blocks = syt_interval; in pool_blocking_data_blocks()
364 desc->data_blocks = 0; in pool_blocking_data_blocks()
374 const enum cip_sfc sfc = s->sfc; in pool_ideal_nonblocking_data_blocks() local
375 unsigned int state = s->ctx_data.rx.data_block_state; in pool_ideal_nonblocking_data_blocks()
381 if (!cip_sfc_is_base_44100(sfc)) { in pool_ideal_nonblocking_data_blocks()
383 desc->data_blocks = state; in pool_ideal_nonblocking_data_blocks()
391 * 2) packets with a rounded-up number of blocks occur as early in pool_ideal_nonblocking_data_blocks()
395 if (sfc == CIP_SFC_44100) in pool_ideal_nonblocking_data_blocks()
397 desc->data_blocks = 5 + ((phase & 1) ^ (phase == 0 || phase >= 40)); in pool_ideal_nonblocking_data_blocks()
400 desc->data_blocks = 11 * (sfc >> 1) + (phase == 0); in pool_ideal_nonblocking_data_blocks()
401 if (++phase >= (80 >> (sfc >> 1))) in pool_ideal_nonblocking_data_blocks()
409 s->ctx_data.rx.data_block_state = state; in pool_ideal_nonblocking_data_blocks()
413 unsigned int *syt_offset_state, enum cip_sfc sfc) in calculate_syt_offset() argument
418 if (!cip_sfc_is_base_44100(sfc)) in calculate_syt_offset()
442 syt_offset = *last_syt_offset - TICKS_PER_CYCLE; in calculate_syt_offset()
455 const enum cip_sfc sfc = s->sfc; in pool_ideal_syt_offsets() local
456 unsigned int last = s->ctx_data.rx.last_syt_offset; in pool_ideal_syt_offsets()
457 unsigned int state = s->ctx_data.rx.syt_offset_state; in pool_ideal_syt_offsets()
463 desc->syt_offset = calculate_syt_offset(&last, &state, sfc); in pool_ideal_syt_offsets()
468 s->ctx_data.rx.last_syt_offset = last; in pool_ideal_syt_offsets()
469 s->ctx_data.rx.syt_offset_state = state; in pool_ideal_syt_offsets()
482 syt_cycle_lo -= cycle_lo; in compute_syt_offset()
490 return syt_offset - transfer_delay; in compute_syt_offset()
499 const unsigned int cache_size = s->ctx_data.tx.cache.size; in calculate_cached_cycle_count()
500 unsigned int cycles = s->ctx_data.tx.cache.tail; in calculate_cached_cycle_count()
504 cycles -= head; in calculate_cached_cycle_count()
511 const unsigned int transfer_delay = s->transfer_delay; in cache_seq()
512 const unsigned int cache_size = s->ctx_data.tx.cache.size; in cache_seq()
513 struct seq_desc *cache = s->ctx_data.tx.cache.descs; in cache_seq()
514 unsigned int cache_tail = s->ctx_data.tx.cache.tail; in cache_seq()
515 bool aware_syt = !(s->flags & CIP_UNAWARE_SYT); in cache_seq()
522 if (aware_syt && src->syt != CIP_SYT_NO_INFO) in cache_seq()
523 dst->syt_offset = compute_syt_offset(src->syt, src->cycle, transfer_delay); in cache_seq()
525 dst->syt_offset = CIP_SYT_NO_INFO; in cache_seq()
526 dst->data_blocks = src->data_blocks; in cache_seq()
531 s->ctx_data.tx.cache.tail = cache_tail; in cache_seq()
536 struct seq_desc *descs = s->ctx_data.rx.seq.descs; in pool_ideal_seq_descs()
537 unsigned int seq_tail = s->ctx_data.rx.seq.tail; in pool_ideal_seq_descs()
538 const unsigned int seq_size = s->ctx_data.rx.seq.size; in pool_ideal_seq_descs()
542 if (s->flags & CIP_BLOCKING) in pool_ideal_seq_descs()
547 s->ctx_data.rx.seq.tail = (seq_tail + count) % seq_size; in pool_ideal_seq_descs()
552 struct amdtp_stream *target = s->ctx_data.rx.replay_target; in pool_replayed_seq()
553 const struct seq_desc *cache = target->ctx_data.tx.cache.descs; in pool_replayed_seq()
554 const unsigned int cache_size = target->ctx_data.tx.cache.size; in pool_replayed_seq()
555 unsigned int cache_head = s->ctx_data.rx.cache_head; in pool_replayed_seq()
556 struct seq_desc *descs = s->ctx_data.rx.seq.descs; in pool_replayed_seq()
557 const unsigned int seq_size = s->ctx_data.rx.seq.size; in pool_replayed_seq()
558 unsigned int seq_tail = s->ctx_data.rx.seq.tail; in pool_replayed_seq()
567 s->ctx_data.rx.seq.tail = seq_tail; in pool_replayed_seq()
568 s->ctx_data.rx.cache_head = cache_head; in pool_replayed_seq()
573 struct amdtp_domain *d = s->domain; in pool_seq_descs()
575 if (!d->replay.enable || !s->ctx_data.rx.replay_target) { in pool_seq_descs()
578 if (!d->replay.on_the_fly) { in pool_seq_descs()
581 struct amdtp_stream *tx = s->ctx_data.rx.replay_target; in pool_seq_descs()
582 const unsigned int cache_size = tx->ctx_data.tx.cache.size; in pool_seq_descs()
583 const unsigned int cache_head = s->ctx_data.rx.cache_head; in pool_seq_descs()
600 ptr = s->pcm_buffer_pointer + frames; in update_pcm_pointers()
601 if (ptr >= pcm->runtime->buffer_size) in update_pcm_pointers()
602 ptr -= pcm->runtime->buffer_size; in update_pcm_pointers()
603 WRITE_ONCE(s->pcm_buffer_pointer, ptr); in update_pcm_pointers()
605 s->pcm_period_pointer += frames; in update_pcm_pointers()
606 if (s->pcm_period_pointer >= pcm->runtime->period_size) { in update_pcm_pointers()
607 s->pcm_period_pointer -= pcm->runtime->period_size; in update_pcm_pointers()
612 if (!pcm->runtime->no_period_wakeup) { in update_pcm_pointers()
630 params->interrupt = sched_irq; in queue_packet()
631 params->tag = s->tag; in queue_packet()
632 params->sy = 0; in queue_packet()
634 err = fw_iso_context_queue(s->context, params, &s->buffer.iso_buffer, in queue_packet()
635 s->buffer.packets[s->packet_index].offset); in queue_packet()
637 dev_err(&s->unit->device, "queueing error: %d\n", err); in queue_packet()
641 if (++s->packet_index >= s->queue_size) in queue_packet()
642 s->packet_index = 0; in queue_packet()
650 params->skip = in queue_out_packet()
651 !!(params->header_length == 0 && params->payload_length == 0); in queue_out_packet()
659 params->header_length = s->ctx_data.tx.ctx_header_size; in queue_in_packet()
660 params->payload_length = s->ctx_data.tx.max_ctx_payload_length; in queue_in_packet()
661 params->skip = false; in queue_in_packet()
668 cip_header[0] = cpu_to_be32(READ_ONCE(s->source_node_id_field) | in generate_cip_header()
669 (s->data_block_quadlets << CIP_DBS_SHIFT) | in generate_cip_header()
670 ((s->sph << CIP_SPH_SHIFT) & CIP_SPH_MASK) | in generate_cip_header()
673 ((s->fmt << CIP_FMT_SHIFT) & CIP_FMT_MASK) | in generate_cip_header()
674 ((s->ctx_data.rx.fdf << CIP_FDF_SHIFT) & CIP_FDF_MASK) | in generate_cip_header()
687 payload_length = data_blocks * sizeof(__be32) * s->data_block_quadlets; in build_it_pkt_header()
688 params->payload_length = payload_length; in build_it_pkt_header()
691 cip_header = (__be32 *)params->header; in build_it_pkt_header()
693 params->header_length = header_length; in build_it_pkt_header()
699 data_block_counter, s->packet_index, index); in build_it_pkt_header()
718 * This module supports 'Two-quadlet CIP header with SYT field'. in check_cip_header()
723 (!(s->flags & CIP_HEADER_WITHOUT_EOH))) { in check_cip_header()
724 dev_info_ratelimited(&s->unit->device, in check_cip_header()
727 return -EAGAIN; in check_cip_header()
733 if (sph != s->sph || fmt != s->fmt) { in check_cip_header()
734 dev_info_ratelimited(&s->unit->device, in check_cip_header()
737 return -EAGAIN; in check_cip_header()
749 dev_err(&s->unit->device, in check_cip_header()
752 return -EPROTO; in check_cip_header()
754 if (s->flags & CIP_WRONG_DBS) in check_cip_header()
755 data_block_quadlets = s->data_block_quadlets; in check_cip_header()
762 if (*data_blocks == 0 && (s->flags & CIP_EMPTY_HAS_WRONG_DBC) && in check_cip_header()
766 if ((dbc == 0x00 && (s->flags & CIP_SKIP_DBC_ZERO_CHECK)) || in check_cip_header()
769 } else if (!(s->flags & CIP_DBC_IS_END_EVENT)) { in check_cip_header()
774 if (*data_blocks > 0 && s->ctx_data.tx.dbc_interval > 0) in check_cip_header()
775 dbc_interval = s->ctx_data.tx.dbc_interval; in check_cip_header()
783 dev_err(&s->unit->device, in check_cip_header()
786 return -EIO; in check_cip_header()
791 if (!(s->flags & CIP_UNAWARE_SYT)) in check_cip_header()
809 if (!(s->flags & CIP_NO_HEADER)) in parse_ir_ctx_header()
814 if (payload_length > cip_header_size + s->ctx_data.tx.max_ctx_payload_length) { in parse_ir_ctx_header()
815 dev_err(&s->unit->device, in parse_ir_ctx_header()
817 payload_length, cip_header_size + s->ctx_data.tx.max_ctx_payload_length); in parse_ir_ctx_header()
818 return -EIO; in parse_ir_ctx_header()
826 err = check_cip_header(s, cip_header, payload_length - cip_header_size, in parse_ir_ctx_header()
838 *data_blocks = payload_length / sizeof(__be32) / s->data_block_quadlets; in parse_ir_ctx_header()
852 // the other hand, in DMA descriptors of 1394 OHCI, 3 bits are used to represent
864 cycle -= OHCI_SECOND_MODULUS * CYCLES_PER_SECOND; in increment_ohci_cycle_count()
872 else if (lval < rval && rval - lval < OHCI_SECOND_MODULUS * CYCLES_PER_SECOND / 2) in compare_ohci_cycle_count()
873 return -1; in compare_ohci_cycle_count()
895 unsigned int next_cycle = s->next_cycle; in generate_device_pkt_descs()
896 unsigned int dbc = s->data_block_counter; in generate_device_pkt_descs()
897 unsigned int packet_index = s->packet_index; in generate_device_pkt_descs()
898 unsigned int queue_size = s->queue_size; in generate_device_pkt_descs()
913 if (s->flags & CIP_NO_HEADER) { in generate_device_pkt_descs()
923 desc->cycle = prev_cycle; in generate_device_pkt_descs()
924 desc->syt = 0; in generate_device_pkt_descs()
925 desc->data_blocks = 0; in generate_device_pkt_descs()
926 desc->data_block_counter = dbc; in generate_device_pkt_descs()
927 desc->ctx_payload = NULL; in generate_device_pkt_descs()
931 } else if (s->flags & CIP_JUMBO_PAYLOAD) { in generate_device_pkt_descs()
940 dev_err(&s->unit->device, "Detect discontinuity of cycle: %d %d\n", in generate_device_pkt_descs()
942 return -EIO; in generate_device_pkt_descs()
951 desc->cycle = cycle; in generate_device_pkt_descs()
952 desc->syt = syt; in generate_device_pkt_descs()
953 desc->data_blocks = data_blocks; in generate_device_pkt_descs()
954 desc->data_block_counter = dbc; in generate_device_pkt_descs()
955 desc->ctx_payload = s->buffer.packets[packet_index].buffer; in generate_device_pkt_descs()
957 if (!(s->flags & CIP_DBC_IS_END_EVENT)) in generate_device_pkt_descs()
958 dbc = (dbc + desc->data_blocks) & 0xff; in generate_device_pkt_descs()
962 ctx_header += s->ctx_data.tx.ctx_header_size / sizeof(*ctx_header); in generate_device_pkt_descs()
966 s->next_cycle = next_cycle; in generate_device_pkt_descs()
967 s->data_block_counter = dbc; in generate_device_pkt_descs()
985 struct pkt_desc *descs = s->pkt_descs; in generate_pkt_descs()
986 const struct seq_desc *seq_descs = s->ctx_data.rx.seq.descs; in generate_pkt_descs()
987 const unsigned int seq_size = s->ctx_data.rx.seq.size; in generate_pkt_descs()
988 unsigned int dbc = s->data_block_counter; in generate_pkt_descs()
989 unsigned int seq_head = s->ctx_data.rx.seq.head; in generate_pkt_descs()
990 bool aware_syt = !(s->flags & CIP_UNAWARE_SYT); in generate_pkt_descs()
995 unsigned int index = (s->packet_index + i) % s->queue_size; in generate_pkt_descs()
998 desc->cycle = compute_ohci_it_cycle(*ctx_header, s->queue_size); in generate_pkt_descs()
1000 if (aware_syt && seq->syt_offset != CIP_SYT_NO_INFO) in generate_pkt_descs()
1001 desc->syt = compute_syt(seq->syt_offset, desc->cycle, s->transfer_delay); in generate_pkt_descs()
1003 desc->syt = CIP_SYT_NO_INFO; in generate_pkt_descs()
1005 desc->data_blocks = seq->data_blocks; in generate_pkt_descs()
1007 if (s->flags & CIP_DBC_IS_END_EVENT) in generate_pkt_descs()
1008 dbc = (dbc + desc->data_blocks) & 0xff; in generate_pkt_descs()
1010 desc->data_block_counter = dbc; in generate_pkt_descs()
1012 if (!(s->flags & CIP_DBC_IS_END_EVENT)) in generate_pkt_descs()
1013 dbc = (dbc + desc->data_blocks) & 0xff; in generate_pkt_descs()
1015 desc->ctx_payload = s->buffer.packets[index].buffer; in generate_pkt_descs()
1022 s->data_block_counter = dbc; in generate_pkt_descs()
1023 s->ctx_data.rx.seq.head = seq_head; in generate_pkt_descs()
1028 s->packet_index = -1; in cancel_stream()
1031 WRITE_ONCE(s->pcm_buffer_pointer, SNDRV_PCM_POS_XRUN); in cancel_stream()
1041 pcm = READ_ONCE(s->pcm); in process_ctx_payloads()
1042 pcm_frames = s->process_ctx_payloads(s, descs, packets, pcm); in process_ctx_payloads()
1051 const struct amdtp_domain *d = s->domain; in process_rx_packets()
1053 const unsigned int events_per_period = d->events_per_period; in process_rx_packets()
1054 unsigned int event_count = s->ctx_data.rx.event_count; in process_rx_packets()
1060 if (s->packet_index < 0) in process_rx_packets()
1070 process_ctx_payloads(s, s->pkt_descs, packets); in process_rx_packets()
1072 if (!(s->flags & CIP_NO_HEADER)) in process_rx_packets()
1077 if (s == d->irq_target) { in process_rx_packets()
1081 struct snd_pcm_substream *pcm = READ_ONCE(s->pcm); in process_rx_packets()
1082 need_hw_irq = !pcm || !pcm->runtime->no_period_wakeup; in process_rx_packets()
1088 const struct pkt_desc *desc = s->pkt_descs + i; in process_rx_packets()
1095 build_it_pkt_header(s, desc->cycle, &template.params, pkt_header_length, in process_rx_packets()
1096 desc->data_blocks, desc->data_block_counter, in process_rx_packets()
1097 desc->syt, i); in process_rx_packets()
1099 if (s == s->domain->irq_target) { in process_rx_packets()
1100 event_count += desc->data_blocks; in process_rx_packets()
1102 event_count -= events_per_period; in process_rx_packets()
1113 s->ctx_data.rx.event_count = event_count; in process_rx_packets()
1120 struct amdtp_domain *d = s->domain; in skip_rx_packets()
1126 if (s->packet_index < 0) in skip_rx_packets()
1131 cycle = compute_ohci_it_cycle(ctx_header[packets - 1], s->queue_size); in skip_rx_packets()
1132 s->next_cycle = increment_ohci_cycle_count(cycle, 1); in skip_rx_packets()
1139 bool sched_irq = (s == d->irq_target && i == packets - 1); in skip_rx_packets()
1155 struct amdtp_domain *d = s->domain; in process_rx_packets_intermediately()
1157 const unsigned int queue_size = s->queue_size; in process_rx_packets_intermediately()
1161 if (s->packet_index < 0) in process_rx_packets_intermediately()
1170 if (compare_ohci_cycle_count(cycle, d->processing_cycle.rx_start) >= 0) in process_rx_packets_intermediately()
1184 header_length -= length; in process_rx_packets_intermediately()
1188 s->ready_processing = true; in process_rx_packets_intermediately()
1189 wake_up(&s->ready_wait); in process_rx_packets_intermediately()
1195 if (s == d->irq_target) in process_rx_packets_intermediately()
1196 s->context->callback.sc = irq_target_callback; in process_rx_packets_intermediately()
1198 s->context->callback.sc = process_rx_packets; in process_rx_packets_intermediately()
1212 if (s->packet_index < 0) in process_tx_packets()
1216 packets = header_length / s->ctx_data.tx.ctx_header_size; in process_tx_packets()
1219 err = generate_device_pkt_descs(s, s->pkt_descs, ctx_header, packets, &desc_count); in process_tx_packets()
1221 if (err != -EAGAIN) { in process_tx_packets()
1226 struct amdtp_domain *d = s->domain; in process_tx_packets()
1228 process_ctx_payloads(s, s->pkt_descs, desc_count); in process_tx_packets()
1230 if (d->replay.enable) in process_tx_packets()
1231 cache_seq(s, s->pkt_descs, desc_count); in process_tx_packets()
1253 if (s->packet_index < 0) in drop_tx_packets()
1256 packets = header_length / s->ctx_data.tx.ctx_header_size; in drop_tx_packets()
1258 ctx_header += (packets - 1) * s->ctx_data.tx.ctx_header_size / sizeof(*ctx_header); in drop_tx_packets()
1260 s->next_cycle = increment_ohci_cycle_count(cycle, 1); in drop_tx_packets()
1276 struct amdtp_domain *d = s->domain; in process_tx_packets_intermediately()
1281 if (s->packet_index < 0) in process_tx_packets_intermediately()
1284 packets = header_length / s->ctx_data.tx.ctx_header_size; in process_tx_packets_intermediately()
1291 if (compare_ohci_cycle_count(cycle, d->processing_cycle.tx_start) >= 0) in process_tx_packets_intermediately()
1294 ctx_header += s->ctx_data.tx.ctx_header_size / sizeof(__be32); in process_tx_packets_intermediately()
1301 size_t length = s->ctx_data.tx.ctx_header_size * offset; in process_tx_packets_intermediately()
1308 header_length -= length; in process_tx_packets_intermediately()
1312 s->ready_processing = true; in process_tx_packets_intermediately()
1313 wake_up(&s->ready_wait); in process_tx_packets_intermediately()
1319 context->callback.sc = process_tx_packets; in process_tx_packets_intermediately()
1327 struct amdtp_domain *d = s->domain; in drop_tx_packets_initially()
1333 if (s->packet_index < 0) in drop_tx_packets_initially()
1336 count = header_length / s->ctx_data.tx.ctx_header_size; in drop_tx_packets_initially()
1346 if (s->flags & CIP_NO_HEADER) { in drop_tx_packets_initially()
1347 data_blocks = payload_quads / s->data_block_quadlets; in drop_tx_packets_initially()
1354 payload_quads -= CIP_HEADER_QUADLETS; in drop_tx_packets_initially()
1356 if (s->flags & CIP_UNAWARE_SYT) { in drop_tx_packets_initially()
1357 data_blocks = payload_quads / s->data_block_quadlets; in drop_tx_packets_initially()
1366 data_blocks = payload_quads / s->data_block_quadlets; in drop_tx_packets_initially()
1373 ctx_header += s->ctx_data.tx.ctx_header_size / sizeof(__be32); in drop_tx_packets_initially()
1379 s->ctx_data.tx.event_starts = true; in drop_tx_packets_initially()
1387 list_for_each_entry(s, &d->streams, list) { in drop_tx_packets_initially()
1388 if (s->direction == AMDTP_IN_STREAM) { in drop_tx_packets_initially()
1390 if (s->ctx_data.tx.event_starts) in drop_tx_packets_initially()
1398 list_for_each_entry(s, &d->streams, list) { in drop_tx_packets_initially()
1399 if (s->direction != AMDTP_IN_STREAM) in drop_tx_packets_initially()
1402 next_cycle = increment_ohci_cycle_count(s->next_cycle, in drop_tx_packets_initially()
1403 d->processing_cycle.tx_init_skip); in drop_tx_packets_initially()
1408 s->context->callback.sc = process_tx_packets_intermediately; in drop_tx_packets_initially()
1411 d->processing_cycle.tx_start = cycle; in drop_tx_packets_initially()
1420 list_for_each_entry(s, &d->streams, list) { in process_ctxs_in_domain()
1421 if (s != d->irq_target && amdtp_stream_running(s)) in process_ctxs_in_domain()
1422 fw_iso_context_flush_completions(s->context); in process_ctxs_in_domain()
1430 if (amdtp_stream_running(d->irq_target)) in process_ctxs_in_domain()
1431 cancel_stream(d->irq_target); in process_ctxs_in_domain()
1433 list_for_each_entry(s, &d->streams, list) { in process_ctxs_in_domain()
1443 struct amdtp_domain *d = s->domain; in irq_target_callback()
1453 struct amdtp_domain *d = s->domain; in irq_target_callback_intermediately()
1463 struct amdtp_domain *d = s->domain; in irq_target_callback_skip()
1469 if (d->replay.enable && !d->replay.on_the_fly) { in irq_target_callback_skip()
1474 list_for_each_entry(rx, &d->streams, list) { in irq_target_callback_skip()
1478 if (rx->direction != AMDTP_OUT_STREAM) in irq_target_callback_skip()
1482 tx = rx->ctx_data.rx.replay_target; in irq_target_callback_skip()
1484 if (cached_cycles > tx->ctx_data.tx.cache.size / 2) in irq_target_callback_skip()
1496 unsigned int cycle = s->next_cycle; in irq_target_callback_skip()
1497 list_for_each_entry(s, &d->streams, list) { in irq_target_callback_skip()
1498 if (s->direction != AMDTP_OUT_STREAM) in irq_target_callback_skip()
1501 if (compare_ohci_cycle_count(s->next_cycle, cycle) > 0) in irq_target_callback_skip()
1502 cycle = s->next_cycle; in irq_target_callback_skip()
1504 if (s == d->irq_target) in irq_target_callback_skip()
1505 s->context->callback.sc = irq_target_callback_intermediately; in irq_target_callback_skip()
1507 s->context->callback.sc = process_rx_packets_intermediately; in irq_target_callback_skip()
1510 d->processing_cycle.rx_start = cycle; in irq_target_callback_skip()
1514 // This is executed one time. For in-stream, first packet has come. For out-stream, prepared to
1521 struct amdtp_domain *d = s->domain; in amdtp_stream_first_callback()
1523 if (s->direction == AMDTP_IN_STREAM) { in amdtp_stream_first_callback()
1524 context->callback.sc = drop_tx_packets_initially; in amdtp_stream_first_callback()
1526 if (s == d->irq_target) in amdtp_stream_first_callback()
1527 context->callback.sc = irq_target_callback_skip; in amdtp_stream_first_callback()
1529 context->callback.sc = skip_rx_packets; in amdtp_stream_first_callback()
1532 context->callback.sc(context, tstamp, header_length, header, s); in amdtp_stream_first_callback()
1536 * amdtp_stream_start - start transferring packets
1550 bool is_irq_target = (s == s->domain->irq_target); in amdtp_stream_start()
1556 mutex_lock(&s->mutex); in amdtp_stream_start()
1559 (s->data_block_quadlets < 1))) { in amdtp_stream_start()
1560 err = -EBADFD; in amdtp_stream_start()
1564 if (s->direction == AMDTP_IN_STREAM) { in amdtp_stream_start()
1567 err = -EINVAL; in amdtp_stream_start()
1571 s->data_block_counter = UINT_MAX; in amdtp_stream_start()
1573 s->data_block_counter = 0; in amdtp_stream_start()
1577 if (s->direction == AMDTP_IN_STREAM) { in amdtp_stream_start()
1580 if (!(s->flags & CIP_NO_HEADER)) in amdtp_stream_start()
1587 ctx_header_size = 0; // No effect for IT context. in amdtp_stream_start()
1591 err = iso_packets_buffer_init(&s->buffer, s->unit, queue_size, max_ctx_payload_size, dir); in amdtp_stream_start()
1594 s->queue_size = queue_size; in amdtp_stream_start()
1596 s->context = fw_iso_context_create(fw_parent_device(s->unit)->card, in amdtp_stream_start()
1599 if (IS_ERR(s->context)) { in amdtp_stream_start()
1600 err = PTR_ERR(s->context); in amdtp_stream_start()
1601 if (err == -EBUSY) in amdtp_stream_start()
1602 dev_err(&s->unit->device, in amdtp_stream_start()
1603 "no free stream on this controller\n"); in amdtp_stream_start()
1609 if (s->direction == AMDTP_IN_STREAM) { in amdtp_stream_start()
1610 s->ctx_data.tx.max_ctx_payload_length = max_ctx_payload_size; in amdtp_stream_start()
1611 s->ctx_data.tx.ctx_header_size = ctx_header_size; in amdtp_stream_start()
1612 s->ctx_data.tx.event_starts = false; in amdtp_stream_start()
1614 if (s->domain->replay.enable) { in amdtp_stream_start()
1617 s->ctx_data.tx.cache.size = max_t(unsigned int, s->syt_interval * 2, in amdtp_stream_start()
1619 s->ctx_data.tx.cache.tail = 0; in amdtp_stream_start()
1620 s->ctx_data.tx.cache.descs = kcalloc(s->ctx_data.tx.cache.size, in amdtp_stream_start()
1621 sizeof(*s->ctx_data.tx.cache.descs), GFP_KERNEL); in amdtp_stream_start()
1622 if (!s->ctx_data.tx.cache.descs) { in amdtp_stream_start()
1623 err = -ENOMEM; in amdtp_stream_start()
1641 s->ctx_data.rx.seq.descs = kcalloc(queue_size, sizeof(*s->ctx_data.rx.seq.descs), GFP_KERNEL); in amdtp_stream_start()
1642 if (!s->ctx_data.rx.seq.descs) { in amdtp_stream_start()
1643 err = -ENOMEM; in amdtp_stream_start()
1646 s->ctx_data.rx.seq.size = queue_size; in amdtp_stream_start()
1647 s->ctx_data.rx.seq.tail = 0; in amdtp_stream_start()
1648 s->ctx_data.rx.seq.head = 0; in amdtp_stream_start()
1650 entry = &initial_state[s->sfc]; in amdtp_stream_start()
1651 s->ctx_data.rx.data_block_state = entry->data_block; in amdtp_stream_start()
1652 s->ctx_data.rx.syt_offset_state = entry->syt_offset; in amdtp_stream_start()
1653 s->ctx_data.rx.last_syt_offset = TICKS_PER_CYCLE; in amdtp_stream_start()
1655 s->ctx_data.rx.event_count = 0; in amdtp_stream_start()
1658 if (s->flags & CIP_NO_HEADER) in amdtp_stream_start()
1659 s->tag = TAG_NO_CIP_HEADER; in amdtp_stream_start()
1661 s->tag = TAG_CIP; in amdtp_stream_start()
1663 s->pkt_descs = kcalloc(s->queue_size, sizeof(*s->pkt_descs), in amdtp_stream_start()
1665 if (!s->pkt_descs) { in amdtp_stream_start()
1666 err = -ENOMEM; in amdtp_stream_start()
1670 s->packet_index = 0; in amdtp_stream_start()
1674 if (s->direction == AMDTP_IN_STREAM) { in amdtp_stream_start()
1683 sched_irq = !((s->packet_index + 1) % in amdtp_stream_start()
1691 } while (s->packet_index > 0); in amdtp_stream_start()
1695 if ((s->flags & CIP_EMPTY_WITH_TAG0) || (s->flags & CIP_NO_HEADER)) in amdtp_stream_start()
1698 s->ready_processing = false; in amdtp_stream_start()
1699 err = fw_iso_context_start(s->context, -1, 0, tag); in amdtp_stream_start()
1703 mutex_unlock(&s->mutex); in amdtp_stream_start()
1707 kfree(s->pkt_descs); in amdtp_stream_start()
1709 if (s->direction == AMDTP_OUT_STREAM) { in amdtp_stream_start()
1710 kfree(s->ctx_data.rx.seq.descs); in amdtp_stream_start()
1712 if (s->domain->replay.enable) in amdtp_stream_start()
1713 kfree(s->ctx_data.tx.cache.descs); in amdtp_stream_start()
1715 fw_iso_context_destroy(s->context); in amdtp_stream_start()
1716 s->context = ERR_PTR(-1); in amdtp_stream_start()
1718 iso_packets_buffer_destroy(&s->buffer, s->unit); in amdtp_stream_start()
1720 mutex_unlock(&s->mutex); in amdtp_stream_start()
1726 * amdtp_domain_stream_pcm_pointer - get the PCM buffer position
1735 struct amdtp_stream *irq_target = d->irq_target; in amdtp_domain_stream_pcm_pointer()
1739 // In software IRQ context, the call causes dead-lock to disable the tasklet in amdtp_domain_stream_pcm_pointer()
1742 fw_iso_context_flush_completions(irq_target->context); in amdtp_domain_stream_pcm_pointer()
1745 return READ_ONCE(s->pcm_buffer_pointer); in amdtp_domain_stream_pcm_pointer()
1750 * amdtp_domain_stream_pcm_ack - acknowledge queued PCM frames
1758 struct amdtp_stream *irq_target = d->irq_target; in amdtp_domain_stream_pcm_ack()
1763 fw_iso_context_flush_completions(irq_target->context); in amdtp_domain_stream_pcm_ack()
1770 * amdtp_stream_update - update the stream after a bus reset
1776 WRITE_ONCE(s->source_node_id_field, in amdtp_stream_update()
1777 (fw_parent_device(s->unit)->card->node_id << CIP_SID_SHIFT) & CIP_SID_MASK); in amdtp_stream_update()
1782 * amdtp_stream_stop - stop sending packets
1790 mutex_lock(&s->mutex); in amdtp_stream_stop()
1793 mutex_unlock(&s->mutex); in amdtp_stream_stop()
1797 fw_iso_context_stop(s->context); in amdtp_stream_stop()
1798 fw_iso_context_destroy(s->context); in amdtp_stream_stop()
1799 s->context = ERR_PTR(-1); in amdtp_stream_stop()
1800 iso_packets_buffer_destroy(&s->buffer, s->unit); in amdtp_stream_stop()
1801 kfree(s->pkt_descs); in amdtp_stream_stop()
1803 if (s->direction == AMDTP_OUT_STREAM) { in amdtp_stream_stop()
1804 kfree(s->ctx_data.rx.seq.descs); in amdtp_stream_stop()
1806 if (s->domain->replay.enable) in amdtp_stream_stop()
1807 kfree(s->ctx_data.tx.cache.descs); in amdtp_stream_stop()
1810 mutex_unlock(&s->mutex); in amdtp_stream_stop()
1814 * amdtp_stream_pcm_abort - abort the running PCM device
1824 pcm = READ_ONCE(s->pcm); in amdtp_stream_pcm_abort()
1831 * amdtp_domain_init - initialize an AMDTP domain structure
1836 INIT_LIST_HEAD(&d->streams); in amdtp_domain_init()
1838 d->events_per_period = 0; in amdtp_domain_init()
1845 * amdtp_domain_destroy - destroy an AMDTP domain structure
1856 * amdtp_domain_add_stream - register isoc context into the domain.
1867 list_for_each_entry(tmp, &d->streams, list) { in amdtp_domain_add_stream()
1869 return -EBUSY; in amdtp_domain_add_stream()
1872 list_add(&s->list, &d->streams); in amdtp_domain_add_stream()
1874 s->channel = channel; in amdtp_domain_add_stream()
1875 s->speed = speed; in amdtp_domain_add_stream()
1876 s->domain = d; in amdtp_domain_add_stream()
1890 list_for_each_entry(rx, &d->streams, list) { in make_association()
1891 if (rx->direction == AMDTP_OUT_STREAM) { in make_association()
1896 list_for_each_entry(s, &d->streams, list) { in make_association()
1897 if (s->direction == AMDTP_IN_STREAM) { in make_association()
1908 list_for_each_entry(s, &d->streams, list) { in make_association()
1909 if (s->direction == AMDTP_IN_STREAM) { in make_association()
1914 // No target is available to replay sequence. in make_association()
1916 return -EINVAL; in make_association()
1919 rx->ctx_data.rx.replay_target = tx; in make_association()
1920 rx->ctx_data.rx.cache_head = 0; in make_association()
1930 * amdtp_domain_start - start sending packets for isoc context in the domain.
1942 unsigned int events_per_buffer = d->events_per_buffer; in amdtp_domain_start()
1943 unsigned int events_per_period = d->events_per_period; in amdtp_domain_start()
1954 d->replay.enable = replay_seq; in amdtp_domain_start()
1955 d->replay.on_the_fly = replay_on_the_fly; in amdtp_domain_start()
1958 list_for_each_entry(s, &d->streams, list) { in amdtp_domain_start()
1959 if (s->direction == AMDTP_OUT_STREAM) { in amdtp_domain_start()
1965 return -ENXIO; in amdtp_domain_start()
1966 d->irq_target = s; in amdtp_domain_start()
1968 d->processing_cycle.tx_init_skip = tx_init_skip_cycles; in amdtp_domain_start()
1974 events_per_period = amdtp_rate_table[d->irq_target->sfc] / 100; in amdtp_domain_start()
1979 amdtp_rate_table[d->irq_target->sfc]); in amdtp_domain_start()
1981 list_for_each_entry(s, &d->streams, list) { in amdtp_domain_start()
1984 if (s->direction == AMDTP_OUT_STREAM && s == d->irq_target) { in amdtp_domain_start()
1986 amdtp_rate_table[d->irq_target->sfc]); in amdtp_domain_start()
1989 // Starts immediately but actually DMA context starts several hundred cycles later. in amdtp_domain_start()
1990 err = amdtp_stream_start(s, s->channel, s->speed, queue_size, idle_irq_interval); in amdtp_domain_start()
1997 list_for_each_entry(s, &d->streams, list) in amdtp_domain_start()
2004 * amdtp_domain_stop - stop sending packets for isoc context in the same domain.
2011 if (d->irq_target) in amdtp_domain_stop()
2012 amdtp_stream_stop(d->irq_target); in amdtp_domain_stop()
2014 list_for_each_entry_safe(s, next, &d->streams, list) { in amdtp_domain_stop()
2015 list_del(&s->list); in amdtp_domain_stop()
2017 if (s != d->irq_target) in amdtp_domain_stop()
2021 d->events_per_period = 0; in amdtp_domain_stop()
2022 d->irq_target = NULL; in amdtp_domain_stop()