arch/powerpc/cpu/ppc4xx/miiphy.c

   1 /*-----------------------------------------------------------------------------+
   2   |   This source code is dual-licensed.  You may use it under the terms of the
   3   |   GNU General Public License version 2, or under the license below.
   4   |
   5   |       This source code has been made available to you by IBM on an AS-IS
   6   |       basis.  Anyone receiving this source is licensed under IBM
   7   |       copyrights to use it in any way he or she deems fit, including
   8   |       copying it, modifying it, compiling it, and redistributing it either
   9   |       with or without modifications.  No license under IBM patents or
  10   |       patent applications is to be implied by the copyright license.
  11   |
  12   |       Any user of this software should understand that IBM cannot provide
  13   |       technical support for this software and will not be responsible for
  14   |       any consequences resulting from the use of this software.
  15   |
  16   |       Any person who transfers this source code or any derivative work
  17   |       must include the IBM copyright notice, this paragraph, and the
  18   |       preceding two paragraphs in the transferred software.
  19   |
  20   |       COPYRIGHT   I B M   CORPORATION 1995
  21   |       LICENSED MATERIAL  -  PROGRAM PROPERTY OF I B M
  22   +-----------------------------------------------------------------------------*/
  23 /*-----------------------------------------------------------------------------+
  24   |
  25   |  File Name:  miiphy.c
  26   |
  27   |  Function:   This module has utilities for accessing the MII PHY through
  28   |            the EMAC3 macro.
  29   |
  30   |  Author:     Mark Wisner
  31   |
  32   +-----------------------------------------------------------------------------*/
  33
  34 /* define DEBUG for debugging output (obviously ;-)) */
  35 #if 0
  36 #define DEBUG
  37 #endif
  38
  39 #include <common.h>
  40 #include <asm/processor.h>
  41 #include <asm/io.h>
  42 #include <ppc_asm.tmpl>
  43 #include <commproc.h>
  44 #include <asm/ppc4xx-emac.h>
  45 #include <asm/ppc4xx-mal.h>
  46 #include <miiphy.h>
  47
  48 #if !defined(CONFIG_PHY_CLK_FREQ)
  49 #define CONFIG_PHY_CLK_FREQ     0
  50 #endif
  51
  52 /***********************************************************/
  53 /* Dump out to the screen PHY regs                         */
  54 /***********************************************************/
  55
  56 void miiphy_dump (char *devname, unsigned char addr)
  57 {
  58         unsigned long i;
  59         unsigned short data;
  60
  61         for (i = 0; i < 0x1A; i++) {
  62                 if (miiphy_read (devname, addr, i, &data)) {
  63                         printf ("read error for reg %lx\n", i);
  64                         return;
  65                 }
  66                 printf ("Phy reg %lx ==> %4x\n", i, data);
  67
  68                 /* jump to the next set of regs */
  69                 if (i == 0x07)
  70                         i = 0x0f;
  71
  72         }                       /* end for loop */
  73 }                               /* end dump */
  74
  75 /***********************************************************/
  76 /* (Re)start autonegotiation                               */
  77 /***********************************************************/
  78 int phy_setup_aneg (char *devname, unsigned char addr)
  79 {
  80         u16 bmcr;
  81
  82 #if defined(CONFIG_PHY_DYNAMIC_ANEG)
  83         /*
  84          * Set up advertisement based on capablilities reported by the PHY.
  85          * This should work for both copper and fiber.
  86          */
  87         u16 bmsr;
  88 #if defined(CONFIG_PHY_GIGE)
  89         u16 exsr = 0x0000;
  90 #endif
  91
  92         miiphy_read (devname, addr, MII_BMSR, &bmsr);
  93
  94 #if defined(CONFIG_PHY_GIGE)
  95         if (bmsr & BMSR_ESTATEN)
  96                 miiphy_read (devname, addr, MII_ESTATUS, &exsr);
  97
  98         if (exsr & (ESTATUS_1000XF | ESTATUS_1000XH)) {
  99                 /* 1000BASE-X */
 100                 u16 anar = 0x0000;
 101
 102                 if (exsr & ESTATUS_1000XF)
 103                         anar |= ADVERTISE_1000XFULL;
 104
 105                 if (exsr & ESTATUS_1000XH)
 106                         anar |= ADVERTISE_1000XHALF;
 107
 108                 miiphy_write (devname, addr, MII_ADVERTISE, anar);
 109         } else
 110 #endif
 111         {
 112                 u16 anar, btcr;
 113
 114                 miiphy_read (devname, addr, MII_ADVERTISE, &anar);
 115                 anar &= ~(0x5000 | LPA_100BASE4 | LPA_100FULL |
 116                           LPA_100HALF | LPA_10FULL | LPA_10HALF);
 117
 118                 miiphy_read (devname, addr, MII_CTRL1000, &btcr);
 119                 btcr &= ~(0x00FF | PHY_1000BTCR_1000FD | PHY_1000BTCR_1000HD);
 120
 121                 if (bmsr & BMSR_100BASE4)
 122                         anar |= LPA_100BASE4;
 123
 124                 if (bmsr & BMSR_100FULL)
 125                         anar |= LPA_100FULL;
 126
 127                 if (bmsr & BMSR_100HALF)
 128                         anar |= LPA_100HALF;
 129
 130                 if (bmsr & BMSR_10FULL)
 131                         anar |= LPA_10FULL;
 132
 133                 if (bmsr & BMSR_10HALF)
 134                         anar |= LPA_10HALF;
 135
 136                 miiphy_write (devname, addr, MII_ADVERTISE, anar);
 137
 138 #if defined(CONFIG_PHY_GIGE)
 139                 if (exsr & ESTATUS_1000_TFULL)
 140                         btcr |= PHY_1000BTCR_1000FD;
 141
 142                 if (exsr & ESTATUS_1000_THALF)
 143                         btcr |= PHY_1000BTCR_1000HD;
 144
 145                 miiphy_write (devname, addr, MII_CTRL1000, btcr);
 146 #endif
 147         }
 148
 149 #else /* defined(CONFIG_PHY_DYNAMIC_ANEG) */
 150         /*
 151          * Set up standard advertisement
 152          */
 153         u16 adv;
 154
 155         miiphy_read (devname, addr, MII_ADVERTISE, &adv);
 156         adv |= (LPA_LPACK  | LPA_100FULL | LPA_100HALF |
 157                 LPA_10FULL | LPA_10HALF);
 158         miiphy_write (devname, addr, MII_ADVERTISE, adv);
 159
 160         miiphy_read (devname, addr, MII_CTRL1000, &adv);
 161         adv |= (0x0300);
 162         miiphy_write (devname, addr, MII_CTRL1000, adv);
 163
 164 #endif /* defined(CONFIG_PHY_DYNAMIC_ANEG) */
 165
 166         /* Start/Restart aneg */
 167         miiphy_read (devname, addr, MII_BMCR, &bmcr);
 168         bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
 169         miiphy_write (devname, addr, MII_BMCR, bmcr);
 170
 171         return 0;
 172 }
 173
 174 /***********************************************************/
 175 /* read a phy reg and return the value with a rc           */
 176 /***********************************************************/
 177 /* AMCC_TODO:
 178  * Find out of the choice for the emac for MDIO is from the bridges,
 179  * i.e. ZMII or RGMII as approporiate.  If the bridges are not used
 180  * to determine the emac for MDIO, then is the SDR0_ETH_CFG[MDIO_SEL]
 181  * used?  If so, then this routine below does not apply to the 460EX/GT.
 182  *
 183  * sr: Currently on 460EX only EMAC0 works with MDIO, so we always
 184  * return EMAC0 offset here
 185  * vg: For 460EX/460GT if internal GPCS PHY address is specified
 186  * return appropriate EMAC offset
 187  */
 188 unsigned int miiphy_getemac_offset(u8 addr)
 189 {
 190 #if defined(CONFIG_440) && \
 191     !defined(CONFIG_440SP) && !defined(CONFIG_440SPE) && \
 192     !defined(CONFIG_460EX) && !defined(CONFIG_460GT)
 193         unsigned long zmii;
 194         unsigned long eoffset;
 195
 196         /* Need to find out which mdi port we're using */
 197         zmii = in_be32((void *)ZMII0_FER);
 198
 199         if (zmii & (ZMII_FER_MDI << ZMII_FER_V (0)))
 200                 /* using port 0 */
 201                 eoffset = 0;
 202
 203         else if (zmii & (ZMII_FER_MDI << ZMII_FER_V (1)))
 204                 /* using port 1 */
 205                 eoffset = 0x100;
 206
 207         else if (zmii & (ZMII_FER_MDI << ZMII_FER_V (2)))
 208                 /* using port 2 */
 209                 eoffset = 0x400;
 210
 211         else if (zmii & (ZMII_FER_MDI << ZMII_FER_V (3)))
 212                 /* using port 3 */
 213                 eoffset = 0x600;
 214
 215         else {
 216                 /* None of the mdi ports are enabled! */
 217                 /* enable port 0 */
 218                 zmii |= ZMII_FER_MDI << ZMII_FER_V (0);
 219                 out_be32((void *)ZMII0_FER, zmii);
 220                 eoffset = 0;
 221                 /* need to soft reset port 0 */
 222                 zmii = in_be32((void *)EMAC0_MR0);
 223                 zmii |= EMAC_MR0_SRST;
 224                 out_be32((void *)EMAC0_MR0, zmii);
 225         }
 226
 227         return (eoffset);
 228 #else
 229
 230 #if defined(CONFIG_405EX)
 231         unsigned long rgmii;
 232         int devnum = 1;
 233
 234         rgmii = in_be32((void *)RGMII_FER);
 235         if (rgmii & (1 << (19 - devnum)))
 236                 return 0x100;
 237 #endif
 238
 239 #if defined(CONFIG_460EX) || defined(CONFIG_460GT)
 240         u32 eoffset = 0;
 241
 242         switch (addr) {
 243 #if defined(CONFIG_HAS_ETH1) && defined(CONFIG_GPCS_PHY1_ADDR)
 244         case CONFIG_GPCS_PHY1_ADDR:
 245                 if (addr == EMAC_MR1_IPPA_GET(in_be32((void *)EMAC0_MR1 + 0x100)))
 246                         eoffset = 0x100;
 247                 break;
 248 #endif
 249 #if defined(CONFIG_HAS_ETH2) && defined(CONFIG_GPCS_PHY2_ADDR)
 250         case CONFIG_GPCS_PHY2_ADDR:
 251                 if (addr == EMAC_MR1_IPPA_GET(in_be32((void *)EMAC0_MR1 + 0x300)))
 252                         eoffset = 0x300;
 253                 break;
 254 #endif
 255 #if defined(CONFIG_HAS_ETH3) && defined(CONFIG_GPCS_PHY3_ADDR)
 256         case CONFIG_GPCS_PHY3_ADDR:
 257                 if (addr == EMAC_MR1_IPPA_GET(in_be32((void *)EMAC0_MR1 + 0x400)))
 258                         eoffset = 0x400;
 259                 break;
 260 #endif
 261         default:
 262                 eoffset = 0;
 263                 break;
 264         }
 265         return eoffset;
 266 #endif
 267
 268         return 0;
 269 #endif
 270 }
 271
 272 static int emac_miiphy_wait(u32 emac_reg)
 273 {
 274         u32 sta_reg;
 275         int i;
 276
 277         /* wait for completion */
 278         i = 0;
 279         do {
 280                 sta_reg = in_be32((void *)EMAC0_STACR + emac_reg);
 281                 if (i++ > 5) {
 282                         debug("%s [%d]: Timeout! EMAC0_STACR=0x%0x\n", __func__,
 283                               __LINE__, sta_reg);
 284                         return -1;
 285                 }
 286                 udelay(10);
 287         } while ((sta_reg & EMAC_STACR_OC) == EMAC_STACR_OC_MASK);
 288
 289         return 0;
 290 }
 291
 292 static int emac_miiphy_command(u8 addr, u8 reg, int cmd, u16 value)
 293 {
 294         u32 emac_reg;
 295         u32 sta_reg;
 296
 297         emac_reg = miiphy_getemac_offset(addr);
 298
 299         /* wait for completion */
 300         if (emac_miiphy_wait(emac_reg) != 0)
 301                 return -1;
 302
 303         sta_reg = reg;          /* reg address */
 304
 305         /* set clock (50MHz) and read flags */
 306 #if defined(CONFIG_440GX) || defined(CONFIG_440SPE) || \
 307     defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
 308     defined(CONFIG_460EX) || defined(CONFIG_460GT) || \
 309     defined(CONFIG_405EX)
 310 #if defined(CONFIG_IBM_EMAC4_V4)        /* EMAC4 V4 changed bit setting */
 311         sta_reg = (sta_reg & ~EMAC_STACR_OP_MASK) | cmd;
 312 #else
 313         sta_reg |= cmd;
 314 #endif
 315 #else
 316         sta_reg = (sta_reg | cmd) & ~EMAC_STACR_CLK_100MHZ;
 317 #endif
 318
 319         /* Some boards (mainly 405EP based) define the PHY clock freqency fixed */
 320         sta_reg = sta_reg | CONFIG_PHY_CLK_FREQ;
 321         sta_reg = sta_reg | ((u32)addr << 5);   /* Phy address */
 322         sta_reg = sta_reg | EMAC_STACR_OC_MASK; /* new IBM emac v4 */
 323         if (cmd == EMAC_STACR_WRITE)
 324                 memcpy(&sta_reg, &value, 2);    /* put in data */
 325
 326         out_be32((void *)EMAC0_STACR + emac_reg, sta_reg);
 327         debug("%s [%d]: sta_reg=%08x\n", __func__, __LINE__, sta_reg);
 328
 329         /* wait for completion */
 330         if (emac_miiphy_wait(emac_reg) != 0)
 331                 return -1;
 332
 333         debug("%s [%d]: sta_reg=%08x\n", __func__, __LINE__, sta_reg);
 334         if ((sta_reg & EMAC_STACR_PHYE) != 0)
 335                 return -1;
 336
 337         return 0;
 338 }
 339
 340 int emac4xx_miiphy_read (const char *devname, unsigned char addr, unsigned char reg,
 341                          unsigned short *value)
 342 {
 343         unsigned long sta_reg;
 344         unsigned long emac_reg;
 345
 346         emac_reg = miiphy_getemac_offset(addr);
 347
 348         if (emac_miiphy_command(addr, reg, EMAC_STACR_READ, 0) != 0)
 349                 return -1;
 350
 351         sta_reg = in_be32((void *)EMAC0_STACR + emac_reg);
 352         *value = sta_reg >> 16;
 353
 354         return 0;
 355 }
 356
 357 /***********************************************************/
 358 /* write a phy reg and return the value with a rc           */
 359 /***********************************************************/
 360
 361 int emac4xx_miiphy_write (const char *devname, unsigned char addr, unsigned char reg,
 362                           unsigned short value)
 363 {
 364         return emac_miiphy_command(addr, reg, EMAC_STACR_WRITE, value);
 365 }