[BACK]Return to xmphy.c CVS log [TXT][DIR] Up to [local] / sys / dev / mii

Annotation of sys/dev/mii/xmphy.c, Revision 1.1

1.1     ! nbrk        1: /*     $OpenBSD: xmphy.c,v 1.17 2006/12/31 15:04:33 krw Exp $  */
        !             2:
        !             3: /*
        !             4:  * Copyright (c) 2000
        !             5:  *     Bill Paul <wpaul@ee.columbia.edu>.  All rights reserved.
        !             6:  *
        !             7:  * Redistribution and use in source and binary forms, with or without
        !             8:  * modification, are permitted provided that the following conditions
        !             9:  * are met:
        !            10:  * 1. Redistributions of source code must retain the above copyright
        !            11:  *    notice, this list of conditions and the following disclaimer.
        !            12:  * 2. Redistributions in binary form must reproduce the above copyright
        !            13:  *    notice, this list of conditions and the following disclaimer in the
        !            14:  *    documentation and/or other materials provided with the distribution.
        !            15:  * 3. All advertising materials mentioning features or use of this software
        !            16:  *    must display the following acknowledgement:
        !            17:  *     This product includes software developed by Bill Paul.
        !            18:  * 4. Neither the name of the author nor the names of any co-contributors
        !            19:  *    may be used to endorse or promote products derived from this software
        !            20:  *    without specific prior written permission.
        !            21:  *
        !            22:  * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
        !            23:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
        !            24:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
        !            25:  * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
        !            26:  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
        !            27:  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
        !            28:  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
        !            29:  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
        !            30:  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
        !            31:  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
        !            32:  * THE POSSIBILITY OF SUCH DAMAGE.
        !            33:  *
        !            34:  * $FreeBSD: src/sys/dev/mii/xmphy.c,v 1.1 2000/04/22 01:58:18 wpaul Exp $
        !            35:  */
        !            36:
        !            37: /*
        !            38:  * driver for the XaQti XMAC II's internal PHY. This is sort of
        !            39:  * like a 10/100 PHY, except the only thing we're really autoselecting
        !            40:  * here is full/half duplex. Speed is always 1000mbps.
        !            41:  */
        !            42:
        !            43: #include <sys/param.h>
        !            44: #include <sys/systm.h>
        !            45: #include <sys/kernel.h>
        !            46: #include <sys/device.h>
        !            47: #include <sys/socket.h>
        !            48: #include <sys/errno.h>
        !            49:
        !            50: #include <net/if.h>
        !            51: #include <net/if_media.h>
        !            52:
        !            53: #include <dev/mii/mii.h>
        !            54: #include <dev/mii/miivar.h>
        !            55: #include <dev/mii/miidevs.h>
        !            56:
        !            57: #include <dev/mii/xmphyreg.h>
        !            58:
        !            59: int xmphy_probe(struct device *, void *, void *);
        !            60: void xmphy_attach(struct device *, struct device *, void *);
        !            61:
        !            62: struct cfattach xmphy_ca = {
        !            63:        sizeof(struct mii_softc), xmphy_probe, xmphy_attach, mii_phy_detach,
        !            64:            mii_phy_activate
        !            65: };
        !            66:
        !            67: struct cfdriver xmphy_cd = {
        !            68:        NULL, "xmphy", DV_DULL
        !            69: };
        !            70:
        !            71: int    xmphy_service(struct mii_softc *, struct mii_data *, int);
        !            72: void   xmphy_status(struct mii_softc *);
        !            73:
        !            74: int    xmphy_mii_phy_auto(struct mii_softc *);
        !            75:
        !            76: const struct mii_phy_funcs xmphy_funcs = {
        !            77:        xmphy_service, xmphy_status, mii_phy_reset,
        !            78: };
        !            79:
        !            80: static const struct mii_phydesc xmphys[] = {
        !            81:        { MII_OUI_xxXAQTI,      MII_MODEL_XAQTI_XMACII,
        !            82:          MII_STR_XAQTI_XMACII },
        !            83:
        !            84:        { MII_OUI_JATO,         MII_MODEL_JATO_BASEX,
        !            85:          MII_STR_JATO_BASEX },
        !            86:
        !            87:        { 0,                    0,
        !            88:          NULL },
        !            89: };
        !            90:
        !            91: int xmphy_probe(struct device *parent, void *match, void *aux)
        !            92: {
        !            93:        struct mii_attach_args *ma = aux;
        !            94:
        !            95:        if (mii_phy_match(ma, xmphys) != NULL)
        !            96:                return (10);
        !            97:
        !            98:        return (0);
        !            99: }
        !           100:
        !           101: void
        !           102: xmphy_attach(struct device *parent, struct device *self, void *aux)
        !           103: {
        !           104:        struct mii_softc *sc = (struct mii_softc *)self;
        !           105:        struct mii_attach_args *ma = aux;
        !           106:        struct mii_data *mii = ma->mii_data;
        !           107:        const struct mii_phydesc *mpd;
        !           108:
        !           109:        mpd = mii_phy_match(ma, xmphys);
        !           110:        printf(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2));
        !           111:
        !           112:        sc->mii_inst = mii->mii_instance;
        !           113:        sc->mii_phy = ma->mii_phyno;
        !           114:        sc->mii_funcs = &xmphy_funcs;
        !           115:        sc->mii_pdata = mii;
        !           116:        sc->mii_flags = ma->mii_flags;
        !           117:        sc->mii_anegticks = MII_ANEGTICKS;
        !           118:
        !           119:        sc->mii_flags |= MIIF_NOISOLATE;
        !           120:
        !           121: #define        ADD(m, c)       ifmedia_add(&mii->mii_media, (m), (c), NULL)
        !           122:
        !           123:        ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst),
        !           124:            BMCR_ISO);
        !           125:
        !           126:        PHY_RESET(sc);
        !           127:
        !           128:        ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_SX, 0, sc->mii_inst),
        !           129:            XMPHY_BMCR_FDX);
        !           130:        ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_SX, IFM_FDX, sc->mii_inst), 0);
        !           131:        ADD(IFM_MAKEWORD(IFM_ETHER, IFM_AUTO, 0, sc->mii_inst), 0);
        !           132:
        !           133: #undef ADD
        !           134: }
        !           135:
        !           136: int
        !           137: xmphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd)
        !           138: {
        !           139:        struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
        !           140:        int reg;
        !           141:
        !           142:        if ((sc->mii_dev.dv_flags & DVF_ACTIVE) == 0)
        !           143:                return (ENXIO);
        !           144:
        !           145:        switch (cmd) {
        !           146:        case MII_POLLSTAT:
        !           147:                /*
        !           148:                 * If we're not polling our PHY instance, just return.
        !           149:                 */
        !           150:                if (IFM_INST(ife->ifm_media) != sc->mii_inst)
        !           151:                        return (0);
        !           152:                break;
        !           153:
        !           154:        case MII_MEDIACHG:
        !           155:                /*
        !           156:                 * If the media indicates a different PHY instance,
        !           157:                 * isolate ourselves.
        !           158:                 */
        !           159:                if (IFM_INST(ife->ifm_media) != sc->mii_inst) {
        !           160:                        reg = PHY_READ(sc, MII_BMCR);
        !           161:                        PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO);
        !           162:                        return (0);
        !           163:                }
        !           164:
        !           165:                /*
        !           166:                 * If the interface is not up, don't do anything.
        !           167:                 */
        !           168:                if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
        !           169:                        break;
        !           170:
        !           171:                switch (IFM_SUBTYPE(ife->ifm_media)) {
        !           172:                case IFM_AUTO:
        !           173:                        (void) xmphy_mii_phy_auto(sc);
        !           174:                        break;
        !           175:                case IFM_1000_SX:
        !           176:                        PHY_RESET(sc);
        !           177:                        if ((ife->ifm_media & IFM_GMASK) == IFM_FDX) {
        !           178:                                PHY_WRITE(sc, XMPHY_MII_ANAR, XMPHY_ANAR_FDX);
        !           179:                                PHY_WRITE(sc, XMPHY_MII_BMCR, XMPHY_BMCR_FDX);
        !           180:                        } else {
        !           181:                                PHY_WRITE(sc, XMPHY_MII_ANAR, XMPHY_ANAR_HDX);
        !           182:                                PHY_WRITE(sc, XMPHY_MII_BMCR, 0);
        !           183:                        }
        !           184:                        break;
        !           185:                case IFM_100_T4:
        !           186:                case IFM_100_TX:
        !           187:                case IFM_10_T:
        !           188:                default:
        !           189:                        return (EINVAL);
        !           190:                }
        !           191:                break;
        !           192:
        !           193:        case MII_TICK:
        !           194:                /*
        !           195:                 * If we're not currently selected, just return.
        !           196:                 */
        !           197:                if (IFM_INST(ife->ifm_media) != sc->mii_inst)
        !           198:                        return (0);
        !           199:
        !           200:                /*
        !           201:                 * Is the interface even up?
        !           202:                 */
        !           203:                if ((mii->mii_ifp->if_flags & IFF_UP) == 0)
        !           204:                        return (0);
        !           205:
        !           206:                /*
        !           207:                 * Only used for autonegotiation.
        !           208:                 */
        !           209:                if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO)
        !           210:                        break;
        !           211:
        !           212:                 /*
        !           213:                  * Check to see if we have link.  If we do, we don't
        !           214:                  * need to restart the autonegotiation process.  Read
        !           215:                  * the BMSR twice in case it's latched.
        !           216:                  */
        !           217:                reg = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR);
        !           218:                if (reg & BMSR_LINK)
        !           219:                        break;
        !           220:
        !           221:                /*
        !           222:                 * Only retry autonegotiation every mii_anegticks seconds.
        !           223:                 */
        !           224:                if (++sc->mii_ticks <= sc->mii_anegticks)
        !           225:                        break;
        !           226:
        !           227:                sc->mii_ticks = 0;
        !           228:                PHY_RESET(sc);
        !           229:
        !           230:                xmphy_mii_phy_auto(sc);
        !           231:                break;
        !           232:        }
        !           233:
        !           234:        /* Update the media status. */
        !           235:        mii_phy_status(sc);
        !           236:
        !           237:        /* Callback if something changed. */
        !           238:        mii_phy_update(sc, cmd);
        !           239:        return (0);
        !           240: }
        !           241:
        !           242: void
        !           243: xmphy_status(struct mii_softc *sc)
        !           244: {
        !           245:        struct mii_data *mii = sc->mii_pdata;
        !           246:        int bmsr, bmcr, anlpar;
        !           247:
        !           248:        mii->mii_media_status = IFM_AVALID;
        !           249:        mii->mii_media_active = IFM_ETHER;
        !           250:
        !           251:        bmsr = PHY_READ(sc, XMPHY_MII_BMSR) |
        !           252:            PHY_READ(sc, XMPHY_MII_BMSR);
        !           253:        if (bmsr & XMPHY_BMSR_LINK)
        !           254:                mii->mii_media_status |= IFM_ACTIVE;
        !           255:
        !           256:        /* Do dummy read of extended status register. */
        !           257:        bmcr = PHY_READ(sc, XMPHY_MII_EXTSTS);
        !           258:
        !           259:        bmcr = PHY_READ(sc, XMPHY_MII_BMCR);
        !           260:
        !           261:        if (bmcr & XMPHY_BMCR_LOOP)
        !           262:                mii->mii_media_active |= IFM_LOOP;
        !           263:
        !           264:
        !           265:        if (bmcr & XMPHY_BMCR_AUTOEN) {
        !           266:                if ((bmsr & XMPHY_BMSR_ACOMP) == 0) {
        !           267:                        if (bmsr & XMPHY_BMSR_LINK) {
        !           268:                                mii->mii_media_active |= IFM_1000_SX|IFM_HDX;
        !           269:                                return;
        !           270:                        }
        !           271:                        /* Erg, still trying, I guess... */
        !           272:                        mii->mii_media_active |= IFM_NONE;
        !           273:                        return;
        !           274:                }
        !           275:
        !           276:                mii->mii_media_active |= IFM_1000_SX;
        !           277:                anlpar = PHY_READ(sc, XMPHY_MII_ANAR) &
        !           278:                    PHY_READ(sc, XMPHY_MII_ANLPAR);
        !           279:                if (anlpar & XMPHY_ANLPAR_FDX)
        !           280:                        mii->mii_media_active |= IFM_FDX;
        !           281:                else
        !           282:                        mii->mii_media_active |= IFM_HDX;
        !           283:                return;
        !           284:        }
        !           285:
        !           286:        mii->mii_media_active |= IFM_1000_SX;
        !           287:        if (bmcr & XMPHY_BMCR_FDX)
        !           288:                mii->mii_media_active |= IFM_FDX;
        !           289:        else
        !           290:                mii->mii_media_active |= IFM_HDX;
        !           291:
        !           292:        return;
        !           293: }
        !           294:
        !           295:
        !           296: int
        !           297: xmphy_mii_phy_auto(struct mii_softc *sc)
        !           298: {
        !           299:        int anar = 0;
        !           300:
        !           301:        anar = PHY_READ(sc, XMPHY_MII_ANAR);
        !           302:        anar |= XMPHY_ANAR_FDX|XMPHY_ANAR_HDX;
        !           303:        PHY_WRITE(sc, XMPHY_MII_ANAR, anar);
        !           304:        DELAY(1000);
        !           305:        PHY_WRITE(sc, XMPHY_MII_BMCR,
        !           306:            XMPHY_BMCR_AUTOEN | XMPHY_BMCR_STARTNEG);
        !           307:
        !           308:        return (EJUSTRETURN);
        !           309: }

CVSweb