[PATCH] Add PHY-driver for KSZ8091RNB with 50MHz.

[Christian Mauderer]

This adds a driver for the KSZ8091RNB PHY. This PHY needs some special
treatment if it is clocked with a 50MHz clock.
---
 libbsd.py                               |   6 ++
 rtemsbsd/sys/dev/mii/ksz8091rnb_50MHz.c | 185 ++++++++++++++++++++++++++++++++
 2 files changed, 191 insertions(+)
 create mode 100644 rtemsbsd/sys/dev/mii/ksz8091rnb_50MHz.c

diff --git a/libbsd.py b/libbsd.py
index 08c8918f..90bc2af7 100644
--- a/libbsd.py
+++ b/libbsd.py
@@ -1395,6 +1395,12 @@ class dev_net(builder.Module):
             ],
             mm.generator['source']()
         )
+        self.addRTEMSSourceFiles(
+            [
+                'sys/dev/mii/ksz8091rnb_50MHz.c',
+            ],
+            mm.generator['source']()
+        )
 
 #
 # Network Interface Controllers (NIC)
diff --git a/rtemsbsd/sys/dev/mii/ksz8091rnb_50MHz.c b/rtemsbsd/sys/dev/mii/ksz8091rnb_50MHz.c
new file mode 100644
index 00000000..d45534bf
--- /dev/null
+++ b/rtemsbsd/sys/dev/mii/ksz8091rnb_50MHz.c
@@ -0,0 +1,185 @@
+#include <machine/rtems-bsd-kernel-space.h>
+
+/*-
+ * Copyright (c) 1998, 1999 The NetBSD Foundation, Inc.
+ * All rights reserved.
+ *
+ * This code is derived from software contributed to The NetBSD Foundation
+ * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
+ * NASA Ames Research Center, and by Frank van der Linden.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
+ * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
+ * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
+ * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
+ * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+/*-
+ * Copyright (c) 1997 Manuel Bouyer.  All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+/*
+ * A PHY driver for the KSZ8091RNB in a 50MHz configuration. This PHY needs an
+ * extra bit set in one of it's config registers for the 50MHz mode. If you have
+ * that hardware configuration, you can link in this driver.
+ *
+ * This driver is based on the ksz8091rnb.
+ */
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/socket.h>
+#include <sys/errno.h>
+#include <sys/module.h>
+#include <sys/bus.h>
+
+#include <net/if.h>
+#include <net/if_media.h>
+
+#include <dev/mii/mii.h>
+#include <dev/mii/miivar.h>
+#include <rtems/bsd/local/miidevs.h>
+
+#include <rtems/bsd/local/miibus_if.h>
+
+#define MII_KSZ8091RNB_PHY_CTRL2 0x1F
+#define MII_KSZ8091RNB_PHY_CTRL2_REFCLK_SELECT 0x0080
+
+static int ksz8091rnb_probe(device_t);
+static int ksz8091rnb_attach(device_t);
+
+static device_method_t ksz8091rnb_methods[] = {
+	/* device interface */
+	DEVMETHOD(device_probe,		ksz8091rnb_probe),
+	DEVMETHOD(device_attach,	ksz8091rnb_attach),
+	DEVMETHOD(device_detach,	mii_phy_detach),
+	DEVMETHOD(device_shutdown,	bus_generic_shutdown),
+	DEVMETHOD_END
+};
+
+static devclass_t ksz8091rnb_devclass;
+
+static driver_t ksz8091rnb_driver = {
+	"ksz8091rnb",
+	ksz8091rnb_methods,
+	sizeof(struct mii_softc)
+};
+
+DRIVER_MODULE(ksz8091rnb, miibus, ksz8091rnb_driver, ksz8091rnb_devclass, 0, 0);
+
+static const struct mii_phydesc ksz8091rnbphys[] = {
+	{
+		.mpd_oui=MII_OUI_MICREL,
+		.mpd_model=0x16,
+		.mpd_name="Microchip KSZ8091RNB with 50MHz clock"
+	},
+	MII_PHY_END
+};
+
+static int	ksz8091rnb_service(struct mii_softc *, struct mii_data *, int);
+static void	ksz8091rnb_phy_reset(struct mii_softc *);
+
+static const struct mii_phy_funcs ksz8091rnb_funcs = {
+	ksz8091rnb_service,
+	ukphy_status,
+	ksz8091rnb_phy_reset
+};
+
+static int
+ksz8091rnb_probe(device_t dev)
+{
+
+	return (mii_phy_dev_probe(dev, ksz8091rnbphys, BUS_PROBE_DEFAULT));
+}
+
+static int
+ksz8091rnb_attach(device_t dev)
+{
+	struct mii_softc *sc;
+
+	sc = device_get_softc(dev);
+
+	mii_phy_dev_attach(dev, MIIF_NOMANPAUSE, &ksz8091rnb_funcs, 1);
+	mii_phy_setmedia(sc);
+
+	return (0);
+}
+
+static void
+ksz8091rnb_phy_reset(struct mii_softc *sc)
+{
+	uint16_t ctrl2;
+
+	mii_phy_reset(sc);
+
+	/* Set 50MHz */
+	ctrl2 = PHY_READ(sc, MII_KSZ8091RNB_PHY_CTRL2);
+	ctrl2 |= MII_KSZ8091RNB_PHY_CTRL2_REFCLK_SELECT;
+	PHY_WRITE(sc, MII_KSZ8091RNB_PHY_CTRL2, ctrl2);
+}
+
+static int
+ksz8091rnb_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
+{
+
+	switch (cmd) {
+	case MII_POLLSTAT:
+		break;
+
+	case MII_MEDIACHG:
+		mii_phy_setmedia(sc);
+		break;
+
+	case MII_TICK:
+		if (mii_phy_tick(sc) == EJUSTRETURN)
+			return (0);
+		break;
+	}
+
+	/* Update the media status. */
+	PHY_STATUS(sc);
+
+	/* Callback if something changed. */
+	mii_phy_update(sc, cmd);
+	return (0);
+}
-- 
2.13.7