Author: andrew
Date: Fri May 22 14:25:23 2015
New Revision: 283287
URL: https://svnweb.freebsd.org/changeset/base/283287

Log:
  Add a miibus_statchg and use it to enable Gigabit mode when appropriate.
  
  MFC after:    1 week

Modified:
  head/sys/arm/ti/cpsw/if_cpsw.c

Modified: head/sys/arm/ti/cpsw/if_cpsw.c
==============================================================================
--- head/sys/arm/ti/cpsw/if_cpsw.c      Fri May 22 12:01:29 2015        
(r283286)
+++ head/sys/arm/ti/cpsw/if_cpsw.c      Fri May 22 14:25:23 2015        
(r283287)
@@ -113,6 +113,7 @@ static int cpsw_ioctl(struct ifnet *, u_
 
 static int cpsw_miibus_readreg(device_t, int phy, int reg);
 static int cpsw_miibus_writereg(device_t, int phy, int reg, int value);
+static void cpsw_miibus_statchg(device_t);
 
 /* Send/Receive packets. */
 static void cpsw_intr_rx(void *arg);
@@ -179,6 +180,7 @@ static device_method_t cpsw_methods[] = 
        /* MII interface */
        DEVMETHOD(miibus_readreg,       cpsw_miibus_readreg),
        DEVMETHOD(miibus_writereg,      cpsw_miibus_writereg),
+       DEVMETHOD(miibus_statchg,       cpsw_miibus_statchg),
        { 0, 0 }
 };
 
@@ -1265,6 +1267,36 @@ cpsw_miibus_writereg(device_t dev, int p
        return 0;
 }
 
+static void
+cpsw_miibus_statchg(device_t dev)
+{
+       struct cpsw_softc *sc = device_get_softc(dev);
+       uint32_t mac_control;
+       int i;
+
+       CPSW_DEBUGF((""));
+
+       for (i = 0; i < 2; i++) {
+               mac_control = cpsw_read_4(sc, CPSW_SL_MACCONTROL(i));
+               mac_control &= ~(1 << 15 | 1 << 7);
+
+               switch(IFM_SUBTYPE(sc->mii->mii_media_active)) {
+               case IFM_1000_SX:
+               case IFM_1000_LX:
+               case IFM_1000_CX:
+               case IFM_1000_T:
+                       mac_control |= 1 << 7;
+                       break;
+
+               default:
+                       mac_control |= 1 << 15;
+                       break;
+               }
+
+               cpsw_write_4(sc, CPSW_SL_MACCONTROL(i), mac_control);
+       }
+}
+
 /*
  *
  * Transmit/Receive Packets.
_______________________________________________
svn-src-head@freebsd.org mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-head
To unsubscribe, send any mail to "svn-src-head-unsubscr...@freebsd.org"

Reply via email to