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