Lines Matching refs:ring
22 #define RING_TYPE(ring) ((ring)->is_tx ? "TX ring" : "RX ring") argument
41 static int ring_interrupt_index(struct tb_ring *ring) in ring_interrupt_index() argument
43 int bit = ring->hop; in ring_interrupt_index()
44 if (!ring->is_tx) in ring_interrupt_index()
45 bit += ring->nhi->hop_count; in ring_interrupt_index()
54 static void ring_interrupt_active(struct tb_ring *ring, bool active) in ring_interrupt_active() argument
57 ring_interrupt_index(ring) / 32 * 4; in ring_interrupt_active()
58 int bit = ring_interrupt_index(ring) & 31; in ring_interrupt_active()
62 if (ring->irq > 0) { in ring_interrupt_active()
67 if (ring->is_tx) in ring_interrupt_active()
68 index = ring->hop; in ring_interrupt_active()
70 index = ring->hop + ring->nhi->hop_count; in ring_interrupt_active()
76 misc = ioread32(ring->nhi->iobase + REG_DMA_MISC); in ring_interrupt_active()
79 iowrite32(misc, ring->nhi->iobase + REG_DMA_MISC); in ring_interrupt_active()
82 ivr_base = ring->nhi->iobase + REG_INT_VEC_ALLOC_BASE; in ring_interrupt_active()
88 ivr |= ring->vector << shift; in ring_interrupt_active()
92 old = ioread32(ring->nhi->iobase + reg); in ring_interrupt_active()
98 dev_info(&ring->nhi->pdev->dev, in ring_interrupt_active()
103 dev_WARN(&ring->nhi->pdev->dev, in ring_interrupt_active()
105 RING_TYPE(ring), ring->hop, in ring_interrupt_active()
107 iowrite32(new, ring->nhi->iobase + reg); in ring_interrupt_active()
129 static void __iomem *ring_desc_base(struct tb_ring *ring) in ring_desc_base() argument
131 void __iomem *io = ring->nhi->iobase; in ring_desc_base()
132 io += ring->is_tx ? REG_TX_RING_BASE : REG_RX_RING_BASE; in ring_desc_base()
133 io += ring->hop * 16; in ring_desc_base()
137 static void __iomem *ring_options_base(struct tb_ring *ring) in ring_options_base() argument
139 void __iomem *io = ring->nhi->iobase; in ring_options_base()
140 io += ring->is_tx ? REG_TX_OPTIONS_BASE : REG_RX_OPTIONS_BASE; in ring_options_base()
141 io += ring->hop * 32; in ring_options_base()
145 static void ring_iowrite16desc(struct tb_ring *ring, u32 value, u32 offset) in ring_iowrite16desc() argument
147 iowrite16(value, ring_desc_base(ring) + offset); in ring_iowrite16desc()
150 static void ring_iowrite32desc(struct tb_ring *ring, u32 value, u32 offset) in ring_iowrite32desc() argument
152 iowrite32(value, ring_desc_base(ring) + offset); in ring_iowrite32desc()
155 static void ring_iowrite64desc(struct tb_ring *ring, u64 value, u32 offset) in ring_iowrite64desc() argument
157 iowrite32(value, ring_desc_base(ring) + offset); in ring_iowrite64desc()
158 iowrite32(value >> 32, ring_desc_base(ring) + offset + 4); in ring_iowrite64desc()
161 static void ring_iowrite32options(struct tb_ring *ring, u32 value, u32 offset) in ring_iowrite32options() argument
163 iowrite32(value, ring_options_base(ring) + offset); in ring_iowrite32options()
166 static bool ring_full(struct tb_ring *ring) in ring_full() argument
168 return ((ring->head + 1) % ring->size) == ring->tail; in ring_full()
171 static bool ring_empty(struct tb_ring *ring) in ring_empty() argument
173 return ring->head == ring->tail; in ring_empty()
181 static void ring_write_descriptors(struct tb_ring *ring) in ring_write_descriptors() argument
185 list_for_each_entry_safe(frame, n, &ring->queue, list) { in ring_write_descriptors()
186 if (ring_full(ring)) in ring_write_descriptors()
188 list_move_tail(&frame->list, &ring->in_flight); in ring_write_descriptors()
189 descriptor = &ring->descriptors[ring->head]; in ring_write_descriptors()
193 if (ring->is_tx) { in ring_write_descriptors()
198 ring->head = (ring->head + 1) % ring->size; in ring_write_descriptors()
199 ring_iowrite16desc(ring, ring->head, ring->is_tx ? 10 : 8); in ring_write_descriptors()
214 struct tb_ring *ring = container_of(work, typeof(*ring), work); in ring_work() local
220 spin_lock_irqsave(&ring->lock, flags); in ring_work()
222 if (!ring->running) { in ring_work()
224 list_splice_tail_init(&ring->in_flight, &done); in ring_work()
225 list_splice_tail_init(&ring->queue, &done); in ring_work()
230 while (!ring_empty(ring)) { in ring_work()
231 if (!(ring->descriptors[ring->tail].flags in ring_work()
234 frame = list_first_entry(&ring->in_flight, typeof(*frame), in ring_work()
237 if (!ring->is_tx) { in ring_work()
238 frame->size = ring->descriptors[ring->tail].length; in ring_work()
239 frame->eof = ring->descriptors[ring->tail].eof; in ring_work()
240 frame->sof = ring->descriptors[ring->tail].sof; in ring_work()
241 frame->flags = ring->descriptors[ring->tail].flags; in ring_work()
243 ring->tail = (ring->tail + 1) % ring->size; in ring_work()
245 ring_write_descriptors(ring); in ring_work()
249 spin_unlock_irqrestore(&ring->lock, flags); in ring_work()
258 frame->callback(ring, frame, canceled); in ring_work()
262 int __tb_ring_enqueue(struct tb_ring *ring, struct ring_frame *frame) in __tb_ring_enqueue() argument
267 spin_lock_irqsave(&ring->lock, flags); in __tb_ring_enqueue()
268 if (ring->running) { in __tb_ring_enqueue()
269 list_add_tail(&frame->list, &ring->queue); in __tb_ring_enqueue()
270 ring_write_descriptors(ring); in __tb_ring_enqueue()
274 spin_unlock_irqrestore(&ring->lock, flags); in __tb_ring_enqueue()
288 struct ring_frame *tb_ring_poll(struct tb_ring *ring) in tb_ring_poll() argument
293 spin_lock_irqsave(&ring->lock, flags); in tb_ring_poll()
294 if (!ring->running) in tb_ring_poll()
296 if (ring_empty(ring)) in tb_ring_poll()
299 if (ring->descriptors[ring->tail].flags & RING_DESC_COMPLETED) { in tb_ring_poll()
300 frame = list_first_entry(&ring->in_flight, typeof(*frame), in tb_ring_poll()
304 if (!ring->is_tx) { in tb_ring_poll()
305 frame->size = ring->descriptors[ring->tail].length; in tb_ring_poll()
306 frame->eof = ring->descriptors[ring->tail].eof; in tb_ring_poll()
307 frame->sof = ring->descriptors[ring->tail].sof; in tb_ring_poll()
308 frame->flags = ring->descriptors[ring->tail].flags; in tb_ring_poll()
311 ring->tail = (ring->tail + 1) % ring->size; in tb_ring_poll()
315 spin_unlock_irqrestore(&ring->lock, flags); in tb_ring_poll()
320 static void __ring_interrupt_mask(struct tb_ring *ring, bool mask) in __ring_interrupt_mask() argument
322 int idx = ring_interrupt_index(ring); in __ring_interrupt_mask()
327 val = ioread32(ring->nhi->iobase + reg); in __ring_interrupt_mask()
332 iowrite32(val, ring->nhi->iobase + reg); in __ring_interrupt_mask()
336 static void __ring_interrupt(struct tb_ring *ring) in __ring_interrupt() argument
338 if (!ring->running) in __ring_interrupt()
341 if (ring->start_poll) { in __ring_interrupt()
342 __ring_interrupt_mask(ring, true); in __ring_interrupt()
343 ring->start_poll(ring->poll_data); in __ring_interrupt()
345 schedule_work(&ring->work); in __ring_interrupt()
356 void tb_ring_poll_complete(struct tb_ring *ring) in tb_ring_poll_complete() argument
360 spin_lock_irqsave(&ring->nhi->lock, flags); in tb_ring_poll_complete()
361 spin_lock(&ring->lock); in tb_ring_poll_complete()
362 if (ring->start_poll) in tb_ring_poll_complete()
363 __ring_interrupt_mask(ring, false); in tb_ring_poll_complete()
364 spin_unlock(&ring->lock); in tb_ring_poll_complete()
365 spin_unlock_irqrestore(&ring->nhi->lock, flags); in tb_ring_poll_complete()
371 struct tb_ring *ring = data; in ring_msix() local
373 spin_lock(&ring->nhi->lock); in ring_msix()
374 spin_lock(&ring->lock); in ring_msix()
375 __ring_interrupt(ring); in ring_msix()
376 spin_unlock(&ring->lock); in ring_msix()
377 spin_unlock(&ring->nhi->lock); in ring_msix()
382 static int ring_request_msix(struct tb_ring *ring, bool no_suspend) in ring_request_msix() argument
384 struct tb_nhi *nhi = ring->nhi; in ring_request_msix()
395 ring->vector = ret; in ring_request_msix()
397 ring->irq = pci_irq_vector(ring->nhi->pdev, ring->vector); in ring_request_msix()
398 if (ring->irq < 0) in ring_request_msix()
399 return ring->irq; in ring_request_msix()
402 return request_irq(ring->irq, ring_msix, irqflags, "thunderbolt", ring); in ring_request_msix()
405 static void ring_release_msix(struct tb_ring *ring) in ring_release_msix() argument
407 if (ring->irq <= 0) in ring_release_msix()
410 free_irq(ring->irq, ring); in ring_release_msix()
411 ida_simple_remove(&ring->nhi->msix_ida, ring->vector); in ring_release_msix()
412 ring->vector = 0; in ring_release_msix()
413 ring->irq = 0; in ring_release_msix()
416 static int nhi_alloc_hop(struct tb_nhi *nhi, struct tb_ring *ring) in nhi_alloc_hop() argument
422 if (ring->hop < 0) { in nhi_alloc_hop()
430 if (ring->is_tx) { in nhi_alloc_hop()
432 ring->hop = i; in nhi_alloc_hop()
437 ring->hop = i; in nhi_alloc_hop()
444 if (ring->hop < 0 || ring->hop >= nhi->hop_count) { in nhi_alloc_hop()
445 dev_warn(&nhi->pdev->dev, "invalid hop: %d\n", ring->hop); in nhi_alloc_hop()
449 if (ring->is_tx && nhi->tx_rings[ring->hop]) { in nhi_alloc_hop()
451 ring->hop); in nhi_alloc_hop()
454 } else if (!ring->is_tx && nhi->rx_rings[ring->hop]) { in nhi_alloc_hop()
456 ring->hop); in nhi_alloc_hop()
461 if (ring->is_tx) in nhi_alloc_hop()
462 nhi->tx_rings[ring->hop] = ring; in nhi_alloc_hop()
464 nhi->rx_rings[ring->hop] = ring; in nhi_alloc_hop()
478 struct tb_ring *ring = NULL; in tb_ring_alloc() local
486 ring = kzalloc(sizeof(*ring), GFP_KERNEL); in tb_ring_alloc()
487 if (!ring) in tb_ring_alloc()
490 spin_lock_init(&ring->lock); in tb_ring_alloc()
491 INIT_LIST_HEAD(&ring->queue); in tb_ring_alloc()
492 INIT_LIST_HEAD(&ring->in_flight); in tb_ring_alloc()
493 INIT_WORK(&ring->work, ring_work); in tb_ring_alloc()
495 ring->nhi = nhi; in tb_ring_alloc()
496 ring->hop = hop; in tb_ring_alloc()
497 ring->is_tx = transmit; in tb_ring_alloc()
498 ring->size = size; in tb_ring_alloc()
499 ring->flags = flags; in tb_ring_alloc()
500 ring->sof_mask = sof_mask; in tb_ring_alloc()
501 ring->eof_mask = eof_mask; in tb_ring_alloc()
502 ring->head = 0; in tb_ring_alloc()
503 ring->tail = 0; in tb_ring_alloc()
504 ring->running = false; in tb_ring_alloc()
505 ring->start_poll = start_poll; in tb_ring_alloc()
506 ring->poll_data = poll_data; in tb_ring_alloc()
508 ring->descriptors = dma_alloc_coherent(&ring->nhi->pdev->dev, in tb_ring_alloc()
509 size * sizeof(*ring->descriptors), in tb_ring_alloc()
510 &ring->descriptors_dma, GFP_KERNEL | __GFP_ZERO); in tb_ring_alloc()
511 if (!ring->descriptors) in tb_ring_alloc()
514 if (ring_request_msix(ring, flags & RING_FLAG_NO_SUSPEND)) in tb_ring_alloc()
517 if (nhi_alloc_hop(nhi, ring)) in tb_ring_alloc()
520 return ring; in tb_ring_alloc()
523 ring_release_msix(ring); in tb_ring_alloc()
525 dma_free_coherent(&ring->nhi->pdev->dev, in tb_ring_alloc()
526 ring->size * sizeof(*ring->descriptors), in tb_ring_alloc()
527 ring->descriptors, ring->descriptors_dma); in tb_ring_alloc()
529 kfree(ring); in tb_ring_alloc()
575 void tb_ring_start(struct tb_ring *ring) in tb_ring_start() argument
580 spin_lock_irq(&ring->nhi->lock); in tb_ring_start()
581 spin_lock(&ring->lock); in tb_ring_start()
582 if (ring->nhi->going_away) in tb_ring_start()
584 if (ring->running) { in tb_ring_start()
585 dev_WARN(&ring->nhi->pdev->dev, "ring already started\n"); in tb_ring_start()
588 dev_info(&ring->nhi->pdev->dev, "starting %s %d\n", in tb_ring_start()
589 RING_TYPE(ring), ring->hop); in tb_ring_start()
591 if (ring->flags & RING_FLAG_FRAME) { in tb_ring_start()
600 if (ring->flags & RING_FLAG_E2E && !ring->is_tx) { in tb_ring_start()
613 ring_iowrite64desc(ring, ring->descriptors_dma, 0); in tb_ring_start()
614 if (ring->is_tx) { in tb_ring_start()
615 ring_iowrite32desc(ring, ring->size, 12); in tb_ring_start()
616 ring_iowrite32options(ring, 0, 4); /* time releated ? */ in tb_ring_start()
617 ring_iowrite32options(ring, flags, 0); in tb_ring_start()
619 u32 sof_eof_mask = ring->sof_mask << 16 | ring->eof_mask; in tb_ring_start()
621 ring_iowrite32desc(ring, (frame_size << 16) | ring->size, 12); in tb_ring_start()
622 ring_iowrite32options(ring, sof_eof_mask, 4); in tb_ring_start()
623 ring_iowrite32options(ring, flags, 0); in tb_ring_start()
625 ring_interrupt_active(ring, true); in tb_ring_start()
626 ring->running = true; in tb_ring_start()
628 spin_unlock(&ring->lock); in tb_ring_start()
629 spin_unlock_irq(&ring->nhi->lock); in tb_ring_start()
646 void tb_ring_stop(struct tb_ring *ring) in tb_ring_stop() argument
648 spin_lock_irq(&ring->nhi->lock); in tb_ring_stop()
649 spin_lock(&ring->lock); in tb_ring_stop()
650 dev_info(&ring->nhi->pdev->dev, "stopping %s %d\n", in tb_ring_stop()
651 RING_TYPE(ring), ring->hop); in tb_ring_stop()
652 if (ring->nhi->going_away) in tb_ring_stop()
654 if (!ring->running) { in tb_ring_stop()
655 dev_WARN(&ring->nhi->pdev->dev, "%s %d already stopped\n", in tb_ring_stop()
656 RING_TYPE(ring), ring->hop); in tb_ring_stop()
659 ring_interrupt_active(ring, false); in tb_ring_stop()
661 ring_iowrite32options(ring, 0, 0); in tb_ring_stop()
662 ring_iowrite64desc(ring, 0, 0); in tb_ring_stop()
663 ring_iowrite16desc(ring, 0, ring->is_tx ? 10 : 8); in tb_ring_stop()
664 ring_iowrite32desc(ring, 0, 12); in tb_ring_stop()
665 ring->head = 0; in tb_ring_stop()
666 ring->tail = 0; in tb_ring_stop()
667 ring->running = false; in tb_ring_stop()
670 spin_unlock(&ring->lock); in tb_ring_stop()
671 spin_unlock_irq(&ring->nhi->lock); in tb_ring_stop()
676 schedule_work(&ring->work); in tb_ring_stop()
677 flush_work(&ring->work); in tb_ring_stop()
691 void tb_ring_free(struct tb_ring *ring) in tb_ring_free() argument
693 spin_lock_irq(&ring->nhi->lock); in tb_ring_free()
698 if (ring->is_tx) in tb_ring_free()
699 ring->nhi->tx_rings[ring->hop] = NULL; in tb_ring_free()
701 ring->nhi->rx_rings[ring->hop] = NULL; in tb_ring_free()
703 if (ring->running) { in tb_ring_free()
704 dev_WARN(&ring->nhi->pdev->dev, "%s %d still running\n", in tb_ring_free()
705 RING_TYPE(ring), ring->hop); in tb_ring_free()
707 spin_unlock_irq(&ring->nhi->lock); in tb_ring_free()
709 ring_release_msix(ring); in tb_ring_free()
711 dma_free_coherent(&ring->nhi->pdev->dev, in tb_ring_free()
712 ring->size * sizeof(*ring->descriptors), in tb_ring_free()
713 ring->descriptors, ring->descriptors_dma); in tb_ring_free()
715 ring->descriptors = NULL; in tb_ring_free()
716 ring->descriptors_dma = 0; in tb_ring_free()
719 dev_info(&ring->nhi->pdev->dev, in tb_ring_free()
721 RING_TYPE(ring), in tb_ring_free()
722 ring->hop); in tb_ring_free()
729 flush_work(&ring->work); in tb_ring_free()
730 kfree(ring); in tb_ring_free()
796 struct tb_ring *ring; in nhi_interrupt_work() local
823 ring = nhi->tx_rings[hop]; in nhi_interrupt_work()
825 ring = nhi->rx_rings[hop]; in nhi_interrupt_work()
826 if (ring == NULL) { in nhi_interrupt_work()
834 spin_lock(&ring->lock); in nhi_interrupt_work()
835 __ring_interrupt(ring); in nhi_interrupt_work()
836 spin_unlock(&ring->lock); in nhi_interrupt_work()