|
|
@@ -19,13 +19,18 @@
|
|
|
#include "raspi4.h"
|
|
|
#include "drv_eth.h"
|
|
|
|
|
|
+#define DBG_LEVEL DBG_LOG
|
|
|
+#include <rtdbg.h>
|
|
|
+#define LOG_TAG "drv.eth"
|
|
|
+
|
|
|
+static int link_speed = 0;
|
|
|
+static int link_flag = 0;
|
|
|
+
|
|
|
#define RECV_CACHE_BUF (1024)
|
|
|
-#define SEND_DATA_NO_CACHE (0x08200000)
|
|
|
-#define RECV_DATA_NO_CACHE (0x08400000)
|
|
|
#define DMA_DISC_ADDR_SIZE (4 * 1024 *1024)
|
|
|
|
|
|
-#define RX_DESC_BASE (MAC_REG + GENET_RX_OFF)
|
|
|
-#define TX_DESC_BASE (MAC_REG + GENET_TX_OFF)
|
|
|
+#define RX_DESC_BASE (mac_reg_base_addr + GENET_RX_OFF)
|
|
|
+#define TX_DESC_BASE (mac_reg_base_addr + GENET_TX_OFF)
|
|
|
|
|
|
#define MAX_ADDR_LEN (6)
|
|
|
|
|
|
@@ -34,6 +39,11 @@
|
|
|
|
|
|
#define BIT(nr) (1UL << (nr))
|
|
|
|
|
|
+static rt_thread_t link_thread_tid = RT_NULL;
|
|
|
+#define LINK_THREAD_STACK_SIZE (1024)
|
|
|
+#define LINK_THREAD_PRIORITY (20)
|
|
|
+#define LINK_THREAD_TIMESLICE (10)
|
|
|
+
|
|
|
static rt_uint32_t tx_index = 0;
|
|
|
static rt_uint32_t rx_index = 0;
|
|
|
static rt_uint32_t index_flag = 0;
|
|
|
@@ -54,6 +64,7 @@ struct rt_eth_dev
|
|
|
};
|
|
|
static struct rt_eth_dev eth_dev;
|
|
|
static struct rt_semaphore sem_lock;
|
|
|
+static struct rt_semaphore link_ack;
|
|
|
|
|
|
static inline rt_uint32_t read32(void *addr)
|
|
|
{
|
|
|
@@ -77,10 +88,10 @@ static int bcmgenet_interface_set(void)
|
|
|
switch (phy_mode) {
|
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
|
case PHY_INTERFACE_MODE_RGMII_RXID:
|
|
|
- write32(MAC_REG + SYS_PORT_CTRL,PORT_MODE_EXT_GPHY);
|
|
|
+ write32(mac_reg_base_addr + SYS_PORT_CTRL,PORT_MODE_EXT_GPHY);
|
|
|
break;
|
|
|
default:
|
|
|
- rt_kprintf("unknown phy mode: %d\n", MAC_REG);
|
|
|
+ rt_kprintf("unknown phy mode: %d\n", mac_reg_base_addr);
|
|
|
return -1;
|
|
|
}
|
|
|
return 0;
|
|
|
@@ -89,44 +100,44 @@ static int bcmgenet_interface_set(void)
|
|
|
static void bcmgenet_umac_reset(void)
|
|
|
{
|
|
|
rt_uint32_t reg;
|
|
|
- reg = read32(MAC_REG + SYS_RBUF_FLUSH_CTRL);
|
|
|
+ reg = read32(mac_reg_base_addr + SYS_RBUF_FLUSH_CTRL);
|
|
|
reg |= BIT(1);
|
|
|
- write32((MAC_REG + SYS_RBUF_FLUSH_CTRL), reg);
|
|
|
+ write32((mac_reg_base_addr + SYS_RBUF_FLUSH_CTRL), reg);
|
|
|
|
|
|
reg &= ~BIT(1);
|
|
|
- write32((MAC_REG + SYS_RBUF_FLUSH_CTRL),reg);
|
|
|
+ write32((mac_reg_base_addr + SYS_RBUF_FLUSH_CTRL),reg);
|
|
|
|
|
|
DELAY_MICROS(10);
|
|
|
- write32((MAC_REG + SYS_RBUF_FLUSH_CTRL),0);
|
|
|
+ write32((mac_reg_base_addr + SYS_RBUF_FLUSH_CTRL),0);
|
|
|
DELAY_MICROS(10);
|
|
|
- write32(MAC_REG + UMAC_CMD, 0);
|
|
|
- write32(MAC_REG + UMAC_CMD, (CMD_SW_RESET | CMD_LCL_LOOP_EN));
|
|
|
+ write32(mac_reg_base_addr + UMAC_CMD, 0);
|
|
|
+ write32(mac_reg_base_addr + UMAC_CMD, (CMD_SW_RESET | CMD_LCL_LOOP_EN));
|
|
|
DELAY_MICROS(2);
|
|
|
- write32(MAC_REG + UMAC_CMD, 0);
|
|
|
+ write32(mac_reg_base_addr + UMAC_CMD, 0);
|
|
|
/* clear tx/rx counter */
|
|
|
- write32(MAC_REG + UMAC_MIB_CTRL, MIB_RESET_RX | MIB_RESET_TX | MIB_RESET_RUNT);
|
|
|
- write32(MAC_REG + UMAC_MIB_CTRL, 0);
|
|
|
- write32(MAC_REG + UMAC_MAX_FRAME_LEN, ENET_MAX_MTU_SIZE);
|
|
|
+ write32(mac_reg_base_addr + UMAC_MIB_CTRL, MIB_RESET_RX | MIB_RESET_TX | MIB_RESET_RUNT);
|
|
|
+ write32(mac_reg_base_addr + UMAC_MIB_CTRL, 0);
|
|
|
+ write32(mac_reg_base_addr + UMAC_MAX_FRAME_LEN, ENET_MAX_MTU_SIZE);
|
|
|
/* init rx registers, enable ip header optimization */
|
|
|
- reg = read32(MAC_REG + RBUF_CTRL);
|
|
|
+ reg = read32(mac_reg_base_addr + RBUF_CTRL);
|
|
|
reg |= RBUF_ALIGN_2B;
|
|
|
- write32(MAC_REG + RBUF_CTRL, reg);
|
|
|
- write32(MAC_REG + RBUF_TBUF_SIZE_CTRL, 1);
|
|
|
+ write32(mac_reg_base_addr + RBUF_CTRL, reg);
|
|
|
+ write32(mac_reg_base_addr + RBUF_TBUF_SIZE_CTRL, 1);
|
|
|
}
|
|
|
|
|
|
static void bcmgenet_disable_dma(void)
|
|
|
{
|
|
|
rt_uint32_t tdma_reg = 0, rdma_reg = 0;
|
|
|
|
|
|
- tdma_reg = read32(MAC_REG + TDMA_REG_BASE + DMA_CTRL);
|
|
|
+ tdma_reg = read32(mac_reg_base_addr + TDMA_REG_BASE + DMA_CTRL);
|
|
|
tdma_reg &= ~(1UL << DMA_EN);
|
|
|
- write32(MAC_REG + TDMA_REG_BASE + DMA_CTRL, tdma_reg);
|
|
|
- rdma_reg = read32(MAC_REG + RDMA_REG_BASE + DMA_CTRL);
|
|
|
+ write32(mac_reg_base_addr + TDMA_REG_BASE + DMA_CTRL, tdma_reg);
|
|
|
+ rdma_reg = read32(mac_reg_base_addr + RDMA_REG_BASE + DMA_CTRL);
|
|
|
rdma_reg &= ~(1UL << DMA_EN);
|
|
|
- write32(MAC_REG + RDMA_REG_BASE + DMA_CTRL, rdma_reg);
|
|
|
- write32(MAC_REG + UMAC_TX_FLUSH, 1);
|
|
|
+ write32(mac_reg_base_addr + RDMA_REG_BASE + DMA_CTRL, rdma_reg);
|
|
|
+ write32(mac_reg_base_addr + UMAC_TX_FLUSH, 1);
|
|
|
DELAY_MICROS(100);
|
|
|
- write32(MAC_REG + UMAC_TX_FLUSH, 0);
|
|
|
+ write32(mac_reg_base_addr + UMAC_TX_FLUSH, 0);
|
|
|
}
|
|
|
|
|
|
static void bcmgenet_enable_dma(void)
|
|
|
@@ -135,10 +146,10 @@ static void bcmgenet_enable_dma(void)
|
|
|
rt_uint32_t dma_ctrl = 0;
|
|
|
|
|
|
dma_ctrl = (1 << (DEFAULT_Q + DMA_RING_BUF_EN_SHIFT)) | DMA_EN;
|
|
|
- write32(MAC_REG + TDMA_REG_BASE + DMA_CTRL, dma_ctrl);
|
|
|
+ write32(mac_reg_base_addr + TDMA_REG_BASE + DMA_CTRL, dma_ctrl);
|
|
|
|
|
|
- reg = read32(MAC_REG + RDMA_REG_BASE + DMA_CTRL);
|
|
|
- write32(MAC_REG + RDMA_REG_BASE + DMA_CTRL, dma_ctrl | reg);
|
|
|
+ reg = read32(mac_reg_base_addr + RDMA_REG_BASE + DMA_CTRL);
|
|
|
+ write32(mac_reg_base_addr + RDMA_REG_BASE + DMA_CTRL, dma_ctrl | reg);
|
|
|
}
|
|
|
|
|
|
static int bcmgenet_mdio_write(rt_uint32_t addr, rt_uint32_t reg, rt_uint32_t value)
|
|
|
@@ -146,16 +157,16 @@ static int bcmgenet_mdio_write(rt_uint32_t addr, rt_uint32_t reg, rt_uint32_t va
|
|
|
int count = 10000;
|
|
|
rt_uint32_t val;
|
|
|
val = MDIO_WR | (addr << MDIO_PMD_SHIFT) |(reg << MDIO_REG_SHIFT) | (0xffff & value);
|
|
|
- write32(MAC_REG + MDIO_CMD, val);
|
|
|
+ write32(mac_reg_base_addr + MDIO_CMD, val);
|
|
|
|
|
|
- rt_uint32_t reg_val = read32(MAC_REG + MDIO_CMD);
|
|
|
+ rt_uint32_t reg_val = read32(mac_reg_base_addr + MDIO_CMD);
|
|
|
reg_val = reg_val | MDIO_START_BUSY;
|
|
|
- write32(MAC_REG + MDIO_CMD, reg_val);
|
|
|
+ write32(mac_reg_base_addr + MDIO_CMD, reg_val);
|
|
|
|
|
|
- while ((read32(MAC_REG + MDIO_CMD) & MDIO_START_BUSY) && (--count))
|
|
|
+ while ((read32(mac_reg_base_addr + MDIO_CMD) & MDIO_START_BUSY) && (--count))
|
|
|
DELAY_MICROS(1);
|
|
|
|
|
|
- reg_val = read32(MAC_REG + MDIO_CMD);
|
|
|
+ reg_val = read32(mac_reg_base_addr + MDIO_CMD);
|
|
|
|
|
|
return reg_val & 0xffff;
|
|
|
|
|
|
@@ -168,16 +179,16 @@ static int bcmgenet_mdio_read(rt_uint32_t addr, rt_uint32_t reg)
|
|
|
rt_uint32_t reg_val = 0;
|
|
|
|
|
|
val = MDIO_RD | (addr << MDIO_PMD_SHIFT) | (reg << MDIO_REG_SHIFT);
|
|
|
- write32(MAC_REG + MDIO_CMD, val);
|
|
|
+ write32(mac_reg_base_addr + MDIO_CMD, val);
|
|
|
|
|
|
- reg_val = read32(MAC_REG + MDIO_CMD);
|
|
|
+ reg_val = read32(mac_reg_base_addr + MDIO_CMD);
|
|
|
reg_val = reg_val | MDIO_START_BUSY;
|
|
|
- write32(MAC_REG + MDIO_CMD, reg_val);
|
|
|
+ write32(mac_reg_base_addr + MDIO_CMD, reg_val);
|
|
|
|
|
|
- while ((read32(MAC_REG + MDIO_CMD) & MDIO_START_BUSY) && (--count))
|
|
|
+ while ((read32(mac_reg_base_addr + MDIO_CMD) & MDIO_START_BUSY) && (--count))
|
|
|
DELAY_MICROS(1);
|
|
|
|
|
|
- reg_val = read32(MAC_REG + MDIO_CMD);
|
|
|
+ reg_val = read32(mac_reg_base_addr + MDIO_CMD);
|
|
|
|
|
|
return reg_val & 0xffff;
|
|
|
}
|
|
|
@@ -190,10 +201,10 @@ static int bcmgenet_gmac_write_hwaddr(void)
|
|
|
bcm271x_mbox_hardware_get_mac_address(&addr[0]);
|
|
|
|
|
|
reg = addr[0] << 24 | addr[1] << 16 | addr[2] << 8 | addr[3];
|
|
|
- write32(MAC_REG + UMAC_MAC0, reg);
|
|
|
+ write32(mac_reg_base_addr + UMAC_MAC0, reg);
|
|
|
|
|
|
reg = addr[4] << 8 | addr[5];
|
|
|
- write32(MAC_REG + UMAC_MAC1, reg);
|
|
|
+ write32(mac_reg_base_addr + UMAC_MAC1, reg);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
@@ -209,7 +220,7 @@ static int get_ethernet_uid(void)
|
|
|
|
|
|
if(BCM54213PE_VERSION_B1 == uid)
|
|
|
{
|
|
|
- rt_kprintf("version is B1\n");
|
|
|
+ LOG_I("version is B1\n");
|
|
|
}
|
|
|
return uid;
|
|
|
}
|
|
|
@@ -236,45 +247,47 @@ static void bcmgenet_mdio_init(void)
|
|
|
/* read status reg */
|
|
|
bcmgenet_mdio_read(1, BCM54213PE_IEEE_EXTENDED_STATUS);
|
|
|
bcmgenet_mdio_read(1, BCM54213PE_AUTO_NEGOTIATION_ADV);
|
|
|
+
|
|
|
bcmgenet_mdio_read(1, BCM54213PE_MII_STATUS);
|
|
|
bcmgenet_mdio_read(1, BCM54213PE_CONTROL);
|
|
|
/* half full duplex capability */
|
|
|
bcmgenet_mdio_write(1, BCM54213PE_CONTROL, (CONTROL_HALF_DUPLEX_CAPABILITY | CONTROL_FULL_DUPLEX_CAPABILITY));
|
|
|
bcmgenet_mdio_read(1, BCM54213PE_MII_CONTROL);
|
|
|
+
|
|
|
/* set mii control */
|
|
|
bcmgenet_mdio_write(1,BCM54213PE_MII_CONTROL,(MII_CONTROL_AUTO_NEGOTIATION_ENABLED | MII_CONTROL_AUTO_NEGOTIATION_RESTART| MII_CONTROL_PHY_FULL_DUPLEX| MII_CONTROL_SPEED_SELECTION));
|
|
|
}
|
|
|
|
|
|
static void rx_ring_init(void)
|
|
|
{
|
|
|
- write32(MAC_REG + RDMA_REG_BASE + DMA_SCB_BURST_SIZE, DMA_MAX_BURST_LENGTH);
|
|
|
- write32(MAC_REG + RDMA_RING_REG_BASE + DMA_START_ADDR,0x0 );
|
|
|
- write32(MAC_REG + RDMA_READ_PTR, 0x0);
|
|
|
- write32(MAC_REG + RDMA_WRITE_PTR, 0x0);
|
|
|
- write32(MAC_REG + RDMA_RING_REG_BASE + DMA_END_ADDR, RX_DESCS * DMA_DESC_SIZE / 4 - 1);
|
|
|
-
|
|
|
- write32(MAC_REG + RDMA_PROD_INDEX, 0x0);
|
|
|
- write32(MAC_REG + RDMA_CONS_INDEX, 0x0);
|
|
|
- write32(MAC_REG + RDMA_RING_REG_BASE + DMA_RING_BUF_SIZE, (RX_DESCS << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH);
|
|
|
- write32(MAC_REG + RDMA_XON_XOFF_THRESH, DMA_FC_THRESH_VALUE);
|
|
|
- write32(MAC_REG + RDMA_REG_BASE + DMA_RING_CFG,1 << DEFAULT_Q);
|
|
|
+ write32(mac_reg_base_addr + RDMA_REG_BASE + DMA_SCB_BURST_SIZE, DMA_MAX_BURST_LENGTH);
|
|
|
+ write32(mac_reg_base_addr + RDMA_RING_REG_BASE + DMA_START_ADDR,0x0 );
|
|
|
+ write32(mac_reg_base_addr + RDMA_READ_PTR, 0x0);
|
|
|
+ write32(mac_reg_base_addr + RDMA_WRITE_PTR, 0x0);
|
|
|
+ write32(mac_reg_base_addr + RDMA_RING_REG_BASE + DMA_END_ADDR, RX_DESCS * DMA_DESC_SIZE / 4 - 1);
|
|
|
+
|
|
|
+ write32(mac_reg_base_addr + RDMA_PROD_INDEX, 0x0);
|
|
|
+ write32(mac_reg_base_addr + RDMA_CONS_INDEX, 0x0);
|
|
|
+ write32(mac_reg_base_addr + RDMA_RING_REG_BASE + DMA_RING_BUF_SIZE, (RX_DESCS << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH);
|
|
|
+ write32(mac_reg_base_addr + RDMA_XON_XOFF_THRESH, DMA_FC_THRESH_VALUE);
|
|
|
+ write32(mac_reg_base_addr + RDMA_REG_BASE + DMA_RING_CFG,1 << DEFAULT_Q);
|
|
|
}
|
|
|
|
|
|
static void tx_ring_init(void)
|
|
|
{
|
|
|
- write32(MAC_REG + TDMA_REG_BASE + DMA_SCB_BURST_SIZE, DMA_MAX_BURST_LENGTH);
|
|
|
- write32(MAC_REG + TDMA_RING_REG_BASE + DMA_START_ADDR, 0x0);
|
|
|
- write32(MAC_REG + TDMA_READ_PTR, 0x0);
|
|
|
- write32(MAC_REG + TDMA_READ_PTR, 0x0);
|
|
|
- write32(MAC_REG + TDMA_READ_PTR, 0x0);
|
|
|
- write32(MAC_REG + TDMA_WRITE_PTR, 0x0);
|
|
|
- write32(MAC_REG + TDMA_RING_REG_BASE + DMA_END_ADDR,TX_DESCS * DMA_DESC_SIZE / 4 - 1);
|
|
|
- write32(MAC_REG + TDMA_PROD_INDEX, 0x0);
|
|
|
- write32(MAC_REG + TDMA_CONS_INDEX, 0x0);
|
|
|
- write32(MAC_REG + TDMA_RING_REG_BASE + DMA_MBUF_DONE_THRESH,0x1);
|
|
|
- write32(MAC_REG + TDMA_FLOW_PERIOD,0x0);
|
|
|
- write32(MAC_REG + TDMA_RING_REG_BASE + DMA_RING_BUF_SIZE, (TX_DESCS << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH);
|
|
|
- write32(MAC_REG + TDMA_REG_BASE + DMA_RING_CFG,1 << DEFAULT_Q);
|
|
|
+ write32(mac_reg_base_addr + TDMA_REG_BASE + DMA_SCB_BURST_SIZE, DMA_MAX_BURST_LENGTH);
|
|
|
+ write32(mac_reg_base_addr + TDMA_RING_REG_BASE + DMA_START_ADDR, 0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_READ_PTR, 0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_READ_PTR, 0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_READ_PTR, 0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_WRITE_PTR, 0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_RING_REG_BASE + DMA_END_ADDR,TX_DESCS * DMA_DESC_SIZE / 4 - 1);
|
|
|
+ write32(mac_reg_base_addr + TDMA_PROD_INDEX, 0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_CONS_INDEX, 0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_RING_REG_BASE + DMA_MBUF_DONE_THRESH,0x1);
|
|
|
+ write32(mac_reg_base_addr + TDMA_FLOW_PERIOD,0x0);
|
|
|
+ write32(mac_reg_base_addr + TDMA_RING_REG_BASE + DMA_RING_BUF_SIZE, (TX_DESCS << DMA_RING_SIZE_SHIFT) | RX_BUF_LENGTH);
|
|
|
+ write32(mac_reg_base_addr + TDMA_REG_BASE + DMA_RING_CFG,1 << DEFAULT_Q);
|
|
|
}
|
|
|
|
|
|
static void rx_descs_init(void)
|
|
|
@@ -291,46 +304,10 @@ static void rx_descs_init(void)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
-static int phy_startup(void)
|
|
|
-{
|
|
|
- int count = 1000000;
|
|
|
- while ((bcmgenet_mdio_read(1, BCM54213PE_MII_STATUS) & MII_STATUS_LINK_UP) && (--count))
|
|
|
- DELAY_MICROS(1);
|
|
|
- if(count > 0)
|
|
|
- {
|
|
|
- rt_kprintf("bcmgenet: PHY startup ok!\n");
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- rt_kprintf("bcmgenet: PHY startup err!\n");
|
|
|
- return 1;
|
|
|
- }
|
|
|
-
|
|
|
- if(bcmgenet_mdio_read(1, BCM54213PE_STATUS) == 0)
|
|
|
- {
|
|
|
- //todo
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- rt_kprintf("bcmgenet: BCM54213PE_STATUS err!\n");
|
|
|
- }
|
|
|
-
|
|
|
- if(bcmgenet_mdio_read(1, BCM54213PE_CONTROL) == (CONTROL_FULL_DUPLEX_CAPABILITY| CONTROL_HALF_DUPLEX_CAPABILITY))
|
|
|
- {
|
|
|
- //todo
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- rt_kprintf("bcmgenet: BCM54213PE_CONTROL err!\n");
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
static int bcmgenet_adjust_link(void)
|
|
|
{
|
|
|
rt_uint32_t speed;
|
|
|
- rt_uint32_t phy_dev_speed = SPEED_100;
|
|
|
+ rt_uint32_t phy_dev_speed = link_speed;
|
|
|
|
|
|
switch (phy_dev_speed) {
|
|
|
case SPEED_1000:
|
|
|
@@ -347,17 +324,25 @@ static int bcmgenet_adjust_link(void)
|
|
|
return -1;
|
|
|
}
|
|
|
|
|
|
- rt_uint32_t reg1 = read32(MAC_REG + EXT_RGMII_OOB_CTRL);
|
|
|
+ rt_uint32_t reg1 = read32(mac_reg_base_addr + EXT_RGMII_OOB_CTRL);
|
|
|
//reg1 &= ~(1UL << OOB_DISABLE);
|
|
|
|
|
|
//rt_kprintf("OOB_DISABLE is %d\n", OOB_DISABLE);
|
|
|
reg1 |= (RGMII_LINK | RGMII_MODE_EN | ID_MODE_DIS);
|
|
|
- write32(MAC_REG + EXT_RGMII_OOB_CTRL, reg1);
|
|
|
+ write32(mac_reg_base_addr + EXT_RGMII_OOB_CTRL, reg1);
|
|
|
DELAY_MICROS(1000);
|
|
|
- write32(MAC_REG + UMAC_CMD, speed << CMD_SPEED_SHIFT);
|
|
|
+ write32(mac_reg_base_addr + UMAC_CMD, speed << CMD_SPEED_SHIFT);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+void link_irq(void *param)
|
|
|
+{
|
|
|
+ if((bcmgenet_mdio_read(1, BCM54213PE_MII_STATUS) & MII_STATUS_LINK_UP) != 0)
|
|
|
+ {
|
|
|
+ rt_sem_release(&link_ack);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
static int bcmgenet_gmac_eth_start(void)
|
|
|
{
|
|
|
rt_uint32_t ret;
|
|
|
@@ -375,13 +360,6 @@ static int bcmgenet_gmac_eth_start(void)
|
|
|
/* Enable RX/TX DMA */
|
|
|
bcmgenet_enable_dma();
|
|
|
|
|
|
- /* read PHY properties over the wire from generic PHY set-up */
|
|
|
- ret = phy_startup();
|
|
|
- if (ret) {
|
|
|
- rt_kprintf("bcmgenet: PHY startup failed: %d\n", ret);
|
|
|
- return ret;
|
|
|
- }
|
|
|
-
|
|
|
/* Update MAC registers based on PHY property */
|
|
|
ret = bcmgenet_adjust_link();
|
|
|
if (ret) {
|
|
|
@@ -390,26 +368,26 @@ static int bcmgenet_gmac_eth_start(void)
|
|
|
}
|
|
|
|
|
|
/* wait tx index clear */
|
|
|
- while ((read32(MAC_REG + TDMA_CONS_INDEX) != 0) && (--count))
|
|
|
+ while ((read32(mac_reg_base_addr + TDMA_CONS_INDEX) != 0) && (--count))
|
|
|
DELAY_MICROS(1);
|
|
|
|
|
|
- tx_index = read32(MAC_REG + TDMA_CONS_INDEX);
|
|
|
- write32(MAC_REG + TDMA_PROD_INDEX, tx_index);
|
|
|
+ tx_index = read32(mac_reg_base_addr + TDMA_CONS_INDEX);
|
|
|
+ write32(mac_reg_base_addr + TDMA_PROD_INDEX, tx_index);
|
|
|
|
|
|
- index_flag = read32(MAC_REG + RDMA_PROD_INDEX);
|
|
|
+ index_flag = read32(mac_reg_base_addr + RDMA_PROD_INDEX);
|
|
|
|
|
|
rx_index = index_flag % 256;
|
|
|
|
|
|
- write32(MAC_REG + RDMA_CONS_INDEX, index_flag);
|
|
|
- write32(MAC_REG + RDMA_PROD_INDEX, index_flag);
|
|
|
+ write32(mac_reg_base_addr + RDMA_CONS_INDEX, index_flag);
|
|
|
+ write32(mac_reg_base_addr + RDMA_PROD_INDEX, index_flag);
|
|
|
|
|
|
/* Enable Rx/Tx */
|
|
|
rt_uint32_t rx_tx_en;
|
|
|
- rx_tx_en = read32(MAC_REG + UMAC_CMD);
|
|
|
+ rx_tx_en = read32(mac_reg_base_addr + UMAC_CMD);
|
|
|
|
|
|
rx_tx_en |= (CMD_TX_EN | CMD_RX_EN);
|
|
|
|
|
|
- write32(MAC_REG + UMAC_CMD, rx_tx_en);
|
|
|
+ write32(mac_reg_base_addr + UMAC_CMD, rx_tx_en);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
@@ -419,7 +397,7 @@ static rt_uint32_t bcmgenet_gmac_eth_recv(rt_uint8_t **packetp)
|
|
|
{
|
|
|
void* desc_base;
|
|
|
rt_uint32_t length = 0, addr = 0;
|
|
|
- rt_uint32_t prod_index = read32(MAC_REG + RDMA_PROD_INDEX);
|
|
|
+ rt_uint32_t prod_index = read32(mac_reg_base_addr + RDMA_PROD_INDEX);
|
|
|
//get next
|
|
|
if(prod_index == index_flag)
|
|
|
{
|
|
|
@@ -449,7 +427,7 @@ static rt_uint32_t bcmgenet_gmac_eth_recv(rt_uint8_t **packetp)
|
|
|
{
|
|
|
rx_index = 0;
|
|
|
}
|
|
|
- write32(MAC_REG + RDMA_CONS_INDEX, cur_recv_cnt);
|
|
|
+ write32(mac_reg_base_addr + RDMA_CONS_INDEX, cur_recv_cnt);
|
|
|
|
|
|
cur_recv_cnt = cur_recv_cnt + 1;
|
|
|
prev_recv_cnt = cur_recv_cnt;
|
|
|
@@ -466,7 +444,7 @@ static int bcmgenet_gmac_eth_send(void *packet, int length)
|
|
|
rt_uint32_t prod_index, cons;
|
|
|
rt_uint32_t tries = 100;
|
|
|
|
|
|
- prod_index = read32(MAC_REG + TDMA_PROD_INDEX);
|
|
|
+ prod_index = read32(mac_reg_base_addr + TDMA_PROD_INDEX);
|
|
|
|
|
|
len_stat |= 0x3F << DMA_TX_QTAG_SHIFT;
|
|
|
len_stat |= DMA_TX_APPEND_CRC | DMA_SOP | DMA_EOP;
|
|
|
@@ -481,10 +459,10 @@ static int bcmgenet_gmac_eth_send(void *packet, int length)
|
|
|
}
|
|
|
prod_index++;
|
|
|
/* Start Transmisson */
|
|
|
- write32(MAC_REG + TDMA_PROD_INDEX,prod_index);
|
|
|
+ write32(mac_reg_base_addr + TDMA_PROD_INDEX,prod_index);
|
|
|
|
|
|
do {
|
|
|
- cons = read32(MAC_REG + TDMA_CONS_INDEX);
|
|
|
+ cons = read32(mac_reg_base_addr + TDMA_CONS_INDEX);
|
|
|
} while ((cons & 0xffff) < prod_index && --tries);
|
|
|
if (!tries)
|
|
|
{
|
|
|
@@ -493,17 +471,67 @@ static int bcmgenet_gmac_eth_send(void *packet, int length)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+static void link_task_entry(void *param)
|
|
|
+{
|
|
|
+ struct eth_device *eth_device = (struct eth_device *)param;
|
|
|
+ RT_ASSERT(eth_device != RT_NULL);
|
|
|
+ struct rt_eth_dev *dev = ð_dev;
|
|
|
+ //start mdio
|
|
|
+ bcmgenet_mdio_init();
|
|
|
+ //start timer link
|
|
|
+ rt_timer_init(&dev->link_timer, "link_timer",
|
|
|
+ link_irq,
|
|
|
+ NULL,
|
|
|
+ 100,
|
|
|
+ RT_TIMER_FLAG_PERIODIC);
|
|
|
+ rt_timer_start(&dev->link_timer);
|
|
|
+
|
|
|
+ //link wait forever
|
|
|
+ rt_sem_take(&link_ack, RT_WAITING_FOREVER);
|
|
|
+ eth_device_linkchange(ð_dev.parent, RT_TRUE);//link up
|
|
|
+ rt_timer_stop(&dev->link_timer);
|
|
|
+
|
|
|
+ //set mac
|
|
|
+ bcmgenet_gmac_write_hwaddr();
|
|
|
+ bcmgenet_gmac_write_hwaddr();
|
|
|
+
|
|
|
+ //check link speed
|
|
|
+ if((bcmgenet_mdio_read(1, BCM54213PE_STATUS) & (1 << 10)) || (bcmgenet_mdio_read(1, BCM54213PE_STATUS) & (1 << 11)))
|
|
|
+ {
|
|
|
+ link_speed = 1000;
|
|
|
+ rt_kprintf("Support link mode Speed 1000M\n");
|
|
|
+ }
|
|
|
+ else if((bcmgenet_mdio_read(1, 0x05) & (1 << 7)) || (bcmgenet_mdio_read(1, 0x05) & (1 << 8)) || (bcmgenet_mdio_read(1, 0x05) & (1 << 9)))
|
|
|
+ {
|
|
|
+ link_speed = 100;
|
|
|
+ rt_kprintf("Support link mode Speed 100M\n");
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ link_speed = 10;
|
|
|
+ rt_kprintf("Support link mode Speed 10M\n");
|
|
|
+ }
|
|
|
+
|
|
|
+ bcmgenet_gmac_eth_start();
|
|
|
+ //irq or poll
|
|
|
+ rt_timer_init(&dev->rx_poll_timer, "rx_poll_timer",
|
|
|
+ eth_rx_irq,
|
|
|
+ NULL,
|
|
|
+ 1,
|
|
|
+ RT_TIMER_FLAG_PERIODIC);
|
|
|
+
|
|
|
+ rt_timer_start(&dev->rx_poll_timer);
|
|
|
+ link_flag = 1;
|
|
|
+}
|
|
|
+
|
|
|
static rt_err_t bcmgenet_eth_init(rt_device_t device)
|
|
|
{
|
|
|
- struct eth_device *eth_device = (struct eth_device *)device;
|
|
|
- RT_ASSERT(eth_device != RT_NULL);
|
|
|
rt_uint32_t ret = 0;
|
|
|
rt_uint32_t hw_reg = 0;
|
|
|
- struct rt_eth_dev *dev = ð_dev;
|
|
|
-
|
|
|
+
|
|
|
/* Read GENET HW version */
|
|
|
rt_uint8_t major = 0;
|
|
|
- hw_reg = read32(MAC_REG + SYS_REV_CTRL);
|
|
|
+ hw_reg = read32(mac_reg_base_addr + SYS_REV_CTRL);
|
|
|
major = (hw_reg >> 24) & 0x0f;
|
|
|
if (major != 6) {
|
|
|
if (major == 5)
|
|
|
@@ -514,7 +542,6 @@ static rt_err_t bcmgenet_eth_init(rt_device_t device)
|
|
|
rt_kprintf("Uns upported GENETv%d.%d\n", major, (hw_reg >> 16) & 0x0f);
|
|
|
return RT_ERROR;
|
|
|
}
|
|
|
-
|
|
|
/* set interface */
|
|
|
ret = bcmgenet_interface_set();
|
|
|
if (ret)
|
|
|
@@ -523,28 +550,18 @@ static rt_err_t bcmgenet_eth_init(rt_device_t device)
|
|
|
}
|
|
|
|
|
|
/* rbuf clear */
|
|
|
- write32(MAC_REG + SYS_RBUF_FLUSH_CTRL, 0);
|
|
|
+ write32(mac_reg_base_addr + SYS_RBUF_FLUSH_CTRL, 0);
|
|
|
|
|
|
/* disable MAC while updating its registers */
|
|
|
- write32(MAC_REG + UMAC_CMD, 0);
|
|
|
+ write32(mac_reg_base_addr + UMAC_CMD, 0);
|
|
|
/* issue soft reset with (rg)mii loopback to ensure a stable rxclk */
|
|
|
- write32(MAC_REG + UMAC_CMD, CMD_SW_RESET | CMD_LCL_LOOP_EN);
|
|
|
+ write32(mac_reg_base_addr + UMAC_CMD, CMD_SW_RESET | CMD_LCL_LOOP_EN);
|
|
|
|
|
|
- bcmgenet_mdio_init();
|
|
|
-
|
|
|
- bcmgenet_gmac_write_hwaddr();
|
|
|
- bcmgenet_gmac_write_hwaddr();
|
|
|
-
|
|
|
- bcmgenet_gmac_eth_start();
|
|
|
-
|
|
|
- //irq or poll
|
|
|
- rt_timer_init(&dev->rx_poll_timer, "rx_poll_timer",
|
|
|
- eth_rx_irq,
|
|
|
- NULL,
|
|
|
- 1,
|
|
|
- RT_TIMER_FLAG_PERIODIC);
|
|
|
-
|
|
|
- rt_timer_start(&dev->rx_poll_timer);
|
|
|
+ link_thread_tid = rt_thread_create("link",link_task_entry, (void *)device,
|
|
|
+ LINK_THREAD_STACK_SIZE,
|
|
|
+ LINK_THREAD_PRIORITY, LINK_THREAD_TIMESLICE);
|
|
|
+ if (link_thread_tid != RT_NULL)
|
|
|
+ rt_thread_startup(link_thread_tid);
|
|
|
|
|
|
return RT_EOK;
|
|
|
}
|
|
|
@@ -565,15 +582,17 @@ static rt_err_t bcmgenet_eth_control(rt_device_t dev, int cmd, void *args)
|
|
|
|
|
|
rt_err_t rt_eth_tx(rt_device_t device, struct pbuf *p)
|
|
|
{
|
|
|
- rt_uint32_t sendbuf = SEND_DATA_NO_CACHE;
|
|
|
+ rt_uint32_t sendbuf = (rt_uint32_t)eth_send_no_cache;
|
|
|
/* lock eth device */
|
|
|
- rt_sem_take(&sem_lock, RT_WAITING_FOREVER);
|
|
|
- //struct rt_eth_dev *dev = (struct rt_eth_dev *) device;
|
|
|
- pbuf_copy_partial(p, (void *)&send_cache_pbuf[0], p->tot_len, 0);
|
|
|
- rt_memcpy((void *)sendbuf, send_cache_pbuf, p->tot_len);
|
|
|
+ if(link_flag == 1)
|
|
|
+ {
|
|
|
+ rt_sem_take(&sem_lock, RT_WAITING_FOREVER);
|
|
|
+ pbuf_copy_partial(p, (void *)&send_cache_pbuf[0], p->tot_len, 0);
|
|
|
+ rt_memcpy((void *)sendbuf, send_cache_pbuf, p->tot_len);
|
|
|
|
|
|
- bcmgenet_gmac_eth_send((void *)sendbuf, p->tot_len);
|
|
|
- rt_sem_release(&sem_lock);
|
|
|
+ bcmgenet_gmac_eth_send((void *)sendbuf, p->tot_len);
|
|
|
+ rt_sem_release(&sem_lock);
|
|
|
+ }
|
|
|
return RT_EOK;
|
|
|
}
|
|
|
|
|
|
@@ -583,16 +602,19 @@ struct pbuf *rt_eth_rx(rt_device_t device)
|
|
|
int recv_len = 0;
|
|
|
rt_uint32_t addr_point[8];
|
|
|
struct pbuf *pbuf = RT_NULL;
|
|
|
- rt_sem_take(&sem_lock, RT_WAITING_FOREVER);
|
|
|
-
|
|
|
- recv_len = bcmgenet_gmac_eth_recv((rt_uint8_t **)&addr_point[0]);
|
|
|
-
|
|
|
- if(recv_len > 0)
|
|
|
+ if(link_flag == 1)
|
|
|
{
|
|
|
- pbuf = pbuf_alloc(PBUF_LINK, recv_len, PBUF_RAM);
|
|
|
- rt_memcpy(pbuf->payload, (char *)addr_point[0], recv_len);
|
|
|
+ rt_sem_take(&sem_lock, RT_WAITING_FOREVER);
|
|
|
+ recv_len = bcmgenet_gmac_eth_recv((rt_uint8_t **)&addr_point[0]);
|
|
|
+ if(recv_len > 0)
|
|
|
+ {
|
|
|
+ pbuf = pbuf_alloc(PBUF_LINK, recv_len, PBUF_RAM);
|
|
|
+ //calc offset
|
|
|
+ addr_point[0] = (rt_uint32_t)(addr_point[0] + (eth_recv_no_cache - RECV_DATA_NO_CACHE));
|
|
|
+ rt_memcpy(pbuf->payload, (char *)addr_point[0], recv_len);
|
|
|
+ }
|
|
|
+ rt_sem_release(&sem_lock);
|
|
|
}
|
|
|
- rt_sem_release(&sem_lock);
|
|
|
return pbuf;
|
|
|
}
|
|
|
|
|
|
@@ -601,14 +623,14 @@ int rt_hw_eth_init(void)
|
|
|
rt_uint8_t mac_addr[6];
|
|
|
|
|
|
rt_sem_init(&sem_lock, "eth_lock", 1, RT_IPC_FLAG_FIFO);
|
|
|
+ rt_sem_init(&link_ack, "link_ack", 0, RT_IPC_FLAG_FIFO);
|
|
|
|
|
|
memset(ð_dev, 0, sizeof(eth_dev));
|
|
|
- memset((void *)SEND_DATA_NO_CACHE, 0, sizeof(DMA_DISC_ADDR_SIZE));
|
|
|
- memset((void *)RECV_DATA_NO_CACHE, 0, sizeof(DMA_DISC_ADDR_SIZE));
|
|
|
-
|
|
|
+ memset((void *)eth_send_no_cache, 0, sizeof(DMA_DISC_ADDR_SIZE));
|
|
|
+ memset((void *)eth_recv_no_cache, 0, sizeof(DMA_DISC_ADDR_SIZE));
|
|
|
bcm271x_mbox_hardware_get_mac_address(&mac_addr[0]);
|
|
|
|
|
|
- eth_dev.iobase = MAC_REG;
|
|
|
+ eth_dev.iobase = mac_reg_base_addr;
|
|
|
eth_dev.name = "e0";
|
|
|
eth_dev.dev_addr[0] = mac_addr[0];
|
|
|
eth_dev.dev_addr[1] = mac_addr[1];
|
|
|
@@ -629,9 +651,8 @@ int rt_hw_eth_init(void)
|
|
|
eth_dev.parent.eth_tx = rt_eth_tx;
|
|
|
eth_dev.parent.eth_rx = rt_eth_rx;
|
|
|
|
|
|
-
|
|
|
eth_device_init(&(eth_dev.parent), "e0");
|
|
|
- eth_device_linkchange(ð_dev.parent, RT_TRUE); //linkup the e0 for lwip to check
|
|
|
+ eth_device_linkchange(ð_dev.parent, RT_FALSE); //link down
|
|
|
return 0;
|
|
|
}
|
|
|
INIT_COMPONENT_EXPORT(rt_hw_eth_init);
|