Changeset 59b3095 in mainline for uspace/drv/nic/rtl8169/driver.c

Timestamp:

2014-06-02T20:53:10Z (10 years ago)

Author:

Agnieszka Tabaka <nufcia@…>

Branches:

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

Children:

be971233

Parents:

0764cc8a

Message:

Implemented DMA buffers allocation and frame sending mechanism. Buffers reclaiming is not implemented yet.

File:

• uspace/drv/nic/rtl8169/driver.c (modified) (10 diffs)

uspace/drv/nic/rtl8169/driver.c

@@ -209 +209 @@
                 return EINVAL;
         };
+
         if (hw_resources->io_ranges.count != 1) {
                 ddf_msg(LVL_ERROR, "%s device: unexpected io ranges count", ddf_dev_get_name(dev));
@@ -237 +238 @@
         rc = dmamem_map_anonymous(TX_RING_SIZE, DMAMEM_4GiB, 
             AS_AREA_READ | AS_AREA_WRITE, 0, &rtl8169->tx_ring_phys,
-            &rtl8169->tx_ring_virt);
+            (void **)&rtl8169->tx_ring);
 
         if (rc != EOK)
@@ -245 +246 @@
         rc = dmamem_map_anonymous(RX_RING_SIZE, DMAMEM_4GiB, 
             AS_AREA_READ | AS_AREA_WRITE, 0, &rtl8169->rx_ring_phys,
-            &rtl8169->rx_ring_virt);
+            (void **)&rtl8169->rx_ring);
 
         if (rc != EOK)
@@ -253 +254 @@
         rc = dmamem_map_anonymous(TX_BUFFERS_SIZE, DMAMEM_4GiB, 
             AS_AREA_READ | AS_AREA_WRITE, 0, &rtl8169->tx_buff_phys,
-            &rtl8169->tx_buff_virt);
+            &rtl8169->tx_buff);
 
         if (rc != EOK)
@@ -261 +262 @@
         rc = dmamem_map_anonymous(RX_BUFFERS_SIZE, DMAMEM_4GiB, 
             AS_AREA_READ | AS_AREA_WRITE, 0, &rtl8169->rx_buff_phys,
-            &rtl8169->rx_buff_virt);
+            &rtl8169->rx_buff);
 
         if (rc != EOK)
                 return rc;
+
+        return EOK;
 }
 
@@ -521 +524 @@
         rtl8169_reset(rtl8169);
 
+        /* Allocate buffers */
+        rtl8169_allocate_buffers(rtl8169);
+
+        /* Write address of descriptor as start of TX ring */
+        pio_write_32(rtl8169->regs + TNPDS, rtl8169->tx_ring_phys & 0xffffffff);
+        pio_write_32(rtl8169->regs + TNPDS + 4, (rtl8169->tx_ring_phys >> 32) & 0xffffffff);
+        rtl8169->tx_head = 0;
+        rtl8169->tx_tail = 0;
+        rtl8169->tx_ring[15].control = CONTROL_EOR;
+
         /* Enable TX and RX */
         uint8_t cr = pio_read_8(rtl8169->regs + CR);
@@ -594 +607 @@
 }
 
-
+static void rtl8169_transmit_done(ddf_dev_t *dev)
+{
+        unsigned int tail, head;
+        nic_t *nic_data = nic_get_from_ddf_dev(dev);
+        rtl8169_t *rtl8169 = nic_get_specific(nic_data);
+        rtl8169_descr_t *descr;
+
+        ddf_msg(LVL_NOTE, "rtl8169_transmit_done()");
+
+        fibril_mutex_lock(&rtl8169->tx_lock);
+
+        head = rtl8169->tx_head;
+        tail = rtl8169->tx_tail;
+
+        while (tail != head) {
+                descr = &rtl8169->tx_ring[tail];
+                tail = (tail + 1) % TX_BUFFERS_COUNT;
+
+                ddf_msg(LVL_NOTE, "TX status for descr %d: 0x%08x", tail, descr->control);
+        }
+
+        rtl8169->tx_tail = tail;
+
+        fibril_mutex_unlock(&rtl8169->tx_lock);
+}
 
 static void rtl8169_irq_handler(ddf_dev_t *dev, ipc_callid_t iid,
@@ -601 +638 @@
         assert(dev);
         assert(icall);
-
-        ddf_msg(LVL_NOTE, "rtl8169_irq_handler()");
 
         uint16_t isr = (uint16_t) IPC_GET_ARG2(*icall);
@@ -608 +643 @@
         rtl8169_t *rtl8169 = nic_get_specific(nic_data);
 
+        //ddf_msg(LVL_NOTE, "rtl8169_irq_handler(): isr=0x%04x", isr);
+
         /* Packet underrun or link change */
         if (isr & INT_PUN)
-                rtl8169_link_change(dev);       
-
+                rtl8169_link_change(dev);
+
+        /* Frame(s) successfully transmitted */
+        if (isr & INT_TOK)
+                rtl8169_transmit_done(dev);
+
+        /* Transmit error */
+        if (isr & INT_TER)
+                rtl8169_transmit_done(dev);
+
+        if (isr & INT_SERR)
+                ddf_msg(LVL_ERROR, "System error interrupt");
+
+        if (isr & INT_TDU)
+                ddf_msg(LVL_ERROR, "Transmit descriptor unavailable");
+
+        if (isr & INT_RER)
+                ddf_msg(LVL_NOTE, "RX error interrupt");
+
+        if (isr & INT_ROK)
+                ddf_msg(LVL_NOTE, "RX OK interrupt");
+
+        pio_write_16(rtl8169->regs + ISR, 0xffff);
         pio_write_16(rtl8169->regs + IMR, 0xffff);
 }
@@ -617 +675 @@
 static void rtl8169_send_frame(nic_t *nic_data, void *data, size_t size)
 {
-
+        rtl8169_descr_t *descr, *prev;
+        unsigned int head, tail;
+        void *buff;
+        uintptr_t buff_phys;
+        rtl8169_t *rtl8169 = nic_get_specific(nic_data);
+
+        if (size > RTL8169_FRAME_MAX_LENGTH) {
+                ddf_msg(LVL_ERROR, "Send frame: frame too long, %zu bytes",
+                    size);
+                nic_report_send_error(nic_data, NIC_SEC_OTHER, 1);
+        }
+
+        fibril_mutex_lock(&rtl8169->tx_lock);
+
+        ddf_msg(LVL_NOTE, "send_frame()");
+        ddf_msg(LVL_NOTE, "tx ring virtual at %p", rtl8169->tx_ring);
+        ddf_msg(LVL_NOTE, "tx ring physical at 0x%08lx", rtl8169->tx_ring_phys);
+        ddf_msg(LVL_NOTE, "tx_head=%d tx_tail=%d", rtl8169->tx_head, rtl8169->tx_tail);
+
+        head = rtl8169->tx_head;
+        tail = rtl8169->tx_tail;
+
+        if ((tail + 1) % TX_BUFFERS_COUNT == head) {
+                /* Queue is full */
+                nic_set_tx_busy(nic_data, 1);
+        }
+
+        /* Calculate address of next free buffer and descriptor */
+        buff = rtl8169->tx_buff + (BUFFER_SIZE * head);
+        buff_phys = rtl8169->tx_buff_phys + (BUFFER_SIZE * head);
+
+        /* Copy frame */
+        memcpy(buff, data, size);
+
+        /* Setup descriptor */
+        descr = &rtl8169->tx_ring[head];
+        prev = &rtl8169->tx_ring[(head - 1) % TX_BUFFERS_COUNT];
+
+        ddf_msg(LVL_NOTE, "current_descr=%p, prev_descr=%p", descr, prev);
+
+        descr->control = CONTROL_OWN | CONTROL_FS | CONTROL_LS;
+        descr->control |= size & 0xffff;
+        descr->vlan = 0;
+        descr->buf_low = buff_phys & 0xffffffff;
+        descr->buf_high = (buff_phys >> 32) & 0xffffffff;
+        rtl8169->tx_head = (head + 1) % TX_BUFFERS_COUNT;
+
+        /* Lift EOR flag from previous descriptor */
+        prev->control &= ~CONTROL_EOR;
+
+        write_barrier();
+
+        /* Notify NIC of pending packets */
+        pio_write_8(rtl8169->regs + TPPOLL, TPPOLL_NPQ);
+
+        fibril_mutex_unlock(&rtl8169->tx_lock);
 }