Resolve M487 EMAC bus error by bus reset

Author: cyliangtw

features/netsocket/emac-drivers/TARGET_NUVOTON_EMAC/TARGET_M480/m480_eth.c

@@ -18,22 +18,27 @@
  */
 #include "m480_eth.h"
 #include "mbed_toolchain.h"
+#define NU_TRACE
 #include "numaker_eth_hal.h"
 
 #define ETH_TRIGGER_RX()    do{EMAC->RXST = 0;}while(0)
 #define ETH_TRIGGER_TX()    do{EMAC->TXST = 0;}while(0)
 #define ETH_ENABLE_TX()     do{EMAC->CTL |= EMAC_CTL_TXON;}while(0)
-#define ETH_ENABLE_RX()     do{EMAC->CTL |= EMAC_CTL_RXON;}while(0)
+#define ETH_ENABLE_RX()     do{EMAC->CTL |= EMAC_CTL_RXON_Msk;}while(0)
 #define ETH_DISABLE_TX()    do{EMAC->CTL &= ~EMAC_CTL_TXON;}while(0)
-#define ETH_DISABLE_RX()    do{EMAC->CTL &= ~EMAC_CTL_RXON;}while(0)
+#define ETH_DISABLE_RX()    do{EMAC->CTL &= ~EMAC_CTL_RXON_Msk;}while(0)
 
+#define EMAC_ENABLE_INT(emac, u32eIntSel)    ((emac)->INTEN |= (u32eIntSel))
+#define EMAC_DISABLE_INT(emac, u32eIntSel)    ((emac)->INTEN &= ~ (u32eIntSel))    
 
 MBED_ALIGN(4) struct eth_descriptor rx_desc[RX_DESCRIPTOR_NUM];
 MBED_ALIGN(4) struct eth_descriptor tx_desc[TX_DESCRIPTOR_NUM];
 
 struct eth_descriptor volatile *cur_tx_desc_ptr, *cur_rx_desc_ptr, *fin_tx_desc_ptr;
 
+__attribute__ ((section("EMAC_RAM")))
 MBED_ALIGN(4) uint8_t rx_buf[RX_DESCRIPTOR_NUM][PACKET_BUFFER_SIZE];
+__attribute__ ((section("EMAC_RAM")))
 MBED_ALIGN(4) uint8_t tx_buf[TX_DESCRIPTOR_NUM][PACKET_BUFFER_SIZE];
 
 eth_callback_t nu_eth_txrx_cb = NULL;
@@ -164,7 +169,7 @@ static void init_rx_desc(void)
         rx_desc[i].status1 = OWNERSHIP_EMAC;
         rx_desc[i].buf = &rx_buf[i][0];
         rx_desc[i].status2 = 0;
-        rx_desc[i].next = &rx_desc[(i + 1) % TX_DESCRIPTOR_NUM];
+        rx_desc[i].next = &rx_desc[(i + 1) % RX_DESCRIPTOR_NUM];
     }
     EMAC->RXDSA = (unsigned int)&rx_desc[0];
     return;
@@ -263,6 +268,11 @@ void numaker_eth_init(uint8_t *mac_addr)
                     EMAC_CAMCTL_AMP_Msk |
                     EMAC_CAMCTL_ABP_Msk;
     EMAC->CAMEN = 1;    // Enable CAM entry 0    
+    /* Limit the max receive frame length to 1514 + 4 */
+    EMAC->MRFL = 1518;    
+
+    /* Set RX FIFO threshold as 8 words */
+    EMAC->FIFOCTL = 0x00200100;
 
     /* Limit the max receive frame length to 1514 + 4 */
     EMAC->MRFL = NU_ETH_MAX_FLEN;    
@@ -285,20 +295,22 @@ unsigned int m_status;
 
 void EMAC_RX_IRQHandler(void)
 {
-//    NU_DEBUGF(("%s ... nu_eth_txrx_cb=0x%x\r\n", __FUNCTION__, nu_eth_txrx_cb));
     m_status = EMAC->INTSTS & 0xFFFF;
     EMAC->INTSTS = m_status;
     if (m_status & EMAC_INTSTS_RXBEIF_Msk) {
         // Shouldn't goes here, unless descriptor corrupted
-		NU_DEBUGF(("RX descriptor corrupted \r\n"));
-		//return;
+        mbed_error_printf("### RX Bus error [0x%x]\r\n", m_status);
+        if (nu_eth_txrx_cb != NULL) nu_eth_txrx_cb('B', nu_userData); 
+        return;
     }
+    EMAC_DISABLE_INT(EMAC, (EMAC_INTEN_RDUIEN_Msk | EMAC_INTEN_RXGDIEN_Msk));
 	if (nu_eth_txrx_cb != NULL) nu_eth_txrx_cb('R', nu_userData); 
 }
 
 
 void numaker_eth_trigger_rx(void)
 {
+    EMAC_ENABLE_INT(EMAC, (EMAC_INTEN_RDUIEN_Msk | EMAC_INTEN_RXGDIEN_Msk));
     ETH_TRIGGER_RX();
 }
 
@@ -317,6 +329,12 @@ int numaker_eth_get_rx_buf(uint16_t *len, uint8_t **buf)
     if (status & RXFD_RXGD) {
         *buf = cur_rx_desc_ptr->buf;
         *len = status & 0xFFFF;
+        if( *len > 1514 ) {
+            NU_DEBUGF(("%s... unexpected long packet length=%d, buf=0x%x\r\n", __FUNCTION__, *len, *buf));
+
+            *len = 0; // Skip this unexpected long packet
+        }
+        if( *len == 1514 ) NU_DEBUGF(("%s... length=%d, buf=0x%x\r\n", __FUNCTION__, *len, *buf));
     }
     return 0;
 }    
@@ -335,6 +353,8 @@ void EMAC_TX_IRQHandler(void)
     EMAC->INTSTS = status;
     if(status & EMAC_INTSTS_TXBEIF_Msk) {
         // Shouldn't goes here, unless descriptor corrupted
+        mbed_error_printf("### TX Bus error [0x%x]\r\n", status);
+        if (nu_eth_txrx_cb != NULL) nu_eth_txrx_cb('B', nu_userData); 
         return;
     }
 

features/netsocket/emac-drivers/TARGET_NUVOTON_EMAC/numaker_emac.cpp

@@ -48,6 +48,7 @@ extern "C" void numaker_eth_rx_next(void);
 /* \brief Flags for worker thread */
 #define FLAG_TX  1
 #define FLAG_RX  2
+#define FLAG_BUS_RESET 4
 
 /** \brief  Driver thread priority */
 #define THREAD_PRIORITY (osPriorityNormal)
@@ -82,6 +83,13 @@ void NUMAKER_EMAC::rx_isr()
     }
 }
 
+void NUMAKER_EMAC::bus_isr()
+{
+    if (thread) {
+        osThreadFlagsSet(thread, FLAG_BUS_RESET);
+    }
+}
+
 void NUMAKER_EMAC::tx_isr()
 {
   /* No-op at this stage */    
@@ -98,6 +106,8 @@ void NUMAKER_EMAC::ethernet_callback(char event, void *param)
       case 'T': //For TX event
         enet->tx_isr();
         break;
+      case 'B': // For BUS event
+        enet->bus_isr();
       default:
         break;
     }
@@ -172,10 +182,13 @@ void NUMAKER_EMAC::thread_function(void* pvParameters)
     static struct NUMAKER_EMAC *nu_enet = static_cast<NUMAKER_EMAC *>(pvParameters);
 
     for (;;) {
-        uint32_t flags = osThreadFlagsWait(FLAG_RX, osFlagsWaitAny, osWaitForever);
+        uint32_t flags = osThreadFlagsWait(FLAG_RX | FLAG_BUS_RESET, osFlagsWaitAny, osWaitForever);
 
         if (flags & FLAG_RX) {
             nu_enet->packet_rx();
+        } else if (flags & FLAG_BUS_RESET) {
+            NU_DEBUGF(("RX BUS error and reset bus\r\n"));
+            nu_enet->bus_reset();
         }
     }
 }
@@ -304,7 +317,7 @@ bool NUMAKER_EMAC::power_up()
     return false;
 
   /* Worker thread */
-  thread = create_new_thread("numaker_emac_thread", &NUMAKER_EMAC::thread_function, this, THREAD_STACKSIZE, THREAD_PRIORITY, &thread_cb);
+    thread = create_new_thread("numaker_emac_thread", &NUMAKER_EMAC::thread_function, this, THREAD_STACKSIZE * 2, THREAD_PRIORITY, &thread_cb);
 
   /* PHY monitoring task */
   phy_state = PHY_UNLINKED_STATE;
@@ -317,6 +330,15 @@ bool NUMAKER_EMAC::power_up()
   return true;
 }
 
+bool NUMAKER_EMAC::bus_reset()
+{
+  /* Initialize the hardware */
+  if (!low_level_init_successful())
+    return false;
+  numaker_eth_enable_interrupts();
+  return true;
+}
+
 
 uint32_t NUMAKER_EMAC::get_mtu_size() const
 {

features/netsocket/emac-drivers/TARGET_NUVOTON_EMAC/numaker_emac.h

@@ -151,9 +151,11 @@ class NUMAKER_EMAC : public EMAC {
     bool low_level_init_successful();
     void tx_isr();
     void rx_isr();
+    void bus_isr();
     void packet_rx();
+    bool bus_reset();
     int low_level_input(emac_mem_buf_t **buf);
-    static void thread_function(void* pvParameters);
+    static void thread_function(void *pvParameters);
     void phy_task();
     static void ethernet_callback(char event, void *param);