git.oblomov.eu Git - linux-2.6/blob - drivers/net/mii.c

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