1 /*- 2 * Copyright (c) 2006, Pyun YongHyeon <yongari@FreeBSD.org> 3 * 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 unmodified, this list of conditions, and the following 10 * disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 * 27 * $FreeBSD: src/sys/dev/mii/ip1000phy.c,v 1.1 2006/07/25 00:16:09 yongari Exp $ 28 * $DragonFly: src/sys/dev/netif/mii_layer/ip1000phy.c,v 1.2 2006/12/22 23:26:20 swildner Exp $ 29 */ 30 31 /* 32 * Driver for the IC Plus IP1000A 10/100/1000 PHY. 33 */ 34 35 #include <sys/param.h> 36 #include <sys/bus.h> 37 #include <sys/kernel.h> 38 #include <sys/module.h> 39 #include <sys/socket.h> 40 #include <sys/sysctl.h> 41 42 #include <net/if.h> 43 #include <net/if_arp.h> 44 #include <net/if_media.h> 45 46 #include <dev/netif/mii_layer/mii.h> 47 #include <dev/netif/mii_layer/miivar.h> 48 #include "miidevs.h" 49 50 #include <dev/netif/mii_layer/ip1000phyreg.h> 51 52 #include "miibus_if.h" 53 54 #include <dev/netif/stge/if_stgereg.h> 55 #include <dev/netif/stge/if_stgevar.h> 56 57 static int ip1000phy_probe(device_t); 58 static int ip1000phy_attach(device_t); 59 static int ip1000phy_service(struct mii_softc *, struct mii_data *, int); 60 static void ip1000phy_status(struct mii_softc *); 61 static void ip1000phy_reset(struct mii_softc *); 62 static int ip1000phy_mii_phy_auto(struct mii_softc *); 63 64 static device_method_t ip1000phy_methods[] = { 65 /* device interface */ 66 DEVMETHOD(device_probe, ip1000phy_probe), 67 DEVMETHOD(device_attach, ip1000phy_attach), 68 DEVMETHOD(device_detach, ukphy_detach), 69 DEVMETHOD(device_shutdown, bus_generic_shutdown), 70 { 0, 0 } 71 }; 72 73 static devclass_t ip1000phy_devclass; 74 static driver_t ip1000phy_driver = { 75 "ip1000phy", 76 ip1000phy_methods, 77 sizeof (struct mii_softc) 78 }; 79 80 DRIVER_MODULE(ip1000phy, miibus, ip1000phy_driver, ip1000phy_devclass, 0, 0); 81 82 static const struct mii_phydesc ip1000phys[] = { 83 MII_PHYDESC(ICPLUS, IP1000A), 84 MII_PHYDESC_NULL 85 }; 86 87 static int 88 ip1000phy_probe(device_t dev) 89 { 90 struct mii_attach_args *ma; 91 const struct mii_phydesc *mpd; 92 93 ma = device_get_ivars(dev); 94 mpd = mii_phy_match(ma, ip1000phys); 95 if (mpd != NULL) { 96 device_set_desc(dev, mpd->mpd_name); 97 return (0); 98 } 99 100 return (ENXIO); 101 } 102 103 static int 104 ip1000phy_attach(device_t dev) 105 { 106 struct mii_softc *sc; 107 struct mii_attach_args *ma; 108 struct mii_data *mii; 109 110 sc = device_get_softc(dev); 111 ma = device_get_ivars(dev); 112 mii_softc_init(sc, ma); 113 sc->mii_dev = device_get_parent(dev); 114 mii = device_get_softc(sc->mii_dev); 115 LIST_INSERT_HEAD(&mii->mii_phys, sc, mii_list); 116 117 sc->mii_inst = mii->mii_instance; 118 sc->mii_service = ip1000phy_service; 119 sc->mii_pdata = mii; 120 121 sc->mii_anegticks = MII_ANEGTICKS_GIGE; 122 sc->mii_flags |= MIIF_NOISOLATE; 123 124 mii->mii_instance++; 125 126 device_printf(dev, " "); 127 128 #define ADD(m, c) ifmedia_add(&mii->mii_media, (m), (c), NULL) 129 130 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_NONE, 0, sc->mii_inst), 131 BMCR_ISO); 132 133 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_10_T, 0, sc->mii_inst), 134 IP1000PHY_BMCR_10); 135 kprintf("10baseT, "); 136 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_10_T, IFM_FDX, sc->mii_inst), 137 IP1000PHY_BMCR_10 | IP1000PHY_BMCR_FDX); 138 kprintf("10baseT-FDX, "); 139 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, 0, sc->mii_inst), 140 IP1000PHY_BMCR_100); 141 kprintf("100baseTX, "); 142 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_100_TX, IFM_FDX, sc->mii_inst), 143 IP1000PHY_BMCR_100 | IP1000PHY_BMCR_FDX); 144 kprintf("100baseTX-FDX, "); 145 /* 1000baseT half-duplex, really supported? */ 146 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_T, 0, sc->mii_inst), 147 IP1000PHY_BMCR_1000); 148 kprintf("1000baseTX, "); 149 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_1000_T, IFM_FDX, sc->mii_inst), 150 IP1000PHY_BMCR_1000 | IP1000PHY_BMCR_FDX); 151 kprintf("1000baseTX-FDX, "); 152 ADD(IFM_MAKEWORD(IFM_ETHER, IFM_AUTO, 0, sc->mii_inst), 0); 153 kprintf("auto\n"); 154 #undef ADD 155 156 ip1000phy_reset(sc); 157 158 MIIBUS_MEDIAINIT(sc->mii_dev); 159 return(0); 160 } 161 162 static int 163 ip1000phy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) 164 { 165 struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 166 uint32_t gig, reg, speed; 167 168 switch (cmd) { 169 case MII_POLLSTAT: 170 /* 171 * If we're not polling our PHY instance, just return. 172 */ 173 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 174 return (0); 175 break; 176 177 case MII_MEDIACHG: 178 /* 179 * If the media indicates a different PHY instance, 180 * isolate ourselves. 181 */ 182 if (IFM_INST(ife->ifm_media) != sc->mii_inst) { 183 reg = PHY_READ(sc, IP1000PHY_MII_BMCR); 184 PHY_WRITE(sc, IP1000PHY_MII_BMCR, 185 reg | IP1000PHY_BMCR_ISO); 186 return (0); 187 } 188 189 /* 190 * If the interface is not up, don't do anything. 191 */ 192 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 193 break; 194 195 ip1000phy_reset(sc); 196 switch (IFM_SUBTYPE(ife->ifm_media)) { 197 case IFM_AUTO: 198 ip1000phy_mii_phy_auto(sc); 199 goto done; 200 201 case IFM_1000_T: 202 /* 203 * XXX 204 * Manual 1000baseT setting doesn't seem to work. 205 */ 206 speed = IP1000PHY_BMCR_1000; 207 break; 208 209 case IFM_100_TX: 210 speed = IP1000PHY_BMCR_100; 211 break; 212 213 case IFM_10_T: 214 speed = IP1000PHY_BMCR_10; 215 break; 216 217 default: 218 return (EINVAL); 219 } 220 221 if (((ife->ifm_media & IFM_GMASK) & IFM_FDX) != 0) { 222 speed |= IP1000PHY_BMCR_FDX; 223 gig = IP1000PHY_1000CR_1000T_FDX; 224 } else { 225 gig = IP1000PHY_1000CR_1000T; 226 } 227 228 PHY_WRITE(sc, IP1000PHY_MII_1000CR, 0); 229 PHY_WRITE(sc, IP1000PHY_MII_BMCR, speed); 230 231 if (IFM_SUBTYPE(ife->ifm_media) != IFM_1000_T) 232 break; 233 234 PHY_WRITE(sc, IP1000PHY_MII_1000CR, gig); 235 PHY_WRITE(sc, IP1000PHY_MII_BMCR, speed); 236 237 /* 238 * When settning the link manually, one side must 239 * be the master and the other the slave. However 240 * ifmedia doesn't give us a good way to specify 241 * this, so we fake it by using one of the LINK 242 * flags. If LINK0 is set, we program the PHY to 243 * be a master, otherwise it's a slave. 244 */ 245 if ((mii->mii_ifp->if_flags & IFF_LINK0)) { 246 PHY_WRITE(sc, IP1000PHY_MII_1000CR, gig | 247 IP1000PHY_1000CR_MASTER | 248 IP1000PHY_1000CR_MMASTER | 249 IP1000PHY_1000CR_MANUAL); 250 } else { 251 PHY_WRITE(sc, IP1000PHY_MII_1000CR, gig | 252 IP1000PHY_1000CR_MASTER | 253 IP1000PHY_1000CR_MANUAL); 254 } 255 256 done: 257 break; 258 259 case MII_TICK: 260 /* 261 * If we're not currently selected, just return. 262 */ 263 if (IFM_INST(ife->ifm_media) != sc->mii_inst) 264 return (0); 265 /* 266 * Is the interface even up? 267 */ 268 if ((mii->mii_ifp->if_flags & IFF_UP) == 0) 269 return (0); 270 271 /* 272 * Only used for autonegotiation. 273 */ 274 if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) { 275 sc->mii_ticks = 0; 276 break; 277 } 278 279 /* 280 * check for link. 281 */ 282 reg = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR); 283 if (reg & BMSR_LINK) { 284 sc->mii_ticks = 0; 285 break; 286 } 287 288 /* Announce link loss right after it happens */ 289 if (sc->mii_ticks++ == 0) 290 break; 291 292 /* 293 * Only retry autonegotiation every mii_anegticks seconds. 294 */ 295 if (sc->mii_ticks <= sc->mii_anegticks) 296 return (0); 297 298 sc->mii_ticks = 0; 299 ip1000phy_mii_phy_auto(sc); 300 break; 301 } 302 303 /* Update the media status. */ 304 ip1000phy_status(sc); 305 306 /* Callback if something changed. */ 307 mii_phy_update(sc, cmd); 308 return (0); 309 } 310 311 static void 312 ip1000phy_status(struct mii_softc *sc) 313 { 314 struct mii_data *mii = sc->mii_pdata; 315 uint32_t bmsr, bmcr, stat; 316 uint32_t ar, lpar; 317 318 mii->mii_media_status = IFM_AVALID; 319 mii->mii_media_active = IFM_ETHER; 320 321 bmsr = PHY_READ(sc, IP1000PHY_MII_BMSR) | 322 PHY_READ(sc, IP1000PHY_MII_BMSR); 323 if ((bmsr & IP1000PHY_BMSR_LINK) != 0) 324 mii->mii_media_status |= IFM_ACTIVE; 325 326 bmcr = PHY_READ(sc, IP1000PHY_MII_BMCR); 327 if ((bmcr & IP1000PHY_BMCR_LOOP) != 0) 328 mii->mii_media_active |= IFM_LOOP; 329 330 if ((bmcr & IP1000PHY_BMCR_AUTOEN) != 0) { 331 if ((bmsr & IP1000PHY_BMSR_ANEGCOMP) == 0) { 332 /* Erg, still trying, I guess... */ 333 mii->mii_media_active |= IFM_NONE; 334 return; 335 } 336 } 337 338 stat = PHY_READ(sc, STGE_PhyCtrl); 339 switch (PC_LinkSpeed(stat)) { 340 case PC_LinkSpeed_Down: 341 mii->mii_media_active |= IFM_NONE; 342 return; 343 case PC_LinkSpeed_10: 344 mii->mii_media_active |= IFM_10_T; 345 break; 346 case PC_LinkSpeed_100: 347 mii->mii_media_active |= IFM_100_TX; 348 break; 349 case PC_LinkSpeed_1000: 350 mii->mii_media_active |= IFM_1000_T; 351 break; 352 } 353 if ((stat & PC_PhyDuplexStatus) != 0) 354 mii->mii_media_active |= IFM_FDX; 355 else 356 mii->mii_media_active |= IFM_HDX; 357 358 ar = PHY_READ(sc, IP1000PHY_MII_ANAR); 359 lpar = PHY_READ(sc, IP1000PHY_MII_ANLPAR); 360 361 /* 362 * FLAG0 : Rx flow-control 363 * FLAG1 : Tx flow-control 364 */ 365 if ((ar & IP1000PHY_ANAR_PAUSE) && (lpar & IP1000PHY_ANLPAR_PAUSE)) 366 mii->mii_media_active |= IFM_FLAG0 | IFM_FLAG1; 367 else if (!(ar & IP1000PHY_ANAR_PAUSE) && (ar & IP1000PHY_ANAR_APAUSE) && 368 (lpar & IP1000PHY_ANLPAR_PAUSE) && (lpar & IP1000PHY_ANLPAR_APAUSE)) 369 mii->mii_media_active |= IFM_FLAG1; 370 else if ((ar & IP1000PHY_ANAR_PAUSE) && (ar & IP1000PHY_ANAR_APAUSE) && 371 !(lpar & IP1000PHY_ANLPAR_PAUSE) && 372 (lpar & IP1000PHY_ANLPAR_APAUSE)) { 373 mii->mii_media_active |= IFM_FLAG0; 374 } 375 376 /* 377 * FLAG2 : local PHY resolved to MASTER 378 */ 379 if ((mii->mii_media_active & IFM_1000_T) != 0) { 380 stat = PHY_READ(sc, IP1000PHY_MII_1000SR); 381 if ((stat & IP1000PHY_1000SR_MASTER) != 0) 382 mii->mii_media_active |= IFM_FLAG2; 383 } 384 } 385 386 static int 387 ip1000phy_mii_phy_auto(struct mii_softc *mii) 388 { 389 uint32_t reg; 390 391 PHY_WRITE(mii, IP1000PHY_MII_ANAR, 392 IP1000PHY_ANAR_10T | IP1000PHY_ANAR_10T_FDX | 393 IP1000PHY_ANAR_100TX | IP1000PHY_ANAR_100TX_FDX | 394 IP1000PHY_ANAR_PAUSE | IP1000PHY_ANAR_APAUSE); 395 reg = IP1000PHY_1000CR_1000T | IP1000PHY_1000CR_1000T_FDX; 396 reg |= IP1000PHY_1000CR_MASTER; 397 PHY_WRITE(mii, IP1000PHY_MII_1000CR, reg); 398 PHY_WRITE(mii, IP1000PHY_MII_BMCR, (IP1000PHY_BMCR_FDX | 399 IP1000PHY_BMCR_AUTOEN | IP1000PHY_BMCR_STARTNEG)); 400 401 return (EJUSTRETURN); 402 } 403 404 static void 405 ip1000phy_load_dspcode(struct mii_softc *sc) 406 { 407 408 PHY_WRITE(sc, 31, 0x0001); 409 PHY_WRITE(sc, 27, 0x01e0); 410 PHY_WRITE(sc, 31, 0x0002); 411 PHY_WRITE(sc, 27, 0xeb8e); 412 PHY_WRITE(sc, 31, 0x0000); 413 PHY_WRITE(sc, 30, 0x005e); 414 PHY_WRITE(sc, 9, 0x0700); 415 416 DELAY(50); 417 } 418 419 static void 420 ip1000phy_reset(struct mii_softc *sc) 421 { 422 struct stge_softc *stge_sc; 423 struct mii_data *mii; 424 device_t parent; 425 uint32_t reg; 426 427 mii_phy_reset(sc); 428 429 /* clear autoneg/full-duplex as we don't want it after reset */ 430 reg = PHY_READ(sc, IP1000PHY_MII_BMCR); 431 reg &= ~(IP1000PHY_BMCR_AUTOEN | IP1000PHY_BMCR_FDX); 432 PHY_WRITE(sc, MII_BMCR, reg); 433 434 mii = sc->mii_pdata; 435 /* 436 * XXX There should be more general way to pass PHY specific 437 * data via mii interface. 438 */ 439 parent = device_get_parent(sc->mii_dev); 440 if (strncmp(device_get_name(parent), "stge", 4) == 0) { 441 stge_sc = device_get_softc(parent); 442 if (stge_sc->sc_rev >= 0x40 && stge_sc->sc_rev <= 0x4e) 443 ip1000phy_load_dspcode(sc); 444 } 445 } 446