arch/powerpc/cpu/mpc85xx/fsl_corenet_serdes.c

   1 /*
   2  * Copyright 2009-2011 Freescale Semiconductor, Inc.
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0+
   5  */
   6
   7 #include <common.h>
   8 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
   9 #include <hwconfig.h>
  10 #endif
  11 #include <asm/fsl_serdes.h>
  12 #include <asm/immap_85xx.h>
  13 #include <asm/io.h>
  14 #include <asm/processor.h>
  15 #include <asm/fsl_law.h>
  16 #include <linux/errno.h>
  17 #include "fsl_corenet_serdes.h"
  18
  19 /*
  20  * The work-arounds for erratum SERDES8 and SERDES-A001 are linked together.
  21  * The code is already very complicated as it is, and separating the two
  22  * completely would just make things worse.  We try to keep them as separate
  23  * as possible, but for now we require SERDES8 if SERDES_A001 is defined.
  24  */
  25 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES_A001
  26 #ifndef CONFIG_SYS_P4080_ERRATUM_SERDES8
  27 #error "CONFIG_SYS_P4080_ERRATUM_SERDES_A001 requires CONFIG_SYS_P4080_ERRATUM_SERDES8"
  28 #endif
  29 #endif
  30
  31 static u32 serdes_prtcl_map;
  32
  33 #ifdef DEBUG
  34 static const char *serdes_prtcl_str[] = {
  35         [NONE] = "NA",
  36         [PCIE1] = "PCIE1",
  37         [PCIE2] = "PCIE2",
  38         [PCIE3] = "PCIE3",
  39         [PCIE4] = "PCIE4",
  40         [SATA1] = "SATA1",
  41         [SATA2] = "SATA2",
  42         [SRIO1] = "SRIO1",
  43         [SRIO2] = "SRIO2",
  44         [SGMII_FM1_DTSEC1] = "SGMII_FM1_DTSEC1",
  45         [SGMII_FM1_DTSEC2] = "SGMII_FM1_DTSEC2",
  46         [SGMII_FM1_DTSEC3] = "SGMII_FM1_DTSEC3",
  47         [SGMII_FM1_DTSEC4] = "SGMII_FM1_DTSEC4",
  48         [SGMII_FM1_DTSEC5] = "SGMII_FM1_DTSEC5",
  49         [SGMII_FM2_DTSEC1] = "SGMII_FM2_DTSEC1",
  50         [SGMII_FM2_DTSEC2] = "SGMII_FM2_DTSEC2",
  51         [SGMII_FM2_DTSEC3] = "SGMII_FM2_DTSEC3",
  52         [SGMII_FM2_DTSEC4] = "SGMII_FM2_DTSEC4",
  53         [SGMII_FM2_DTSEC5] = "SGMII_FM2_DTSEC5",
  54         [XAUI_FM1] = "XAUI_FM1",
  55         [XAUI_FM2] = "XAUI_FM2",
  56         [AURORA] = "DEBUG",
  57 };
  58 #endif
  59
  60 static const struct {
  61         int idx;
  62         unsigned int lpd; /* RCW lane powerdown bit */
  63         int bank;
  64 } lanes[SRDS_MAX_LANES] = {
  65         { 0, 152, FSL_SRDS_BANK_1 },
  66         { 1, 153, FSL_SRDS_BANK_1 },
  67         { 2, 154, FSL_SRDS_BANK_1 },
  68         { 3, 155, FSL_SRDS_BANK_1 },
  69         { 4, 156, FSL_SRDS_BANK_1 },
  70         { 5, 157, FSL_SRDS_BANK_1 },
  71         { 6, 158, FSL_SRDS_BANK_1 },
  72         { 7, 159, FSL_SRDS_BANK_1 },
  73         { 8, 160, FSL_SRDS_BANK_1 },
  74         { 9, 161, FSL_SRDS_BANK_1 },
  75         { 16, 162, FSL_SRDS_BANK_2 },
  76         { 17, 163, FSL_SRDS_BANK_2 },
  77         { 18, 164, FSL_SRDS_BANK_2 },
  78         { 19, 165, FSL_SRDS_BANK_2 },
  79 #ifdef CONFIG_PPC_P4080
  80         { 20, 170, FSL_SRDS_BANK_3 },
  81         { 21, 171, FSL_SRDS_BANK_3 },
  82         { 22, 172, FSL_SRDS_BANK_3 },
  83         { 23, 173, FSL_SRDS_BANK_3 },
  84 #else
  85         { 20, 166, FSL_SRDS_BANK_3 },
  86         { 21, 167, FSL_SRDS_BANK_3 },
  87         { 22, 168, FSL_SRDS_BANK_3 },
  88         { 23, 169, FSL_SRDS_BANK_3 },
  89 #endif
  90 #if SRDS_MAX_BANK > 3
  91         { 24, 175, FSL_SRDS_BANK_4 },
  92         { 25, 176, FSL_SRDS_BANK_4 },
  93 #endif
  94 };
  95
  96 int serdes_get_lane_idx(int lane)
  97 {
  98         return lanes[lane].idx;
  99 }
 100
 101 int serdes_get_bank_by_lane(int lane)
 102 {
 103         return lanes[lane].bank;
 104 }
 105
 106 int serdes_lane_enabled(int lane)
 107 {
 108         ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
 109         serdes_corenet_t *regs = (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
 110
 111         int bank = lanes[lane].bank;
 112         int word = lanes[lane].lpd / 32;
 113         int bit = lanes[lane].lpd % 32;
 114
 115         if (in_be32(&regs->bank[bank].rstctl) & SRDS_RSTCTL_SDPD)
 116                 return 0;
 117
 118 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 119         /*
 120          * For banks two and three, use the srds_lpd_b[] array instead of the
 121          * RCW, because this array contains the real values of SRDS_LPD_B2 and
 122          * SRDS_LPD_B3.
 123          */
 124         if (bank > 0)
 125                 return !(srds_lpd_b[bank] & (8 >> (lane - (6 + 4 * bank))));
 126 #endif
 127
 128         return !(in_be32(&gur->rcwsr[word]) & (0x80000000 >> bit));
 129 }
 130
 131 int is_serdes_configured(enum srds_prtcl device)
 132 {
 133         ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
 134
 135         /* Is serdes enabled at all? */
 136         if (!(in_be32(&gur->rcwsr[5]) & FSL_CORENET_RCWSR5_SRDS_EN))
 137                 return 0;
 138
 139         if (!(serdes_prtcl_map & (1 << NONE)))
 140                 fsl_serdes_init();
 141
 142         return (1 << device) & serdes_prtcl_map;
 143 }
 144
 145 static int __serdes_get_first_lane(uint32_t prtcl, enum srds_prtcl device)
 146 {
 147         int i;
 148
 149         for (i = 0; i < SRDS_MAX_LANES; i++) {
 150                 if (serdes_get_prtcl(prtcl, i) == device)
 151                         return i;
 152         }
 153
 154         return -ENODEV;
 155 }
 156
 157 /*
 158  * Returns the SERDES lane (0..SRDS_MAX_LANES-1) that routes to the given
 159  * device. This depends on the current SERDES protocol, as defined in the RCW.
 160  *
 161  * Returns a negative error code if SERDES is disabled or the given device is
 162  * not supported in the current SERDES protocol.
 163  */
 164 int serdes_get_first_lane(enum srds_prtcl device)
 165 {
 166         u32 prtcl;
 167         const ccsr_gur_t *gur;
 168
 169         gur = (typeof(gur))CONFIG_SYS_MPC85xx_GUTS_ADDR;
 170
 171         /* Is serdes enabled at all? */
 172         if (unlikely((in_be32(&gur->rcwsr[5]) & 0x2000) == 0))
 173                 return -ENODEV;
 174
 175         prtcl = (in_be32(&gur->rcwsr[4]) & FSL_CORENET_RCWSR4_SRDS_PRTCL) >> 26;
 176
 177         return __serdes_get_first_lane(prtcl, device);
 178 }
 179
 180 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES9
 181 /*
 182  * Returns the SERDES bank (1, 2, or 3) that a given device is on for a given
 183  * SERDES protocol.
 184  *
 185  * Returns a negative error code if the given device is not supported for the
 186  * given SERDES protocol.
 187  */
 188 static int serdes_get_bank_by_device(uint32_t prtcl, enum srds_prtcl device)
 189 {
 190         int lane;
 191
 192         lane = __serdes_get_first_lane(prtcl, device);
 193         if (unlikely(lane < 0))
 194                 return lane;
 195
 196         return serdes_get_bank_by_lane(lane);
 197 }
 198
 199 static uint32_t __serdes_get_lane_count(uint32_t prtcl, enum srds_prtcl device,
 200                                         int first)
 201 {
 202         int lane;
 203
 204         for (lane = first; lane < SRDS_MAX_LANES; lane++) {
 205                 if (serdes_get_prtcl(prtcl, lane) != device)
 206                         break;
 207         }
 208
 209         return lane - first;
 210 }
 211
 212 static void __serdes_reset_rx(serdes_corenet_t *regs,
 213                               uint32_t prtcl,
 214                               enum srds_prtcl device)
 215 {
 216         int lane, idx, first, last;
 217
 218         lane = __serdes_get_first_lane(prtcl, device);
 219         if (unlikely(lane < 0))
 220                 return;
 221         first = serdes_get_lane_idx(lane);
 222         last = first + __serdes_get_lane_count(prtcl, device, lane);
 223
 224         /*
 225          * Set BnGCRy0[RRST] = 0 for each lane in the each bank that is
 226          * selected as XAUI to place the lane into reset.
 227         */
 228         for (idx = first; idx < last; idx++)
 229                 clrbits_be32(&regs->lane[idx].gcr0, SRDS_GCR0_RRST);
 230
 231         /* Wait at least 250 ns */
 232         udelay(1);
 233
 234         /*
 235          * Set BnGCRy0[RRST] = 1 for each lane in the each bank that is
 236          * selected as XAUI to bring the lane out of reset.
 237          */
 238         for (idx = first; idx < last; idx++)
 239                 setbits_be32(&regs->lane[idx].gcr0, SRDS_GCR0_RRST);
 240 }
 241
 242 void serdes_reset_rx(enum srds_prtcl device)
 243 {
 244         u32 prtcl;
 245         const ccsr_gur_t *gur;
 246         serdes_corenet_t *regs;
 247
 248         if (unlikely(device == NONE))
 249                 return;
 250
 251         gur = (typeof(gur))CONFIG_SYS_MPC85xx_GUTS_ADDR;
 252
 253         /* Is serdes enabled at all? */
 254         if (unlikely((in_be32(&gur->rcwsr[5]) & 0x2000) == 0))
 255                 return;
 256
 257         regs = (typeof(regs))CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
 258         prtcl = (in_be32(&gur->rcwsr[4]) & FSL_CORENET_RCWSR4_SRDS_PRTCL) >> 26;
 259
 260         __serdes_reset_rx(regs, prtcl, device);
 261 }
 262 #endif
 263
 264 #ifndef CONFIG_SYS_DCSRBAR_PHYS
 265 #define CONFIG_SYS_DCSRBAR_PHYS 0x80000000 /* Must be 1GB-aligned for rev1.0 */
 266 #define CONFIG_SYS_DCSRBAR      0x80000000
 267 #define __DCSR_NOT_DEFINED_BY_CONFIG
 268 #endif
 269
 270 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 271 /*
 272  * Enable a SERDES bank that was disabled via the RCW
 273  *
 274  * We only call this function for SERDES8 and SERDES-A001 in cases we really
 275  * want to enable the bank, whether we actually want to use the lanes or not,
 276  * so make sure at least one lane is enabled.  We're only enabling this one
 277  * lane to satisfy errata requirements that the bank be enabled.
 278  *
 279  * We use a local variable instead of srds_lpd_b[] because we want drivers to
 280  * think that the lanes actually are disabled.
 281  */
 282 static void enable_bank(ccsr_gur_t *gur, int bank)
 283 {
 284         u32 rcw5;
 285         u32 temp_lpd_b = srds_lpd_b[bank];
 286
 287         /*
 288          * If we're asked to disable all lanes, just pretend we're doing
 289          * that.
 290          */
 291         if (temp_lpd_b == 0xF)
 292                 temp_lpd_b = 0xE;
 293
 294         /*
 295          * Enable the lanes SRDS_LPD_Bn.  The RCW bits are read-only in
 296          * CCSR, and read/write in DSCR.
 297          */
 298         rcw5 = in_be32(gur->rcwsr + 5);
 299         if (bank == FSL_SRDS_BANK_2) {
 300                 rcw5 &= ~FSL_CORENET_RCWSRn_SRDS_LPD_B2;
 301                 rcw5 |= temp_lpd_b << 26;
 302         } else if (bank == FSL_SRDS_BANK_3) {
 303                 rcw5 &= ~FSL_CORENET_RCWSRn_SRDS_LPD_B3;
 304                 rcw5 |= temp_lpd_b << 18;
 305         } else {
 306                 printf("SERDES: enable_bank: bad bank %d\n", bank + 1);
 307                 return;
 308         }
 309
 310         /* See similar code in cpu/mpc85xx/cpu_init.c for an explanation
 311          * of the DCSR mapping.
 312          */
 313         {
 314 #ifdef __DCSR_NOT_DEFINED_BY_CONFIG
 315                 struct law_entry law = find_law(CONFIG_SYS_DCSRBAR_PHYS);
 316                 int law_index;
 317                 if (law.index == -1)
 318                         law_index = set_next_law(CONFIG_SYS_DCSRBAR_PHYS,
 319                                                  LAW_SIZE_1M, LAW_TRGT_IF_DCSR);
 320                 else
 321                         set_law(law.index, CONFIG_SYS_DCSRBAR_PHYS, LAW_SIZE_1M,
 322                                 LAW_TRGT_IF_DCSR);
 323 #endif
 324                 u32 *p = (void *)CONFIG_SYS_DCSRBAR + 0x20114;
 325                 out_be32(p, rcw5);
 326 #ifdef __DCSR_NOT_DEFINED_BY_CONFIG
 327                 if (law.index == -1)
 328                         disable_law(law_index);
 329                 else
 330                         set_law(law.index, law.addr, law.size, law.trgt_id);
 331 #endif
 332         }
 333 }
 334
 335 /*
 336  * To avoid problems with clock jitter, rev 2 p4080 uses the pll from
 337  * bank 3 to clock banks 2 and 3, as well as a limited selection of
 338  * protocol configurations.  This requires that banks 2 and 3's lanes be
 339  * disabled in the RCW, and enabled with some fixup here to re-enable
 340  * them, and to configure bank 2's clock parameters in bank 3's pll in
 341  * cases where they differ.
 342  */
 343 static void p4080_erratum_serdes8(serdes_corenet_t *regs, ccsr_gur_t *gur,
 344                                   u32 devdisr, u32 devdisr2, int cfg)
 345 {
 346         int srds_ratio_b2;
 347         int rfck_sel;
 348
 349         /*
 350          * The disabled lanes of bank 2 will cause the associated
 351          * logic blocks to be disabled in DEVDISR.  We reverse that here.
 352          *
 353          * Note that normally it is not permitted to clear DEVDISR bits
 354          * once the device has been disabled, but the hardware people
 355          * say that this special case is OK.
 356          */
 357         clrbits_be32(&gur->devdisr, devdisr);
 358         clrbits_be32(&gur->devdisr2, devdisr2);
 359
 360         /*
 361          * Some protocols require special handling.  There are a few
 362          * additional protocol configurations that can be used, which are
 363          * not listed here.  See app note 4065 for supported protocol
 364          * configurations.
 365          */
 366         switch (cfg) {
 367         case 0x19:
 368                 /*
 369                  * Bank 2 has PCIe which wants BWSEL -- tell bank 3's PLL.
 370                  * SGMII on bank 3 should still be usable.
 371                  */
 372                 setbits_be32(&regs->bank[FSL_SRDS_BANK_3].pllcr1,
 373                              SRDS_PLLCR1_PLL_BWSEL);
 374                 break;
 375
 376         case 0x0f:
 377         case 0x10:
 378                 /*
 379                  * Banks 2 (XAUI) and 3 (SGMII) have different clocking
 380                  * requirements in these configurations.  Bank 3 cannot
 381                  * be used and should have its lanes (but not the bank
 382                  * itself) disabled in the RCW.  We set up bank 3's pll
 383                  * for bank 2's needs here.
 384                  */
 385                 srds_ratio_b2 = (in_be32(&gur->rcwsr[4]) >> 13) & 7;
 386
 387                 /* Determine refclock from XAUI ratio */
 388                 switch (srds_ratio_b2) {
 389                 case 1: /* 20:1 */
 390                         rfck_sel = SRDS_PLLCR0_RFCK_SEL_156_25;
 391                         break;
 392                 case 2: /* 25:1 */
 393                         rfck_sel = SRDS_PLLCR0_RFCK_SEL_125;
 394                         break;
 395                 default:
 396                         printf("SERDES: bad SRDS_RATIO_B2 %d\n",
 397                                srds_ratio_b2);
 398                         return;
 399                 }
 400
 401                 clrsetbits_be32(&regs->bank[FSL_SRDS_BANK_3].pllcr0,
 402                                 SRDS_PLLCR0_RFCK_SEL_MASK, rfck_sel);
 403
 404                 clrsetbits_be32(&regs->bank[FSL_SRDS_BANK_3].pllcr0,
 405                                 SRDS_PLLCR0_FRATE_SEL_MASK,
 406                                 SRDS_PLLCR0_FRATE_SEL_6_25);
 407                 break;
 408         }
 409
 410         enable_bank(gur, FSL_SRDS_BANK_3);
 411 }
 412 #endif
 413
 414 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES_A005
 415 /*
 416  * If PCIe is not selected as a protocol for any lanes driven by a given PLL,
 417  * that PLL should have SRDSBnPLLCR1[PLLBW_SEL] = 0.
 418  */
 419 static void p4080_erratum_serdes_a005(serdes_corenet_t *regs, unsigned int cfg)
 420 {
 421         enum srds_prtcl device;
 422
 423         switch (cfg) {
 424         case 0x13:
 425         case 0x16:
 426                 /*
 427                  * If SRDS_PRTCL = 0x13 or 0x16, set SRDSB1PLLCR1[PLLBW_SEL]
 428                  * to 0.
 429                  */
 430                 clrbits_be32(&regs->bank[FSL_SRDS_BANK_1].pllcr1,
 431                              SRDS_PLLCR1_PLL_BWSEL);
 432                 break;
 433         case 0x19:
 434                 /*
 435                  * If SRDS_PRTCL = 0x19, set SRDSB1PLLCR1[PLLBW_SEL] to 0 and
 436                  * SRDSB3PLLCR1[PLLBW_SEL] to 1.
 437                  */
 438                 clrbits_be32(&regs->bank[FSL_SRDS_BANK_1].pllcr1,
 439                              SRDS_PLLCR1_PLL_BWSEL);
 440                 setbits_be32(&regs->bank[FSL_SRDS_BANK_3].pllcr1,
 441                              SRDS_PLLCR1_PLL_BWSEL);
 442                 break;
 443         }
 444
 445         /*
 446          * Set SRDSBnPLLCR1[PLLBW_SEL] to 0 for each bank that selects XAUI
 447          * before XAUI is initialized.
 448          */
 449         for (device = XAUI_FM1; device <= XAUI_FM2; device++) {
 450                 if (is_serdes_configured(device)) {
 451                         int bank = serdes_get_bank_by_device(cfg, device);
 452
 453                         clrbits_be32(&regs->bank[bank].pllcr1,
 454                                      SRDS_PLLCR1_PLL_BWSEL);
 455                 }
 456         }
 457 }
 458 #endif
 459
 460 /*
 461  * Wait for the RSTDONE bit to get set, or a one-second timeout.
 462  */
 463 static void wait_for_rstdone(unsigned int bank)
 464 {
 465         serdes_corenet_t *srds_regs =
 466                 (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
 467         unsigned long long end_tick;
 468         u32 rstctl;
 469
 470         /* wait for reset complete or 1-second timeout */
 471         end_tick = usec2ticks(1000000) + get_ticks();
 472         do {
 473                 rstctl = in_be32(&srds_regs->bank[bank].rstctl);
 474                 if (rstctl & SRDS_RSTCTL_RSTDONE)
 475                         break;
 476         } while (end_tick > get_ticks());
 477
 478         if (!(rstctl & SRDS_RSTCTL_RSTDONE))
 479                 printf("SERDES: timeout resetting bank %u\n", bank + 1);
 480 }
 481
 482
 483 static void __soc_serdes_init(void)
 484 {
 485         /* Allow for SoC-specific initialization in <SOC>_serdes.c  */
 486 };
 487 void soc_serdes_init(void) __attribute__((weak, alias("__soc_serdes_init")));
 488
 489 void fsl_serdes_init(void)
 490 {
 491         ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
 492         int cfg;
 493         serdes_corenet_t *srds_regs;
 494 #ifdef CONFIG_PPC_P5040
 495         serdes_corenet_t *srds2_regs;
 496 #endif
 497         int lane, bank, idx;
 498         int have_bank[SRDS_MAX_BANK] = {};
 499 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 500         u32 serdes8_devdisr = 0;
 501         u32 serdes8_devdisr2 = 0;
 502         char srds_lpd_opt[16];
 503         const char *srds_lpd_arg;
 504         size_t arglen;
 505 #endif
 506 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES_A001
 507         int need_serdes_a001;   /* true == need work-around for SERDES A001 */
 508 #endif
 509 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 510         char buffer[HWCONFIG_BUFFER_SIZE];
 511         char *buf = NULL;
 512
 513         /*
 514          * Extract hwconfig from environment since we have not properly setup
 515          * the environment but need it for ddr config params
 516          */
 517         if (getenv_f("hwconfig", buffer, sizeof(buffer)) > 0)
 518                 buf = buffer;
 519 #endif
 520         if (serdes_prtcl_map & (1 << NONE))
 521                 return;
 522
 523         /* Is serdes enabled at all? */
 524         if (!(in_be32(&gur->rcwsr[5]) & FSL_CORENET_RCWSR5_SRDS_EN))
 525                 return;
 526
 527         srds_regs = (void *)(CONFIG_SYS_FSL_CORENET_SERDES_ADDR);
 528         cfg = (in_be32(&gur->rcwsr[4]) & FSL_CORENET_RCWSR4_SRDS_PRTCL) >> 26;
 529         debug("Using SERDES configuration 0x%x, lane settings:\n", cfg);
 530
 531         if (!is_serdes_prtcl_valid(cfg)) {
 532                 printf("SERDES[PRTCL] = 0x%x is not valid\n", cfg);
 533                 return;
 534         }
 535
 536 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 537         /*
 538          * Display a warning if banks two and three are not disabled in the RCW,
 539          * since our work-around for SERDES8 depends on these banks being
 540          * disabled at power-on.
 541          */
 542 #define B2_B3 (FSL_CORENET_RCWSRn_SRDS_LPD_B2 | FSL_CORENET_RCWSRn_SRDS_LPD_B3)
 543         if ((in_be32(&gur->rcwsr[5]) & B2_B3) != B2_B3) {
 544                 printf("Warning: SERDES8 requires banks two and "
 545                        "three to be disabled in the RCW\n");
 546         }
 547
 548         /*
 549          * Store the values of the fsl_srds_lpd_b2 and fsl_srds_lpd_b3
 550          * hwconfig options into the srds_lpd_b[] array.  See README.p4080ds
 551          * for a description of these options.
 552          */
 553         for (bank = 1; bank < ARRAY_SIZE(srds_lpd_b); bank++) {
 554                 sprintf(srds_lpd_opt, "fsl_srds_lpd_b%u", bank + 1);
 555                 srds_lpd_arg =
 556                         hwconfig_subarg_f("serdes", srds_lpd_opt, &arglen, buf);
 557                 if (srds_lpd_arg)
 558                         srds_lpd_b[bank] =
 559                                 simple_strtoul(srds_lpd_arg, NULL, 0) & 0xf;
 560         }
 561
 562         if ((cfg == 0xf) || (cfg == 0x10)) {
 563                 /*
 564                  * For SERDES protocols 0xF and 0x10, force bank 3 to be
 565                  * disabled, because it is not supported.
 566                  */
 567                 srds_lpd_b[FSL_SRDS_BANK_3] = 0xF;
 568         }
 569 #endif
 570
 571         /* Look for banks with all lanes disabled, and power down the bank. */
 572         for (lane = 0; lane < SRDS_MAX_LANES; lane++) {
 573                 enum srds_prtcl lane_prtcl = serdes_get_prtcl(cfg, lane);
 574                 if (serdes_lane_enabled(lane)) {
 575                         have_bank[serdes_get_bank_by_lane(lane)] = 1;
 576                         serdes_prtcl_map |= (1 << lane_prtcl);
 577                 }
 578         }
 579
 580 #ifdef CONFIG_PPC_P5040
 581         /*
 582          * Lanes on bank 4 on P5040 are commented-out, but for some SERDES
 583          * protocols, these lanes are routed to SATA.  We use serdes_prtcl_map
 584          * to decide whether a protocol is supported on a given lane, so SATA
 585          * will be identified as not supported, and therefore not initialized.
 586          * So for protocols which use SATA on bank4, we add SATA support in
 587          * serdes_prtcl_map.
 588          */
 589         switch (cfg) {
 590         case 0x0:
 591         case 0x1:
 592         case 0x2:
 593         case 0x3:
 594         case 0x4:
 595         case 0x5:
 596         case 0x6:
 597         case 0x7:
 598                 serdes_prtcl_map |= 1 << SATA1 | 1 << SATA2;
 599                 break;
 600         default:
 601                 srds2_regs = (void *)CONFIG_SYS_FSL_CORENET_SERDES2_ADDR;
 602
 603                 /* We don't need bank 4, so power it down */
 604                 setbits_be32(&srds2_regs->bank[0].rstctl, SRDS_RSTCTL_SDPD);
 605         }
 606 #endif
 607
 608         soc_serdes_init();
 609
 610         /* Set the first bit to indicate serdes has been initialized */
 611         serdes_prtcl_map |= (1 << NONE);
 612
 613 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 614         /*
 615          * Bank two uses the clock from bank three, so if bank two is enabled,
 616          * then bank three must also be enabled.
 617          */
 618         if (have_bank[FSL_SRDS_BANK_2])
 619                 have_bank[FSL_SRDS_BANK_3] = 1;
 620 #endif
 621
 622 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES_A001
 623         /*
 624          * The work-aroud for erratum SERDES-A001 is needed only if bank two
 625          * is disabled and bank three is enabled.  The converse is also true,
 626          * but SERDES8 ensures that bank 3 is always enabled if bank 2 is
 627          * enabled, so there's no point in complicating the code to handle
 628          * that situation.
 629          */
 630         need_serdes_a001 =
 631                 !have_bank[FSL_SRDS_BANK_2] && have_bank[FSL_SRDS_BANK_3];
 632 #endif
 633
 634         /* Power down the banks we're not interested in */
 635         for (bank = 0; bank < SRDS_MAX_BANK; bank++) {
 636                 if (!have_bank[bank]) {
 637                         printf("SERDES: bank %d disabled\n", bank + 1);
 638 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES_A001
 639                         /*
 640                          * Erratum SERDES-A001 says bank two needs to be powered
 641                          * down after bank three is powered up, so don't power
 642                          * down bank two here.
 643                          */
 644                         if (!need_serdes_a001 || (bank != FSL_SRDS_BANK_2))
 645                                 setbits_be32(&srds_regs->bank[bank].rstctl,
 646                                              SRDS_RSTCTL_SDPD);
 647 #else
 648                         setbits_be32(&srds_regs->bank[bank].rstctl,
 649                                      SRDS_RSTCTL_SDPD);
 650 #endif
 651                 }
 652         }
 653
 654 #ifdef CONFIG_SYS_FSL_ERRATUM_A004699
 655         /*
 656          * To avoid the situation that resulted in the P4080 erratum
 657          * SERDES-8, a given SerDes bank will use the PLLs from the previous
 658          * bank if one of the PLL frequencies is a multiple of the other.  For
 659          * instance, if bank 3 is running at 2.5GHz and bank 2 is at 1.25GHz,
 660          * then bank 3 will use bank 2's PLL.  P5040 Erratum A-004699 says
 661          * that, in this situation, lane synchronization is not initiated.  So
 662          * when we detect a bank with a "borrowed" PLL, we have to manually
 663          * initiate lane synchronization.
 664          */
 665         for (bank = FSL_SRDS_BANK_2; bank <= FSL_SRDS_BANK_3; bank++) {
 666                 /* Determine the first lane for this bank */
 667                 unsigned int lane;
 668
 669                 for (lane = 0; lane < SRDS_MAX_LANES; lane++)
 670                         if (lanes[lane].bank == bank)
 671                                 break;
 672                 idx = lanes[lane].idx;
 673
 674                 /*
 675                  * Check if the PLL for the bank is borrowed.  The UOTHL
 676                  * bit of the first lane will tell us that.
 677                  */
 678                 if (in_be32(&srds_regs->lane[idx].gcr0) & SRDS_GCR0_UOTHL) {
 679                         /* Manually start lane synchronization */
 680                         setbits_be32(&srds_regs->bank[bank].pllcr0,
 681                                      SRDS_PLLCR0_PVCOCNT_EN);
 682                 }
 683         }
 684 #endif
 685
 686 #if defined(CONFIG_SYS_P4080_ERRATUM_SERDES8) || defined (CONFIG_SYS_P4080_ERRATUM_SERDES9)
 687         for (lane = 0; lane < SRDS_MAX_LANES; lane++) {
 688                 enum srds_prtcl lane_prtcl;
 689
 690                 idx = serdes_get_lane_idx(lane);
 691                 lane_prtcl = serdes_get_prtcl(cfg, lane);
 692
 693 #ifdef DEBUG
 694                 switch (lane) {
 695                 case 0:
 696                         puts("Bank1: ");
 697                         break;
 698                 case 10:
 699                         puts("\nBank2: ");
 700                         break;
 701                 case 14:
 702                         puts("\nBank3: ");
 703                         break;
 704                 default:
 705                         break;
 706                 }
 707
 708                 printf("%s ", serdes_prtcl_str[lane_prtcl]);
 709 #endif
 710
 711 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES9
 712                 /*
 713                  * Set BnTTLCRy0[FLT_SEL] = 011011 and set BnTTLCRy0[31] = 1
 714                  * for each of the SerDes lanes selected as SGMII, XAUI, SRIO,
 715                  * or AURORA before the device is initialized.
 716                  *
 717                  * Note that this part of the SERDES-9 work-around is
 718                  * redundant if the work-around for A-4580 has already been
 719                  * applied via PBI.
 720                  */
 721                 switch (lane_prtcl) {
 722                 case SGMII_FM1_DTSEC1:
 723                 case SGMII_FM1_DTSEC2:
 724                 case SGMII_FM1_DTSEC3:
 725                 case SGMII_FM1_DTSEC4:
 726                 case SGMII_FM2_DTSEC1:
 727                 case SGMII_FM2_DTSEC2:
 728                 case SGMII_FM2_DTSEC3:
 729                 case SGMII_FM2_DTSEC4:
 730                 case SGMII_FM2_DTSEC5:
 731                 case XAUI_FM1:
 732                 case XAUI_FM2:
 733                 case SRIO1:
 734                 case SRIO2:
 735                 case AURORA:
 736                         out_be32(&srds_regs->lane[idx].ttlcr0,
 737                                  SRDS_TTLCR0_FLT_SEL_KFR_26 |
 738                                  SRDS_TTLCR0_FLT_SEL_KPH_28 |
 739                                  SRDS_TTLCR0_FLT_SEL_750PPM |
 740                                  SRDS_TTLCR0_FREQOVD_EN);
 741                         break;
 742                 default:
 743                         break;
 744                 }
 745 #endif
 746
 747 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 748                 switch (lane_prtcl) {
 749                 case PCIE1:
 750                 case PCIE2:
 751                 case PCIE3:
 752                         serdes8_devdisr |= FSL_CORENET_DEVDISR_PCIE1 >>
 753                                            (lane_prtcl - PCIE1);
 754                         break;
 755                 case SRIO1:
 756                 case SRIO2:
 757                         serdes8_devdisr |= FSL_CORENET_DEVDISR_SRIO1 >>
 758                                            (lane_prtcl - SRIO1);
 759                         break;
 760                 case SGMII_FM1_DTSEC1:
 761                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM1 |
 762                                             FSL_CORENET_DEVDISR2_DTSEC1_1;
 763                         break;
 764                 case SGMII_FM1_DTSEC2:
 765                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM1 |
 766                                             FSL_CORENET_DEVDISR2_DTSEC1_2;
 767                         break;
 768                 case SGMII_FM1_DTSEC3:
 769                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM1 |
 770                                             FSL_CORENET_DEVDISR2_DTSEC1_3;
 771                         break;
 772                 case SGMII_FM1_DTSEC4:
 773                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM1 |
 774                                             FSL_CORENET_DEVDISR2_DTSEC1_4;
 775                         break;
 776                 case SGMII_FM2_DTSEC1:
 777                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM2 |
 778                                             FSL_CORENET_DEVDISR2_DTSEC2_1;
 779                         break;
 780                 case SGMII_FM2_DTSEC2:
 781                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM2 |
 782                                             FSL_CORENET_DEVDISR2_DTSEC2_2;
 783                         break;
 784                 case SGMII_FM2_DTSEC3:
 785                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM2 |
 786                                             FSL_CORENET_DEVDISR2_DTSEC2_3;
 787                         break;
 788                 case SGMII_FM2_DTSEC4:
 789                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM2 |
 790                                             FSL_CORENET_DEVDISR2_DTSEC2_4;
 791                         break;
 792                 case SGMII_FM2_DTSEC5:
 793                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM2 |
 794                                             FSL_CORENET_DEVDISR2_DTSEC2_5;
 795                         break;
 796                 case XAUI_FM1:
 797                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM1    |
 798                                             FSL_CORENET_DEVDISR2_10GEC1;
 799                         break;
 800                 case XAUI_FM2:
 801                         serdes8_devdisr2 |= FSL_CORENET_DEVDISR2_FM2    |
 802                                             FSL_CORENET_DEVDISR2_10GEC2;
 803                         break;
 804                 case AURORA:
 805                         break;
 806                 default:
 807                         break;
 808                 }
 809
 810 #endif
 811         }
 812 #endif
 813
 814 #ifdef DEBUG
 815         puts("\n");
 816 #endif
 817
 818 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES_A005
 819         p4080_erratum_serdes_a005(srds_regs, cfg);
 820 #endif
 821
 822         for (idx = 0; idx < SRDS_MAX_BANK; idx++) {
 823                 bank = idx;
 824
 825 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 826                 /*
 827                  * Change bank init order to 0, 2, 1, so that the third bank's
 828                  * PLL is established before we start the second bank.  The
 829                  * second bank uses the third bank's PLL.
 830                  */
 831
 832                 if (idx == 1)
 833                         bank = FSL_SRDS_BANK_3;
 834                 else if (idx == 2)
 835                         bank = FSL_SRDS_BANK_2;
 836 #endif
 837
 838                 /* Skip disabled banks */
 839                 if (!have_bank[bank])
 840                         continue;
 841
 842 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES8
 843                 if (idx == 1) {
 844                         /*
 845                          * Re-enable devices on banks two and three that were
 846                          * disabled by the RCW, and then enable bank three. The
 847                          * devices need to be enabled before either bank is
 848                          * powered up.
 849                          */
 850                         p4080_erratum_serdes8(srds_regs, gur, serdes8_devdisr,
 851                                               serdes8_devdisr2, cfg);
 852                 } else if (idx == 2) {
 853                         /* Enable bank two now that bank three is enabled. */
 854                         enable_bank(gur, FSL_SRDS_BANK_2);
 855                 }
 856 #endif
 857
 858                 wait_for_rstdone(bank);
 859         }
 860
 861 #ifdef CONFIG_SYS_P4080_ERRATUM_SERDES_A001
 862         if (need_serdes_a001) {
 863                 /* Bank 3 has been enabled, so now we can disable bank 2 */
 864                 setbits_be32(&srds_regs->bank[FSL_SRDS_BANK_2].rstctl,
 865                              SRDS_RSTCTL_SDPD);
 866         }
 867 #endif
 868 }
 869
 870 const char *serdes_clock_to_string(u32 clock)
 871 {
 872         switch (clock) {
 873         case SRDS_PLLCR0_RFCK_SEL_100:
 874                 return "100";
 875         case SRDS_PLLCR0_RFCK_SEL_125:
 876                 return "125";
 877         case SRDS_PLLCR0_RFCK_SEL_156_25:
 878                 return "156.25";
 879         case SRDS_PLLCR0_RFCK_SEL_161_13:
 880                 return "161.1328123";
 881         default:
 882                 return "150";
 883         }
 884 }
 885