arch/powerpc/cpu/ppc4xx/cpu_init.c

   1 /*
   2  * (C) Copyright 2000-2007
   3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 #include <common.h>
   9 #include <watchdog.h>
  10 #include <asm/ppc4xx-emac.h>
  11 #include <asm/processor.h>
  12 #include <asm/ppc4xx-gpio.h>
  13 #include <asm/ppc4xx.h>
  14
  15 DECLARE_GLOBAL_DATA_PTR;
  16
  17 #ifndef CONFIG_SYS_PLL_RECONFIG
  18 #define CONFIG_SYS_PLL_RECONFIG 0
  19 #endif
  20
  21 #if defined(CONFIG_440EPX) || \
  22     defined(CONFIG_460EX) || defined(CONFIG_460GT)
  23 static void reset_with_rli(void)
  24 {
  25         u32 reg;
  26
  27         /*
  28          * Set reload inhibit so configuration will persist across
  29          * processor resets
  30          */
  31         mfcpr(CPR0_ICFG, reg);
  32         reg |= CPR0_ICFG_RLI_MASK;
  33         mtcpr(CPR0_ICFG, reg);
  34
  35         /* Reset processor if configuration changed */
  36         __asm__ __volatile__ ("sync; isync");
  37         mtspr(SPRN_DBCR0, 0x20000000);
  38 }
  39 #endif
  40
  41 void reconfigure_pll(u32 new_cpu_freq)
  42 {
  43 #if defined(CONFIG_440EPX)
  44         int     reset_needed = 0;
  45         u32     reg, temp;
  46         u32     prbdv0, target_prbdv0,                          /* CLK_PRIMBD */
  47                 fwdva, target_fwdva, fwdvb, target_fwdvb,       /* CLK_PLLD */
  48                 fbdv, target_fbdv, lfbdv, target_lfbdv,
  49                 perdv0, target_perdv0,                          /* CLK_PERD */
  50                 spcid0, target_spcid0;                          /* CLK_SPCID */
  51
  52         /* Reconfigure clocks if necessary.
  53          * See PPC440EPx User's Manual, sections 8.2 and 14 */
  54         if (new_cpu_freq == 667) {
  55                 target_prbdv0 = 2;
  56                 target_fwdva = 2;
  57                 target_fwdvb = 4;
  58                 target_fbdv = 20;
  59                 target_lfbdv = 1;
  60                 target_perdv0 = 4;
  61                 target_spcid0 = 4;
  62
  63                 mfcpr(CPR0_PRIMBD0, reg);
  64                 temp = (reg & PRBDV_MASK) >> 24;
  65                 prbdv0 = temp ? temp : 8;
  66                 if (prbdv0 != target_prbdv0) {
  67                         reg &= ~PRBDV_MASK;
  68                         reg |= ((target_prbdv0 == 8 ? 0 : target_prbdv0) << 24);
  69                         mtcpr(CPR0_PRIMBD0, reg);
  70                         reset_needed = 1;
  71                 }
  72
  73                 mfcpr(CPR0_PLLD, reg);
  74
  75                 temp = (reg & PLLD_FWDVA_MASK) >> 16;
  76                 fwdva = temp ? temp : 16;
  77
  78                 temp = (reg & PLLD_FWDVB_MASK) >> 8;
  79                 fwdvb = temp ? temp : 8;
  80
  81                 temp = (reg & PLLD_FBDV_MASK) >> 24;
  82                 fbdv = temp ? temp : 32;
  83
  84                 temp = (reg & PLLD_LFBDV_MASK);
  85                 lfbdv = temp ? temp : 64;
  86
  87                 if (fwdva != target_fwdva || fbdv != target_fbdv || lfbdv != target_lfbdv) {
  88                         reg &= ~(PLLD_FWDVA_MASK | PLLD_FWDVB_MASK |
  89                                  PLLD_FBDV_MASK | PLLD_LFBDV_MASK);
  90                         reg |= ((target_fwdva == 16 ? 0 : target_fwdva) << 16) |
  91                                 ((target_fwdvb == 8 ? 0 : target_fwdvb) << 8) |
  92                                 ((target_fbdv == 32 ? 0 : target_fbdv) << 24) |
  93                                 (target_lfbdv == 64 ? 0 : target_lfbdv);
  94                         mtcpr(CPR0_PLLD, reg);
  95                         reset_needed = 1;
  96                 }
  97
  98                 mfcpr(CPR0_PERD, reg);
  99                 perdv0 = (reg & CPR0_PERD_PERDV0_MASK) >> 24;
 100                 if (perdv0 != target_perdv0) {
 101                         reg &= ~CPR0_PERD_PERDV0_MASK;
 102                         reg |= (target_perdv0 << 24);
 103                         mtcpr(CPR0_PERD, reg);
 104                         reset_needed = 1;
 105                 }
 106
 107                 mfcpr(CPR0_SPCID, reg);
 108                 temp = (reg & CPR0_SPCID_SPCIDV0_MASK) >> 24;
 109                 spcid0 = temp ? temp : 4;
 110                 if (spcid0 != target_spcid0) {
 111                         reg &= ~CPR0_SPCID_SPCIDV0_MASK;
 112                         reg |= ((target_spcid0 == 4 ? 0 : target_spcid0) << 24);
 113                         mtcpr(CPR0_SPCID, reg);
 114                         reset_needed = 1;
 115                 }
 116         }
 117
 118         /* Get current value of FWDVA.*/
 119         mfcpr(CPR0_PLLD, reg);
 120         temp = (reg & PLLD_FWDVA_MASK) >> 16;
 121
 122         /*
 123          * Check to see if FWDVA has been set to value of 1. if it has we must
 124          * modify it.
 125          */
 126         if (temp == 1) {
 127                 /*
 128                  * Load register that contains current boot strapping option.
 129                  */
 130                 mfcpr(CPR0_ICFG, reg);
 131                 /*
 132                  * Strapping option bits (ICS) are already in correct position,
 133                  * only masking needed.
 134                  */
 135                 reg &= CPR0_ICFG_ICS_MASK;
 136
 137                 if ((reg == BOOT_STRAP_OPTION_A) || (reg == BOOT_STRAP_OPTION_B) ||
 138                     (reg == BOOT_STRAP_OPTION_D) || (reg == BOOT_STRAP_OPTION_E)) {
 139                         mfcpr(CPR0_PLLD, reg);
 140
 141                         /* Get current value of fbdv.  */
 142                         temp = (reg & PLLD_FBDV_MASK) >> 24;
 143                         fbdv = temp ? temp : 32;
 144
 145                         /* Get current value of lfbdv. */
 146                         temp = (reg & PLLD_LFBDV_MASK);
 147                         lfbdv = temp ? temp : 64;
 148
 149                         /*
 150                          * Get current value of FWDVA. Assign current FWDVA to
 151                          * new FWDVB.
 152                          */
 153                         mfcpr(CPR0_PLLD, reg);
 154                         target_fwdvb = (reg & PLLD_FWDVA_MASK) >> 16;
 155                         fwdvb = target_fwdvb ? target_fwdvb : 8;
 156
 157                         /*
 158                          * Get current value of FWDVB. Assign current FWDVB to
 159                          * new FWDVA.
 160                          */
 161                         target_fwdva = (reg & PLLD_FWDVB_MASK) >> 8;
 162                         fwdva = target_fwdva ? target_fwdva : 16;
 163
 164                         /*
 165                          * Update CPR0_PLLD with switched FWDVA and FWDVB.
 166                          */
 167                         reg &= ~(PLLD_FWDVA_MASK | PLLD_FWDVB_MASK |
 168                                 PLLD_FBDV_MASK | PLLD_LFBDV_MASK);
 169                         reg |= ((fwdva == 16 ? 0 : fwdva) << 16) |
 170                                 ((fwdvb == 8 ? 0 : fwdvb) << 8) |
 171                                 ((fbdv == 32 ? 0 : fbdv) << 24) |
 172                                 (lfbdv == 64 ? 0 : lfbdv);
 173                         mtcpr(CPR0_PLLD, reg);
 174
 175                         /* Acknowledge that a reset is required. */
 176                         reset_needed = 1;
 177                 }
 178         }
 179
 180         /* Now reset the CPU if needed */
 181         if (reset_needed)
 182                 reset_with_rli();
 183 #endif
 184
 185 #if defined(CONFIG_460EX) || defined(CONFIG_460GT)
 186         u32 reg;
 187
 188         /*
 189          * See "9.2.1.1 Booting with Option E" in the 460EX/GT
 190          * users manual
 191          */
 192         mfcpr(CPR0_PLLC, reg);
 193         if ((reg & (CPR0_PLLC_RST | CPR0_PLLC_ENG)) == CPR0_PLLC_RST) {
 194                 /*
 195                  * Set engage bit
 196                  */
 197                 reg = (reg & ~CPR0_PLLC_RST) | CPR0_PLLC_ENG;
 198                 mtcpr(CPR0_PLLC, reg);
 199
 200                 /* Now reset the CPU */
 201                 reset_with_rli();
 202         }
 203 #endif
 204 }
 205
 206 #ifdef CONFIG_SYS_4xx_CHIP_21_ERRATA
 207 void
 208 chip_21_errata(void)
 209 {
 210         /*
 211          * See rev 1.09 of the 405EX/405EXr errata.  CHIP_21 says that
 212          * sometimes reading the PVR and/or SDR0_ECID results in incorrect
 213          * values.  Since the rev-D chip uses the SDR0_ECID bits to control
 214          * internal features, that means the second PCIe or ethernet of an EX
 215          * variant could fail to work.  Also, security features of both EX and
 216          * EXr might be incorrectly disabled.
 217          *
 218          * The suggested workaround is as follows (covering rev-C and rev-D):
 219          *
 220          * 1.Read the PVR and SDR0_ECID3.
 221          *
 222          * 2.If the PVR matches an expected Revision C PVR value AND if
 223          * SDR0_ECID3[12:15] is different from PVR[28:31], then processor is
 224          * Revision C: continue executing the initialization code (no reset
 225          * required).  else go to step 3.
 226          *
 227          * 3.If the PVR matches an expected Revision D PVR value AND if
 228          * SDR0_ECID3[10:11] matches its expected value, then continue
 229          * executing initialization code, no reset required.  else write
 230          * DBCR0[RST] = 0b11 to generate a SysReset.
 231          */
 232
 233         u32 pvr;
 234         u32 pvr_28_31;
 235         u32 ecid3;
 236         u32 ecid3_10_11;
 237         u32 ecid3_12_15;
 238
 239         /* Step 1: */
 240         pvr = get_pvr();
 241         mfsdr(SDR0_ECID3, ecid3);
 242
 243         /* Step 2: */
 244         pvr_28_31 = pvr & 0xf;
 245         ecid3_10_11 = (ecid3 >> 20) & 0x3;
 246         ecid3_12_15 = (ecid3 >> 16) & 0xf;
 247         if ((pvr == CONFIG_405EX_CHIP21_PVR_REV_C) &&
 248                         (pvr_28_31 != ecid3_12_15)) {
 249                 /* No reset required. */
 250                 return;
 251         }
 252
 253         /* Step 3: */
 254         if ((pvr == CONFIG_405EX_CHIP21_PVR_REV_D) &&
 255                         (ecid3_10_11 == CONFIG_405EX_CHIP21_ECID3_REV_D)) {
 256                 /* No reset required. */
 257                 return;
 258         }
 259
 260         /* Reset required. */
 261         __asm__ __volatile__ ("sync; isync");
 262         mtspr(SPRN_DBCR0, 0x30000000);
 263 }
 264 #endif
 265
 266 /*
 267  * Breath some life into the CPU...
 268  *
 269  * Reconfigure PLL if necessary,
 270  * set up the memory map,
 271  * initialize a bunch of registers
 272  */
 273 void
 274 cpu_init_f (void)
 275 {
 276 #if defined(CONFIG_WATCHDOG) || defined(CONFIG_440GX) || defined(CONFIG_460EX)
 277         u32 val;
 278 #endif
 279
 280 #ifdef CONFIG_SYS_4xx_CHIP_21_ERRATA
 281         chip_21_errata();
 282 #endif
 283
 284         reconfigure_pll(CONFIG_SYS_PLL_RECONFIG);
 285
 286 #if (defined(CONFIG_405EP) || defined (CONFIG_405EX)) && \
 287     !defined(CONFIG_SYS_4xx_GPIO_TABLE)
 288         /*
 289          * GPIO0 setup (select GPIO or alternate function)
 290          */
 291 #if defined(CONFIG_SYS_GPIO0_OR)
 292         out32(GPIO0_OR, CONFIG_SYS_GPIO0_OR);           /* set initial state of output pins     */
 293 #endif
 294 #if defined(CONFIG_SYS_GPIO0_ODR)
 295         out32(GPIO0_ODR, CONFIG_SYS_GPIO0_ODR); /* open-drain select                    */
 296 #endif
 297         out32(GPIO0_OSRH, CONFIG_SYS_GPIO0_OSRH);       /* output select                        */
 298         out32(GPIO0_OSRL, CONFIG_SYS_GPIO0_OSRL);
 299         out32(GPIO0_ISR1H, CONFIG_SYS_GPIO0_ISR1H);     /* input select                         */
 300         out32(GPIO0_ISR1L, CONFIG_SYS_GPIO0_ISR1L);
 301         out32(GPIO0_TSRH, CONFIG_SYS_GPIO0_TSRH);       /* three-state select                   */
 302         out32(GPIO0_TSRL, CONFIG_SYS_GPIO0_TSRL);
 303 #if defined(CONFIG_SYS_GPIO0_ISR2H)
 304         out32(GPIO0_ISR2H, CONFIG_SYS_GPIO0_ISR2H);
 305         out32(GPIO0_ISR2L, CONFIG_SYS_GPIO0_ISR2L);
 306 #endif
 307 #if defined (CONFIG_SYS_GPIO0_TCR)
 308         out32(GPIO0_TCR, CONFIG_SYS_GPIO0_TCR); /* enable output driver for outputs     */
 309 #endif
 310 #endif /* CONFIG_405EP ... && !CONFIG_SYS_4xx_GPIO_TABLE */
 311
 312 #if defined (CONFIG_405EP)
 313         /*
 314          * Set EMAC noise filter bits
 315          */
 316         mtdcr(CPC0_EPCTL, CPC0_EPCTL_E0NFE | CPC0_EPCTL_E1NFE);
 317 #endif /* CONFIG_405EP */
 318
 319 #if defined(CONFIG_SYS_4xx_GPIO_TABLE)
 320         gpio_set_chip_configuration();
 321 #endif /* CONFIG_SYS_4xx_GPIO_TABLE */
 322
 323         /*
 324          * External Bus Controller (EBC) Setup
 325          */
 326 #if (defined(CONFIG_SYS_EBC_PB0AP) && defined(CONFIG_SYS_EBC_PB0CR))
 327 #if (defined(CONFIG_405GP) || \
 328      defined(CONFIG_405EP) || defined(CONFIG_405EZ) || \
 329      defined(CONFIG_405EX) || defined(CONFIG_405))
 330         /*
 331          * Move the next instructions into icache, since these modify the flash
 332          * we are running from!
 333          */
 334         asm volatile("  bl      0f"             ::: "lr");
 335         asm volatile("0:        mflr    3"              ::: "r3");
 336         asm volatile("  addi    4, 0, 14"       ::: "r4");
 337         asm volatile("  mtctr   4"              ::: "ctr");
 338         asm volatile("1:        icbt    0, 3");
 339         asm volatile("  addi    3, 3, 32"       ::: "r3");
 340         asm volatile("  bdnz    1b"             ::: "ctr", "cr0");
 341         asm volatile("  addis   3, 0, 0x0"      ::: "r3");
 342         asm volatile("  ori     3, 3, 0xA000"   ::: "r3");
 343         asm volatile("  mtctr   3"              ::: "ctr");
 344         asm volatile("2:        bdnz    2b"             ::: "ctr", "cr0");
 345 #endif
 346
 347         mtebc(PB0AP, CONFIG_SYS_EBC_PB0AP);
 348         mtebc(PB0CR, CONFIG_SYS_EBC_PB0CR);
 349 #endif
 350
 351 #if (defined(CONFIG_SYS_EBC_PB1AP) && defined(CONFIG_SYS_EBC_PB1CR) && !(CONFIG_SYS_INIT_DCACHE_CS == 1))
 352         mtebc(PB1AP, CONFIG_SYS_EBC_PB1AP);
 353         mtebc(PB1CR, CONFIG_SYS_EBC_PB1CR);
 354 #endif
 355
 356 #if (defined(CONFIG_SYS_EBC_PB2AP) && defined(CONFIG_SYS_EBC_PB2CR) && !(CONFIG_SYS_INIT_DCACHE_CS == 2))
 357         mtebc(PB2AP, CONFIG_SYS_EBC_PB2AP);
 358         mtebc(PB2CR, CONFIG_SYS_EBC_PB2CR);
 359 #endif
 360
 361 #if (defined(CONFIG_SYS_EBC_PB3AP) && defined(CONFIG_SYS_EBC_PB3CR) && !(CONFIG_SYS_INIT_DCACHE_CS == 3))
 362         mtebc(PB3AP, CONFIG_SYS_EBC_PB3AP);
 363         mtebc(PB3CR, CONFIG_SYS_EBC_PB3CR);
 364 #endif
 365
 366 #if (defined(CONFIG_SYS_EBC_PB4AP) && defined(CONFIG_SYS_EBC_PB4CR) && !(CONFIG_SYS_INIT_DCACHE_CS == 4))
 367         mtebc(PB4AP, CONFIG_SYS_EBC_PB4AP);
 368         mtebc(PB4CR, CONFIG_SYS_EBC_PB4CR);
 369 #endif
 370
 371 #if (defined(CONFIG_SYS_EBC_PB5AP) && defined(CONFIG_SYS_EBC_PB5CR) && !(CONFIG_SYS_INIT_DCACHE_CS == 5))
 372         mtebc(PB5AP, CONFIG_SYS_EBC_PB5AP);
 373         mtebc(PB5CR, CONFIG_SYS_EBC_PB5CR);
 374 #endif
 375
 376 #if (defined(CONFIG_SYS_EBC_PB6AP) && defined(CONFIG_SYS_EBC_PB6CR) && !(CONFIG_SYS_INIT_DCACHE_CS == 6))
 377         mtebc(PB6AP, CONFIG_SYS_EBC_PB6AP);
 378         mtebc(PB6CR, CONFIG_SYS_EBC_PB6CR);
 379 #endif
 380
 381 #if (defined(CONFIG_SYS_EBC_PB7AP) && defined(CONFIG_SYS_EBC_PB7CR) && !(CONFIG_SYS_INIT_DCACHE_CS == 7))
 382         mtebc(PB7AP, CONFIG_SYS_EBC_PB7AP);
 383         mtebc(PB7CR, CONFIG_SYS_EBC_PB7CR);
 384 #endif
 385
 386 #if defined (CONFIG_SYS_EBC_CFG)
 387         mtebc(EBC0_CFG, CONFIG_SYS_EBC_CFG);
 388 #endif
 389
 390 #if defined(CONFIG_WATCHDOG)
 391         val = mfspr(SPRN_TCR);
 392 #if defined(CONFIG_440EP) || defined(CONFIG_440GR)
 393         val |= 0xb8000000;      /* generate system reset after 1.34 seconds */
 394 #elif defined(CONFIG_440EPX)
 395         val |= 0xb0000000;      /* generate system reset after 1.34 seconds */
 396 #else
 397         val |= 0xf0000000;      /* generate system reset after 2.684 seconds */
 398 #endif
 399 #if defined(CONFIG_SYS_4xx_RESET_TYPE)
 400         val &= ~0x30000000;                     /* clear WRC bits */
 401         val |= CONFIG_SYS_4xx_RESET_TYPE << 28; /* set board specific WRC type */
 402 #endif
 403         mtspr(SPRN_TCR, val);
 404
 405         val = mfspr(SPRN_TSR);
 406         val |= 0x80000000;      /* enable watchdog timer */
 407         mtspr(SPRN_TSR, val);
 408
 409         reset_4xx_watchdog();
 410 #endif /* CONFIG_WATCHDOG */
 411
 412 #if defined(CONFIG_440GX)
 413         /* Take the GX out of compatibility mode
 414          * Travis Sawyer, 9 Mar 2004
 415          * NOTE: 440gx user manual inconsistency here
 416          *       Compatibility mode and Ethernet Clock select are not
 417          *       correct in the manual
 418          */
 419         mfsdr(SDR0_MFR, val);
 420         val &= ~0x10000000;
 421         mtsdr(SDR0_MFR,val);
 422 #endif /* CONFIG_440GX */
 423
 424 #if defined(CONFIG_460EX)
 425         /*
 426          * Set SDR0_AHB_CFG[A2P_INCR4] (bit 24) and
 427          * clear SDR0_AHB_CFG[A2P_PROT2] (bit 25) for a new 460EX errata
 428          * regarding concurrent use of AHB USB OTG, USB 2.0 host and SATA
 429          */
 430         mfsdr(SDR0_AHB_CFG, val);
 431         val |= 0x80;
 432         val &= ~0x40;
 433         mtsdr(SDR0_AHB_CFG, val);
 434         mfsdr(SDR0_USB2HOST_CFG, val);
 435         val &= ~0xf00;
 436         val |= 0x400;
 437         mtsdr(SDR0_USB2HOST_CFG, val);
 438 #endif /* CONFIG_460EX */
 439
 440 #if defined(CONFIG_405EX) || \
 441     defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
 442     defined(CONFIG_460EX) || defined(CONFIG_460GT)  || \
 443     defined(CONFIG_460SX)
 444         /*
 445          * Set PLB4 arbiter (Segment 0 and 1) to 4 deep pipeline read
 446          */
 447         mtdcr(PLB4A0_ACR, (mfdcr(PLB4A0_ACR) & ~PLB4Ax_ACR_RDP_MASK) |
 448               PLB4Ax_ACR_RDP_4DEEP);
 449         mtdcr(PLB4A1_ACR, (mfdcr(PLB4A1_ACR) & ~PLB4Ax_ACR_RDP_MASK) |
 450               PLB4Ax_ACR_RDP_4DEEP);
 451 #endif /* CONFIG_440SP/SPE || CONFIG_460EX/GT || CONFIG_405EX */
 452
 453         gd = (gd_t *)(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
 454
 455         /* Clear initial global data */
 456         memset((void *)gd, 0, sizeof(gd_t));
 457 }
 458
 459 /*
 460  * initialize higher level parts of CPU like time base and timers
 461  */
 462 int cpu_init_r (void)
 463 {
 464 #if defined(CONFIG_405GP)
 465         uint pvr = get_pvr();
 466
 467         /*
 468          * Set edge conditioning circuitry on PPC405GPr
 469          * for compatibility to existing PPC405GP designs.
 470          */
 471         if ((pvr & 0xfffffff0) == (PVR_405GPR_RB & 0xfffffff0)) {
 472                 mtdcr(CPC0_ECR, 0x60606000);
 473         }
 474 #endif  /* defined(CONFIG_405GP) */
 475
 476         return 0;
 477 }
 478
 479 #if defined(CONFIG_PCI) && \
 480         (defined(CONFIG_440EP) || defined(CONFIG_440EPX) || \
 481          defined(CONFIG_440GR) || defined(CONFIG_440GRX))
 482 /*
 483  * 440EP(x)/GR(x) PCI async/sync clocking restriction:
 484  *
 485  * In asynchronous PCI mode, the synchronous PCI clock must meet
 486  * certain requirements. The following equation describes the
 487  * relationship that must be maintained between the asynchronous PCI
 488  * clock and synchronous PCI clock. Select an appropriate PCI:PLB
 489  * ratio to maintain the relationship:
 490  *
 491  * AsyncPCIClk - 1MHz <= SyncPCIclock <= (2 * AsyncPCIClk) - 1MHz
 492  */
 493 static int ppc4xx_pci_sync_clock_ok(u32 sync, u32 async)
 494 {
 495         if (((async - 1000000) > sync) || (sync > ((2 * async) - 1000000)))
 496                 return 0;
 497         else
 498                 return 1;
 499 }
 500
 501 int ppc4xx_pci_sync_clock_config(u32 async)
 502 {
 503         sys_info_t sys_info;
 504         u32 sync;
 505         int div;
 506         u32 reg;
 507         u32 spcid_val[] = {
 508                 CPR0_SPCID_SPCIDV0_DIV1, CPR0_SPCID_SPCIDV0_DIV2,
 509                 CPR0_SPCID_SPCIDV0_DIV3, CPR0_SPCID_SPCIDV0_DIV4 };
 510
 511         get_sys_info(&sys_info);
 512         sync = sys_info.freqPCI;
 513
 514         /*
 515          * First check if the equation above is met
 516          */
 517         if (!ppc4xx_pci_sync_clock_ok(sync, async)) {
 518                 /*
 519                  * Reconfigure PCI sync clock to meet the equation.
 520                  * Start with highest possible PCI sync frequency
 521                  * (divider 1).
 522                  */
 523                 for (div = 1; div <= 4; div++) {
 524                         sync = sys_info.freqPLB / div;
 525                         if (ppc4xx_pci_sync_clock_ok(sync, async))
 526                             break;
 527                 }
 528
 529                 if (div <= 4) {
 530                         mtcpr(CPR0_SPCID, spcid_val[div]);
 531
 532                         mfcpr(CPR0_ICFG, reg);
 533                         reg |= CPR0_ICFG_RLI_MASK;
 534                         mtcpr(CPR0_ICFG, reg);
 535
 536                         /* do chip reset */
 537                         mtspr(SPRN_DBCR0, 0x20000000);
 538                 } else {
 539                         /* Impossible to configure the PCI sync clock */
 540                         return -1;
 541                 }
 542         }
 543
 544         return 0;
 545 }
 546 #endif