#include <sys/param.h>
#include <sys/device.h>
#include <sys/systm.h>
#include <sys/socket.h>
#include <net/if.h>
#include <net/if_media.h>
#include <dev/mii/mii.h>
#include <dev/mii/miivar.h>
int mii_print(void *, const char *);
int mii_submatch(struct device *, void *, void *);
#define MIICF_PHY 0
#define MIICF_PHY_DEFAULT (-1)
void
mii_attach(struct device *parent, struct mii_data *mii, int capmask,
int phyloc, int offloc, int flags)
{
struct mii_attach_args ma;
struct mii_softc *child;
int bmsr, offset = 0;
int phymin, phymax;
if (phyloc != MII_PHY_ANY && offloc != MII_OFFSET_ANY)
panic("mii_attach: phyloc and offloc specified");
if (phyloc == MII_PHY_ANY) {
phymin = 0;
phymax = MII_NPHY - 1;
} else
phymin = phymax = phyloc;
if ((mii->mii_flags & MIIF_INITDONE) == 0) {
LIST_INIT(&mii->mii_phys);
mii->mii_flags |= MIIF_INITDONE;
}
for (ma.mii_phyno = phymin; ma.mii_phyno <= phymax; ma.mii_phyno++) {
for (child = LIST_FIRST(&mii->mii_phys); child != NULL;
child = LIST_NEXT(child, mii_list)) {
if (child->mii_phy == ma.mii_phyno) {
offset++;
goto loop_end;
}
}
bmsr = (*mii->mii_readreg)(parent, ma.mii_phyno, MII_BMSR);
if (bmsr == 0 || bmsr == 0xffff ||
(bmsr & (BMSR_MEDIAMASK|BMSR_EXTSTAT)) == 0) {
goto loop_end;
}
if (offloc != MII_OFFSET_ANY && offloc != offset) {
offset++;
goto loop_end;
}
ma.mii_id1 = (*mii->mii_readreg)(parent, ma.mii_phyno,
MII_PHYIDR1);
ma.mii_id2 = (*mii->mii_readreg)(parent, ma.mii_phyno,
MII_PHYIDR2);
ma.mii_data = mii;
ma.mii_capmask = capmask;
ma.mii_flags = flags | (mii->mii_flags & MIIF_INHERIT_MASK);
if ((child = (struct mii_softc *)config_found_sm(parent, &ma,
mii_print, mii_submatch)) != NULL) {
LIST_INSERT_HEAD(&mii->mii_phys, child, mii_list);
child->mii_offset = offset;
mii->mii_instance++;
}
offset++;
loop_end: ;
}
}
void
mii_detach(struct mii_data *mii, int phyloc, int offloc)
{
struct mii_softc *child, *nchild;
if (phyloc != MII_PHY_ANY && offloc != MII_PHY_ANY)
panic("mii_detach: phyloc and offloc specified");
if ((mii->mii_flags & MIIF_INITDONE) == 0)
return;
for (child = LIST_FIRST(&mii->mii_phys);
child != NULL; child = nchild) {
nchild = LIST_NEXT(child, mii_list);
if (phyloc != MII_PHY_ANY || offloc != MII_OFFSET_ANY) {
if (phyloc != MII_PHY_ANY &&
phyloc != child->mii_phy)
continue;
if (offloc != MII_OFFSET_ANY &&
offloc != child->mii_offset)
continue;
}
LIST_REMOVE(child, mii_list);
(void) config_detach(&child->mii_dev, DETACH_FORCE);
}
}
int
mii_print(void *aux, const char *pnp)
{
struct mii_attach_args *ma = aux;
if (pnp != NULL)
printf("OUI 0x%06x model 0x%04x rev %d at %s",
MII_OUI(ma->mii_id1, ma->mii_id2), MII_MODEL(ma->mii_id2),
MII_REV(ma->mii_id2), pnp);
printf(" phy %d", ma->mii_phyno);
return (UNCONF);
}
int
mii_submatch(struct device *parent, void *match, void *aux)
{
struct cfdata *cf = match;
struct mii_attach_args *ma = aux;
if (ma->mii_phyno != cf->cf_loc[MIICF_PHY] &&
cf->cf_loc[MIICF_PHY] != MIICF_PHY_DEFAULT)
return (0);
return ((*cf->cf_attach->ca_match)(parent, cf, aux));
}
int
mii_mediachg(struct mii_data *mii)
{
struct mii_softc *child;
int rv;
mii->mii_media_status = 0;
mii->mii_media_active = IFM_NONE;
for (child = LIST_FIRST(&mii->mii_phys); child != NULL;
child = LIST_NEXT(child, mii_list)) {
rv = PHY_SERVICE(child, mii, MII_MEDIACHG);
if (rv)
return (rv);
}
return (0);
}
void
mii_tick(struct mii_data *mii)
{
struct mii_softc *child;
for (child = LIST_FIRST(&mii->mii_phys); child != NULL;
child = LIST_NEXT(child, mii_list))
(void) PHY_SERVICE(child, mii, MII_TICK);
}
void
mii_pollstat(struct mii_data *mii)
{
struct mii_softc *child;
mii->mii_media_status = 0;
mii->mii_media_active = IFM_NONE;
for (child = LIST_FIRST(&mii->mii_phys); child != NULL;
child = LIST_NEXT(child, mii_list))
(void) PHY_SERVICE(child, mii, MII_POLLSTAT);
}
void
mii_down(struct mii_data *mii)
{
struct mii_softc *child;
for (child = LIST_FIRST(&mii->mii_phys); child != NULL;
child = LIST_NEXT(child, mii_list))
(void) PHY_SERVICE(child, mii, MII_DOWN);
}