Changeset 2bff2cc2 in mainline for uspace/drv/bus/usb/xhci/trb_ring.c

Timestamp:

2018-01-18T14:00:57Z (7 years ago)

Author:

Ondřej Hlavatý <aearsis@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

2c0564c

Parents:

0f79283b

git-author:

Ondřej Hlavatý <aearsis@…> (2018-01-18 13:30:15)

git-committer:

Ondřej Hlavatý <aearsis@…> (2018-01-18 14:00:57)

Message:

xhci: implement sw trb ring

File:

• uspace/drv/bus/usb/xhci/trb_ring.c (modified) (1 diff)

uspace/drv/bus/usb/xhci/trb_ring.c

@@ -376 +376 @@
         return EOK;
 }
+
+void xhci_sw_ring_init(xhci_sw_ring_t *ring, size_t size)
+{
+        ring->begin = calloc(size, sizeof(xhci_trb_t));
+        ring->end = ring->begin + size;
+
+        ring->enqueue = ring->dequeue = ring->begin;
+
+        fibril_mutex_initialize(&ring->guard);
+        fibril_condvar_initialize(&ring->enqueued_cv);
+        fibril_condvar_initialize(&ring->dequeued_cv);
+
+        ring->running = true;
+}
+
+int xhci_sw_ring_enqueue(xhci_sw_ring_t *ring, xhci_trb_t *trb)
+{
+        assert(ring);
+        assert(trb);
+
+        fibril_mutex_lock(&ring->guard);
+        while (ring->running && TRB_CYCLE(*ring->enqueue))
+                fibril_condvar_wait(&ring->dequeued_cv, &ring->guard);
+
+        *ring->enqueue = *trb;
+        TRB_SET_CYCLE(*ring->enqueue, 1);
+        if (++ring->enqueue == ring->end)
+                ring->enqueue = ring->begin;
+        fibril_condvar_signal(&ring->enqueued_cv);
+        fibril_mutex_unlock(&ring->guard);
+
+        return ring->running ? EOK : EINTR;
+}
+
+int xhci_sw_ring_dequeue(xhci_sw_ring_t *ring, xhci_trb_t *trb)
+{
+        assert(ring);
+        assert(trb);
+
+        fibril_mutex_lock(&ring->guard);
+        while (ring->running && !TRB_CYCLE(*ring->dequeue))
+                fibril_condvar_wait(&ring->enqueued_cv, &ring->guard);
+
+        *trb = *ring->dequeue;
+        TRB_SET_CYCLE(*ring->dequeue, 0);
+        if (++ring->dequeue == ring->end)
+                ring->dequeue = ring->begin;
+        fibril_condvar_signal(&ring->dequeued_cv);
+        fibril_mutex_unlock(&ring->guard);
+
+        return ring->running ? EOK : EINTR;
+}
+
+void xhci_sw_ring_stop(xhci_sw_ring_t *ring)
+{
+        ring->running = false;
+        fibril_condvar_broadcast(&ring->enqueued_cv);
+        fibril_condvar_broadcast(&ring->dequeued_cv);
+}
+
+void xhci_sw_ring_fini(xhci_sw_ring_t *ring)
+{
+        free(ring->begin);
+}
+
+/**
+ * @}
+ */