#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/socket.h>
#include <sys/bus.h>
#include <net/if.h>
#include <net/if_var.h>
#include <net/if_media.h>
#include <dev/netif/mii_layer/mii.h>
#include <dev/netif/mii_layer/miivar.h>
#include <dev/netif/mii_layer/ruephyreg.h>
#include "miibus_if.h"
static int ruephy_probe(device_t);
static int ruephy_attach(device_t);
static device_method_t ruephy_methods[] = {
DEVMETHOD(device_probe, ruephy_probe),
DEVMETHOD(device_attach, ruephy_attach),
DEVMETHOD(device_detach, ukphy_detach),
DEVMETHOD(device_shutdown, bus_generic_shutdown),
DEVMETHOD_END
};
static devclass_t ruephy_devclass;
static driver_t ruephy_driver = {
"ruephy",
ruephy_methods,
sizeof(struct mii_softc)
};
DRIVER_MODULE(ruephy, miibus, ruephy_driver, ruephy_devclass, NULL, NULL);
static int ruephy_service(struct mii_softc *, struct mii_data *, int);
static void ruephy_reset(struct mii_softc *);
static void ruephy_status(struct mii_softc *);
static int
ruephy_probe(device_t dev)
{
struct mii_attach_args *ma;
device_t parent;
ma = device_get_ivars(dev);
parent = device_get_parent(device_get_parent(dev));
if (MII_OUI(ma->mii_id1, ma->mii_id2) != 0 ||
MII_MODEL(ma->mii_id2) != 0)
return (ENXIO);
if (strcmp(device_get_name(parent), "rue") != 0)
return (ENXIO);
device_set_desc(dev, "RealTek RTL8150 internal media interface");
return (0);
}
static int
ruephy_attach(device_t dev)
{
struct mii_softc *sc;
struct mii_attach_args *ma;
struct mii_data *mii;
sc = device_get_softc(dev);
ma = device_get_ivars(dev);
mii_softc_init(sc, ma);
sc->mii_dev = device_get_parent(dev);
mii = device_get_softc(sc->mii_dev);
if (mii->mii_instance != 0) {
device_printf(dev, "ignoring this PHY, non-zero instance\n");
return (ENXIO);
}
LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list);
sc->mii_inst = mii->mii_instance;
sc->mii_service = ruephy_service;
sc->mii_reset = ruephy_reset;
sc->mii_pdata = mii;
mii->mii_instance++;
sc->mii_flags |= MIIF_NOISOLATE;
ruephy_reset(sc);
sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask;
device_printf(dev, " ");
if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0)
kprintf("no media present");
else
mii_phy_add_media(sc);
kprintf("\n");
MIIBUS_MEDIAINIT(sc->mii_dev);
return (0);
}
static int
ruephy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
{
struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
int reg;
KASSERT(IFM_INST(ife->ifm_media) == sc->mii_inst,
("ruephy_service: can't isolate RealTek RTL8150 PHY"));
switch (cmd) {
case MII_POLLSTAT:
break;
case MII_MEDIACHG:
if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
break;
if (IFM_SUBTYPE(ife->ifm_media) == IFM_100_T4) {
return (EINVAL);
}
mii_phy_set_media(sc);
break;
case MII_TICK:
if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
return (0);
if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO)
break;
reg = PHY_READ(sc, RUEPHY_MII_MSR) |
PHY_READ(sc, RUEPHY_MII_MSR);
if (reg & RUEPHY_MSR_LINK) {
sc->mii_ticks = 0;
break;
}
if (++sc->mii_ticks != 5)
return (0);
sc->mii_ticks = 0;
ruephy_reset(sc);
if (mii_phy_auto(sc, 0) == EJUSTRETURN)
return (0);
break;
}
ruephy_status(sc);
mii_phy_update(sc, cmd);
return (0);
}
static void
ruephy_reset(struct mii_softc *sc)
{
mii_phy_reset(sc);
PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN);
}
static void
ruephy_status(struct mii_softc *sc)
{
struct mii_data *mii = sc->mii_pdata;
int bmsr, bmcr, msr;
mii->mii_media_status = IFM_AVALID;
mii->mii_media_active = IFM_ETHER;
msr = PHY_READ(sc, RUEPHY_MII_MSR) | PHY_READ(sc, RUEPHY_MII_MSR);
if (msr & RUEPHY_MSR_LINK)
mii->mii_media_status |= IFM_ACTIVE;
bmcr = PHY_READ(sc, MII_BMCR);
if (bmcr & BMCR_ISO) {
mii->mii_media_active |= IFM_NONE;
mii->mii_media_status = 0;
return;
}
bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
if (bmcr & BMCR_AUTOEN) {
if ((bmsr & BMSR_ACOMP) == 0) {
mii->mii_media_active |= IFM_NONE;
return;
}
if (msr & RUEPHY_MSR_SPEED100)
mii->mii_media_active |= IFM_100_TX;
else
mii->mii_media_active |= IFM_10_T;
if (msr & RUEPHY_MSR_DUPLEX)
mii->mii_media_active |= IFM_FDX;
} else {
mii->mii_media_active = mii->mii_media.ifm_cur->ifm_media;
}
}