Lines Matching refs:ring
28 #define RING_TYPE(ring) ((ring)->is_tx ? "TX ring" : "RX ring") argument
53 static int ring_interrupt_index(const struct tb_ring *ring) in ring_interrupt_index() argument
55 int bit = ring->hop; in ring_interrupt_index()
56 if (!ring->is_tx) in ring_interrupt_index()
57 bit += ring->nhi->hop_count; in ring_interrupt_index()
61 static void nhi_mask_interrupt(struct tb_nhi *nhi, int mask, int ring) in nhi_mask_interrupt() argument
66 val = ioread32(nhi->iobase + REG_RING_INTERRUPT_BASE + ring); in nhi_mask_interrupt()
67 iowrite32(val & ~mask, nhi->iobase + REG_RING_INTERRUPT_BASE + ring); in nhi_mask_interrupt()
69 iowrite32(mask, nhi->iobase + REG_RING_INTERRUPT_MASK_CLEAR_BASE + ring); in nhi_mask_interrupt()
73 static void nhi_clear_interrupt(struct tb_nhi *nhi, int ring) in nhi_clear_interrupt() argument
76 ioread32(nhi->iobase + REG_RING_NOTIFY_BASE + ring); in nhi_clear_interrupt()
78 iowrite32(~0, nhi->iobase + REG_RING_INT_CLEAR + ring); in nhi_clear_interrupt()
86 static void ring_interrupt_active(struct tb_ring *ring, bool active) in ring_interrupt_active() argument
88 int index = ring_interrupt_index(ring) / 32 * 4; in ring_interrupt_active()
90 int interrupt_bit = ring_interrupt_index(ring) & 31; in ring_interrupt_active()
94 if (ring->irq > 0) { in ring_interrupt_active()
100 if (ring->is_tx) in ring_interrupt_active()
101 index = ring->hop; in ring_interrupt_active()
103 index = ring->hop + ring->nhi->hop_count; in ring_interrupt_active()
116 misc = ioread32(ring->nhi->iobase + REG_DMA_MISC); in ring_interrupt_active()
117 if (ring->nhi->quirks & QUIRK_AUTO_CLEAR_INT) in ring_interrupt_active()
123 ring->nhi->iobase + REG_DMA_MISC); in ring_interrupt_active()
125 ivr_base = ring->nhi->iobase + REG_INT_VEC_ALLOC_BASE; in ring_interrupt_active()
131 ivr |= ring->vector << shift; in ring_interrupt_active()
135 old = ioread32(ring->nhi->iobase + reg); in ring_interrupt_active()
141 dev_dbg(&ring->nhi->pdev->dev, in ring_interrupt_active()
146 dev_WARN(&ring->nhi->pdev->dev, in ring_interrupt_active()
148 RING_TYPE(ring), ring->hop, in ring_interrupt_active()
152 iowrite32(new, ring->nhi->iobase + reg); in ring_interrupt_active()
154 nhi_mask_interrupt(ring->nhi, mask, index); in ring_interrupt_active()
176 static void __iomem *ring_desc_base(struct tb_ring *ring) in ring_desc_base() argument
178 void __iomem *io = ring->nhi->iobase; in ring_desc_base()
179 io += ring->is_tx ? REG_TX_RING_BASE : REG_RX_RING_BASE; in ring_desc_base()
180 io += ring->hop * 16; in ring_desc_base()
184 static void __iomem *ring_options_base(struct tb_ring *ring) in ring_options_base() argument
186 void __iomem *io = ring->nhi->iobase; in ring_options_base()
187 io += ring->is_tx ? REG_TX_OPTIONS_BASE : REG_RX_OPTIONS_BASE; in ring_options_base()
188 io += ring->hop * 32; in ring_options_base()
192 static void ring_iowrite_cons(struct tb_ring *ring, u16 cons) in ring_iowrite_cons() argument
199 iowrite32(cons, ring_desc_base(ring) + 8); in ring_iowrite_cons()
202 static void ring_iowrite_prod(struct tb_ring *ring, u16 prod) in ring_iowrite_prod() argument
205 iowrite32(prod << 16, ring_desc_base(ring) + 8); in ring_iowrite_prod()
208 static void ring_iowrite32desc(struct tb_ring *ring, u32 value, u32 offset) in ring_iowrite32desc() argument
210 iowrite32(value, ring_desc_base(ring) + offset); in ring_iowrite32desc()
213 static void ring_iowrite64desc(struct tb_ring *ring, u64 value, u32 offset) in ring_iowrite64desc() argument
215 iowrite32(value, ring_desc_base(ring) + offset); in ring_iowrite64desc()
216 iowrite32(value >> 32, ring_desc_base(ring) + offset + 4); in ring_iowrite64desc()
219 static void ring_iowrite32options(struct tb_ring *ring, u32 value, u32 offset) in ring_iowrite32options() argument
221 iowrite32(value, ring_options_base(ring) + offset); in ring_iowrite32options()
224 static bool ring_full(struct tb_ring *ring) in ring_full() argument
226 return ((ring->head + 1) % ring->size) == ring->tail; in ring_full()
229 static bool ring_empty(struct tb_ring *ring) in ring_empty() argument
231 return ring->head == ring->tail; in ring_empty()
239 static void ring_write_descriptors(struct tb_ring *ring) in ring_write_descriptors() argument
243 list_for_each_entry_safe(frame, n, &ring->queue, list) { in ring_write_descriptors()
244 if (ring_full(ring)) in ring_write_descriptors()
246 list_move_tail(&frame->list, &ring->in_flight); in ring_write_descriptors()
247 descriptor = &ring->descriptors[ring->head]; in ring_write_descriptors()
251 if (ring->is_tx) { in ring_write_descriptors()
256 ring->head = (ring->head + 1) % ring->size; in ring_write_descriptors()
257 if (ring->is_tx) in ring_write_descriptors()
258 ring_iowrite_prod(ring, ring->head); in ring_write_descriptors()
260 ring_iowrite_cons(ring, ring->head); in ring_write_descriptors()
275 struct tb_ring *ring = container_of(work, typeof(*ring), work); in ring_work() local
281 spin_lock_irqsave(&ring->lock, flags); in ring_work()
283 if (!ring->running) { in ring_work()
285 list_splice_tail_init(&ring->in_flight, &done); in ring_work()
286 list_splice_tail_init(&ring->queue, &done); in ring_work()
291 while (!ring_empty(ring)) { in ring_work()
292 if (!(ring->descriptors[ring->tail].flags in ring_work()
295 frame = list_first_entry(&ring->in_flight, typeof(*frame), in ring_work()
298 if (!ring->is_tx) { in ring_work()
299 frame->size = ring->descriptors[ring->tail].length; in ring_work()
300 frame->eof = ring->descriptors[ring->tail].eof; in ring_work()
301 frame->sof = ring->descriptors[ring->tail].sof; in ring_work()
302 frame->flags = ring->descriptors[ring->tail].flags; in ring_work()
304 ring->tail = (ring->tail + 1) % ring->size; in ring_work()
306 ring_write_descriptors(ring); in ring_work()
310 spin_unlock_irqrestore(&ring->lock, flags); in ring_work()
319 frame->callback(ring, frame, canceled); in ring_work()
323 int __tb_ring_enqueue(struct tb_ring *ring, struct ring_frame *frame) in __tb_ring_enqueue() argument
328 spin_lock_irqsave(&ring->lock, flags); in __tb_ring_enqueue()
329 if (ring->running) { in __tb_ring_enqueue()
330 list_add_tail(&frame->list, &ring->queue); in __tb_ring_enqueue()
331 ring_write_descriptors(ring); in __tb_ring_enqueue()
335 spin_unlock_irqrestore(&ring->lock, flags); in __tb_ring_enqueue()
349 struct ring_frame *tb_ring_poll(struct tb_ring *ring) in tb_ring_poll() argument
354 spin_lock_irqsave(&ring->lock, flags); in tb_ring_poll()
355 if (!ring->running) in tb_ring_poll()
357 if (ring_empty(ring)) in tb_ring_poll()
360 if (ring->descriptors[ring->tail].flags & RING_DESC_COMPLETED) { in tb_ring_poll()
361 frame = list_first_entry(&ring->in_flight, typeof(*frame), in tb_ring_poll()
365 if (!ring->is_tx) { in tb_ring_poll()
366 frame->size = ring->descriptors[ring->tail].length; in tb_ring_poll()
367 frame->eof = ring->descriptors[ring->tail].eof; in tb_ring_poll()
368 frame->sof = ring->descriptors[ring->tail].sof; in tb_ring_poll()
369 frame->flags = ring->descriptors[ring->tail].flags; in tb_ring_poll()
372 ring->tail = (ring->tail + 1) % ring->size; in tb_ring_poll()
376 spin_unlock_irqrestore(&ring->lock, flags); in tb_ring_poll()
381 static void __ring_interrupt_mask(struct tb_ring *ring, bool mask) in __ring_interrupt_mask() argument
383 int idx = ring_interrupt_index(ring); in __ring_interrupt_mask()
388 val = ioread32(ring->nhi->iobase + reg); in __ring_interrupt_mask()
393 iowrite32(val, ring->nhi->iobase + reg); in __ring_interrupt_mask()
397 static void __ring_interrupt(struct tb_ring *ring) in __ring_interrupt() argument
399 if (!ring->running) in __ring_interrupt()
402 if (ring->start_poll) { in __ring_interrupt()
403 __ring_interrupt_mask(ring, true); in __ring_interrupt()
404 ring->start_poll(ring->poll_data); in __ring_interrupt()
406 schedule_work(&ring->work); in __ring_interrupt()
417 void tb_ring_poll_complete(struct tb_ring *ring) in tb_ring_poll_complete() argument
421 spin_lock_irqsave(&ring->nhi->lock, flags); in tb_ring_poll_complete()
422 spin_lock(&ring->lock); in tb_ring_poll_complete()
423 if (ring->start_poll) in tb_ring_poll_complete()
424 __ring_interrupt_mask(ring, false); in tb_ring_poll_complete()
425 spin_unlock(&ring->lock); in tb_ring_poll_complete()
426 spin_unlock_irqrestore(&ring->nhi->lock, flags); in tb_ring_poll_complete()
430 static void ring_clear_msix(const struct tb_ring *ring) in ring_clear_msix() argument
434 if (ring->nhi->quirks & QUIRK_AUTO_CLEAR_INT) in ring_clear_msix()
437 bit = ring_interrupt_index(ring) & 31; in ring_clear_msix()
438 if (ring->is_tx) in ring_clear_msix()
439 iowrite32(BIT(bit), ring->nhi->iobase + REG_RING_INT_CLEAR); in ring_clear_msix()
441 iowrite32(BIT(bit), ring->nhi->iobase + REG_RING_INT_CLEAR + in ring_clear_msix()
442 4 * (ring->nhi->hop_count / 32)); in ring_clear_msix()
447 struct tb_ring *ring = data; in ring_msix() local
449 spin_lock(&ring->nhi->lock); in ring_msix()
450 ring_clear_msix(ring); in ring_msix()
451 spin_lock(&ring->lock); in ring_msix()
452 __ring_interrupt(ring); in ring_msix()
453 spin_unlock(&ring->lock); in ring_msix()
454 spin_unlock(&ring->nhi->lock); in ring_msix()
459 static int ring_request_msix(struct tb_ring *ring, bool no_suspend) in ring_request_msix() argument
461 struct tb_nhi *nhi = ring->nhi; in ring_request_msix()
472 ring->vector = ret; in ring_request_msix()
474 ret = pci_irq_vector(ring->nhi->pdev, ring->vector); in ring_request_msix()
478 ring->irq = ret; in ring_request_msix()
481 ret = request_irq(ring->irq, ring_msix, irqflags, "thunderbolt", ring); in ring_request_msix()
488 ida_simple_remove(&nhi->msix_ida, ring->vector); in ring_request_msix()
493 static void ring_release_msix(struct tb_ring *ring) in ring_release_msix() argument
495 if (ring->irq <= 0) in ring_release_msix()
498 free_irq(ring->irq, ring); in ring_release_msix()
499 ida_simple_remove(&ring->nhi->msix_ida, ring->vector); in ring_release_msix()
500 ring->vector = 0; in ring_release_msix()
501 ring->irq = 0; in ring_release_msix()
504 static int nhi_alloc_hop(struct tb_nhi *nhi, struct tb_ring *ring) in nhi_alloc_hop() argument
511 if (ring->flags & RING_FLAG_E2E && !ring->is_tx) { in nhi_alloc_hop()
513 ring->e2e_tx_hop, RING_E2E_RESERVED_HOPID); in nhi_alloc_hop()
514 ring->e2e_tx_hop = RING_E2E_RESERVED_HOPID; in nhi_alloc_hop()
520 if (ring->hop < 0) { in nhi_alloc_hop()
528 if (ring->is_tx) { in nhi_alloc_hop()
530 ring->hop = i; in nhi_alloc_hop()
535 ring->hop = i; in nhi_alloc_hop()
542 if (ring->hop > 0 && ring->hop < start_hop) { in nhi_alloc_hop()
543 dev_warn(&nhi->pdev->dev, "invalid hop: %d\n", ring->hop); in nhi_alloc_hop()
547 if (ring->hop < 0 || ring->hop >= nhi->hop_count) { in nhi_alloc_hop()
548 dev_warn(&nhi->pdev->dev, "invalid hop: %d\n", ring->hop); in nhi_alloc_hop()
552 if (ring->is_tx && nhi->tx_rings[ring->hop]) { in nhi_alloc_hop()
554 ring->hop); in nhi_alloc_hop()
558 if (!ring->is_tx && nhi->rx_rings[ring->hop]) { in nhi_alloc_hop()
560 ring->hop); in nhi_alloc_hop()
565 if (ring->is_tx) in nhi_alloc_hop()
566 nhi->tx_rings[ring->hop] = ring; in nhi_alloc_hop()
568 nhi->rx_rings[ring->hop] = ring; in nhi_alloc_hop()
582 struct tb_ring *ring = NULL; in tb_ring_alloc() local
587 ring = kzalloc(sizeof(*ring), GFP_KERNEL); in tb_ring_alloc()
588 if (!ring) in tb_ring_alloc()
591 spin_lock_init(&ring->lock); in tb_ring_alloc()
592 INIT_LIST_HEAD(&ring->queue); in tb_ring_alloc()
593 INIT_LIST_HEAD(&ring->in_flight); in tb_ring_alloc()
594 INIT_WORK(&ring->work, ring_work); in tb_ring_alloc()
596 ring->nhi = nhi; in tb_ring_alloc()
597 ring->hop = hop; in tb_ring_alloc()
598 ring->is_tx = transmit; in tb_ring_alloc()
599 ring->size = size; in tb_ring_alloc()
600 ring->flags = flags; in tb_ring_alloc()
601 ring->e2e_tx_hop = e2e_tx_hop; in tb_ring_alloc()
602 ring->sof_mask = sof_mask; in tb_ring_alloc()
603 ring->eof_mask = eof_mask; in tb_ring_alloc()
604 ring->head = 0; in tb_ring_alloc()
605 ring->tail = 0; in tb_ring_alloc()
606 ring->running = false; in tb_ring_alloc()
607 ring->start_poll = start_poll; in tb_ring_alloc()
608 ring->poll_data = poll_data; in tb_ring_alloc()
610 ring->descriptors = dma_alloc_coherent(&ring->nhi->pdev->dev, in tb_ring_alloc()
611 size * sizeof(*ring->descriptors), in tb_ring_alloc()
612 &ring->descriptors_dma, GFP_KERNEL | __GFP_ZERO); in tb_ring_alloc()
613 if (!ring->descriptors) in tb_ring_alloc()
616 if (ring_request_msix(ring, flags & RING_FLAG_NO_SUSPEND)) in tb_ring_alloc()
619 if (nhi_alloc_hop(nhi, ring)) in tb_ring_alloc()
622 return ring; in tb_ring_alloc()
625 ring_release_msix(ring); in tb_ring_alloc()
627 dma_free_coherent(&ring->nhi->pdev->dev, in tb_ring_alloc()
628 ring->size * sizeof(*ring->descriptors), in tb_ring_alloc()
629 ring->descriptors, ring->descriptors_dma); in tb_ring_alloc()
631 kfree(ring); in tb_ring_alloc()
680 void tb_ring_start(struct tb_ring *ring) in tb_ring_start() argument
685 spin_lock_irq(&ring->nhi->lock); in tb_ring_start()
686 spin_lock(&ring->lock); in tb_ring_start()
687 if (ring->nhi->going_away) in tb_ring_start()
689 if (ring->running) { in tb_ring_start()
690 dev_WARN(&ring->nhi->pdev->dev, "ring already started\n"); in tb_ring_start()
693 dev_dbg(&ring->nhi->pdev->dev, "starting %s %d\n", in tb_ring_start()
694 RING_TYPE(ring), ring->hop); in tb_ring_start()
696 if (ring->flags & RING_FLAG_FRAME) { in tb_ring_start()
705 ring_iowrite64desc(ring, ring->descriptors_dma, 0); in tb_ring_start()
706 if (ring->is_tx) { in tb_ring_start()
707 ring_iowrite32desc(ring, ring->size, 12); in tb_ring_start()
708 ring_iowrite32options(ring, 0, 4); /* time releated ? */ in tb_ring_start()
709 ring_iowrite32options(ring, flags, 0); in tb_ring_start()
711 u32 sof_eof_mask = ring->sof_mask << 16 | ring->eof_mask; in tb_ring_start()
713 ring_iowrite32desc(ring, (frame_size << 16) | ring->size, 12); in tb_ring_start()
714 ring_iowrite32options(ring, sof_eof_mask, 4); in tb_ring_start()
715 ring_iowrite32options(ring, flags, 0); in tb_ring_start()
722 if (ring->flags & RING_FLAG_E2E) { in tb_ring_start()
723 if (!ring->is_tx) { in tb_ring_start()
726 hop = ring->e2e_tx_hop << REG_RX_OPTIONS_E2E_HOP_SHIFT; in tb_ring_start()
730 dev_dbg(&ring->nhi->pdev->dev, in tb_ring_start()
732 RING_TYPE(ring), ring->hop, ring->e2e_tx_hop); in tb_ring_start()
734 dev_dbg(&ring->nhi->pdev->dev, "enabling E2E for %s %d\n", in tb_ring_start()
735 RING_TYPE(ring), ring->hop); in tb_ring_start()
739 ring_iowrite32options(ring, flags, 0); in tb_ring_start()
742 ring_interrupt_active(ring, true); in tb_ring_start()
743 ring->running = true; in tb_ring_start()
745 spin_unlock(&ring->lock); in tb_ring_start()
746 spin_unlock_irq(&ring->nhi->lock); in tb_ring_start()
764 void tb_ring_stop(struct tb_ring *ring) in tb_ring_stop() argument
766 spin_lock_irq(&ring->nhi->lock); in tb_ring_stop()
767 spin_lock(&ring->lock); in tb_ring_stop()
768 dev_dbg(&ring->nhi->pdev->dev, "stopping %s %d\n", in tb_ring_stop()
769 RING_TYPE(ring), ring->hop); in tb_ring_stop()
770 if (ring->nhi->going_away) in tb_ring_stop()
772 if (!ring->running) { in tb_ring_stop()
773 dev_WARN(&ring->nhi->pdev->dev, "%s %d already stopped\n", in tb_ring_stop()
774 RING_TYPE(ring), ring->hop); in tb_ring_stop()
777 ring_interrupt_active(ring, false); in tb_ring_stop()
779 ring_iowrite32options(ring, 0, 0); in tb_ring_stop()
780 ring_iowrite64desc(ring, 0, 0); in tb_ring_stop()
781 ring_iowrite32desc(ring, 0, 8); in tb_ring_stop()
782 ring_iowrite32desc(ring, 0, 12); in tb_ring_stop()
783 ring->head = 0; in tb_ring_stop()
784 ring->tail = 0; in tb_ring_stop()
785 ring->running = false; in tb_ring_stop()
788 spin_unlock(&ring->lock); in tb_ring_stop()
789 spin_unlock_irq(&ring->nhi->lock); in tb_ring_stop()
794 schedule_work(&ring->work); in tb_ring_stop()
795 flush_work(&ring->work); in tb_ring_stop()
809 void tb_ring_free(struct tb_ring *ring) in tb_ring_free() argument
811 spin_lock_irq(&ring->nhi->lock); in tb_ring_free()
816 if (ring->is_tx) in tb_ring_free()
817 ring->nhi->tx_rings[ring->hop] = NULL; in tb_ring_free()
819 ring->nhi->rx_rings[ring->hop] = NULL; in tb_ring_free()
821 if (ring->running) { in tb_ring_free()
822 dev_WARN(&ring->nhi->pdev->dev, "%s %d still running\n", in tb_ring_free()
823 RING_TYPE(ring), ring->hop); in tb_ring_free()
825 spin_unlock_irq(&ring->nhi->lock); in tb_ring_free()
827 ring_release_msix(ring); in tb_ring_free()
829 dma_free_coherent(&ring->nhi->pdev->dev, in tb_ring_free()
830 ring->size * sizeof(*ring->descriptors), in tb_ring_free()
831 ring->descriptors, ring->descriptors_dma); in tb_ring_free()
833 ring->descriptors = NULL; in tb_ring_free()
834 ring->descriptors_dma = 0; in tb_ring_free()
837 dev_dbg(&ring->nhi->pdev->dev, "freeing %s %d\n", RING_TYPE(ring), in tb_ring_free()
838 ring->hop); in tb_ring_free()
845 flush_work(&ring->work); in tb_ring_free()
846 kfree(ring); in tb_ring_free()
912 struct tb_ring *ring; in nhi_interrupt_work() local
939 ring = nhi->tx_rings[hop]; in nhi_interrupt_work()
941 ring = nhi->rx_rings[hop]; in nhi_interrupt_work()
942 if (ring == NULL) { in nhi_interrupt_work()
950 spin_lock(&ring->lock); in nhi_interrupt_work()
951 __ring_interrupt(ring); in nhi_interrupt_work()
952 spin_unlock(&ring->lock); in nhi_interrupt_work()