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