[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

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