1 /* 2 3 mii.c: MII interface library 4 5 Maintained by Jeff Garzik <jgarzik@pobox.com> 6 Copyright 2001,2002 Jeff Garzik 7 8 Various code came from myson803.c and other files by 9 Donald Becker. Copyright: 10 11 Written 1998-2002 by Donald Becker. 12 13 This software may be used and distributed according 14 to the terms of the GNU General Public License (GPL), 15 incorporated herein by reference. Drivers based on 16 or derived from this code fall under the GPL and must 17 retain the authorship, copyright and license notice. 18 This file is not a complete program and may only be 19 used when the entire operating system is licensed 20 under the GPL. 21 22 The author may be reached as becker@scyld.com, or C/O 23 Scyld Computing Corporation 24 410 Severn Ave., Suite 210 25 Annapolis MD 21403 26 27 28 */ 29 30 #include <linux/kernel.h> 31 #include <linux/module.h> 32 #include <linux/netdevice.h> 33 #include <linux/ethtool.h> 34 #include <linux/mii.h> 35 36 static u32 mii_get_an(struct mii_if_info *mii, u16 addr) 37 { 38 int advert; 39 40 advert = mii->mdio_read(mii->dev, mii->phy_id, addr); 41 42 return mii_lpa_to_ethtool_lpa_t(advert); 43 } 44 45 /** 46 * mii_ethtool_gset - get settings that are specified in @ecmd 47 * @mii: MII interface 48 * @ecmd: requested ethtool_cmd 49 * 50 * The @ecmd parameter is expected to have been cleared before calling 51 * mii_ethtool_gset(). 52 * 53 * Returns 0 for success, negative on error. 54 */ 55 int mii_ethtool_gset(struct mii_if_info *mii, struct ethtool_cmd *ecmd) 56 { 57 struct net_device *dev = mii->dev; 58 u16 bmcr, bmsr, ctrl1000 = 0, stat1000 = 0; 59 u32 nego; 60 61 ecmd->supported = 62 (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | 63 SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | 64 SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII); 65 if (mii->supports_gmii) 66 ecmd->supported |= SUPPORTED_1000baseT_Half | 67 SUPPORTED_1000baseT_Full; 68 69 /* only supports twisted-pair */ 70 ecmd->port = PORT_MII; 71 72 /* only supports internal transceiver */ 73 ecmd->transceiver = XCVR_INTERNAL; 74 75 /* this isn't fully supported at higher layers */ 76 ecmd->phy_address = mii->phy_id; 77 ecmd->mdio_support = ETH_MDIO_SUPPORTS_C22; 78 79 ecmd->advertising = ADVERTISED_TP | ADVERTISED_MII; 80 81 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR); 82 bmsr = mii->mdio_read(dev, mii->phy_id, MII_BMSR); 83 if (mii->supports_gmii) { 84 ctrl1000 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000); 85 stat1000 = mii->mdio_read(dev, mii->phy_id, MII_STAT1000); 86 } 87 if (bmcr & BMCR_ANENABLE) { 88 ecmd->advertising |= ADVERTISED_Autoneg; 89 ecmd->autoneg = AUTONEG_ENABLE; 90 91 ecmd->advertising |= mii_get_an(mii, MII_ADVERTISE); 92 if (mii->supports_gmii) 93 ecmd->advertising |= 94 mii_ctrl1000_to_ethtool_adv_t(ctrl1000); 95 96 if (bmsr & BMSR_ANEGCOMPLETE) { 97 ecmd->lp_advertising = mii_get_an(mii, MII_LPA); 98 ecmd->lp_advertising |= 99 mii_stat1000_to_ethtool_lpa_t(stat1000); 100 } else { 101 ecmd->lp_advertising = 0; 102 } 103 104 nego = ecmd->advertising & ecmd->lp_advertising; 105 106 if (nego & (ADVERTISED_1000baseT_Full | 107 ADVERTISED_1000baseT_Half)) { 108 ethtool_cmd_speed_set(ecmd, SPEED_1000); 109 ecmd->duplex = !!(nego & ADVERTISED_1000baseT_Full); 110 } else if (nego & (ADVERTISED_100baseT_Full | 111 ADVERTISED_100baseT_Half)) { 112 ethtool_cmd_speed_set(ecmd, SPEED_100); 113 ecmd->duplex = !!(nego & ADVERTISED_100baseT_Full); 114 } else { 115 ethtool_cmd_speed_set(ecmd, SPEED_10); 116 ecmd->duplex = !!(nego & ADVERTISED_10baseT_Full); 117 } 118 } else { 119 ecmd->autoneg = AUTONEG_DISABLE; 120 121 ethtool_cmd_speed_set(ecmd, 122 ((bmcr & BMCR_SPEED1000 && 123 (bmcr & BMCR_SPEED100) == 0) ? 124 SPEED_1000 : 125 ((bmcr & BMCR_SPEED100) ? 126 SPEED_100 : SPEED_10))); 127 ecmd->duplex = (bmcr & BMCR_FULLDPLX) ? DUPLEX_FULL : DUPLEX_HALF; 128 } 129 130 mii->full_duplex = ecmd->duplex; 131 132 /* ignore maxtxpkt, maxrxpkt for now */ 133 134 return 0; 135 } 136 137 /** 138 * mii_ethtool_sset - set settings that are specified in @ecmd 139 * @mii: MII interface 140 * @ecmd: requested ethtool_cmd 141 * 142 * Returns 0 for success, negative on error. 143 */ 144 int mii_ethtool_sset(struct mii_if_info *mii, struct ethtool_cmd *ecmd) 145 { 146 struct net_device *dev = mii->dev; 147 u32 speed = ethtool_cmd_speed(ecmd); 148 149 if (speed != SPEED_10 && 150 speed != SPEED_100 && 151 speed != SPEED_1000) 152 return -EINVAL; 153 if (ecmd->duplex != DUPLEX_HALF && ecmd->duplex != DUPLEX_FULL) 154 return -EINVAL; 155 if (ecmd->port != PORT_MII) 156 return -EINVAL; 157 if (ecmd->transceiver != XCVR_INTERNAL) 158 return -EINVAL; 159 if (ecmd->phy_address != mii->phy_id) 160 return -EINVAL; 161 if (ecmd->autoneg != AUTONEG_DISABLE && ecmd->autoneg != AUTONEG_ENABLE) 162 return -EINVAL; 163 if ((speed == SPEED_1000) && (!mii->supports_gmii)) 164 return -EINVAL; 165 166 /* ignore supported, maxtxpkt, maxrxpkt */ 167 168 if (ecmd->autoneg == AUTONEG_ENABLE) { 169 u32 bmcr, advert, tmp; 170 u32 advert2 = 0, tmp2 = 0; 171 172 if ((ecmd->advertising & (ADVERTISED_10baseT_Half | 173 ADVERTISED_10baseT_Full | 174 ADVERTISED_100baseT_Half | 175 ADVERTISED_100baseT_Full | 176 ADVERTISED_1000baseT_Half | 177 ADVERTISED_1000baseT_Full)) == 0) 178 return -EINVAL; 179 180 /* advertise only what has been requested */ 181 advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE); 182 tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4); 183 if (mii->supports_gmii) { 184 advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000); 185 tmp2 = advert2 & ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL); 186 } 187 tmp |= ethtool_adv_to_mii_adv_t(ecmd->advertising); 188 189 if (mii->supports_gmii) 190 tmp2 |= 191 ethtool_adv_to_mii_ctrl1000_t(ecmd->advertising); 192 if (advert != tmp) { 193 mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp); 194 mii->advertising = tmp; 195 } 196 if ((mii->supports_gmii) && (advert2 != tmp2)) 197 mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2); 198 199 /* turn on autonegotiation, and force a renegotiate */ 200 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR); 201 bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART); 202 mii->mdio_write(dev, mii->phy_id, MII_BMCR, bmcr); 203 204 mii->force_media = 0; 205 } else { 206 u32 bmcr, tmp; 207 208 /* turn off auto negotiation, set speed and duplexity */ 209 bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR); 210 tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 | 211 BMCR_SPEED1000 | BMCR_FULLDPLX); 212 if (speed == SPEED_1000) 213 tmp |= BMCR_SPEED1000; 214 else if (speed == SPEED_100) 215 tmp |= BMCR_SPEED100; 216 if (ecmd->duplex == DUPLEX_FULL) { 217 tmp |= BMCR_FULLDPLX; 218 mii->full_duplex = 1; 219 } else 220 mii->full_duplex = 0; 221 if (bmcr != tmp) 222 mii->mdio_write(dev, mii->phy_id, MII_BMCR, tmp); 223 224 mii->force_media = 1; 225 } 226 return 0; 227 } 228 229 /** 230 * mii_check_gmii_support - check if the MII supports Gb interfaces 231 * @mii: the MII interface 232 */ 233 int mii_check_gmii_support(struct mii_if_info *mii) 234 { 235 int reg; 236 237 reg = mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR); 238 if (reg & BMSR_ESTATEN) { 239 reg = mii->mdio_read(mii->dev, mii->phy_id, MII_ESTATUS); 240 if (reg & (ESTATUS_1000_TFULL | ESTATUS_1000_THALF)) 241 return 1; 242 } 243 244 return 0; 245 } 246 247 /** 248 * mii_link_ok - is link status up/ok 249 * @mii: the MII interface 250 * 251 * Returns 1 if the MII reports link status up/ok, 0 otherwise. 252 */ 253 int mii_link_ok (struct mii_if_info *mii) 254 { 255 /* first, a dummy read, needed to latch some MII phys */ 256 mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR); 257 if (mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR) & BMSR_LSTATUS) 258 return 1; 259 return 0; 260 } 261 262 /** 263 * mii_nway_restart - restart NWay (autonegotiation) for this interface 264 * @mii: the MII interface 265 * 266 * Returns 0 on success, negative on error. 267 */ 268 int mii_nway_restart (struct mii_if_info *mii) 269 { 270 int bmcr; 271 int r = -EINVAL; 272 273 /* if autoneg is off, it's an error */ 274 bmcr = mii->mdio_read(mii->dev, mii->phy_id, MII_BMCR); 275 276 if (bmcr & BMCR_ANENABLE) { 277 bmcr |= BMCR_ANRESTART; 278 mii->mdio_write(mii->dev, mii->phy_id, MII_BMCR, bmcr); 279 r = 0; 280 } 281 282 return r; 283 } 284 285 /** 286 * mii_check_link - check MII link status 287 * @mii: MII interface 288 * 289 * If the link status changed (previous != current), call 290 * netif_carrier_on() if current link status is Up or call 291 * netif_carrier_off() if current link status is Down. 292 */ 293 void mii_check_link (struct mii_if_info *mii) 294 { 295 int cur_link = mii_link_ok(mii); 296 int prev_link = netif_carrier_ok(mii->dev); 297 298 if (cur_link && !prev_link) 299 netif_carrier_on(mii->dev); 300 else if (prev_link && !cur_link) 301 netif_carrier_off(mii->dev); 302 } 303 304 /** 305 * mii_check_media - check the MII interface for a carrier/speed/duplex change 306 * @mii: the MII interface 307 * @ok_to_print: OK to print link up/down messages 308 * @init_media: OK to save duplex mode in @mii 309 * 310 * Returns 1 if the duplex mode changed, 0 if not. 311 * If the media type is forced, always returns 0. 312 */ 313 unsigned int mii_check_media (struct mii_if_info *mii, 314 unsigned int ok_to_print, 315 unsigned int init_media) 316 { 317 unsigned int old_carrier, new_carrier; 318 int advertise, lpa, media, duplex; 319 int lpa2 = 0; 320 321 /* check current and old link status */ 322 old_carrier = netif_carrier_ok(mii->dev) ? 1 : 0; 323 new_carrier = (unsigned int) mii_link_ok(mii); 324 325 /* if carrier state did not change, this is a "bounce", 326 * just exit as everything is already set correctly 327 */ 328 if ((!init_media) && (old_carrier == new_carrier)) 329 return 0; /* duplex did not change */ 330 331 /* no carrier, nothing much to do */ 332 if (!new_carrier) { 333 netif_carrier_off(mii->dev); 334 if (ok_to_print) 335 netdev_info(mii->dev, "link down\n"); 336 return 0; /* duplex did not change */ 337 } 338 339 /* 340 * we have carrier, see who's on the other end 341 */ 342 netif_carrier_on(mii->dev); 343 344 if (mii->force_media) { 345 if (ok_to_print) 346 netdev_info(mii->dev, "link up\n"); 347 return 0; /* duplex did not change */ 348 } 349 350 /* get MII advertise and LPA values */ 351 if ((!init_media) && (mii->advertising)) 352 advertise = mii->advertising; 353 else { 354 advertise = mii->mdio_read(mii->dev, mii->phy_id, MII_ADVERTISE); 355 mii->advertising = advertise; 356 } 357 lpa = mii->mdio_read(mii->dev, mii->phy_id, MII_LPA); 358 if (mii->supports_gmii) 359 lpa2 = mii->mdio_read(mii->dev, mii->phy_id, MII_STAT1000); 360 361 /* figure out media and duplex from advertise and LPA values */ 362 media = mii_nway_result(lpa & advertise); 363 duplex = (media & ADVERTISE_FULL) ? 1 : 0; 364 if (lpa2 & LPA_1000FULL) 365 duplex = 1; 366 367 if (ok_to_print) 368 netdev_info(mii->dev, "link up, %uMbps, %s-duplex, lpa 0x%04X\n", 369 lpa2 & (LPA_1000FULL | LPA_1000HALF) ? 1000 : 370 media & (ADVERTISE_100FULL | ADVERTISE_100HALF) ? 371 100 : 10, 372 duplex ? "full" : "half", 373 lpa); 374 375 if ((init_media) || (mii->full_duplex != duplex)) { 376 mii->full_duplex = duplex; 377 return 1; /* duplex changed */ 378 } 379 380 return 0; /* duplex did not change */ 381 } 382 383 /** 384 * generic_mii_ioctl - main MII ioctl interface 385 * @mii_if: the MII interface 386 * @mii_data: MII ioctl data structure 387 * @cmd: MII ioctl command 388 * @duplex_chg_out: pointer to @duplex_changed status if there was no 389 * ioctl error 390 * 391 * Returns 0 on success, negative on error. 392 */ 393 int generic_mii_ioctl(struct mii_if_info *mii_if, 394 struct mii_ioctl_data *mii_data, int cmd, 395 unsigned int *duplex_chg_out) 396 { 397 int rc = 0; 398 unsigned int duplex_changed = 0; 399 400 if (duplex_chg_out) 401 *duplex_chg_out = 0; 402 403 mii_data->phy_id &= mii_if->phy_id_mask; 404 mii_data->reg_num &= mii_if->reg_num_mask; 405 406 switch(cmd) { 407 case SIOCGMIIPHY: 408 mii_data->phy_id = mii_if->phy_id; 409 /* fall through */ 410 411 case SIOCGMIIREG: 412 mii_data->val_out = 413 mii_if->mdio_read(mii_if->dev, mii_data->phy_id, 414 mii_data->reg_num); 415 break; 416 417 case SIOCSMIIREG: { 418 u16 val = mii_data->val_in; 419 420 if (mii_data->phy_id == mii_if->phy_id) { 421 switch(mii_data->reg_num) { 422 case MII_BMCR: { 423 unsigned int new_duplex = 0; 424 if (val & (BMCR_RESET|BMCR_ANENABLE)) 425 mii_if->force_media = 0; 426 else 427 mii_if->force_media = 1; 428 if (mii_if->force_media && 429 (val & BMCR_FULLDPLX)) 430 new_duplex = 1; 431 if (mii_if->full_duplex != new_duplex) { 432 duplex_changed = 1; 433 mii_if->full_duplex = new_duplex; 434 } 435 break; 436 } 437 case MII_ADVERTISE: 438 mii_if->advertising = val; 439 break; 440 default: 441 /* do nothing */ 442 break; 443 } 444 } 445 446 mii_if->mdio_write(mii_if->dev, mii_data->phy_id, 447 mii_data->reg_num, val); 448 break; 449 } 450 451 default: 452 rc = -EOPNOTSUPP; 453 break; 454 } 455 456 if ((rc == 0) && (duplex_chg_out) && (duplex_changed)) 457 *duplex_chg_out = 1; 458 459 return rc; 460 } 461 462 MODULE_AUTHOR ("Jeff Garzik <jgarzik@pobox.com>"); 463 MODULE_DESCRIPTION ("MII hardware support library"); 464 MODULE_LICENSE("GPL"); 465 466 EXPORT_SYMBOL(mii_link_ok); 467 EXPORT_SYMBOL(mii_nway_restart); 468 EXPORT_SYMBOL(mii_ethtool_gset); 469 EXPORT_SYMBOL(mii_ethtool_sset); 470 EXPORT_SYMBOL(mii_check_link); 471 EXPORT_SYMBOL(mii_check_media); 472 EXPORT_SYMBOL(mii_check_gmii_support); 473 EXPORT_SYMBOL(generic_mii_ioctl); 474 475