| 1 | /* $NetBSD: etphy.c,v 1.1 2010/11/13 00:47:24 jnemeth Exp $ */ |
| 2 | /* $OpenBSD: etphy.c,v 1.4 2008/04/02 20:12:58 brad Exp $ */ |
| 3 | |
| 4 | /* |
| 5 | * Copyright (c) 2007 The DragonFly Project. All rights reserved. |
| 6 | * |
| 7 | * This code is derived from software contributed to The DragonFly Project |
| 8 | * by Sepherosa Ziehau <sepherosa@gmail.com> |
| 9 | * |
| 10 | * Redistribution and use in source and binary forms, with or without |
| 11 | * modification, are permitted provided that the following conditions |
| 12 | * are met: |
| 13 | * |
| 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 |
| 18 | * the documentation and/or other materials provided with the |
| 19 | * distribution. |
| 20 | * 3. Neither the name of The DragonFly Project nor the names of its |
| 21 | * contributors may be used to endorse or promote products derived |
| 22 | * from this software without specific, prior written permission. |
| 23 | * |
| 24 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| 25 | * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| 26 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| 27 | * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| 28 | * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| 29 | * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| 30 | * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
| 31 | * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
| 32 | * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| 33 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT |
| 34 | * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| 35 | * SUCH DAMAGE. |
| 36 | * |
| 37 | * $DragonFly: src/sys/dev/netif/mii_layer/truephy.c,v 1.1 2007/10/12 14:12:42 sephe Exp $ |
| 38 | */ |
| 39 | |
| 40 | #include <sys/cdefs.h> |
| 41 | __KERNEL_RCSID(0, "$NetBSD: etphy.c,v 1.1 2010/11/13 00:47:24 jnemeth Exp $" ); |
| 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 | |
| 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 | #define ETPHY_INDEX 0x10 /* XXX reserved in DS */ |
| 57 | #define ETPHY_INDEX_MAGIC 0x402 |
| 58 | #define ETPHY_DATA 0x11 /* XXX reserved in DS */ |
| 59 | |
| 60 | #define ETPHY_CTRL 0x12 |
| 61 | #define ETPHY_CTRL_DIAG 0x0004 |
| 62 | #define ETPHY_CTRL_RSV1 0x0002 /* XXX reserved */ |
| 63 | #define ETPHY_CTRL_RSV0 0x0001 /* XXX reserved */ |
| 64 | |
| 65 | #define ETPHY_CONF 0x16 |
| 66 | #define ETPHY_CONF_TXFIFO_MASK 0x3000 |
| 67 | #define ETPHY_CONF_TXFIFO_8 0x0000 |
| 68 | #define ETPHY_CONF_TXFIFO_16 0x1000 |
| 69 | #define ETPHY_CONF_TXFIFO_24 0x2000 |
| 70 | #define ETPHY_CONF_TXFIFO_32 0x3000 |
| 71 | |
| 72 | #define ETPHY_SR 0x1a |
| 73 | #define ETPHY_SR_SPD_MASK 0x0300 |
| 74 | #define ETPHY_SR_SPD_1000T 0x0200 |
| 75 | #define ETPHY_SR_SPD_100TX 0x0100 |
| 76 | #define ETPHY_SR_SPD_10T 0x0000 |
| 77 | #define ETPHY_SR_FDX 0x0080 |
| 78 | |
| 79 | |
| 80 | int etphy_service(struct mii_softc *, struct mii_data *, int); |
| 81 | void etphy_attach(device_t, device_t, void *); |
| 82 | int etphy_match(device_t, cfdata_t, void *); |
| 83 | void etphy_reset(struct mii_softc *); |
| 84 | void etphy_status(struct mii_softc *); |
| 85 | |
| 86 | const struct mii_phy_funcs etphy_funcs = { |
| 87 | etphy_service, etphy_status, etphy_reset, |
| 88 | }; |
| 89 | |
| 90 | static const struct mii_phydesc etphys[] = { |
| 91 | { MII_OUI_AGERE, MII_MODEL_AGERE_ET1011, |
| 92 | MII_STR_AGERE_ET1011 }, |
| 93 | { 0, 0, |
| 94 | NULL }, |
| 95 | }; |
| 96 | |
| 97 | CFATTACH_DECL_NEW(etphy, sizeof(struct mii_softc), |
| 98 | etphy_match, etphy_attach, mii_phy_detach, mii_phy_activate); |
| 99 | |
| 100 | static const struct etphy_dsp { |
| 101 | uint16_t index; |
| 102 | uint16_t data; |
| 103 | } etphy_dspcode[] = { |
| 104 | { 0x880b, 0x0926 }, /* AfeIfCreg4B1000Msbs */ |
| 105 | { 0x880c, 0x0926 }, /* AfeIfCreg4B100Msbs */ |
| 106 | { 0x880d, 0x0926 }, /* AfeIfCreg4B10Msbs */ |
| 107 | |
| 108 | { 0x880e, 0xb4d3 }, /* AfeIfCreg4B1000Lsbs */ |
| 109 | { 0x880f, 0xb4d3 }, /* AfeIfCreg4B100Lsbs */ |
| 110 | { 0x8810, 0xb4d3 }, /* AfeIfCreg4B10Lsbs */ |
| 111 | |
| 112 | { 0x8805, 0xb03e }, /* AfeIfCreg3B1000Msbs */ |
| 113 | { 0x8806, 0xb03e }, /* AfeIfCreg3B100Msbs */ |
| 114 | { 0x8807, 0xff00 }, /* AfeIfCreg3B10Msbs */ |
| 115 | |
| 116 | { 0x8808, 0xe090 }, /* AfeIfCreg3B1000Lsbs */ |
| 117 | { 0x8809, 0xe110 }, /* AfeIfCreg3B100Lsbs */ |
| 118 | { 0x880a, 0x0000 }, /* AfeIfCreg3B10Lsbs */ |
| 119 | |
| 120 | { 0x300d, 1 }, /* DisableNorm */ |
| 121 | |
| 122 | { 0x280c, 0x0180 }, /* LinkHoldEnd */ |
| 123 | |
| 124 | { 0x1c21, 0x0002 }, /* AlphaM */ |
| 125 | |
| 126 | { 0x3821, 6 }, /* FfeLkgTx0 */ |
| 127 | { 0x381d, 1 }, /* FfeLkg1g4 */ |
| 128 | { 0x381e, 1 }, /* FfeLkg1g5 */ |
| 129 | { 0x381f, 1 }, /* FfeLkg1g6 */ |
| 130 | { 0x3820, 1 }, /* FfeLkg1g7 */ |
| 131 | |
| 132 | { 0x8402, 0x01f0 }, /* Btinact */ |
| 133 | { 0x800e, 20 }, /* LftrainTime */ |
| 134 | { 0x800f, 24 }, /* DvguardTime */ |
| 135 | { 0x8010, 46 } /* IdlguardTime */ |
| 136 | }; |
| 137 | |
| 138 | int |
| 139 | etphy_match(device_t parent, cfdata_t match, void *aux) |
| 140 | { |
| 141 | struct mii_attach_args *ma = aux; |
| 142 | |
| 143 | if (mii_phy_match(ma, etphys) != NULL) |
| 144 | return 10; |
| 145 | |
| 146 | return 0; |
| 147 | } |
| 148 | |
| 149 | void |
| 150 | etphy_attach(device_t parent, device_t self, void *aux) |
| 151 | { |
| 152 | struct mii_softc *sc = device_private(self); |
| 153 | struct mii_attach_args *ma = aux; |
| 154 | struct mii_data *mii = ma->mii_data; |
| 155 | const struct mii_phydesc *mpd; |
| 156 | |
| 157 | mpd = mii_phy_match(ma, etphys); |
| 158 | aprint_normal(": %s, rev. %d\n" , mpd->mpd_name, MII_REV(ma->mii_id2)); |
| 159 | |
| 160 | sc->mii_dev = self; |
| 161 | sc->mii_inst = mii->mii_instance; |
| 162 | sc->mii_phy = ma->mii_phyno; |
| 163 | sc->mii_funcs = &etphy_funcs; |
| 164 | sc->mii_mpd_model = MII_MODEL(ma->mii_id2); |
| 165 | sc->mii_pdata = mii; |
| 166 | sc->mii_flags = ma->mii_flags; |
| 167 | |
| 168 | sc->mii_flags |= MIIF_NOISOLATE | MIIF_NOLOOP; |
| 169 | |
| 170 | PHY_RESET(sc); |
| 171 | |
| 172 | sc->mii_capabilities = PHY_READ(sc, MII_BMSR) & ma->mii_capmask; |
| 173 | if (sc->mii_capabilities & BMSR_EXTSTAT) { |
| 174 | sc->mii_extcapabilities = PHY_READ(sc, MII_EXTSR); |
| 175 | /* No 1000baseT half-duplex support */ |
| 176 | sc->mii_extcapabilities &= ~EXTSR_1000THDX; |
| 177 | } |
| 178 | aprint_normal_dev(self, "" ); |
| 179 | if ((sc->mii_capabilities & BMSR_MEDIAMASK) == 0) |
| 180 | aprint_error("no media present" ); |
| 181 | else |
| 182 | mii_phy_add_media(sc); |
| 183 | aprint_normal("\n" ); |
| 184 | |
| 185 | if (!pmf_device_register(self, NULL, mii_phy_resume)) |
| 186 | aprint_error_dev(self, "couldn't establish power handler\n" ); |
| 187 | } |
| 188 | |
| 189 | int |
| 190 | etphy_service(struct mii_softc *sc, struct mii_data *mii, int cmd) |
| 191 | { |
| 192 | struct ifmedia_entry *ife = mii->mii_media.ifm_cur; |
| 193 | int bmcr; |
| 194 | |
| 195 | switch (cmd) { |
| 196 | case MII_POLLSTAT: |
| 197 | /* |
| 198 | * If we're not polling our PHY instance, just return. |
| 199 | */ |
| 200 | if (IFM_INST(ife->ifm_media) != sc->mii_inst) |
| 201 | return 0; |
| 202 | break; |
| 203 | |
| 204 | case MII_MEDIACHG: |
| 205 | /* |
| 206 | * If the media indicates a different PHY instance, |
| 207 | * isolate ourselves. |
| 208 | */ |
| 209 | if (IFM_INST(ife->ifm_media) != sc->mii_inst) { |
| 210 | bmcr = PHY_READ(sc, MII_BMCR); |
| 211 | PHY_WRITE(sc, MII_BMCR, bmcr | BMCR_ISO); |
| 212 | return 0; |
| 213 | } |
| 214 | |
| 215 | /* |
| 216 | * If the interface is not up, don't do anything. |
| 217 | */ |
| 218 | if ((mii->mii_ifp->if_flags & IFF_UP) == 0) |
| 219 | break; |
| 220 | |
| 221 | if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) { |
| 222 | bmcr = PHY_READ(sc, MII_BMCR) & ~BMCR_AUTOEN; |
| 223 | PHY_WRITE(sc, MII_BMCR, bmcr); |
| 224 | PHY_WRITE(sc, MII_BMCR, bmcr | BMCR_PDOWN); |
| 225 | } |
| 226 | |
| 227 | mii_phy_setmedia(sc); |
| 228 | |
| 229 | if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO) { |
| 230 | bmcr = PHY_READ(sc, MII_BMCR) & ~BMCR_PDOWN; |
| 231 | PHY_WRITE(sc, MII_BMCR, bmcr); |
| 232 | |
| 233 | if (IFM_SUBTYPE(ife->ifm_media) == IFM_1000_T) { |
| 234 | PHY_WRITE(sc, MII_BMCR, |
| 235 | bmcr | BMCR_AUTOEN | BMCR_STARTNEG); |
| 236 | } |
| 237 | } |
| 238 | break; |
| 239 | |
| 240 | case MII_TICK: |
| 241 | /* |
| 242 | * If we're not currently selected, just return. |
| 243 | */ |
| 244 | if (IFM_INST(ife->ifm_media) != sc->mii_inst) |
| 245 | return 0; |
| 246 | |
| 247 | if (mii_phy_tick(sc) == EJUSTRETURN) |
| 248 | return 0; |
| 249 | break; |
| 250 | } |
| 251 | |
| 252 | /* Update the media status. */ |
| 253 | mii_phy_status(sc); |
| 254 | |
| 255 | /* Callback if something changed. */ |
| 256 | mii_phy_update(sc, cmd); |
| 257 | return 0; |
| 258 | } |
| 259 | |
| 260 | void |
| 261 | etphy_reset(struct mii_softc *sc) |
| 262 | { |
| 263 | int i; |
| 264 | |
| 265 | for (i = 0; i < 2; ++i) { |
| 266 | PHY_READ(sc, MII_PHYIDR1); |
| 267 | PHY_READ(sc, MII_PHYIDR2); |
| 268 | |
| 269 | PHY_READ(sc, ETPHY_CTRL); |
| 270 | PHY_WRITE(sc, ETPHY_CTRL, |
| 271 | ETPHY_CTRL_DIAG | ETPHY_CTRL_RSV1); |
| 272 | |
| 273 | PHY_WRITE(sc, ETPHY_INDEX, ETPHY_INDEX_MAGIC); |
| 274 | PHY_READ(sc, ETPHY_DATA); |
| 275 | |
| 276 | PHY_WRITE(sc, ETPHY_CTRL, ETPHY_CTRL_RSV1); |
| 277 | } |
| 278 | |
| 279 | PHY_READ(sc, MII_BMCR); |
| 280 | PHY_READ(sc, ETPHY_CTRL); |
| 281 | PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN | BMCR_PDOWN | BMCR_S1000); |
| 282 | PHY_WRITE(sc, ETPHY_CTRL, |
| 283 | ETPHY_CTRL_DIAG | ETPHY_CTRL_RSV1 | ETPHY_CTRL_RSV0); |
| 284 | |
| 285 | #define N(arr) (int)(sizeof(arr) / sizeof(arr[0])) |
| 286 | |
| 287 | for (i = 0; i < N(etphy_dspcode); ++i) { |
| 288 | const struct etphy_dsp *dsp = &etphy_dspcode[i]; |
| 289 | |
| 290 | PHY_WRITE(sc, ETPHY_INDEX, dsp->index); |
| 291 | PHY_WRITE(sc, ETPHY_DATA, dsp->data); |
| 292 | |
| 293 | PHY_WRITE(sc, ETPHY_INDEX, dsp->index); |
| 294 | PHY_READ(sc, ETPHY_DATA); |
| 295 | } |
| 296 | |
| 297 | #undef N |
| 298 | |
| 299 | PHY_READ(sc, MII_BMCR); |
| 300 | PHY_READ(sc, ETPHY_CTRL); |
| 301 | PHY_WRITE(sc, MII_BMCR, BMCR_AUTOEN | BMCR_S1000); |
| 302 | PHY_WRITE(sc, ETPHY_CTRL, ETPHY_CTRL_RSV1); |
| 303 | |
| 304 | mii_phy_reset(sc); |
| 305 | } |
| 306 | |
| 307 | void |
| 308 | etphy_status(struct mii_softc *sc) |
| 309 | { |
| 310 | struct mii_data *mii = sc->mii_pdata; |
| 311 | int bmsr, bmcr, sr; |
| 312 | |
| 313 | mii->mii_media_status = IFM_AVALID; |
| 314 | mii->mii_media_active = IFM_ETHER; |
| 315 | |
| 316 | sr = PHY_READ(sc, ETPHY_SR); |
| 317 | bmcr = PHY_READ(sc, MII_BMCR); |
| 318 | |
| 319 | bmsr = PHY_READ(sc, MII_BMSR) | PHY_READ(sc, MII_BMSR); |
| 320 | if (bmsr & BMSR_LINK) |
| 321 | mii->mii_media_status |= IFM_ACTIVE; |
| 322 | |
| 323 | if (bmcr & BMCR_AUTOEN) { |
| 324 | if ((bmsr & BMSR_ACOMP) == 0) { |
| 325 | mii->mii_media_active |= IFM_NONE; |
| 326 | return; |
| 327 | } |
| 328 | } |
| 329 | |
| 330 | switch (sr & ETPHY_SR_SPD_MASK) { |
| 331 | case ETPHY_SR_SPD_1000T: |
| 332 | mii->mii_media_active |= IFM_1000_T; |
| 333 | break; |
| 334 | case ETPHY_SR_SPD_100TX: |
| 335 | mii->mii_media_active |= IFM_100_TX; |
| 336 | break; |
| 337 | case ETPHY_SR_SPD_10T: |
| 338 | mii->mii_media_active |= IFM_10_T; |
| 339 | break; |
| 340 | default: |
| 341 | mii->mii_media_active |= IFM_NONE; |
| 342 | return; |
| 343 | } |
| 344 | |
| 345 | if (sr & ETPHY_SR_FDX) |
| 346 | mii->mii_media_active |= IFM_FDX; |
| 347 | else |
| 348 | mii->mii_media_active |= IFM_HDX; |
| 349 | } |
| 350 | |