iophy.c revision 1.33
1 /* $NetBSD: iophy.c,v 1.33 2008/05/04 17:06:09 xtraeme Exp $ */ 2 3 /* 4 * Copyright (c) 1998, 1999, 2000 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility, 9 * NASA Ames Research Center. 10 * 11 * Redistribution and use in source and binary forms, with or without 12 * modification, are permitted provided that the following conditions 13 * are met: 14 * 1. Redistributions of source code must retain the above copyright 15 * notice, this list of conditions and the following disclaimer. 16 * 2. Redistributions in binary form must reproduce the above copyright 17 * notice, this list of conditions and the following disclaimer in the 18 * documentation and/or other materials provided with the distribution. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 22 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 23 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 24 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 25 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 30 * POSSIBILITY OF SUCH DAMAGE. 31 */ 32 33 /* 34 * Copyright (c) 1997 Manuel Bouyer. All rights reserved. 35 * 36 * Redistribution and use in source and binary forms, with or without 37 * modification, are permitted provided that the following conditions 38 * are met: 39 * 1. Redistributions of source code must retain the above copyright 40 * notice, this list of conditions and the following disclaimer. 41 * 2. Redistributions in binary form must reproduce the above copyright 42 * notice, this list of conditions and the following disclaimer in the 43 * documentation and/or other materials provided with the distribution. 44 * 3. All advertising materials mentioning features or use of this software 45 * must display the following acknowledgement: 46 * This product includes software developed by Manuel Bouyer. 47 * 4. The name of the author may not be used to endorse or promote products 48 * derived from this software without specific prior written permission. 49 * 50 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 51 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 52 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 53 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 54 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 55 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 56 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 57 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 58 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 59 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 60 */ 61 62 /* 63 * Intel 82553 PHY driver 64 */ 65 66 #include <sys/cdefs.h> 67 __KERNEL_RCSID(0, "$NetBSD: iophy.c,v 1.33 2008/05/04 17:06:09 xtraeme Exp $"); 68 69 #include <sys/param.h> 70 #include <sys/systm.h> 71 #include <sys/kernel.h> 72 #include <sys/device.h> 73 #include <sys/socket.h> 74 75 #include <net/if.h> 76 #include <net/if_media.h> 77 78 #include <dev/mii/mii.h> 79 #include <dev/mii/miivar.h> 80 #include <dev/mii/miidevs.h> 81 82 #include <dev/mii/iophyreg.h> 83 84 static int iophymatch(device_t, cfdata_t, void *); 85 static void iophyattach(device_t, device_t, void *); 86 87 CFATTACH_DECL_NEW(iophy, sizeof(struct mii_softc), 88 iophymatch, iophyattach, mii_phy_detach, mii_phy_activate); 89 90 static int iophy_service(struct mii_softc *, struct mii_data *, int); 91 static void iophy_status(struct mii_softc *); 92 93 static const struct mii_phy_funcs iophy_funcs = { 94 iophy_service, iophy_status, mii_phy_reset, 95 }; 96 97 static const struct mii_phydesc iophys[] = { 98 { MII_OUI_xxINTEL, MII_MODEL_xxINTEL_I82553, 99 MII_STR_xxINTEL_I82553 }, 100 101 { MII_OUI_yyINTEL, MII_MODEL_yyINTEL_I82553, 102 MII_STR_yyINTEL_I82553 }, 103 104 { 0, 0, 105 NULL }, 106 }; 107 108 static int 109 iophymatch(device_t parent, cfdata_t match, void *aux) 110 { 111 struct mii_attach_args *ma = aux; 112 113 if (mii_phy_match(ma, iophys) != NULL) 114 return (10); 115 116 return (0); 117 } 118 119 static void 120 iophyattach(device_t parent, device_t self, void *aux) 121 { 122 struct mii_softc *sc = device_private(self); 123 struct mii_attach_args *ma = aux; 124 struct mii_data *mii = ma->mii_data; 125 const struct mii_phydesc *mpd; 126 127 mpd = mii_phy_match(ma, iophys); 128 aprint_naive(": Media interface\n"); 129 aprint_normal(": %s, rev. %d\n", mpd->mpd_name, MII_REV(ma->mii_id2)); 130 131 sc->mii_dev = self; 132 sc->mii_inst = mii->mii_instance; 133 sc->mii_phy = ma->mii_phyno; 134 sc->mii_funcs = &iophy_funcs; 135 sc->mii_pdata = mii; 136 sc->mii_flags = ma->mii_flags; 137 sc->mii_anegticks = MII_ANEGTICKS; 138 139 PHY_RESET(sc); 140 141 sc->mii_capabilities = 142 PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 143 aprint_normal_dev(self, ""); 144 if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0) 145 aprint_error("no media present"); 146 else 147 mii_phy_add_media(sc); 148 aprint_normal("\n"); 149 150 if (!pmf_device_register(self, NULL, mii_phy_resume)) 151 aprint_error_dev(self, "couldn't establish power handler\n"); 152 } 153 154 static int 155 iophy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 156 { 157 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 158 int reg; 159 160 switch (cmd) { 161 case MII_POLLSTAT: 162 /* 163 * If we're not polling our PHY instance, just return. 164 */ 165 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 166 return (0); 167 break; 168 169 case MII_MEDIACHG: 170 /* 171 * If the media indicates a different PHY instance, 172 * isolate ourselves. 173 */ 174 if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 175 reg = PHY_READ(sc, MII_BMCR); 176 PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO); 177 return (0); 178 } 179 180 /* 181 * If the interface is not up, don't do anything. 182 */ 183 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 184 break; 185 186 mii_phy_setmedia(sc); 187 break; 188 189 case MII_TICK: 190 /* 191 * If we're not currently selected, just return. 192 */ 193 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 194 return (0); 195 196 if (mii_phy_tick(sc) == EJUSTRETURN) 197 return (0); 198 break; 199 200 case MII_DOWN: 201 mii_phy_down(sc); 202 return (0); 203 } 204 205 /* Update the media status. */ 206 mii_phy_status(sc); 207 208 /* Callback if something changed. */ 209 mii_phy_update(sc, cmd); 210 return (0); 211 } 212 213 static void 214 iophy_status(struct mii_softc *sc) 215 { 216 struct mii_data *mii = sc->mii_pdata; 217 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 218 int bmsr, bmcr, ext0; 219 220 mii->mii_media_status = IFM_AVALID; 221 mii->mii_media_active = IFM_ETHER; 222 223 bmsr = PHY_READ(sc, MII_BMSR) | 224 PHY_READ(sc, MII_BMSR); 225 if (bmsr & BMSR_LINK) 226 mii->mii_media_status |= IFM_ACTIVE; 227 228 bmcr = PHY_READ(sc, MII_BMCR); 229 if (bmcr & BMCR_ISO) { 230 mii->mii_media_active |= IFM_NONE; 231 mii->mii_media_status = 0; 232 return; 233 } 234 235 if (bmcr & BMCR_LOOP) 236 mii->mii_media_active |= IFM_LOOP; 237 238 if (bmcr & BMCR_AUTOEN) { 239 if ((bmsr & BMSR_ACOMP) == 0) { 240 /* Erg, still trying, I guess... */ 241 mii->mii_media_active |= IFM_NONE; 242 return; 243 } 244 ext0 = PHY_READ(sc, MII_IOPHY_EXT0); 245 246 if (ext0 & EXT0_SPEED) 247 if (bmsr & BMSR_100T4) { 248 mii->mii_media_active |= IFM_100_T4; 249 return; 250 } else { 251 mii->mii_media_active |= IFM_100_TX; 252 } 253 else 254 mii->mii_media_active |= IFM_10_T; 255 256 if (ext0 & EXT0_DUPLEX) 257 mii->mii_media_active |= IFM_FDX; 258 } else 259 mii->mii_media_active = ife->ifm_media; 260 } 261
Indexes created Sun Sep 28 07:09:56 GMT 2025