Add qemu 2.4.0
[kvmfornfv.git] / qemu / roms / u-boot / board / freescale / mpc8569mds / mpc8569mds.c
diff --git a/qemu/roms/u-boot/board/freescale/mpc8569mds/mpc8569mds.c b/qemu/roms/u-boot/board/freescale/mpc8569mds/mpc8569mds.c
new file mode 100644 (file)
index 0000000..cb55e1c
--- /dev/null
@@ -0,0 +1,583 @@
+/*
+ * Copyright 2009-2010 Freescale Semiconductor.
+ *
+ * (C) Copyright 2002 Scott McNutt <smcnutt@artesyncp.com>
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+#include <hwconfig.h>
+#include <pci.h>
+#include <asm/processor.h>
+#include <asm/mmu.h>
+#include <asm/cache.h>
+#include <asm/immap_85xx.h>
+#include <asm/fsl_pci.h>
+#include <fsl_ddr_sdram.h>
+#include <asm/fsl_serdes.h>
+#include <asm/io.h>
+#include <spd_sdram.h>
+#include <i2c.h>
+#include <ioports.h>
+#include <libfdt.h>
+#include <fdt_support.h>
+#include <fsl_esdhc.h>
+#include <phy.h>
+
+#include "bcsr.h"
+#if defined(CONFIG_PQ_MDS_PIB)
+#include "../common/pq-mds-pib.h"
+#endif
+
+const qe_iop_conf_t qe_iop_conf_tab[] = {
+       /* QE_MUX_MDC */
+       {2,  31, 1, 0, 1}, /* QE_MUX_MDC               */
+
+       /* QE_MUX_MDIO */
+       {2,  30, 3, 0, 2}, /* QE_MUX_MDIO              */
+
+#if defined(CONFIG_SYS_UCC_RGMII_MODE)
+       /* UCC_1_RGMII */
+       {2, 11, 2, 0, 1}, /* CLK12 */
+       {0,  0, 1, 0, 3}, /* ENET1_TXD0_SER1_TXD0      */
+       {0,  1, 1, 0, 3}, /* ENET1_TXD1_SER1_TXD1      */
+       {0,  2, 1, 0, 1}, /* ENET1_TXD2_SER1_TXD2      */
+       {0,  3, 1, 0, 2}, /* ENET1_TXD3_SER1_TXD3      */
+       {0,  6, 2, 0, 3}, /* ENET1_RXD0_SER1_RXD0      */
+       {0,  7, 2, 0, 1}, /* ENET1_RXD1_SER1_RXD1      */
+       {0,  8, 2, 0, 2}, /* ENET1_RXD2_SER1_RXD2      */
+       {0,  9, 2, 0, 2}, /* ENET1_RXD3_SER1_RXD3      */
+       {0,  4, 1, 0, 2}, /* ENET1_TX_EN_SER1_RTS_B    */
+       {0, 12, 2, 0, 3}, /* ENET1_RX_DV_SER1_CTS_B    */
+       {2,  8, 2, 0, 1}, /* ENET1_GRXCLK              */
+       {2, 20, 1, 0, 2}, /* ENET1_GTXCLK              */
+
+       /* UCC_2_RGMII */
+       {2, 16, 2, 0, 3}, /* CLK17 */
+       {0, 14, 1, 0, 2}, /* ENET2_TXD0_SER2_TXD0      */
+       {0, 15, 1, 0, 2}, /* ENET2_TXD1_SER2_TXD1      */
+       {0, 16, 1, 0, 1}, /* ENET2_TXD2_SER2_TXD2      */
+       {0, 17, 1, 0, 1}, /* ENET2_TXD3_SER2_TXD3      */
+       {0, 20, 2, 0, 2}, /* ENET2_RXD0_SER2_RXD0      */
+       {0, 21, 2, 0, 1}, /* ENET2_RXD1_SER2_RXD1      */
+       {0, 22, 2, 0, 1}, /* ENET2_RXD2_SER2_RXD2      */
+       {0, 23, 2, 0, 1}, /* ENET2_RXD3_SER2_RXD3      */
+       {0, 18, 1, 0, 2}, /* ENET2_TX_EN_SER2_RTS_B    */
+       {0, 26, 2, 0, 3}, /* ENET2_RX_DV_SER2_CTS_B    */
+       {2,  3, 2, 0, 1}, /* ENET2_GRXCLK              */
+       {2,  2, 1, 0, 2}, /* ENET2_GTXCLK              */
+
+       /* UCC_3_RGMII */
+       {2, 11, 2, 0, 1}, /* CLK12 */
+       {0, 29, 1, 0, 2}, /* ENET3_TXD0_SER3_TXD0      */
+       {0, 30, 1, 0, 3}, /* ENET3_TXD1_SER3_TXD1      */
+       {0, 31, 1, 0, 2}, /* ENET3_TXD2_SER3_TXD2      */
+       {1,  0, 1, 0, 3}, /* ENET3_TXD3_SER3_TXD3      */
+       {1,  3, 2, 0, 3}, /* ENET3_RXD0_SER3_RXD0      */
+       {1,  4, 2, 0, 1}, /* ENET3_RXD1_SER3_RXD1      */
+       {1,  5, 2, 0, 2}, /* ENET3_RXD2_SER3_RXD2      */
+       {1,  6, 2, 0, 3}, /* ENET3_RXD3_SER3_RXD3      */
+       {1,  1, 1, 0, 1}, /* ENET3_TX_EN_SER3_RTS_B    */
+       {1,  9, 2, 0, 3}, /* ENET3_RX_DV_SER3_CTS_B    */
+       {2,  9, 2, 0, 2}, /* ENET3_GRXCLK              */
+       {2, 25, 1, 0, 2}, /* ENET3_GTXCLK              */
+
+       /* UCC_4_RGMII */
+       {2, 16, 2, 0, 3}, /* CLK17 */
+       {1, 12, 1, 0, 2}, /* ENET4_TXD0_SER4_TXD0      */
+       {1, 13, 1, 0, 2}, /* ENET4_TXD1_SER4_TXD1      */
+       {1, 14, 1, 0, 1}, /* ENET4_TXD2_SER4_TXD2      */
+       {1, 15, 1, 0, 2}, /* ENET4_TXD3_SER4_TXD3      */
+       {1, 18, 2, 0, 2}, /* ENET4_RXD0_SER4_RXD0      */
+       {1, 19, 2, 0, 1}, /* ENET4_RXD1_SER4_RXD1      */
+       {1, 20, 2, 0, 1}, /* ENET4_RXD2_SER4_RXD2      */
+       {1, 21, 2, 0, 2}, /* ENET4_RXD3_SER4_RXD3      */
+       {1, 16, 1, 0, 2}, /* ENET4_TX_EN_SER4_RTS_B    */
+       {1, 24, 2, 0, 3}, /* ENET4_RX_DV_SER4_CTS_B    */
+       {2, 17, 2, 0, 2}, /* ENET4_GRXCLK              */
+       {2, 24, 1, 0, 2}, /* ENET4_GTXCLK              */
+
+#elif defined(CONFIG_SYS_UCC_RMII_MODE)
+       /* UCC_1_RMII */
+       {2, 15, 2, 0, 1}, /* CLK16 */
+       {0,  0, 1, 0, 3}, /* ENET1_TXD0_SER1_TXD0      */
+       {0,  1, 1, 0, 3}, /* ENET1_TXD1_SER1_TXD1      */
+       {0,  6, 2, 0, 3}, /* ENET1_RXD0_SER1_RXD0      */
+       {0,  7, 2, 0, 1}, /* ENET1_RXD1_SER1_RXD1      */
+       {0,  4, 1, 0, 2}, /* ENET1_TX_EN_SER1_RTS_B    */
+       {0, 12, 2, 0, 3}, /* ENET1_RX_DV_SER1_CTS_B    */
+
+       /* UCC_2_RMII */
+       {2, 15, 2, 0, 1}, /* CLK16 */
+       {0, 14, 1, 0, 2}, /* ENET2_TXD0_SER2_TXD0      */
+       {0, 15, 1, 0, 2}, /* ENET2_TXD1_SER2_TXD1      */
+       {0, 20, 2, 0, 2}, /* ENET2_RXD0_SER2_RXD0      */
+       {0, 21, 2, 0, 1}, /* ENET2_RXD1_SER2_RXD1      */
+       {0, 18, 1, 0, 2}, /* ENET2_TX_EN_SER2_RTS_B    */
+       {0, 26, 2, 0, 3}, /* ENET2_RX_DV_SER2_CTS_B    */
+
+       /* UCC_3_RMII */
+       {2, 15, 2, 0, 1}, /* CLK16 */
+       {0, 29, 1, 0, 2}, /* ENET3_TXD0_SER3_TXD0      */
+       {0, 30, 1, 0, 3}, /* ENET3_TXD1_SER3_TXD1      */
+       {1,  3, 2, 0, 3}, /* ENET3_RXD0_SER3_RXD0      */
+       {1,  4, 2, 0, 1}, /* ENET3_RXD1_SER3_RXD1      */
+       {1,  1, 1, 0, 1}, /* ENET3_TX_EN_SER3_RTS_B    */
+       {1,  9, 2, 0, 3}, /* ENET3_RX_DV_SER3_CTS_B    */
+
+       /* UCC_4_RMII */
+       {2, 15, 2, 0, 1}, /* CLK16 */
+       {1, 12, 1, 0, 2}, /* ENET4_TXD0_SER4_TXD0      */
+       {1, 13, 1, 0, 2}, /* ENET4_TXD1_SER4_TXD1      */
+       {1, 18, 2, 0, 2}, /* ENET4_RXD0_SER4_RXD0      */
+       {1, 19, 2, 0, 1}, /* ENET4_RXD1_SER4_RXD1      */
+       {1, 16, 1, 0, 2}, /* ENET4_TX_EN_SER4_RTS_B    */
+       {1, 24, 2, 0, 3}, /* ENET4_RX_DV_SER4_CTS_B    */
+#endif
+
+       /* UART1 is muxed with QE PortF bit [9-12].*/
+       {5, 12, 2, 0, 3}, /* UART1_SIN */
+       {5, 9,  1, 0, 3}, /* UART1_SOUT */
+       {5, 10, 2, 0, 3}, /* UART1_CTS_B */
+       {5, 11, 1, 0, 2}, /* UART1_RTS_B */
+
+       /* QE UART                                     */
+       {0, 19, 1, 0, 2}, /* QEUART_TX                 */
+       {1, 17, 2, 0, 3}, /* QEUART_RX                 */
+       {0, 25, 1, 0, 1}, /* QEUART_RTS                */
+       {1, 23, 2, 0, 1}, /* QEUART_CTS                */
+
+       /* QE USB                                      */
+       {5,  3, 1, 0, 1}, /* USB_OE                    */
+       {5,  4, 1, 0, 2}, /* USB_TP                    */
+       {5,  5, 1, 0, 2}, /* USB_TN                    */
+       {5,  6, 2, 0, 2}, /* USB_RP                    */
+       {5,  7, 2, 0, 1}, /* USB_RX                    */
+       {5,  8, 2, 0, 1}, /* USB_RN                    */
+       {2,  4, 2, 0, 2}, /* CLK5                      */
+
+       /* SPI Flash, M25P40                           */
+       {4, 27, 3, 0, 1}, /* SPI_MOSI                  */
+       {4, 28, 3, 0, 1}, /* SPI_MISO                  */
+       {4, 29, 3, 0, 1}, /* SPI_CLK                   */
+       {4, 30, 1, 0, 0}, /* SPI_SEL, GPIO             */
+
+       {0,  0, 0, 0, QE_IOP_TAB_END} /* END of table */
+};
+
+void local_bus_init(void);
+
+int board_early_init_f (void)
+{
+       /*
+        * Initialize local bus.
+        */
+       local_bus_init ();
+
+       enable_8569mds_flash_write();
+
+#ifdef CONFIG_QE
+       enable_8569mds_qe_uec();
+#endif
+
+#if CONFIG_SYS_I2C2_OFFSET
+       /* Enable I2C2 signals instead of SD signals */
+       volatile struct ccsr_gur *gur;
+       gur = (struct ccsr_gur *)(CONFIG_SYS_IMMR + 0xe0000);
+       gur->plppar1 &= ~PLPPAR1_I2C_BIT_MASK;
+       gur->plppar1 |= PLPPAR1_I2C2_VAL;
+       gur->plpdir1 &= ~PLPDIR1_I2C_BIT_MASK;
+       gur->plpdir1 |= PLPDIR1_I2C2_VAL;
+
+       disable_8569mds_brd_eeprom_write_protect();
+#endif
+
+       return 0;
+}
+
+int board_early_init_r(void)
+{
+       const unsigned int flashbase = CONFIG_SYS_NAND_BASE;
+       const u8 flash_esel = 0;
+
+       /*
+        * Remap Boot flash to caching-inhibited
+        * so that flash can be erased properly.
+        */
+
+       /* Flush d-cache and invalidate i-cache of any FLASH data */
+       flush_dcache();
+       invalidate_icache();
+
+       /* invalidate existing TLB entry for flash */
+       disable_tlb(flash_esel);
+
+       set_tlb(1, flashbase, CONFIG_SYS_NAND_BASE,     /* tlb, epn, rpn */
+               MAS3_SX|MAS3_SW|MAS3_SR, MAS2_I|MAS2_G, /* perms, wimge */
+               0, flash_esel,                          /* ts, esel */
+               BOOKE_PAGESZ_64M, 1);                   /* tsize, iprot */
+
+       return 0;
+}
+
+int checkboard (void)
+{
+       printf ("Board: 8569 MDS\n");
+
+       return 0;
+}
+
+#if !defined(CONFIG_SPD_EEPROM)
+phys_size_t fixed_sdram(void)
+{
+       struct ccsr_ddr __iomem *ddr =
+               (struct ccsr_ddr __iomem *)CONFIG_SYS_FSL_DDR_ADDR;
+       uint d_init;
+
+       out_be32(&ddr->cs0_bnds, CONFIG_SYS_DDR_CS0_BNDS);
+       out_be32(&ddr->cs0_config, CONFIG_SYS_DDR_CS0_CONFIG);
+       out_be32(&ddr->timing_cfg_3, CONFIG_SYS_DDR_TIMING_3);
+       out_be32(&ddr->timing_cfg_0, CONFIG_SYS_DDR_TIMING_0);
+       out_be32(&ddr->timing_cfg_1, CONFIG_SYS_DDR_TIMING_1);
+       out_be32(&ddr->timing_cfg_2, CONFIG_SYS_DDR_TIMING_2);
+       out_be32(&ddr->sdram_cfg, CONFIG_SYS_DDR_SDRAM_CFG);
+       out_be32(&ddr->sdram_cfg_2, CONFIG_SYS_DDR_SDRAM_CFG_2);
+       out_be32(&ddr->sdram_mode, CONFIG_SYS_DDR_SDRAM_MODE);
+       out_be32(&ddr->sdram_mode_2, CONFIG_SYS_DDR_SDRAM_MODE_2);
+       out_be32(&ddr->sdram_interval, CONFIG_SYS_DDR_SDRAM_INTERVAL);
+       out_be32(&ddr->sdram_data_init, CONFIG_SYS_DDR_DATA_INIT);
+       out_be32(&ddr->sdram_clk_cntl, CONFIG_SYS_DDR_SDRAM_CLK_CNTL);
+       out_be32(&ddr->timing_cfg_4, CONFIG_SYS_DDR_TIMING_4);
+       out_be32(&ddr->timing_cfg_5, CONFIG_SYS_DDR_TIMING_5);
+       out_be32(&ddr->ddr_zq_cntl, CONFIG_SYS_DDR_ZQ_CNTL);
+       out_be32(&ddr->ddr_wrlvl_cntl, CONFIG_SYS_DDR_WRLVL_CNTL);
+       out_be32(&ddr->sdram_cfg_2, CONFIG_SYS_DDR_SDRAM_CFG_2);
+#if defined (CONFIG_DDR_ECC)
+       out_be32(&ddr->err_int_en, CONFIG_SYS_DDR_ERR_INT_EN);
+       out_be32(&ddr->err_disable, CONFIG_SYS_DDR_ERR_DIS);
+       out_be32(&ddr->err_sbe, CONFIG_SYS_DDR_SBE);
+#endif
+       udelay(500);
+
+       out_be32(&ddr->sdram_cfg, CONFIG_SYS_DDR_CONTROL);
+#if defined(CONFIG_ECC_INIT_VIA_DDRCONTROLLER)
+       d_init = 1;
+       debug("DDR - 1st controller: memory initializing\n");
+       /*
+        * Poll until memory is initialized.
+        * 512 Meg at 400 might hit this 200 times or so.
+        */
+       while ((ddr->sdram_cfg_2 & (d_init << 4)) != 0) {
+               udelay(1000);
+       }
+       debug("DDR: memory initialized\n\n");
+       udelay(500);
+#endif
+       return CONFIG_SYS_SDRAM_SIZE * 1024 * 1024;
+}
+#endif
+
+/*
+ * Initialize Local Bus
+ */
+void
+local_bus_init(void)
+{
+       volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
+       volatile fsl_lbc_t *lbc = LBC_BASE_ADDR;
+
+       uint clkdiv;
+       sys_info_t sysinfo;
+
+       get_sys_info(&sysinfo);
+       clkdiv = (lbc->lcrr & LCRR_CLKDIV) * 2;
+
+       out_be32(&gur->lbiuiplldcr1, 0x00078080);
+       if (clkdiv == 16)
+               out_be32(&gur->lbiuiplldcr0, 0x7c0f1bf0);
+       else if (clkdiv == 8)
+               out_be32(&gur->lbiuiplldcr0, 0x6c0f1bf0);
+       else if (clkdiv == 4)
+               out_be32(&gur->lbiuiplldcr0, 0x5c0f1bf0);
+
+       out_be32(&lbc->lcrr, (u32)in_be32(&lbc->lcrr)| 0x00030000);
+}
+
+static void fdt_board_disable_serial(void *blob, bd_t *bd, const char *alias)
+{
+       const char *status = "disabled";
+       int off;
+       int err;
+
+       off = fdt_path_offset(blob, alias);
+       if (off < 0) {
+               printf("WARNING: could not find %s alias: %s.\n", alias,
+                       fdt_strerror(off));
+               return;
+       }
+
+       err = fdt_setprop(blob, off, "status", status, strlen(status) + 1);
+       if (err) {
+               printf("WARNING: could not set status for serial0: %s.\n",
+                       fdt_strerror(err));
+               return;
+       }
+}
+
+/*
+ * Because of an erratum in prototype boards it is impossible to use eSDHC
+ * without disabling UART0 (which makes it quite easy to 'brick' the board
+ * by simply issung 'setenv hwconfig esdhc', and not able to interact with
+ * U-Boot anylonger).
+ *
+ * So, but default we assume that the board is a prototype, which is a most
+ * safe assumption. There is no way to determine board revision from a
+ * register, so we use hwconfig.
+ */
+
+static int prototype_board(void)
+{
+       if (hwconfig_subarg("board", "rev", NULL))
+               return hwconfig_subarg_cmp("board", "rev", "prototype");
+       return 1;
+}
+
+static int esdhc_disables_uart0(void)
+{
+       return prototype_board() ||
+              hwconfig_subarg_cmp("esdhc", "mode", "4-bits");
+}
+
+static void fdt_board_fixup_qe_uart(void *blob, bd_t *bd)
+{
+       u8 *bcsr = (u8 *)CONFIG_SYS_BCSR_BASE;
+       const char *devtype = "serial";
+       const char *compat = "ucc_uart";
+       const char *clk = "brg9";
+       u32 portnum = 0;
+       int off = -1;
+
+       if (!hwconfig("qe_uart"))
+               return;
+
+       if (hwconfig("esdhc") && esdhc_disables_uart0()) {
+               printf("QE UART: won't enable with esdhc.\n");
+               return;
+       }
+
+       fdt_board_disable_serial(blob, bd, "serial1");
+
+       while (1) {
+               const u32 *idx;
+               int len;
+
+               off = fdt_node_offset_by_compatible(blob, off, "ucc_geth");
+               if (off < 0) {
+                       printf("WARNING: unable to fixup device tree for "
+                               "QE UART\n");
+                       return;
+               }
+
+               idx = fdt_getprop(blob, off, "cell-index", &len);
+               if (!idx || len != sizeof(*idx) || *idx != fdt32_to_cpu(2))
+                       continue;
+               break;
+       }
+
+       fdt_setprop(blob, off, "device_type", devtype, strlen(devtype) + 1);
+       fdt_setprop(blob, off, "compatible", compat, strlen(compat) + 1);
+       fdt_setprop(blob, off, "tx-clock-name", clk, strlen(clk) + 1);
+       fdt_setprop(blob, off, "rx-clock-name", clk, strlen(clk) + 1);
+       fdt_setprop(blob, off, "port-number", &portnum, sizeof(portnum));
+
+       setbits_8(&bcsr[15], BCSR15_QEUART_EN);
+}
+
+#ifdef CONFIG_FSL_ESDHC
+
+int board_mmc_init(bd_t *bd)
+{
+       struct ccsr_gur *gur = (struct ccsr_gur *)CONFIG_SYS_MPC85xx_GUTS_ADDR;
+       u8 *bcsr = (u8 *)CONFIG_SYS_BCSR_BASE;
+       u8 bcsr6 = BCSR6_SD_CARD_1BIT;
+
+       if (!hwconfig("esdhc"))
+               return 0;
+
+       printf("Enabling eSDHC...\n"
+              "  For eSDHC to function, I2C2 ");
+       if (esdhc_disables_uart0()) {
+               printf("and UART0 should be disabled.\n");
+               printf("  Redirecting stderr, stdout and stdin to UART1...\n");
+               console_assign(stderr, "eserial1");
+               console_assign(stdout, "eserial1");
+               console_assign(stdin, "eserial1");
+               printf("Switched to UART1 (initial log has been printed to "
+                      "UART0).\n");
+
+               clrsetbits_be32(&gur->plppar1, PLPPAR1_UART0_BIT_MASK,
+                                              PLPPAR1_ESDHC_4BITS_VAL);
+               clrsetbits_be32(&gur->plpdir1, PLPDIR1_UART0_BIT_MASK,
+                                              PLPDIR1_ESDHC_4BITS_VAL);
+               bcsr6 |= BCSR6_SD_CARD_4BITS;
+       } else {
+               printf("should be disabled.\n");
+       }
+
+       /* Assign I2C2 signals to eSDHC. */
+       clrsetbits_be32(&gur->plppar1, PLPPAR1_I2C_BIT_MASK,
+                                      PLPPAR1_ESDHC_VAL);
+       clrsetbits_be32(&gur->plpdir1, PLPDIR1_I2C_BIT_MASK,
+                                      PLPDIR1_ESDHC_VAL);
+
+       /* Mux I2C2 (and optionally UART0) signals to eSDHC. */
+       setbits_8(&bcsr[6], bcsr6);
+
+       return fsl_esdhc_mmc_init(bd);
+}
+
+static void fdt_board_fixup_esdhc(void *blob, bd_t *bd)
+{
+       const char *status = "disabled";
+       int off = -1;
+
+       if (!hwconfig("esdhc"))
+               return;
+
+       if (esdhc_disables_uart0())
+               fdt_board_disable_serial(blob, bd, "serial0");
+
+       while (1) {
+               const u32 *idx;
+               int len;
+
+               off = fdt_node_offset_by_compatible(blob, off, "fsl-i2c");
+               if (off < 0)
+                       break;
+
+               idx = fdt_getprop(blob, off, "cell-index", &len);
+               if (!idx || len != sizeof(*idx))
+                       continue;
+
+               if (*idx == 1) {
+                       fdt_setprop(blob, off, "status", status,
+                                   strlen(status) + 1);
+                       break;
+               }
+       }
+
+       if (hwconfig_subarg_cmp("esdhc", "mode", "4-bits")) {
+               off = fdt_node_offset_by_compatible(blob, -1, "fsl,esdhc");
+               if (off < 0) {
+                       printf("WARNING: could not find esdhc node\n");
+                       return;
+               }
+               fdt_delprop(blob, off, "sdhci,1-bit-only");
+       }
+}
+#else
+static inline void fdt_board_fixup_esdhc(void *blob, bd_t *bd) {}
+#endif
+
+static void fdt_board_fixup_qe_usb(void *blob, bd_t *bd)
+{
+       u8 *bcsr = (u8 *)CONFIG_SYS_BCSR_BASE;
+
+       if (hwconfig_subarg_cmp("qe_usb", "speed", "low"))
+               clrbits_8(&bcsr[17], BCSR17_nUSBLOWSPD);
+       else
+               setbits_8(&bcsr[17], BCSR17_nUSBLOWSPD);
+
+       if (hwconfig_subarg_cmp("qe_usb", "mode", "peripheral")) {
+               clrbits_8(&bcsr[17], BCSR17_USBVCC);
+               clrbits_8(&bcsr[17], BCSR17_USBMODE);
+               do_fixup_by_compat(blob, "fsl,mpc8569-qe-usb", "mode",
+                                  "peripheral", sizeof("peripheral"), 1);
+       } else {
+               setbits_8(&bcsr[17], BCSR17_USBVCC);
+               setbits_8(&bcsr[17], BCSR17_USBMODE);
+       }
+
+       clrbits_8(&bcsr[17], BCSR17_nUSBEN);
+}
+
+#ifdef CONFIG_PCI
+void pci_init_board(void)
+{
+#if defined(CONFIG_PQ_MDS_PIB)
+       pib_init();
+#endif
+
+       fsl_pcie_init_board(0);
+}
+#endif /* CONFIG_PCI */
+
+#if defined(CONFIG_OF_BOARD_SETUP)
+void ft_board_setup(void *blob, bd_t *bd)
+{
+#if defined(CONFIG_SYS_UCC_RMII_MODE)
+       int nodeoff, off, err;
+       unsigned int val;
+       const u32 *ph;
+       const u32 *index;
+
+       /* fixup device tree for supporting rmii mode */
+       nodeoff = -1;
+       while ((nodeoff = fdt_node_offset_by_compatible(blob, nodeoff,
+                               "ucc_geth")) >= 0) {
+               err = fdt_setprop_string(blob, nodeoff, "tx-clock-name",
+                                               "clk16");
+               if (err < 0) {
+                       printf("WARNING: could not set tx-clock-name %s.\n",
+                               fdt_strerror(err));
+                       break;
+               }
+
+               err = fdt_fixup_phy_connection(blob, nodeoff,
+                               PHY_INTERFACE_MODE_RMII);
+
+               if (err < 0) {
+                       printf("WARNING: could not set phy-connection-type "
+                               "%s.\n", fdt_strerror(err));
+                       break;
+               }
+
+               index = fdt_getprop(blob, nodeoff, "cell-index", 0);
+               if (index == NULL) {
+                       printf("WARNING: could not get cell-index of ucc\n");
+                       break;
+               }
+
+               ph = fdt_getprop(blob, nodeoff, "phy-handle", 0);
+               if (ph == NULL) {
+                       printf("WARNING: could not get phy-handle of ucc\n");
+                       break;
+               }
+
+               off = fdt_node_offset_by_phandle(blob, *ph);
+               if (off < 0) {
+                       printf("WARNING: could not get phy node %s.\n",
+                               fdt_strerror(err));
+                       break;
+               }
+
+               val = 0x7 + *index; /* RMII phy address starts from 0x8 */
+
+               err = fdt_setprop(blob, off, "reg", &val, sizeof(u32));
+               if (err < 0) {
+                       printf("WARNING: could not set reg for phy-handle "
+                               "%s.\n", fdt_strerror(err));
+                       break;
+               }
+       }
+#endif
+       ft_cpu_setup(blob, bd);
+
+       FT_FSL_PCI_SETUP;
+
+       fdt_board_fixup_esdhc(blob, bd);
+       fdt_board_fixup_qe_uart(blob, bd);
+       fdt_board_fixup_qe_usb(blob, bd);
+}
+#endif