brgphy.c revision 95722
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 * $FreeBSD: head/sys/dev/mii/brgphy.c 95722 2002-04-29 13:07:38Z phk $ 33 */ 34 35/* 36 * Driver for the Broadcom BCR5400 1000baseTX PHY. Speed is always 37 * 1000mbps; all we need to negotiate here is full or half duplex. 38 */ 39 40#include <sys/param.h> 41#include <sys/systm.h> 42#include <sys/kernel.h> 43#include <sys/malloc.h> 44#include <sys/socket.h> 45#include <sys/bus.h> 46 47#include <machine/clock.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 <dev/mii/miidevs.h> 55 56#include <dev/mii/brgphyreg.h> 57 58#include "miibus_if.h" 59 60#if !defined(lint) 61static const char rcsid[] = 62 "$FreeBSD: head/sys/dev/mii/brgphy.c 95722 2002-04-29 13:07:38Z phk $"; 63#endif 64 65static int brgphy_probe (device_t); 66static int brgphy_attach (device_t); 67 68static device_method_t brgphy_methods[] = { 69 /* device interface */ 70 DEVMETHOD(device_probe, brgphy_probe), 71 DEVMETHOD(device_attach, brgphy_attach), 72 DEVMETHOD(device_detach, mii_phy_detach), 73 DEVMETHOD(device_shutdown, bus_generic_shutdown), 74 { 0, 0 } 75}; 76 77static devclass_t brgphy_devclass; 78 79static driver_t brgphy_driver = { 80 "brgphy", 81 brgphy_methods, 82 sizeof(struct mii_softc) 83}; 84 85DRIVER_MODULE(brgphy, miibus, brgphy_driver, brgphy_devclass, 0, 0); 86 87static int brgphy_service(struct mii_softc *, struct mii_data *, int); 88static void brgphy_status(struct mii_softc *); 89static int brgphy_mii_phy_auto(struct mii_softc *, int); 90extern void mii_phy_auto_timeout(void *); 91 92static int brgphy_probe(dev) 93 device_t dev; 94{ 95 struct mii_attach_args *ma; 96 97 ma = device_get_ivars(dev); 98 99 if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_xxBROADCOM && 100 MII_MODEL(ma->mii_id2) == MII_MODEL_xxBROADCOM_BCM5400) { 101 device_set_desc(dev, MII_STR_xxBROADCOM_BCM5400); 102 return(0); 103 } 104 105 if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_xxBROADCOM && 106 MII_MODEL(ma->mii_id2) == MII_MODEL_xxBROADCOM_BCM5401) { 107 device_set_desc(dev, MII_STR_xxBROADCOM_BCM5401); 108 return(0); 109 } 110 111 if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_xxBROADCOM && 112 MII_MODEL(ma->mii_id2) == MII_MODEL_xxBROADCOM_BCM5411) { 113 device_set_desc(dev, MII_STR_xxBROADCOM_BCM5411); 114 return(0); 115 } 116 117 if (MII_OUI(ma->mii_id1, ma->mii_id2) == MII_OUI_xxBROADCOM && 118 MII_MODEL(ma->mii_id2) == MII_MODEL_xxBROADCOM_BCM5701) { 119 device_set_desc(dev, MII_STR_xxBROADCOM_BCM5701); 120 return(0); 121 } 122 123 return(ENXIO); 124} 125 126static int brgphy_attach(dev) 127 device_t dev; 128{ 129 struct mii_softc *sc; 130 struct mii_attach_args *ma; 131 struct mii_data *mii; 132 const char *sep = ""; 133 134 sc = device_get_softc(dev); 135 ma = device_get_ivars(dev); 136 sc->mii_dev = device_get_parent(dev); 137 mii = device_get_softc(sc->mii_dev); 138 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 139 140 sc->mii_inst = mii->mii_instance; 141 sc->mii_phy = ma->mii_phyno; 142 sc->mii_service = brgphy_service; 143 sc->mii_pdata = mii; 144 145 sc->mii_flags |= MIIF_NOISOLATE; 146 mii->mii_instance++; 147 148#define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL) 149#define PRINT(s) printf("%s%s", sep, s); sep = ", " 150 151 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst), 152 BMCR_ISO); 153#if 0 154 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_LOOP, sc->mii_inst), 155 BMCR_LOOP|BMCR_S100); 156#endif 157 158 mii_phy_reset(sc); 159 160 161 sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask; 162 sc->mii_capabilities &= ~BMSR_ANEG; 163 device_printf(dev, " "); 164 mii_add_media(sc); 165 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_T, 0, sc->mii_inst), 166 BRGPHY_BMCR_FDX); 167 PRINT(", 1000baseTX"); 168 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_T, IFM_FDX, sc->mii_inst), 0); 169 PRINT("1000baseTX-FDX"); 170 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_AUTO, 0, sc->mii_inst), 0); 171 PRINT("auto"); 172 173 printf("\n"); 174#undef ADD 175#undef PRINT 176 177 MIIBUS_MEDIAINIT(sc->mii_dev); 178 return(0); 179} 180 181static int 182brgphy_service(sc, mii, cmd) 183 struct mii_softc *sc; 184 struct mii_data *mii; 185 int cmd; 186{ 187 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 188 int reg, speed; 189 190 switch (cmd) { 191 case MII_POLLSTAT: 192 /* 193 * If we're not polling our PHY instance, just return. 194 */ 195 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 196 return (0); 197 break; 198 199 case MII_MEDIACHG: 200 /* 201 * If the media indicates a different PHY instance, 202 * isolate ourselves. 203 */ 204 if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 205 reg = PHY_READ(sc, MII_BMCR); 206 PHY_WRITE(sc, MII_BMCR, reg | BMCR_ISO); 207 return (0); 208 } 209 210 /* 211 * If the interface is not up, don't do anything. 212 */ 213 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 214 break; 215 216 PHY_WRITE(sc, BRGPHY_MII_PHY_EXTCTL, 217 BRGPHY_PHY_EXTCTL_HIGH_LA|BRGPHY_PHY_EXTCTL_EN_LTR); 218 PHY_WRITE(sc, BRGPHY_MII_AUXCTL, 219 BRGPHY_AUXCTL_LONG_PKT|BRGPHY_AUXCTL_TX_TST); 220 PHY_WRITE(sc, BRGPHY_MII_IMR, 0xFF00); 221 222 switch (IFM_SUBTYPE(ife->ifm_media)) { 223 case IFM_AUTO: 224#ifdef foo 225 /* 226 * If we're already in auto mode, just return. 227 */ 228 if (PHY_READ(sc, BRGPHY_MII_BMCR) & BRGPHY_BMCR_AUTOEN) 229 return (0); 230#endif 231 (void) brgphy_mii_phy_auto(sc, 1); 232 break; 233 case IFM_1000_T: 234 speed = BRGPHY_S1000; 235 goto setit; 236 case IFM_100_TX: 237 speed = BRGPHY_S100; 238 goto setit; 239 case IFM_10_T: 240 speed = BRGPHY_S10; 241setit: 242 if ((ife->ifm_media & IFM_GMASK) == IFM_FDX) { 243 PHY_WRITE(sc, BRGPHY_MII_BMCR, 244 BRGPHY_BMCR_FDX|speed); 245 } else { 246 PHY_WRITE(sc, BRGPHY_MII_BMCR, speed); 247 } 248 PHY_WRITE(sc, BRGPHY_MII_ANAR, BRGPHY_SEL_TYPE); 249 250 if (IFM_SUBTYPE(ife->ifm_media) != IFM_1000_T) 251 break; 252 253 /* 254 * When settning the link manually, one side must 255 * be the master and the other the slave. However 256 * ifmedia doesn't give us a good way to specify 257 * this, so we fake it by using one of the LINK 258 * flags. If LINK0 is set, we program the PHY to 259 * be a master, otherwise it's a slave. 260 */ 261 if ((mii->mii_ifp->if_flags & IFF_LINK0)) { 262 PHY_WRITE(sc, BRGPHY_MII_1000CTL, 263 BRGPHY_1000CTL_MSE|BRGPHY_1000CTL_MSC); 264 } else { 265 PHY_WRITE(sc, BRGPHY_MII_1000CTL, 266 BRGPHY_1000CTL_MSE); 267 } 268 break; 269#ifdef foo 270 case IFM_NONE: 271 PHY_WRITE(sc, MII_BMCR, BMCR_ISO|BMCR_PDOWN); 272 break; 273#endif 274 case IFM_100_T4: 275 default: 276 return (EINVAL); 277 } 278 break; 279 280 case MII_TICK: 281 /* 282 * If we're not currently selected, just return. 283 */ 284 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 285 return (0); 286 287 /* 288 * Is the interface even up? 289 */ 290 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 291 return (0); 292 293 /* 294 * Only used for autonegotiation. 295 */ 296 if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) 297 break; 298 299 /* 300 * Check to see if we have link. If we do, we don't 301 * need to restart the autonegotiation process. Read 302 * the BMSR twice in case it's latched. 303 */ 304 reg = PHY_READ(sc, BRGPHY_MII_AUXSTS); 305 if (reg & BRGPHY_AUXSTS_LINK) 306 break; 307 308 /* 309 * Only retry autonegotiation every 5 seconds. 310 */ 311 if (++sc->mii_ticks != 5) 312 return (0); 313 314 sc->mii_ticks = 0; 315 mii_phy_reset(sc); 316 if (brgphy_mii_phy_auto(sc, 0) == EJUSTRETURN) 317 return (0); 318 break; 319 } 320 321 /* Update the media status. */ 322 brgphy_status(sc); 323 324 /* Callback if something changed. */ 325 mii_phy_update(sc, cmd); 326 return (0); 327} 328 329static void 330brgphy_status(sc) 331 struct mii_softc *sc; 332{ 333 struct mii_data *mii = sc->mii_pdata; 334 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 335 int bmsr, bmcr; 336 337 mii->mii_media_status = IFM_AVALID; 338 mii->mii_media_active = IFM_ETHER; 339 340 bmsr = PHY_READ(sc, BRGPHY_MII_BMSR); 341 if (PHY_READ(sc, BRGPHY_MII_AUXSTS) & BRGPHY_AUXSTS_LINK) 342 mii->mii_media_status |= IFM_ACTIVE; 343 344 bmcr = PHY_READ(sc, BRGPHY_MII_BMCR); 345 346 if (bmcr & BRGPHY_BMCR_LOOP) 347 mii->mii_media_active |= IFM_LOOP; 348 349 if (bmcr & BRGPHY_BMCR_AUTOEN) { 350 if ((bmsr & BRGPHY_BMSR_ACOMP) == 0) { 351 /* Erg, still trying, I guess... */ 352 mii->mii_media_active |= IFM_NONE; 353 return; 354 } 355 356 switch (PHY_READ(sc, BRGPHY_MII_AUXSTS) & 357 BRGPHY_AUXSTS_AN_RES) { 358 case BRGPHY_RES_1000FD: 359 mii->mii_media_active |= IFM_1000_T | IFM_FDX; 360 break; 361 case BRGPHY_RES_1000HD: 362 mii->mii_media_active |= IFM_1000_T | IFM_HDX; 363 break; 364 case BRGPHY_RES_100FD: 365 mii->mii_media_active |= IFM_100_TX | IFM_FDX; 366 break; 367 case BRGPHY_RES_100T4: 368 mii->mii_media_active |= IFM_100_T4; 369 break; 370 case BRGPHY_RES_100HD: 371 mii->mii_media_active |= IFM_100_TX | IFM_HDX; 372 break; 373 case BRGPHY_RES_10FD: 374 mii->mii_media_active |= IFM_10_T | IFM_FDX; 375 break; 376 case BRGPHY_RES_10HD: 377 mii->mii_media_active |= IFM_10_T | IFM_HDX; 378 break; 379 default: 380 mii->mii_media_active |= IFM_NONE; 381 break; 382 } 383 return; 384 } 385 386 mii->mii_media_active = ife->ifm_media; 387 388 return; 389} 390 391 392static int 393brgphy_mii_phy_auto(mii, waitfor) 394 struct mii_softc *mii; 395 int waitfor; 396{ 397 int bmsr, ktcr = 0, i; 398 399 if ((mii->mii_flags & MIIF_DOINGAUTO) == 0) { 400 mii_phy_reset(mii); 401 PHY_WRITE(mii, BRGPHY_MII_BMCR, 0); 402 DELAY(1000); 403 ktcr = PHY_READ(mii, BRGPHY_MII_1000CTL); 404 PHY_WRITE(mii, BRGPHY_MII_1000CTL, ktcr | 405 BRGPHY_1000CTL_AFD|BRGPHY_1000CTL_AHD); 406 ktcr = PHY_READ(mii, BRGPHY_MII_1000CTL); 407 DELAY(1000); 408 PHY_WRITE(mii, BRGPHY_MII_ANAR, 409 BMSR_MEDIA_TO_ANAR(mii->mii_capabilities) | ANAR_CSMA); 410 DELAY(1000); 411 PHY_WRITE(mii, BRGPHY_MII_BMCR, 412 BRGPHY_BMCR_AUTOEN | BRGPHY_BMCR_STARTNEG); 413 PHY_WRITE(mii, BRGPHY_MII_IMR, 0xFF00); 414 } 415 416 if (waitfor) { 417 /* Wait 500ms for it to complete. */ 418 for (i = 0; i < 500; i++) { 419 if ((bmsr = PHY_READ(mii, BRGPHY_MII_BMSR)) & 420 BRGPHY_BMSR_ACOMP) 421 return (0); 422 DELAY(1000); 423#if 0 424 if ((bmsr & BMSR_ACOMP) == 0) 425 printf("%s: autonegotiation failed to complete\n", 426 mii->mii_dev.dv_xname); 427#endif 428 } 429 430 /* 431 * Don't need to worry about clearing MIIF_DOINGAUTO. 432 * If that's set, a timeout is pending, and it will 433 * clear the flag. 434 */ 435 return (EIO); 436 } 437 438 /* 439 * Just let it finish asynchronously. This is for the benefit of 440 * the tick handler driving autonegotiation. Don't want 500ms 441 * delays all the time while the system is running! 442 */ 443 if ((mii->mii_flags & MIIF_DOINGAUTO) == 0) { 444 mii->mii_flags |= MIIF_DOINGAUTO; 445 mii->mii_auto_ch = timeout(mii_phy_auto_timeout, mii, hz >> 1); 446 } 447 return (EJUSTRETURN); 448} 449