From 7c909980ef2893ac70e04864c9326f90b4d05a66 Mon Sep 17 00:00:00 2001
From: Andrew Turner <andrew@FreeBSD.org>
Date: Fri, 22 May 2015 14:25:23 +0000
Subject: [PATCH] Add a miibus_statchg and use it to enable Gigabit mode when
 appropriate.

MFC after:	1 week
---
 sys/arm/ti/cpsw/if_cpsw.c | 32 ++++++++++++++++++++++++++++++++
 1 file changed, 32 insertions(+)

diff --git a/sys/arm/ti/cpsw/if_cpsw.c b/sys/arm/ti/cpsw/if_cpsw.c
index f74609557bf3..a27393dd10d3 100644
--- a/sys/arm/ti/cpsw/if_cpsw.c
+++ b/sys/arm/ti/cpsw/if_cpsw.c
@@ -113,6 +113,7 @@ static int cpsw_ioctl(struct ifnet *, u_long command, caddr_t data);
 
 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 phy, int reg, int value)
 	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.