#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: mvphy.c,v 1.15 2020/03/15 23:04:50 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/socket.h>
#include <sys/errno.h>
#include <net/if.h>
#include <net/if_media.h>
#include <dev/mii/mii.h>
#include <dev/mii/miivar.h>
#include <dev/mii/miidevs.h>
#include <dev/mii/mvphyreg.h>
#define MV_PORT(sc) ((sc)->mii_phy - 16)
#define MV_CPU_PORT 5
#define MV_READ(p, phy, r, v) \
(*(p)->mii_pdata->mii_readreg)(device_parent((p)->mii_dev), \
(phy), (r), (v))
#define MV_WRITE(p, phy, r, v) \
(*(p)->mii_pdata->mii_writereg)(device_parent((p)->mii_dev), \
(phy), (r), (v))
#define MV_ATUCTRL_ATU_SIZE_DEFAULT 2
#define MV_ATUCTRL_AGE_TIME_DEFAULT 19
#define SM(_v, _f) (((_v) << _f##_S) & _f)
#define MS(_v, _f) (((_v) & _f) >> _f##_S)
static int mvphymatch(device_t, cfdata_t, void *);
static void mvphyattach(device_t, device_t, void *);
CFATTACH_DECL_NEW(mvphy, sizeof(struct mii_softc),
mvphymatch, mvphyattach, mii_phy_detach, mii_phy_activate);
static int mvphy_service(struct mii_softc *, struct mii_data *, int);
static void mvphy_status(struct mii_softc *);
static void mvphy_reset(struct mii_softc *sc);
static const struct mii_phy_funcs mvphy_funcs = {
mvphy_service, mvphy_status, mvphy_reset,
};
static const struct mii_phydesc mvphys[] = {
MII_PHY_DESC(xxMARVELL, E6060),
MII_PHY_END,
};
struct mvPhyConfig {
uint16_t switchPortAddr;
uint16_t vlanSetting;
uint32_t portControl;
};
static const struct mvPhyConfig dumbConfig[] = {
{ 0x18, 0x2e,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x19, 0x2d,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1a, 0x2b,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1b, 0x27,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1c, 0x25,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1d, 0x1f,
MV_PORT_CONTROL_PORT_STATE_FORWARDING }
};
#if 0
static const struct mvPhyConfig routerConfig[] = {
{ 0x18, 0x2e,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x19, 0x2d,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1a, 0x2b,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1b, 0x27,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1c, 0x1020,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1d, 0x0f,
MV_PORT_CONTROL_PORT_STATE_FORWARDING
#if 0
| MV_PORT_CONTROL_INGRESS_TRAILER
| MV_PORT_CONTROL_EGRESS_MODE
#endif
}
};
static const struct mvPhyConfig bridgeConfig[] = {
{ 0x18, 0x3e,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x19, 0x3d,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1a, 0x3b,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1b, 0x37,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1c, 0x37,
MV_PORT_CONTROL_PORT_STATE_FORWARDING },
{ 0x1d, 0x1f,
MV_PORT_CONTROL_PORT_STATE_FORWARDING
#if 0
| MV_PORT_CONTROL_INGRESS_TRAILER
| MV_PORT_CONTROL_EGRESS_MODE
#endif
}
};
#endif
static void mvphy_switchconfig(struct mii_softc *, int);
static void mvphy_flushatu(struct mii_softc *);
static int
mvphymatch(device_t parent, cfdata_t match, void *aux)
{
struct mii_attach_args *ma = aux;
if (mii_phy_match(ma, mvphys) != NULL)
return 10;
return 0;
}
static void
mvphyattach(device_t parent, device_t self, void *aux)
{
struct mii_softc *sc = device_private(self);
struct mii_attach_args *ma = aux;
struct mii_data *mii = ma->mii_data;
const struct mii_phydesc *mpd;
mpd = mii_phy_match(ma, mvphys);
aprint_naive(": Media interface\n");
aprint_normal(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
sc->mii_dev = self;
sc->mii_inst = mii->mii_instance;
sc->mii_phy = ma->mii_phyno;
sc->mii_funcs = &mvphy_funcs;
sc->mii_pdata = mii;
sc->mii_flags = ma->mii_flags;
mii_lock(mii);
if (MV_PORT(sc) == 0) {
MV_WRITE(sc, MII_MV_SWITCH_GLOBAL_ADDR, MV_ATU_CONTROL,
SM(MV_ATUCTRL_AGE_TIME_DEFAULT, MV_ATUCTRL_AGE_TIME)
| SM(MV_ATUCTRL_ATU_SIZE_DEFAULT, MV_ATUCTRL_ATU_SIZE));
mvphy_switchconfig(sc, MV_CPU_PORT);
}
PHY_RESET(sc);
PHY_READ(sc, MII_BMSR, &sc->mii_capabilities);
sc->mii_capabilities &= ma->mii_capmask;
mii_unlock(mii);
mii_phy_add_media(sc);
}
static int
mvphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
{
struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
KASSERT(mii_locked(mii));
switch (cmd) {
case MII_POLLSTAT:
if (IFM_INST(ife->ifm_media) != sc->mii_inst)
return 0;
break;
case MII_MEDIACHG:
if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
return 0;
}
if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
break;
mii_phy_setmedia(sc);
break;
case MII_TICK:
if (IFM_INST(ife->ifm_media) != sc->mii_inst)
return 0;
if (mii_phy_tick(sc) == EJUSTRETURN)
return 0;
break;
case MII_DOWN:
mii_phy_down(sc);
return 0;
}
mii_phy_status(sc);
mii_phy_update(sc, cmd);
return 0;
}
static void
mvphy_status(struct mii_softc *sc)
{
struct mii_data *mii = sc->mii_pdata;
uint16_t hwstatus;
KASSERT(mii_locked(mii));
mii->mii_media_status = IFM_AVALID;
mii->mii_media_active = IFM_ETHER;
PHY_READ(sc, MII_MV_PHY_SPECIFIC_STATUS, &hwstatus);
if (hwstatus & MV_STATUS_REAL_TIME_LINK_UP) {
mii->mii_media_status |= IFM_ACTIVE;
if (hwstatus & MV_STATUS_RESOLVED_SPEED_100)
mii->mii_media_active |= IFM_100_TX;
else
mii->mii_media_active |= IFM_10_T;
if (hwstatus & MV_STATUS_RESOLVED_DUPLEX_FULL)
mii->mii_media_active |= IFM_FDX;
else
mii->mii_media_active |= IFM_HDX;
} else {
mii->mii_media_active |= IFM_NONE;
mvphy_flushatu(sc);
}
}
static void
mvphy_reset(struct mii_softc *sc)
{
KASSERT(mii_locked(sc->mii_pdata));
PHY_WRITE(sc, MII_BMCR, BMCR_RESET | BMCR_AUTOEN);
mvphy_switchconfig(sc, MV_PORT(sc));
}
static void
mvphy_switchconfig(struct mii_softc *sc, int port)
{
const struct mvPhyConfig *conf = &dumbConfig[port];
MV_WRITE(sc, conf->switchPortAddr, MV_PORT_BASED_VLAN_MAP,
conf->vlanSetting);
MV_WRITE(sc, conf->switchPortAddr, MV_PORT_CONTROL, conf->portControl);
MV_WRITE(sc, conf->switchPortAddr, MV_PORT_ASSOCIATION_VECTOR,
1 << port);
}
static void
mvphy_flushatu(struct mii_softc *sc)
{
int status;
uint16_t reg;
int i;
for (i = 0; i < 1000; i++) {
status = MV_READ(sc, MII_MV_SWITCH_GLOBAL_ADDR,
MV_ATU_OPERATION, ®);
if (MV_ATU_IS_BUSY(status))
break;
}
if (i != 1000) {
MV_WRITE(sc, MII_MV_SWITCH_GLOBAL_ADDR, MV_ATU_OPERATION,
MV_ATU_OP_FLUSH_ALL | MV_ATU_BUSY);
}
}