stm32/eth_phy: Add support for RTL8211 inititialization.

This gets the status indicator working on the RTL8211.

Signed-off-by: Damien George <[email protected]>

Author: dpgeorge

ports/stm32/eth.c

@@ -219,6 +219,7 @@ int eth_init(eth_t *self, int mac_idx, uint32_t phy_addr, int phy_type) {
     } else if (phy_type == ETH_PHY_LAN8720 || phy_type == ETH_PHY_LAN8742) {
         self->phy_get_link_status = eth_phy_lan87xx_get_link_status;
     } else if (phy_type == ETH_PHY_RTL8211) {
+        self->phy_init = eth_phy_rtl8211_init;
         self->phy_get_link_status = eth_phy_rtl8211_get_link_status;
     } else {
         return -1;

ports/stm32/eth_phy.c

@@ -47,6 +47,8 @@
 #define PHY_RTL8211_PHYSR_SPEED_Pos     (4)
 #define PHY_RTL8211_PHYSR_SPEED_Msk     (3 << PHY_RTL8211_PHYSR_SPEED_Pos)
 #define PHY_RTL8211_PHYSR_DUPLEX_Msk    (0x0008)
+#define PHY_RTL8211_LCR_PAGE            (0xd04)
+#define PHY_RTL8211_LCR_ADDR            (0x10)
 
 void eth_phy_generic_init(uint32_t phy_addr) {
     // Reset the PHY.
@@ -81,6 +83,16 @@ int16_t eth_phy_dp838xx_get_link_status(uint32_t phy_addr) {
     return scsr;
 }
 
+void eth_phy_rtl8211_init(uint32_t phy_addr) {
+    // Perform generic PHY initialization.
+    eth_phy_generic_init(phy_addr);
+
+    // Configure LED0 output to show 10/100/1000 link speed, and activity.
+    eth_phy_write(phy_addr, PHY_RTL8211_PAGSR_ADDR, PHY_RTL8211_LCR_PAGE);
+    eth_phy_write(phy_addr, PHY_RTL8211_LCR_ADDR, 0x001b);
+    eth_phy_write(phy_addr, PHY_RTL8211_PAGSR_ADDR, PHY_RTL8211_DEFAULT_PAGE);
+}
+
 int16_t eth_phy_rtl8211_get_link_status(uint32_t phy_addr) {
     // Get the link mode & speed
     eth_phy_write(phy_addr, PHY_RTL8211_PAGSR_ADDR, PHY_RTL8211_PHYSR_PAGE);

ports/stm32/eth_phy.h

@@ -64,6 +64,7 @@ void eth_phy_write(uint32_t phy_addr, uint32_t reg, uint32_t val);
 void eth_phy_generic_init(uint32_t phy_addr);
 int16_t eth_phy_lan87xx_get_link_status(uint32_t phy_addr);
 int16_t eth_phy_dp838xx_get_link_status(uint32_t phy_addr);
+void eth_phy_rtl8211_init(uint32_t phy_addr);
 int16_t eth_phy_rtl8211_get_link_status(uint32_t phy_addr);
 
 #endif