]> Zhao Yanbai Git Server - minix.git/commitdiff
VT6105: Restructure the code and correct function order in initialization 92/3392/1
authorJia-Ju Bai <baijiaju1990@163.com>
Sun, 15 Jan 2017 03:31:13 +0000 (03:31 +0000)
committerDavid van Moolenbroek <david@minix3.org>
Thu, 26 Jan 2017 11:50:48 +0000 (12:50 +0100)
Change-Id: Ibbc8f835174349501e74dde7163c234effb34bc8

minix/drivers/net/vt6105/README
minix/drivers/net/vt6105/io.h
minix/drivers/net/vt6105/vt6105.c
minix/drivers/net/vt6105/vt6105.h

index 93dc8063f4a52d49f7ad89229f6347daa529f225..c19f4919f8d3ee29b4fab900828a6ca244d17858 100644 (file)
@@ -10,9 +10,11 @@ Revision 1.1 2016/11/12
 Modification: Remove and rewrite Linux-derived code
 Authored by Jia-Ju Bai <baijiaju1990@163.com>
 
+Revision 1.2 2017/1/12
+Modification: Restructure the code and correct function order in initialization
+Authored by Jia-Ju Bai <baijiaju1990@163.com>
+
 Something can be improved:
-1. MII, WOL functions are not adequately defined and used.
-2. Link status report does not work well.
-3. Ethernet address can not be modified at present.
-4. Programming PHY registers and EEPROM are not adequately used.
-5. Dump interfaces are not provided.
+1. Link status report is not detailed.
+2. Ethernet address can not be modified at present.
+3. Dump interfaces are not provided.
index 90f9901a62cd4404d50e929fa4af7f0ec999754c..f313bd87e38f0bbba49c8f92ca3ac40d4b0d1327 100644 (file)
@@ -9,76 +9,76 @@
 static u8_t my_inb(u32_t port) {
        u32_t value;
        int r;
-#ifdef DMA_REG_MODE
-       value = *(u8_t *)(port);
+#ifdef DMA_BASE_IOMAP
+       value = *(volatile u8_t *)(port);
 #else
        if ((r = sys_inb(port, &value)) != OK)
-               printf("vt6105: sys_inb failed: %d\n", r);
+               printf("NDR: sys_inb failed: %d\n", r);
 #endif
        return (u8_t)value;
 }
-#define vt_in8(port, offset) (my_inb((port) + (offset)))
+#define ndr_in8(port, offset) (my_inb((port) + (offset)))
 
 static u16_t my_inw(u32_t port) {
        u32_t value;
        int r;
-#ifdef DMA_REG_MODE
-       value = *(u16_t *)(port);
+#ifdef DMA_BASE_IOMAP
+       value = *(volatile u16_t *)(port);
 #else
        if ((r = sys_inw(port, &value)) != OK)
-               printf("vt6105: sys_inw failed: %d\n", r);
+               printf("NDR: sys_inw failed: %d\n", r);
 #endif
        return (u16_t)value;
 }
-#define vt_in16(port, offset) (my_inw((port) + (offset)))
+#define ndr_in16(port, offset) (my_inw((port) + (offset)))
 
 static u32_t my_inl(u32_t port) {
        u32_t value;
        int r;
-#ifdef DMA_REG_MODE
-       value = *(u32_t *)(port);
+#ifdef DMA_BASE_IOMAP
+       value = *(volatile u32_t *)(port);
 #else
        if ((r = sys_inl(port, &value)) != OK)
-               printf("vt6105: sys_inl failed: %d\n", r);
+               printf("NDR: sys_inl failed: %d\n", r);
 #endif
        return value;
 }
-#define vt_in32(port, offset) (my_inl((port) + (offset)))
+#define ndr_in32(port, offset) (my_inl((port) + (offset)))
 
-static void my_outb(u32_t port, u8_t value) {
+static void my_outb(u32_t port, u32_t value) {
        int r;
-#ifdef DMA_REG_MODE
-       *(u8_t *)(port) = value;
+#ifdef DMA_BASE_IOMAP
+       *(volatile u8_t *)(port) = value;
 #else
-       if ((r = sys_outb(port, value)) != OK)
-               printf("vt6105: sys_outb failed: %d\n", r);
+       if ((r = sys_outb(port, (u8_t)value)) != OK)
+               printf("NDR: sys_outb failed: %d\n", r);
 #endif
 }
-#define vt_out8(port, offset, value) \
+#define ndr_out8(port, offset, value) \
                                (my_outb(((port) + (offset)), (value)))
 
-static void my_outw(u32_t port, u16_t value) {
+static void my_outw(u32_t port, u32_t value) {
        int r;
-#ifdef DMA_REG_MODE
-       *(u16_t *)(port) = value;
+#ifdef DMA_BASE_IOMAP
+       *(volatile u16_t *)(port) = value;
 #else
-       if ((r = sys_outw(port, value)) != OK)
-               printf("vt6105: sys_outw failed: %d\n", r);
+       if ((r = sys_outw(port, (u16_t)value)) != OK)
+               printf("NDR: sys_outw failed: %d\n", r);
 #endif
 }
-#define vt_out16(port, offset, value) \
+#define ndr_out16(port, offset, value) \
                                (my_outw(((port) + (offset)), (value)))
 
-static void my_outl(u16_t port, u32_t value) {
+static void my_outl(u32_t port, u32_t value) {
        int r;
-#ifdef DMA_REG_MODE
-       *(u32_t *)(port) = value;
+#ifdef DMA_BASE_IOMAP
+       *(volatile u32_t *)(port) = value;
 #else
        if ((r = sys_outl(port, value)) != OK)
-               printf("vt6105: sys_outl failed: %d\n", r);
+               printf("NDR: sys_outl failed: %d\n", r);
 #endif
 }
-#define vt_out32(port, offset, value) \
+#define ndr_out32(port, offset, value) \
                                (my_outl(((port) + (offset)), (value)))
 
 #endif
index b0baee8ffdc3e197d5e0623804f5499f4a7318e9..92b89d0cf095e6a37444dfc5c5a7f3956be49f08 100644 (file)
 #include <minix/drivers.h>
 #include <minix/netdriver.h>
 #include <machine/pci.h>
+#include <sys/mman.h>
 #include "vt6105.h"
 #include "io.h"
 
 /* global value */
-static vt_driver g_driver;
+static NDR_driver g_driver;
 static int g_instance;
 
 /* driver interface */
-static int vt_init(unsigned int instance, ether_addr_t *addr);
-static void vt_stop(void);
-static void vt_mode(unsigned int mode);
-static ssize_t vt_recv(struct netdriver_data *data, size_t max);
-static int vt_send(struct netdriver_data *data, size_t size);
-static void vt_intr(unsigned int mask);
-static void vt_stat(eth_stat_t *stat);
+static int NDR_init(unsigned int instance, ether_addr_t *addr);
+static void NDR_stop(void);
+static void NDR_mode(unsigned int mode);
+static ssize_t NDR_recv(struct netdriver_data *data, size_t max);
+static int NDR_send(struct netdriver_data *data, size_t size);
+static void NDR_intr(unsigned int mask);
+static void NDR_stat(eth_stat_t *stat);
 
 /* internal function */
-static int vt_probe(vt_driver *pdev, int instance);
-static int vt_init_buf(vt_driver *pdev);
-static int vt_init_hw(vt_driver *pdev, ether_addr_t *addr);
-static int vt_reset_hw(vt_driver *pdev);
-static void vt_conf_addr(vt_driver *pdev, ether_addr_t *addr);
-static void vt_handler(vt_driver *pdev);
-static void vt_check_ints(vt_driver *pdev);
+static int dev_probe(NDR_driver *pdev, int instance);
+static int dev_init_buf(NDR_driver *pdev);
+static int dev_init_hw(NDR_driver *pdev, ether_addr_t *addr);
+static int dev_reset_hw(NDR_driver *pdev);
+static void dev_conf_addr(NDR_driver *pdev, ether_addr_t *addr);
+static void dev_handler(NDR_driver *pdev);
+static void dev_check_ints(NDR_driver *pdev);
 
 /* developer interface */
-static void vt_init_rx_desc(vt_desc *desc, size_t size, phys_bytes dma);
-static void vt_init_tx_desc(vt_desc *desc, size_t size, phys_bytes dma);
-static int vt_real_reset(u32_t base);
-static int vt_init_power(u32_t base);
-static int vt_init_mii(u32_t base);
-static int vt_init_io(u32_t base);
-static void vt_start_rx_tx(u32_t base);
-static void vt_get_addr(u32_t base, u8_t *pa);
-static int vt_check_link(u32_t base);
-static void vt_stop_rx_tx(u32_t base);
-static int vt_rx_status_ok(vt_desc *desc);
-static int vt_get_rx_len(vt_desc *desc);
-static void vt_tx_desc_start(vt_desc *desc, size_t size);
-static void vt_wakeup_tx(u32_t base);
-static int vt_tx_status_ok(vt_desc *desc);
-
-/* ======= Developer-defined function ======= */
-/* Intialize Rx descriptor (### RX_DESC_INIT ###) */
-static void vt_init_rx_desc(vt_desc *desc, size_t size, phys_bytes dma) {
-       desc->status = DESC_OWN | ((size << 16) & DESC_RX_LENMASK);
-       desc->addr = dma;
-       desc->length = size;
-}
-
-/* Intialize Tx descriptor (### TX_DESC_INIT ###) */
-static void vt_init_tx_desc(vt_desc *desc, size_t size, phys_bytes dma) {
-       desc->addr = dma;
-       desc->length = size;
-}
-
+static int dev_real_reset(u32_t *base);
+static int dev_init_io(u32_t *base);
+static int dev_init_mii(u32_t *base);
+static void dev_intr_control(u32_t *base, int flag);
+static void dev_rx_tx_control(u32_t *base, int flag);
+static void dev_get_addr(u32_t *base, u8_t *pa);
+static int dev_check_link(u32_t *base);
+static void dev_set_rec_mode(u32_t *base, int mode);
+static void dev_start_tx(u32_t *base);
+static u32_t dev_read_clear_intr_status(u32_t *base);
+static void dev_init_rx_desc(NDR_desc *desc_start, int index, size_t buf_size,
+                       phys_bytes buf_dma, int max_desc_num, phys_bytes desc_dma_start);
+static void dev_init_tx_desc(NDR_desc *desc_start, int index, size_t buf_size,
+                       phys_bytes buf_dma, int max_desc_num, phys_bytes desc_dma_start);
+static void dev_set_desc_reg(u32_t *base, phys_bytes rx_addr,
+                                                               phys_bytes tx_addr);
+static int dev_rx_ok_desc(u32_t *base, NDR_desc *desc, int index);
+static int dev_rx_len_desc(u32_t *base, NDR_desc *desc, int index);
+static void dev_set_rx_desc_done(u32_t *base, NDR_desc *desc, int index);
+static void dev_set_tx_desc_prepare(u32_t *base, NDR_desc *desc, int index,
+                                                                               size_t data_size);
+static int dev_tx_ok_desc(u32_t *base, NDR_desc *desc, int index);
+static void dev_set_tx_desc_done(u32_t *base, NDR_desc *desc, int index);
+
+/* ======= Developer implemented function ======= */
+/* ====== Self-defined function ======*/
+
+/* ====== Developer interface ======*/
 /* Real hardware reset (### RESET_HARDWARE_CAN_FAIL ###)
  * -- Return OK means success, Others means failure */
-static int vt_real_reset(u32_t base) {
-       vt_out16(base, REG_CR, CMD_RESET);
-       micro_delay(10000);
-       if (vt_in16(base, REG_CR) & CMD_RESET) {
-               vt_out8(base, REG_MCR1, 0x40);
-               micro_delay(10000);
-               if (vt_in16(base, REG_CR) & CMD_RESET)
+static int dev_real_reset(u32_t *base) {
+       u32_t base0 = base[0];
+       ndr_out16(base0, REG_CR, CMD_RESET);
+       micro_delay(5000);
+       if (ndr_in16(base0, REG_CR) & CMD_RESET) {
+               ndr_out8(base0, REG_MCR, 0x40);
+               micro_delay(5000);
+               if (ndr_in16(base0, REG_CR) & CMD_RESET)
                        return -EIO;
        }
        return OK;
 }
 
-/* Intialize power (### POWER_INIT_CAN_FAIL ###)
+/* Intialize other hardware I/O registers (### INIT_HARDWARE_IO_CAN_FAIL ###)
  * -- Return OK means success, Others means failure */
-static int vt_init_power(u32_t base) {
+static int dev_init_io(u32_t *base) {
+       u32_t base0 = base[0];
        u8_t stick;
-       stick = vt_in8(base, REG_STICK);
-       vt_out8(base, REG_STICK, stick & 0xfc);
+       stick = ndr_in8(base0, REG_STICK);
+       ndr_out8(base0, REG_STICK, stick & 0xfc);
+       ndr_out16(base0, REG_BCR, 0x0006);
+       ndr_out8(base0, REG_TCR, 0x20);
+       ndr_out8(base0, REG_RCR, 0x78);
        return OK;
 }
 
 /* Intialize MII interface (### MII_INIT_CAN_FAIL ###)
- * -- Return OK means success, Others means failure */
-static int vt_init_mii(u32_t base) {
+  -- Return OK means success, Others means failure */
+static int dev_init_mii(u32_t *base) {
+       u32_t base0 = base[0];
+       ndr_out8(base0, REG_MII_CR, 0);
+       ndr_out8(base0, REG_MII_REG, 0x01);
+       ndr_out8(base0, REG_MII_CR, 0x80);
+       micro_delay(5000);
+       if (!(ndr_in8(base0, REG_MII_REG) & 0x20)) {
+               printf("NDR: Fail to monitor linkage\n");
+               return -EIO;
+       }
+       ndr_out8(base0, REG_MII_REG, 0x41);
        return OK;
 }
 
-/* Intialize other hardware I/O registers (### INIT_HARDWARE_IO_CAN_FAIL ###)
- * -- Return OK means success, Others means failure */
-static int vt_init_io(u32_t base) {
-       vt_out16(base, REG_BCR0, 0x0006);
-       vt_out8(base, REG_TCR, 0x20);
-       vt_out8(base, REG_RCR, 0x78);
-       return OK;
+/* Enable or disable interrupt (### INTR_ENABLE_DISABLE ###) */
+static void dev_intr_control(u32_t *base, int flag) {
+       u32_t data, base0 = base[0];
+       data = ndr_in16(base0, REG_IMR);
+       if (flag == INTR_ENABLE)
+               ndr_out16(base0, REG_IMR, data | CMD_INTR_ENABLE);
+       else if (flag == INTR_DISABLE)
+               ndr_out16(base0, REG_IMR, data & ~CMD_INTR_ENABLE);
 }
 
-/* Start Rx/Tx (### START_RX_TX ###) */
-static void vt_start_rx_tx(u32_t base) {
-       u16_t cmd = CMD_START | CMD_RX_ON | CMD_TX_ON | CMD_NO_POLL | CMD_FDUPLEX;
-       vt_out16(base, REG_CR, cmd);
-       micro_delay(1000);
+/* Enable or disable Rx/Tx (### RX_TX_ENABLE_DISABLE ###) */
+static void dev_rx_tx_control(u32_t *base, int flag) {
+       u32_t data, base0 = base[0];
+       if (flag == RX_TX_ENABLE) {
+               data = CMD_START | CMD_RX_ON | CMD_TX_ON | CMD_NO_POLL | CMD_FDUPLEX;
+               ndr_out16(base0, REG_CR, data);
+       }
+       else if (flag == RX_TX_DISABLE) {
+               ndr_out16(base0, REG_CR, CMD_STOP);
+       }
 }
 
 /* Get MAC address to the array 'pa' (### GET_MAC_ADDR ###) */
-static void vt_get_addr(u32_t base, u8_t *pa) {
-       int i;
+static void dev_get_addr(u32_t *base, u8_t *pa) {
+       u32_t i, base0 = base[0];
        for (i = 0; i < 6; i++)
-               pa[i] = vt_in8(base, REG_ADDR + i);
+               pa[i] = ndr_in8(base0, REG_ADDR + i);
 }
 
 /* Check link status (### CHECK_LINK ###)
  * -- Return LINK_UP or LINK_DOWN */
-static int vt_check_link(u32_t base) {
-       u32_t r;
-       vt_out8(base, REG_MII_CFG, 0x01);
-       vt_out8(base, REG_MII_ADDR, 0x01);
-       vt_out8(base, REG_MII_CR, 0x40);
-       micro_delay(10000);
-       r = vt_in16(base, REG_MII_DATA);
-       if (r & 0x0004)
+static int dev_check_link(u32_t *base) {
+       u32_t data, base0 = base[0];
+       ndr_out8(base0, REG_MII_PHY, 0x01);
+       ndr_out8(base0, REG_MII_REG, 0x01);
+       ndr_out8(base0, REG_MII_CR, 0x40);
+       micro_delay(5000);
+       if (ndr_in8(base0, REG_MII_CR) & 0x40)
+               printf("NDR: Fail to get linkage\n");
+       data = ndr_in16(base0, REG_MII_DATA);
+       if (data & LINK_STATUS)
                return LINK_UP;
        return LINK_DOWN;
 }
 
-/* Stop Rx/Tx (### STOP_RX_TX ###) */
-static void vt_stop_rx_tx(u32_t base) {
-       vt_out16(base, REG_CR, CMD_STOP);
+/* Set driver receive mode (### SET_REC_MODE ###) */
+static void dev_set_rec_mode(u32_t *base, int mode) {
+       u32_t data, base0 = base[0];
+       data = ndr_in8(base0, REG_RCR);
+       data &= ~(CMD_RCR_UNICAST | CMD_RCR_MULTICAST | CMD_RCR_BROADCAST);
+       if (mode & NDEV_PROMISC)
+               data |= CMD_RCR_UNICAST | CMD_RCR_BROADCAST | CMD_RCR_MULTICAST;
+       if (mode & NDEV_BROAD)
+               data |= CMD_RCR_BROADCAST;
+       if (mode & NDEV_MULTI)
+               data |= CMD_RCR_MULTICAST;
+       data |= CMD_RCR_UNICAST;
+       ndr_out8(base0, REG_RCR, data);
+}
+
+/* Start Tx channel (### START_TX_CHANNEL ###) */
+static void dev_start_tx(u32_t *base) {
+       u32_t data, base0 = base[0];
+       data = ndr_in8(base0, REG_CR);
+       ndr_out8(base0, REG_CR, data | CMD_TX_DEMAND);
+}
+
+/* Read and clear interrupt (### READ_CLEAR_INTR_STS ###) */
+static u32_t dev_read_clear_intr_status(u32_t *base) {
+       u32_t data, base0 = base[0];
+       data = ndr_in16(base0, REG_ISR);
+       ndr_out16(base0, REG_ISR, data & INTR_STS_CLEAR);
+       return data;
+}
+
+/* ---------- WITH DESCRIPTOR ---------- */
+/* Intialize Rx descriptor (### INIT_RX_DESC ###) */
+static void dev_init_rx_desc(NDR_desc *desc_start, int index, size_t buf_size,
+                       phys_bytes buf_dma, int max_desc_num, phys_bytes desc_dma_start) {
+       NDR_desc *desc = desc_start + index;
+       desc->status = DESC_OWN | ((buf_size << 16) & DESC_RX_LENMASK);
+       desc->addr = buf_dma;
+       desc->length = buf_size;
+       if (index == max_desc_num - 1)
+               desc->next = desc_dma_start;
+       else
+               desc->next = desc_dma_start + (index + 1) * sizeof(NDR_desc);
+}
+
+/* Intialize Tx descriptor (### INIT_TX_DESC ###) */
+static void dev_init_tx_desc(NDR_desc *desc_start, int index, size_t buf_size,
+                       phys_bytes buf_dma, int max_desc_num, phys_bytes desc_dma_start) {
+       NDR_desc *desc = desc_start + index;
+       desc->addr = buf_dma;
+       desc->length = buf_size;
+       if (index == max_desc_num - 1)
+               desc->next = desc_dma_start;
+       else
+               desc->next = desc_dma_start + (index + 1) * sizeof(NDR_desc);
 }
 
-/* Check whether Rx status OK (### CHECK_RX_STATUS_OK ###)
- * -- Return TRUE or FALSE */
-static int vt_rx_status_ok(vt_desc *desc) {
+/* Set Rx/Tx descriptor address into device register (### SET_DESC_REG ###) */
+static void dev_set_desc_reg(u32_t *base, phys_bytes rx_addr,
+                                                               phys_bytes tx_addr) {
+       u32_t base0 = base[0];
+       ndr_out32(base0, REG_RX_DESC_BASE, rx_addr);
+       ndr_out32(base0, REG_TX_DESC_BASE, tx_addr);
+}
+
+/* Check whether Rx is OK from Rx descriptor (### CHECK_RX_OK_FROM_DESC ###)
+ * -- Current buffer number is index
+ * -- Return RX_OK or RX_SUSPEND or RX_ERROR */
+static int dev_rx_ok_desc(u32_t *base, NDR_desc *desc, int index) {
        if (!(desc->status & DESC_OWN)) {
+               if (desc->status & DESC_RX_ERROR)
+                       return RX_ERROR;
                if ((desc->status & DESC_RX_NORMAL) == DESC_RX_NORMAL)
-                       return TRUE;
+                       return RX_OK;
        }
-       return FALSE;
+       return RX_SUSPEND;
 }
 
-/* Get Rx data length from descriptor (### GET_RX_LEN ###)
- * --- Return the length */
-static int vt_get_rx_len(vt_desc *desc) {
-       int len;
-       len = ((desc->status & DESC_RX_LENMASK) >> 16) - ETH_CRC_SIZE;
+/* Get length from Rx descriptor (### GET_RX_LENGTH_FROM_DESC ###)
+ * -- Current buffer number is index
+ * -- Return the length */
+static int dev_rx_len_desc(u32_t *base, NDR_desc *desc, int index) {
+       int len = ((desc->status & DESC_RX_LENMASK) >> 16) - ETH_CRC_SIZE;
        return len;
 }
 
-/* Set Tx descriptor in send (### TX_DESC_START ###) */
-static void vt_tx_desc_start(vt_desc *desc, size_t size) {
+/* Set Rx descriptor after Rx done (### SET_RX_DESC_DONE ###)
+ * -- Current buffer number is index */
+static void dev_set_rx_desc_done(u32_t *base, NDR_desc *desc, int index) {
+       desc->status = DESC_OWN;
+}
+
+/* Set Tx descriptor to prepare transmitting (### SET_TX_DESC_PREPARE)
+ * -- Current buffer number is index */
+static void dev_set_tx_desc_prepare(u32_t *base, NDR_desc *desc, int index,
+                                                               size_t data_size) {
        desc->status = DESC_OWN | DESC_FIRST | DESC_LAST;
-       desc->length = 0x00e08000 | (size > 60 ? size : 60);
+       desc->length = 0x00e08000 | (data_size > 60 ? data_size : 60);
 }
 
-/* Wake up Tx channel (### WAKE_UP_TX ###) */
-static void vt_wakeup_tx(u32_t base) {
-       u8_t cmd;
-       cmd = vt_in8(base, REG_CR);
-       cmd |= CMD_TX_DEMAND;
-       vt_out8(base, REG_CR, cmd);
+/* Check whether Tx is OK from Tx descriptor (### CHECK_TX_OK_FROM_DESC ###)
+ * -- Current buffer number is index
+ * -- Return TX_OK or TX_SUSPEND or TX_ERROR */
+static int dev_tx_ok_desc(u32_t *base, NDR_desc *desc, int index) {
+       if (!(desc->status & DESC_OWN)) {
+               if (desc->status & DESC_TX_ERROR)
+                       return TX_ERROR;
+               return TX_OK;
+       }
+       return TX_SUSPEND;
 }
 
-/* Check whether Tx status OK (### CHECK_TX_STATUS_OK ###)
- * -- Return TRUE or FALSE */
-static int vt_tx_status_ok(vt_desc *desc) {
-       if (!(desc->status & DESC_OWN))
-               return TRUE;
-       return FALSE;
+/* Set Tx descriptor after Tx done (### SET_TX_DESC_DONE ###)
+ * -- Current buffer number is index */
+static void dev_set_tx_desc_done(u32_t *base, NDR_desc *desc, int index) {
+       desc->status = 0;
 }
 
 /* Driver interface table */
-static const struct netdriver vt_table = {
-       .ndr_init = vt_init,
-       .ndr_stop = vt_stop,
-       .ndr_mode = vt_mode,
-       .ndr_recv = vt_recv,
-       .ndr_send = vt_send,
-       .ndr_stat = vt_stat,
-       .ndr_intr = vt_intr,
+static const struct netdriver NDR_table = {
+       .ndr_init = NDR_init,
+       .ndr_stop = NDR_stop,
+       .ndr_mode = NDR_mode,
+       .ndr_recv = NDR_recv,
+       .ndr_send = NDR_send,
+       .ndr_intr = NDR_intr,
+       .ndr_stat = NDR_stat
 };
 
 int main(int argc, char *argv[]) {
        env_setargs(argc, argv);
-       netdriver_task(&vt_table);
+       netdriver_task(&NDR_table);
 }
 
 /* Initialize the driver */
-static int vt_init(unsigned int instance, ether_addr_t *addr) {
-       int ret = 0;
+static int NDR_init(unsigned int instance, ether_addr_t *addr) {
+       int i, ret = 0;
 
        /* Intialize driver data structure */
        memset(&g_driver, 0, sizeof(g_driver));
        g_driver.link = LINK_UNKNOWN;
-       strcpy(g_driver.name, "netdriver#0");
-       g_driver.name[10] += instance;
+       strcpy(g_driver.name, DRIVER_NAME);
+       strcat(g_driver.name, "#0");
+       g_driver.name[strlen(g_driver.name) - 1] += instance;
        g_instance = instance;
 
        /* Probe the device */
-       if (vt_probe(&g_driver, instance)) {
-               printf("vt6105: Device is not found\n");
+       if (dev_probe(&g_driver, instance)) {
+               printf("NDR: Device is not found\n");
                ret = -ENODEV;
                goto err_probe;
        }
 
+       /* Intialize hardware */
+       if (dev_init_hw(&g_driver, addr)) {
+               printf("NDR: Fail to initialize hardware\n");
+               ret = -EIO;
+               goto err_init_hw;
+       }
+
        /* Allocate and initialize buffer */
-       if (vt_init_buf(&g_driver)) {
-               printf("vt6105: Fail to initialize buffer\n");
+       if (dev_init_buf(&g_driver)) {
+               printf("NDR: Fail to initialize buffer\n");
                ret = -ENODEV;
                goto err_init_buf;
        }
 
-       /* Intialize hardware */
-       if (vt_init_hw(&g_driver, addr)) {
-               printf("vt6105: Fail to initialize hardware\n");
-               ret = -EIO;
-               goto err_init_hw;
-       }
+       /* Enable interrupts */
+       /* ### INTR_ENABLE_DISABLE ### */
+       dev_intr_control(g_driver.base, INTR_ENABLE);
+
+       /* Start Rx and Tx */
+       /* ### RX_TX_ENABLE_DISABLE ### */
+       dev_rx_tx_control(g_driver.base, RX_TX_ENABLE);
 
        /* Use a synchronous alarm instead of a watchdog timer */
        sys_setalarm(sys_hz(), 0);
@@ -225,208 +328,240 @@ static int vt_init(unsigned int instance, ether_addr_t *addr) {
 
        return 0;
 
-err_init_hw:
-       free_contig(g_driver.buf, g_driver.buf_size);
 err_init_buf:
+err_init_hw:
 err_probe:
        return ret;
 }
 
-/* Match the device and get base address */
-static int vt_probe(vt_driver *pdev, int instance) {
-       int devind, ioflag;
-       u16_t cr, vid, did;
-       u32_t bar, size;
-       u8_t irq, rev;
-       u8_t *reg;
+/* Stop the driver */
+static void NDR_stop(void) {
+       /* Free Rx and Tx buffer*/
+       free_contig(g_driver.buf, g_driver.buf_size);
 
-       /* Find pci device */
-       pci_init();
-       if (!pci_first_dev(&devind, &vid, &did))
-               return -EIO;
-       while (instance--) {
-               if (!pci_next_dev(&devind, &vid, &did))
-                       return -EIO;
-       }
-       pci_reserve(devind);
+       /* Stop interrupt */
+       /* ### INTR_ENABLE_DISABLE ### */
+       dev_intr_control(g_driver.base, INTR_DISABLE);
 
-       /* Enable bus mastering */
-       cr = pci_attr_r16(devind, PCI_CR);
-       if (!(cr & PCI_CR_MAST_EN))
-               pci_attr_w16(devind, PCI_CR, cr | PCI_CR_MAST_EN);
+       /* Stop Rx and Tx */
+       /* ### RX_TX_ENABLE_DISABLE ### */
+       dev_rx_tx_control(g_driver.base, RX_TX_DISABLE);
+}
 
-       /* Get base address */
-#ifdef DMA_REG_MODE
-       if (pci_get_bar(devind, PCI_BAR, &base, &size, &ioflag)) {
-               printf("vt6105: Fail to get PCI BAR\n");
-               return -EIO;
-       }
-       if (ioflag) {
-               printf("vt6105: PCI BAR is not for memory\n");
-               return -EIO;
-       }
-       if ((reg = vm_map_phys(SELF, (void *)base, size)) == MAP_FAILED) {
-               printf("vt6105: Fail to map hardware registers from PCI\n");
-               return -EIO;
-       }
-       pdev->base_addr = (u32_t)reg;
-#else
-       bar = pci_attr_r32(devind, PCI_BAR) & 0xffffffe0;
-       if (bar < 0x400) {
-               printf("vt6105: Base address is not properly configured\n");
-               return -EIO;
+/* Set driver mode */
+static void NDR_mode(unsigned int mode) {
+       g_driver.mode = mode;
+       /* Set driver receive mode */
+       /* ### SET_REC_MODE ### */
+       dev_set_rec_mode(g_driver.base, mode);
+}
+
+/* Receive data */
+static ssize_t NDR_recv(struct netdriver_data *data, size_t max) {
+       NDR_driver *pdev = &g_driver;
+       u32_t totlen, packlen;
+       int index, ret, offset = 0;
+       NDR_desc *desc;
+
+       index = pdev->rx_head;
+       desc = pdev->rx_desc;
+       desc += index;
+       /* Check whether Rx is OK from Rx descriptor */
+       /* ### CHECK_RX_OK_FROM_DESC ### */
+       ret = dev_rx_ok_desc(pdev->base, desc, index);
+       if (ret == RX_SUSPEND)
+               return SUSPEND;
+       else if (ret == RX_ERROR)
+               printf("NDR: Rx error now\n");
+       /* Get length from Rx descriptor */
+       /* ### GET_RX_LENGTH_FROM_DESC ### */
+       totlen = dev_rx_len_desc(pdev->base, desc, index);
+
+       /* Get data length */
+       /* ### Get , int inde, int indexxRx data length ### */
+       if (totlen < 8 || totlen > 2 * ETH_MAX_PACK_SIZE) {
+               printf("NDR: Bad data length: %d\n", totlen);
+               panic(NULL);
        }
-       pdev->base_addr = bar;
-#endif
 
-       /* Get irq number */
-       irq = pci_attr_r8(devind, PCI_ILR);
-       pdev->irq = irq;
+       packlen = totlen;
+       if (packlen > max)
+               packlen = max;
 
-       /* Get revision ID */
-       rev = pci_attr_r8(devind, PCI_REV);
-       pdev->revision = rev;
+       /* Copy data to user */
+       netdriver_copyout(data, 0, pdev->rx[index].buf + offset, packlen);
+       pdev->stat.ets_packetR++;
+
+       /* Set Rx descriptor after Rx done */
+       /* ### SET_RX_DESC_DONE ### */
+       dev_set_rx_desc_done(pdev->base, desc, index);
+       if (index == RX_BUFFER_NUM - 1)
+               index = 0;
+       else
+               index++;
+       pdev->rx_head = index;
 
 #ifdef MY_DEBUG
-       printf("vt6105: Base address is 0x%08x\n", pdev->base_addr);
-       printf("vt6105: IRQ number is 0x%02x\n", pdev->irq);
-       printf("vt6105: Revision ID is 0x%02x\n", pdev->revision);
+       printf("NDR: Successfully receive a packet, length = %d\n", packlen);
 #endif
 
-       return 0;
+       return packlen;
 }
 
-/* Allocate and initialize buffer */
-static int vt_init_buf(vt_driver *pdev) {
-       size_t rx_desc_size, tx_desc_size, rx_buf_size, tx_buf_size, tot_buf_size;
-       vt_desc *desc;
-       phys_bytes buf_dma, next;
-       char *buf;
-       int i;
+/* Transmit data */
+static int NDR_send(struct netdriver_data *data, size_t size) {
+       NDR_driver *pdev = &g_driver;
+       int tx_head, i;
+       NDR_desc *desc;
 
-       /* Build Rx and Tx descriptor buffer */
-       rx_desc_size = RX_DESC_NUM * sizeof(vt_desc);
-       tx_desc_size = TX_DESC_NUM * sizeof(vt_desc);
+       tx_head = pdev->tx_head;
+       if (pdev->tx[tx_head].busy)
+               return SUSPEND;
 
-       /* Allocate Rx and Tx buffer */
-       tx_buf_size = TX_BUF_SIZE;
-       if (tx_buf_size % 4)
-               tx_buf_size += 4 - (tx_buf_size % 4);
-       rx_buf_size = RX_BUF_SIZE;
-       tot_buf_size = rx_desc_size + tx_desc_size;
-       tot_buf_size += TX_DESC_NUM * tx_buf_size + RX_DESC_NUM * rx_buf_size;
-       if (tot_buf_size % 4096)
-               tot_buf_size += 4096 - (tot_buf_size % 4096);
+       /* Copy data from user */
+       netdriver_copyin(data, 0, pdev->tx[tx_head].buf, size);
 
-       if (!(buf = alloc_contig(tot_buf_size, 0, &buf_dma))) {
-               printf("vt6105: Fail to allocate memory\n");
-               return -ENOMEM;
-       }
-       pdev->buf_size = tot_buf_size;
-       pdev->buf = buf;
+       /* Set busy */
+       pdev->tx[tx_head].busy = TRUE;
+       pdev->tx_busy_num++;
 
-       /* Rx descriptor */
-       pdev->rx_desc = (vt_desc *)buf;
-       pdev->rx_desc_dma = buf_dma;
-       memset(buf, 0, rx_desc_size);
-       buf += rx_desc_size;
-       buf_dma += rx_desc_size;
+       desc = pdev->tx_desc;
+       desc += tx_head;
+       /* Set Tx descriptor to prepare transmitting */
+       /* ### SET_TX_DESC_PREPARE ### */
+       dev_set_tx_desc_prepare(pdev->base, desc, tx_head, size);
+       if (tx_head == TX_BUFFER_NUM - 1)
+               tx_head = 0;
+       else
+               tx_head++;
+       pdev->tx_head = tx_head;
 
-       /* Tx descriptor */
-       pdev->tx_desc = (vt_desc *)buf;
-       pdev->tx_desc_dma = buf_dma;
-       memset(buf, 0, tx_desc_size);
-       buf += tx_desc_size;
-       buf_dma += tx_desc_size;
+       /* Start Tx channel */
+       /* ### START_TX ### */
+       dev_start_tx(pdev->base);
 
-       /* Rx buffer assignment */
-       desc = pdev->rx_desc;
-       next = pdev->rx_desc_dma;
-       for (i = 0; i < RX_DESC_NUM; i++) {
-               /* Set Rx buffer */
-               pdev->rx[i].buf_dma = buf_dma;
-               pdev->rx[i].buf = buf;
-               buf_dma += rx_buf_size;
-               buf += rx_buf_size;
+       return 0;
+}
 
-               /* Set Rx descriptor */
-               /* ### RX_DESC_INIT ### */
-               vt_init_rx_desc(desc, rx_buf_size, pdev->rx[i].buf_dma);
-               if (i == (RX_DESC_NUM - 1))
-                       desc->next = pdev->rx_desc_dma;
-               else {
-                       next += sizeof(vt_desc);
-                       desc->next = next;
-                       desc++;
-               }
+/* Handle interrupt */
+static void NDR_intr(unsigned int mask) {
+       int s;
+
+       /* Run interrupt handler at driver level */
+       dev_handler(&g_driver);
+
+       /* Reenable interrupts for this hook */
+       if ((s = sys_irqenable(&g_driver.hook)) != OK)
+               printf("NDR: Cannot enable OS interrupts: %d\n", s);
+
+       /* Perform tasks based on the flagged conditions */
+       dev_check_ints(&g_driver);
+}
+
+/* Get driver status */
+static void NDR_stat(eth_stat_t *stat) {
+       memcpy(stat, &g_driver.stat, sizeof(*stat));
+}
+
+/* Match the device and get base address */
+static int dev_probe(NDR_driver *pdev, int instance) {
+       int devind, ioflag, i;
+       u16_t cr, vid, did;
+       u32_t bar, size, base;
+       u8_t irq, rev;
+       u8_t *reg;
+
+       /* Find pci device */
+       pci_init();
+       if (!pci_first_dev(&devind, &vid, &did))
+               return -EIO;
+       while (instance--) {
+               if (!pci_next_dev(&devind, &vid, &did))
+                       return -EIO;
        }
+       pci_reserve(devind);
 
-       /* Tx buffer assignment */
-       desc = pdev->tx_desc;
-       next = pdev->tx_desc_dma;
-       for (i = 0; i < TX_DESC_NUM; i++) {
-               /* Set Tx buffer */
-               pdev->tx[i].busy = 0;
-               pdev->tx[i].buf_dma = buf_dma;
-               pdev->tx[i].buf = buf;
-               buf_dma += tx_buf_size;
-               buf += tx_buf_size;
+       /* Enable bus mastering and I/O space */
+       cr = pci_attr_r16(devind, PCI_CR);
+       pci_attr_w16(devind, PCI_CR, cr | 0x105);
 
-               /* Set Rx descriptor */
-               /* ### TX_DESC_INIT ### */
-               vt_init_tx_desc(desc, tx_buf_size, pdev->tx[i].buf_dma);
-               if (i == (TX_DESC_NUM - 1))
-                       desc->next = pdev->tx_desc_dma;
-               else {
-                       next += sizeof(vt_desc);
-                       desc->next = next;
-                       desc++;
+       /* Get base address */
+       for (i = 0; i < 6; i++)
+               pdev->base[i] = 0;
+#ifdef DMA_BASE_IOMAP
+       for (i = 0; i < 6; i++) {
+               if (pci_get_bar(devind, PCI_BAR + i * 4, &base, &size, &ioflag)) {
+                       /* printf("NDR: Fail to get PCI BAR\n"); */
+                       continue;
+               }
+               if (ioflag) {
+                       /* printf("NDR: PCI BAR is not for memory\n"); */
+                       continue;
                }
+               if ((reg = vm_map_phys(SELF, (void *)base, size)) == MAP_FAILED) {
+                       printf("NDR: Fail to map hardware registers from PCI\n");
+                       return -EIO;
+               }
+               pdev->base[i] = (u32_t)reg;
        }
-       pdev->tx_busy_num = 0;
-       pdev->tx_head = 0;
-       pdev->tx_tail = 0;
-       pdev->rx_head = 0;
+#else
+       for (i = 0; i < 6; i++)
+               pdev->base[i] = pci_attr_r32(devind, PCI_BAR + i * 4) & 0xffffffe0;
+#endif
+       pdev->dev_name = pci_dev_name(vid, did);
+       pdev->irq = pci_attr_r8(devind, PCI_ILR);
+       pdev->revision = pci_attr_r8(devind, PCI_REV);
+       pdev->did = did;
+       pdev->vid = vid;
+       pdev->devind = devind;
+
+#ifdef MY_DEBUG
+       printf("NDR: Hardware name is %s\n", pdev->dev_name);
+       for (i = 0; i < 6; i++)
+               printf("NDR: PCI BAR%d is 0x%08x\n", i, pdev->base[i]);
+       printf("NDR: IRQ number is 0x%02x\n", pdev->irq);
+#endif
 
        return 0;
 }
 
 /* Intialize hardware */
-static int vt_init_hw(vt_driver *pdev, ether_addr_t *addr) {
+static int dev_init_hw(NDR_driver *pdev, ether_addr_t *addr) {
        int r, ret;
 
        /* Set the OS interrupt handler */
        pdev->hook = pdev->irq;
        if ((r = sys_irqsetpolicy(pdev->irq, 0, &pdev->hook)) != OK) {
-               printf("vt6105: Fail to set OS IRQ policy: %d\n", r);
+               printf("NDR: Fail to set OS IRQ policy: %d\n", r);
                ret = -EFAULT;
                goto err_irq_policy;
        }
 
        /* Reset hardware */
-       if (vt_reset_hw(pdev)) {
-               printf("vt6105: Fail to reset the device\n");
+       if (dev_reset_hw(pdev)) {
+               printf("NDR: Fail to reset the device\n");
                ret = -EIO;
                goto err_reset_hw;
        }
 
        /* Enable OS IRQ */
        if ((r = sys_irqenable(&pdev->hook)) != OK) {
-               printf("vt6105: Fail to enable OS IRQ: %d\n", r);
+               printf("NDR: Fail to enable OS IRQ: %d\n", r);
                ret = -EFAULT;
                goto err_irq_enable;
        }
 
        /* Configure MAC address */
-       vt_conf_addr(pdev, addr);
+       dev_conf_addr(pdev, addr);
 
        /* Detect link status */
-       pdev->link = vt_check_link(pdev->base_addr);
+       /* ### CHECK_LINK ### */
+       pdev->link = dev_check_link(pdev->base);
 #ifdef MY_DEBUG
        if (pdev->link)
-               printf("vt6105: Link up\n");
+               printf("NDR: Link up\n");
        else
-               printf("vt6105: Link down\n");
+               printf("NDR: Link down\n");
 #endif
 
        return 0;
@@ -438,79 +573,48 @@ err_irq_policy:
 }
 
 /* Reset hardware */
-static int vt_reset_hw(vt_driver *pdev) {
-       u32_t base = pdev->base_addr;
+static int dev_reset_hw(NDR_driver *pdev) {
        int ret;
 
        /* Reset the chip */
        /* ### RESET_HARDWARE_CAN_FAIL ### */
-       if (vt_real_reset(base)) {
-               printf("vt6105: Fail to reset the hardware\n");
+       if (dev_real_reset(pdev->base)) {
+               printf("NDR: Fail to reset the hardware\n");
                ret = -EIO;
                goto err_real_reset;
        }
 
-       /* Initialize power */
-       /* ### POWER_INIT_CAN_FAIL ### */
-       if (vt_init_power(base)) {
-               printf("vt6105: Fail to initialize power\n");
+       /* Initialize other hardware I/O registers */
+       /* ### SET_RX_DESC_REG ### */
+       if (dev_init_io(pdev->base)) {
+               printf("NDR: Fail to initialize I/O registers\n");
                ret = -EIO;
-               goto err_init_power;
+               goto err_init_io;
        }
 
        /* Initialize MII interface */
        /* ### MII_INIT_CAN_FAIL ### */
-       if (vt_init_mii(base)) {
-               printf("vt6105: Fail to initialize MII interface\n");
+       if (dev_init_mii(pdev->base)) {
+               printf("NDR: Fail to initialize MII interface\n");
                ret = -EIO;
                goto err_init_mii;
        }
 
-       /* Initialize hardware I/O registers */
-       /* ### SET_RX_DESC_REG ### */
-       if (vt_init_io(base)) {
-               printf("vt6105: Fail to initialize I/O registers\n");
-               ret = -EIO;
-               goto err_init_io;
-       }
-
-       /* Set Rx/Tx descriptor into register */
-       /* ### SET_RX_DESC_REG ### */
-       vt_out32(base, REG_RX_DESC_BASEL, pdev->rx_desc_dma);
-#ifdef DESC_BASE_DMA64
-       vt_out32(base, REG_RX_DESC_BASEU, 0x00000000);
-#endif
-       /* ### SET_TX_DESC_REG ### */
-       vt_out32(base, REG_TX_DESC_BASEL, pdev->tx_desc_dma);
-#ifdef DESC_BASE_DMA64
-       vt_out32(base, REG_TX_DESC_BASEU, 0x00000000);
-#endif
-
-       /* Enable interrupts */
-       /* ### ENABLE_INTR ### */
-       vt_out16(base, REG_IMR, INTR_IMR_ENABLE);
-
-       /* Start the device, Rx and Tx */
-       /* ### START_RX_TX ### */
-       vt_start_rx_tx(base);
-
        return 0;
 
-err_init_io:
 err_init_mii:
-err_init_power:
+err_init_io:
 err_real_reset:
        return ret;
 }
 
 /* Configure MAC address */
-static void vt_conf_addr(vt_driver *pdev, ether_addr_t *addr) {
+static void dev_conf_addr(NDR_driver *pdev, ether_addr_t *addr) {
        u8_t pa[6];
-       u32_t base = pdev->base_addr;
 
        /* Get MAC address */
        /* ### GET_MAC_ADDR ### */
-       vt_get_addr(base, pa);
+       dev_get_addr(pdev->base, pa);
        addr->ea_addr[0] = pa[0];
        addr->ea_addr[1] = pa[1];
        addr->ea_addr[2] = pa[2];
@@ -518,201 +622,123 @@ static void vt_conf_addr(vt_driver *pdev, ether_addr_t *addr) {
        addr->ea_addr[4] = pa[4];
        addr->ea_addr[5] = pa[5];
 #ifdef MY_DEBUG
-       printf("vt6105: Ethernet address is %02x:%02x:%02x:%02x:%02x:%02x\n",
+       printf("NDR: Ethernet address is %02x:%02x:%02x:%02x:%02x:%02x\n",
                        addr->ea_addr[0], addr->ea_addr[1], addr->ea_addr[2],
                        addr->ea_addr[3], addr->ea_addr[4], addr->ea_addr[5]);
 #endif
 }
 
-/* Stop the driver */
-static void vt_stop(void) {
-       u32_t base = g_driver.base_addr;
-
-       /* Free Rx and Tx buffer*/
-       free_contig(g_driver.buf, g_driver.buf_size);
-
-       /* Stop interrupt */
-       /* ### DISABLE_INTR ### */
-       vt_out16(base, REG_IMR, INTR_IMR_DISABLE);
-
-       /* Stop Rx/Tx */
-       /* ### STOP_RX_TX ### */
-       vt_stop_rx_tx(base);
-}
-
-/* Set driver mode */
-static void vt_mode(unsigned int mode) {
-       vt_driver *pdev = &g_driver;
-       u32_t base = pdev->base_addr;
-       u8_t rcr;
-
-       pdev->mode = mode;
-
-       /* ### READ_RCR ### */
-       rcr = vt_in8(base, REG_RCR);
-       rcr &= ~(RCR_UNICAST | RCR_MULTICAST | RCR_BROADCAST);
-       if (pdev->mode & NDEV_PROMISC)
-               rcr |= RCR_UNICAST | RCR_MULTICAST;
-       if (pdev->mode & NDEV_BROAD)
-               rcr |= RCR_BROADCAST;
-       if (pdev->mode & NDEV_MULTI)
-               rcr |= RCR_MULTICAST;
-       rcr |= RCR_UNICAST;
-       /* ### WRITE_RCR ### */
-       vt_out8(base, REG_RCR, rcr);
-}
-
-/* Receive data */
-static ssize_t vt_recv(struct netdriver_data *data, size_t max) {
-       vt_driver *pdev = &g_driver;
-       u32_t totlen, packlen;
-       vt_desc *desc;
-       int index, i;
-
-       index = pdev->rx_head;
-       desc = pdev->rx_desc;
-       desc += index;
-
-       /* Check whether the receiving is OK */
-       /* ### CHECK_RX_STATUS_OK ### */
-       if (vt_rx_status_ok(desc) != TRUE)
-               return SUSPEND;
+/* Allocate and initialize buffer */
+static int dev_init_buf(NDR_driver *pdev) {
+       size_t rx_desc_size, tx_desc_size, rx_buf_size, tx_buf_size, tot_buf_size;
+       phys_bytes buf_dma;
+       char *buf;
+       int i;
 
-       /* Check Rx status error */
-       /* ### CHECK_RX_STATUS_ERROR ### */
-       if (desc->status & DESC_STATUS_RX_RECV_ERR)
-               printf("vt6105: Rx error\n");
+       /* Build Rx and Tx buffer */
+       tx_buf_size = TX_BUF_SIZE;
+       if (tx_buf_size % 4)
+               tx_buf_size += 4 - (tx_buf_size % 4);
+       rx_buf_size = RX_BUF_SIZE;
+       if (rx_buf_size % 4)
+               rx_buf_size += 4 - (rx_buf_size % 4);
+       tot_buf_size = TX_BUFFER_NUM * tx_buf_size + RX_BUFFER_NUM * rx_buf_size;
+       rx_desc_size = RX_BUFFER_NUM * sizeof(NDR_desc);
+       tx_desc_size = TX_BUFFER_NUM * sizeof(NDR_desc);
+       tot_buf_size += rx_desc_size + tx_desc_size;
+       if (tot_buf_size % 4096)
+               tot_buf_size += 4096 - (tot_buf_size % 4096);
 
-       /* Get data length */
-       /* ### Get Rx data length ### */
-       totlen = vt_get_rx_len(desc);
-       if (totlen < 8 || totlen > 2 * ETH_MAX_PACK_SIZE) {
-               printf("vt6105: Bad data length: %d\n", totlen);
-               panic(NULL);
+       if (!(buf = alloc_contig(tot_buf_size, 0, &buf_dma))) {
+               printf("NDR: Fail to allocate memory\n");
+               return -ENOMEM;
        }
+       pdev->buf_size = tot_buf_size;
+       pdev->buf = buf;
 
-       packlen = totlen;
-       if (packlen > max)
-               packlen = max;
-
-       /* Copy data to user */
-       netdriver_copyout(data, 0, pdev->rx[index].buf, packlen);
-       pdev->stat.ets_packetR++;
-
-       /* Set Rx descriptor status */
-       /* ### SET_RX_STATUS_INTR ### */
-       desc->status = DESC_STATUS_RX_RECV_CLEAR;
-       if (index == RX_DESC_NUM - 1)
-               index = 0;
-       else
-               index++;
-       pdev->rx_head = index;
-
-#ifdef MY_DEBUG
-       printf("vt6105: Successfully receive a packet, length = %d\n", packlen);
-#endif
-
-       return packlen;
-}
-
-/* Transmit data */
-static int vt_send(struct netdriver_data *data, size_t size) {
-       vt_driver *pdev = &g_driver;
-       vt_desc *desc;
-       int tx_head, i;
-       u32_t base = pdev->base_addr;
-
-       tx_head = pdev->tx_head;
-       desc = pdev->tx_desc;
-       desc += tx_head;
+       /* Rx descriptor buffer location */
+       pdev->rx_desc = (NDR_desc *)buf;
+       pdev->rx_desc_dma = buf_dma;
+       memset(buf, 0, rx_desc_size);
+       buf += rx_desc_size;
+       buf_dma += rx_desc_size;
 
-       if (pdev->tx[tx_head].busy)
-               return SUSPEND;
+       /* Tx descriptor buffer location */
+       pdev->tx_desc = (NDR_desc *)buf;
+       pdev->tx_desc_dma = buf_dma;
+       memset(buf, 0, tx_desc_size);
+       buf += tx_desc_size;
+       buf_dma += tx_desc_size;
 
-       /* Copy data from user */
-       netdriver_copyin(data, 0, pdev->tx[tx_head].buf, size);
+       /* Rx buffer assignment */
+       for (i = 0; i < RX_BUFFER_NUM; i++) {
+               /* Initialize Rx buffer */
+               pdev->rx[i].buf_dma = buf_dma;
+               pdev->rx[i].buf = buf;
+               buf_dma += rx_buf_size;
+               buf += rx_buf_size;
+               /* Set Rx descriptor */
+               /* ### INIT_RX_DESC ### */
+               dev_init_rx_desc(pdev->rx_desc, i, rx_buf_size, pdev->rx[i].buf_dma,
+                                                       RX_BUFFER_NUM, pdev->rx_desc_dma);
+       }
 
-       /* Set busy */
-       pdev->tx[tx_head].busy = TRUE;
-       pdev->tx_busy_num++;
+       /* Tx buffer assignment */
+       for (i = 0; i < TX_BUFFER_NUM; i++) {
+               /* Set Tx buffer */
+               pdev->tx[i].busy = 0;
+               pdev->tx[i].buf_dma = buf_dma;
+               pdev->tx[i].buf = buf;
+               buf_dma += tx_buf_size;
+               buf += tx_buf_size;
+               /* Initialize Tx descriptor */
+               /* ### INIT_TX_DESC ### */
+               dev_init_tx_desc(pdev->tx_desc, i, tx_buf_size, pdev->tx[i].buf_dma,
+                                                       TX_BUFFER_NUM, pdev->tx_desc_dma);
+       }
 
-       /* Set Tx descriptor status */
-       /* ### TX_DESC_START ### */
-       vt_tx_desc_start(desc, size);
-       if (tx_head == TX_DESC_NUM - 1)
-               tx_head = 0;
-       else
-               tx_head++;
-       pdev->tx_head = tx_head;
+       /* Set Rx/Tx descriptor address into device register */
+       /* ### SET_DESC_REG ### */
+       dev_set_desc_reg(pdev->base, g_driver.rx_desc_dma,
+                                               g_driver.tx_desc_dma);
 
-       /* Wake up transmit channel */
-       /* ### WAKE_UP_TX ### */
-       vt_wakeup_tx(base);
+       pdev->tx_busy_num = 0;
+       pdev->tx_head = 0;
+       pdev->tx_tail = 0;
+       pdev->rx_head = 0;
 
        return 0;
 }
 
-/* Handle Interrupt */
-static void vt_intr(unsigned int mask) {
-       int s;
-
-       /* Run interrupt handler at driver level */
-       vt_handler(&g_driver);
-
-       /* Reenable interrupts for this hook */
-       if ((s = sys_irqenable(&g_driver.hook)) != OK)
-               printf("vt6105: Cannot enable OS interrupts: %d\n", s);
-
-       /* Perform tasks based on the flagged conditions */
-       vt_check_ints(&g_driver);
-}
-
 /* Real handler interrupt */
-static void vt_handler(vt_driver *pdev) {
-       u32_t base = pdev->base_addr;
-       u16_t intr_status;
-       int flag = 0, tx_head, tx_tail;
-       vt_desc *desc;
-
-       /* Get interrupt status */
-       /* ### GET_INTR_STATUS ### */
-       intr_status = vt_in16(base, REG_ISR);
+static void dev_handler(NDR_driver *pdev) {
+       u32_t intr_status;
+       int tx_head, tx_tail, index, flag = 0, ret;
+       NDR_desc *desc;
 
-       /* Clear interrupt */
-       /* ### CLEAR_INTR ### */
-       vt_out16(base, REG_ISR, intr_status & INTR_ISR_CLEAR);
+       /* Read and clear interrupt status */
+       /* ### READ_CLEAR_INTR_STS ### */
+       intr_status = dev_read_clear_intr_status(pdev->base);
 
        /* Enable interrupt */
-       /* ### ENABLE_INTR ### */
-       vt_out16(base, REG_IMR, INTR_IMR_ENABLE);
-
-       /* Check interrupt error */
-       /* ### CHECK_INTR_ERROR ### */
-       if (intr_status & INTR_ISR_ERR) {
-               printf("vt6105: interrupt error\n");
-               return;
-       }
+       /* ### INTR_ENABLE_DISABLE ### */
+       dev_intr_control(pdev->base, INTR_ENABLE);
 
        /* Check link status */
-       /* ### CHECK_LINK_INTR ### */
-       if (intr_status & INTR_ISR_LINK_EVENT) {
-               pdev->link = vt_check_link(base);
+       if (intr_status & INTR_STS_LINK) {
+               pdev->link = dev_check_link(pdev->base);
 #ifdef MY_DEBUG
-               printf("vt6105: Link state change\n");
+               printf("NDR: Link state change\n");
 #endif
                flag++;
        }
-
        /* Check Rx request status */
-       /* ### CHECK_RX_INTR ### */
-       if (intr_status & INTR_ISR_RX_DONE) {
+       if (intr_status & INTR_STS_RX) {
                pdev->recv_flag = TRUE;
                flag++;
        }
-
        /* Check Tx request status */
-       /* ### CHECK_TX_INTR ### */
-       if (intr_status & INTR_ISR_TX_DONE) {
+       if (intr_status & INTR_STS_TX) {
                pdev->send_flag = TRUE;
                flag++;
 
@@ -720,51 +746,48 @@ static void vt_handler(vt_driver *pdev) {
                tx_head = pdev->tx_head;
                tx_tail = pdev->tx_tail;
                while (tx_tail != tx_head) {
+                       if (!pdev->tx[tx_tail].busy)
+                               printf("NDR: Strange, buffer not busy?\n");
+                       index = tx_tail;
                        desc = pdev->tx_desc;
                        desc += tx_tail;
-                       if (!pdev->tx[tx_tail].busy)
-                               printf("vt6105: Strange, buffer not busy?\n");
-
-                       /* Check whether the transmiting is OK */
-                       /* ### CHECK_TX_STATUS_OK ### */
-                       if (vt_tx_status_ok(desc) != TRUE)
+                       /* Check whether Tx is OK from Tx descriptor */
+                       /* ### CHECK_TX_OK_FROM_DESC ### */
+                       ret = dev_tx_ok_desc(pdev->base, desc, index);
+                       if (ret == TX_SUSPEND)
                                break;
-
-                       /* Check Tx status error */
-                       /* ### CHECK_TX_STATUS_ERROR ### */
-                       if (desc->status & DESC_STATUS_TX_SEND_ERR)
-                               printf("vt6105: Tx error\n");
+                       else if (ret == TX_ERROR)
+                               printf("NDR: Tx error now\n");
 
                        pdev->stat.ets_packetT++;
                        pdev->tx[tx_tail].busy = FALSE;
                        pdev->tx_busy_num--;
 
-                       if (++tx_tail >= TX_DESC_NUM)
+                       if (++tx_tail >= TX_BUFFER_NUM)
                                tx_tail = 0;
 
                        pdev->send_flag = TRUE;
                        pdev->recv_flag = TRUE;
 
-                       /* Set Tx descriptor status in interrupt */
-                       /* ### SET_TX_STATUS_INTR ### */
-                       desc->status = DESC_STATUS_TX_SEND_CLEAR;
-
+                       /* Set Tx descriptor after Tx done */
+                       /* ### SET_TX_DESC_DONE ### */
+                       dev_set_tx_desc_done(pdev->base, desc, index);
 #ifdef MY_DEBUG
-                       printf("vt6105: Successfully send a packet\n");
+                       printf("NDR: Successfully send a packet\n");
 #endif
                }
                pdev->tx_tail = tx_tail;
        }
 #ifdef MY_DEBUG
        if (!flag) {
-               printf("vt6105: Unknown error in interrupt\n");
+               printf("NDR: Unknown error in interrupt 0x%08x\n", intr_status);
                return;
        }
 #endif
 }
 
 /* Check interrupt and perform */
-static void vt_check_ints(vt_driver *pdev) {
+static void dev_check_ints(NDR_driver *pdev) {
        if (!pdev->recv_flag)
                return;
        pdev->recv_flag = FALSE;
@@ -778,7 +801,3 @@ static void vt_check_ints(vt_driver *pdev) {
                netdriver_send();
        }
 }
-
-static void vt_stat(eth_stat_t *stat) {
-       memcpy(stat, &g_driver.stat, sizeof(*stat));
-}
index c675ccb287af399f77f992d0dd213b9d1fd9dbc2..c804c4a8825514081ef5ec075bc80c5f823278e8 100644 (file)
-#ifndef _vt_H
-#define _vt_H
-
-#include <minix/drivers.h>
+#ifndef _NDR_H
+#define _NDR_H
 
 /* ======= General Parameter ======= */
 /* Global configure */
-#define DESC_BASE64
 
-/* Key internal register */
-#define REG_RCR                                0x06
-#define REG_ISR                                0x0c
-#define REG_IMR                                0x0e
-#define REG_RX_DESC_BASEL      0x18
-#define REG_TX_DESC_BASEL      0x1c
+#include <minix/drivers.h>
 
-#ifdef DESC_BASE_DMA64
-#define REG_RX_DESC_BASEU      0
-#define REG_TX_DESC_BASEU      0
-#endif
+#define DRIVER_NAME            "VT6105"
+
+/* Rx/Tx buffer parameter */
+#define RX_BUF_SIZE            1536
+#define TX_BUF_SIZE            1536
+#define RX_BUFFER_NUM  64
+#define TX_BUFFER_NUM  64
 
-/* Key internal register width */
-#define WIDTH_REG_RCR          8
-#define WIDTH_REG_ISR          16
-#define WIDTH_REG_IMR          16
-
-/* Interrupt statu and command */
-#define INTR_ISR_ERR                   0x3ffc
-#define INTR_ISR_LINK_EVENT            0x4000
-#define INTR_ISR_RX_DONE               0x0001
-#define INTR_ISR_TX_DONE               0x0002
-#define INTR_ISR_CLEAR                 0xbfbf
-#define INTR_IMR_ENABLE                        0xfeff
-#define INTR_IMR_DISABLE               0x0000
-
-/* Descriptor status */
-#define DESC_STATUS_RX_RECV_ERR                0x000000bf
-#define DESC_STATUS_RX_RECV_CLEAR      0x80000000
-#define DESC_STATUS_TX_SEND_ERR                0x00008f10
-#define DESC_STATUS_TX_SEND_CLEAR      0x00000000
-
-/* Rx mode */
-#define RCR_UNICAST            0x10
-#define RCR_MULTICAST  0x04
-#define RCR_BROADCAST  0x08
+/* Interrupt status */
+#define INTR_STS_LINK  0x4000
+#define INTR_STS_RX            0x0001
+#define INTR_STS_TX            0x0002
 
 /* Link status */
 #define LINK_UP                        1
 #define LINK_DOWN              0
 #define LINK_UNKNOWN   -1
 
-/* Basic Rx/Tx parameters */
-#define RX_BUF_SIZE            1536
-#define TX_BUF_SIZE            1536
-#define RX_DESC_NUM            64
-#define TX_DESC_NUM            64
+/* Interrupt control */
+#define INTR_ENABLE            1
+#define INTR_DISABLE   0
+
+/* Rx status */
+#define RX_ERROR               1
+#define RX_OK                  0
+#define RX_SUSPEND             -1
+
+/* Tx status */
+#define TX_ERROR               1
+#define TX_OK                  0
+#define TX_SUSPEND             -1
+
+/* Rx/Tx control */
+#define RX_TX_ENABLE   1
+#define RX_TX_DISABLE  0
 
 /* ======= Self-defined Parameter ======= */
 #define DESC_OWN                       0x80000000
 #define DESC_FIRST                     0x00000200
 #define DESC_LAST                      0x00000100
-
 #define DESC_RX_LENMASK                0x7fff0000
-#define DESC_RX_OK                     0x00008000
+#define DESC_RX_ERROR          0x000000bf
 #define DESC_RX_NORMAL         (DESC_FIRST | DESC_LAST)
+#define DESC_TX_ERROR          0x00008f10
 
-#define REG_ADDR               0x00
-#define REG_TCR                        0x07
-#define REG_CR                 0x08
-#define REG_BCR0               0x6e
-#define REG_MCR1               0x81
-#define REG_STICK              0x83
-#define REG_MII_CFG            0x6c
-#define REG_MII_CR             0x70
-#define REG_MII_ADDR   0x71
-#define REG_MII_DATA   0x72
-#define REG_WOL_SET            0xa4
-#define REG_WOLC_SET   0xa7
-
-#define CMD_START              0x0002
-#define CMD_STOP               0x0004
-#define CMD_RX_ON              0x0008
-#define CMD_TX_ON              0x0010
-#define CMD_TX_DEMAND  0x0020
-#define CMD_RX_DEMAND  0x0040
-#define CMD_FDUPLEX            0x0400
-#define CMD_NO_POLL            0x0800
-#define CMD_RESET              0x8000
+#define REG_ADDR                       0x00
+#define REG_RCR                                0x06
+#define REG_TCR                                0x07
+#define REG_CR                         0x08
+#define REG_IMR                                0x0e
+#define REG_ISR                                0x0c
+#define REG_RX_DESC_BASE       0x18
+#define REG_TX_DESC_BASE       0x1c
+#define REG_MII_PHY                    0x6c
+#define REG_BCR                                0x6e
+#define REG_MII_CR                     0x70
+#define REG_MII_REG                    0x71
+#define REG_MII_DATA           0x72
+#define REG_MCR                                0x81
+#define REG_STICK                      0x83
+
+#define CMD_START                      0x0002
+#define CMD_STOP                       0x0004
+#define CMD_RX_ON                      0x0008
+#define CMD_TX_ON                      0x0010
+#define CMD_TX_DEMAND          0x0020
+#define CMD_RX_DEMAND          0x0040
+#define CMD_FDUPLEX                    0x0400
+#define CMD_NO_POLL                    0x0800
+#define CMD_RESET                      0x8000
+#define CMD_INTR_ENABLE                0xfeff
+#define CMD_RCR_UNICAST                0x10
+#define CMD_RCR_MULTICAST      0x04
+#define CMD_RCR_BROADCAST      0x08
+#define INTR_STS_CLEAR         0xbfbf
+#define LINK_STATUS                    0x0004
 
 /* ======= Data Descriptor ======= */
-typedef struct vt_desc {
+typedef struct NDR_desc {
        u32_t status;
        u32_t length;
        u32_t addr;
        u32_t next;
-} vt_desc;
+} NDR_desc;
 
 /* Driver Data Structure */
-typedef struct vt_driver {
-       u32_t base_addr;                /* Base address */
-       int revision;                   /* Revision ID */
-       int irq;                                /* IRQ number */
+typedef struct NDR_driver {
+       char *dev_name;                 /* Device name */
+       u16_t vid, did;                 /* Vendor and device ID */
+       u32_t devind;                   /* Device index */
+       u32_t base[6];                  /* Base address */
+       char irq;                               /* IRQ number */
+       char revision;                  /* Revision ID */
+
        int mode;
        int link;                               /* Whether link-up */
        int recv_flag;                  /* Receive flag */
        int send_flag;                  /* Send flag */
-       int tx_busy;
+       int tx_busy;                    /* Whether Tx is busy */
 
        /* Buffer */
        size_t buf_size;
@@ -115,9 +115,7 @@ typedef struct vt_driver {
        struct {
                phys_bytes buf_dma;
                char *buf;
-       } rx[RX_DESC_NUM];
-       vt_desc *rx_desc;                       /* Rx descriptor buffer */
-       phys_bytes rx_desc_dma;         /* Rx descriptor DMA buffer */
+       } rx[RX_BUFFER_NUM];
 
        /* Tx data */
        int tx_head;
@@ -126,15 +124,17 @@ typedef struct vt_driver {
                int busy;
                phys_bytes buf_dma;
                char *buf;
-       } tx[TX_DESC_NUM];
-       vt_desc *tx_desc;                       /* Tx descriptor buffer */
-       phys_bytes tx_desc_dma;         /* Tx descriptor DMA buffer */
-       int tx_busy_num;                        /* Number of busy Tx descriptors */
+       } tx[TX_BUFFER_NUM];
+       int tx_busy_num;                        /* Number of busy Tx buffer */
 
-       int hook;               /* IRQ hook id at kernel */
-       eth_stat_t stat;
+       NDR_desc *rx_desc;                      /* Rx descriptor buffer */
+       phys_bytes rx_desc_dma;         /* Rx descriptor DMA buffer */
+       NDR_desc *tx_desc;                      /* Tx descriptor buffer */
+       phys_bytes tx_desc_dma;         /* Tx descriptor DMA buffer */
 
-       char name[20];
-} vt_driver;
+       int hook;                       /* IRQ hook id at kernel */
+       eth_stat_t stat;        /* Ethernet status */
+       char name[50];          /* Driver name */
+} NDR_driver;
 
 #endif