]> git.ipfire.org Git - thirdparty/u-boot.git/commitdiff
Xilinx: ARM: Removed some unused code in board file
authorJagan <jaganna@xilinx.com>
Fri, 8 Jun 2012 14:55:28 +0000 (20:25 +0530)
committerJohn Linn <john.linn@xilinx.com>
Fri, 8 Jun 2012 19:51:20 +0000 (12:51 -0700)
Removed some unused code for initializing PLL, MIO and clocks
on board file which was possibly added during initial support
of u-boot for ZYNQ bringup.

Signed-off-by: Jagan <jaganna@xilinx.com>
board/xilinx/zynq_common/board.c

index 212f96cfae494e90649a6e99b0890ca826ca73ee..35d4bcc4cb918423e2a6386122020730ca491e00 100644 (file)
@@ -5,10 +5,8 @@
 #include <common.h>
 #include <asm/arch/mmc.h>
 #include <asm/arch/nand.h>
-#include <asm/arch/xparameters.h>
 #include <netdev.h>
 #include <zynqpl.h>
-#include "ps7_init_hw.h"
 
 #define PARPORT_CRTL_BASEADDR                   XPSS_CRTL_PARPORT_BASEADDR
 #define NOR_FLASH_BASEADDR                      XPSS_PARPORT0_BASEADDR
@@ -123,495 +121,12 @@ void init_nor_flash(void)
 #define Xil_Out32 Out32
 #define Xil_In32 In32
 
-#if 1
-/* PLL divisor */
-#define ARM_PLL_FDIV           48      /* 800 MHz CPU */ 
-#define DDR_PLL_FDIV           24
-#define        IO_PLL_FDIV             30
-
-#define ARM_PLL_RES            2
-#define ARM_PLL_CP             2
-#define ARM_PLL_LOCK_CNT       250
-
-#define DDR_PLL_RES            2
-#define DDR_PLL_CP             2
-#define DDR_PLL_LOCK_CNT       300
-
-#define IO_PLL_RES             2
-#define IO_PLL_CP              12
-#define IO_PLL_LOCK_CNT                325
-
-/* CPU */
-#define CPU_SRCSEL             CPU_ARM_PLL
-#define CPU_DIVISOR            2
-/* DDR */
-#define DDR_3XCLK_DIVISOR      2
-#define DDR_2XCLK_DIVISOR      6
-/* DCI */
-#define DCI_DIVISOR0           2
-#define DCI_DIVISOR1           40
-/* USB0 */
-#define USB0_SRCSEL            IO_PLL
-#define USB0_DIVISOR0          15
-#define USB0_DIVISOR1          1
-/* GEM0 RX */
-#define GEM0_RX_SRCSEL         GEM0_MIO_RX_CLK
-/* GEM0 */
-#define GEM0_SRCSEL            IO_PLL
-#define GEM0_DIVISOR0          40 // was 8 JHL
-#define GEM0_DIVISOR1          1
-/* SMC */
-#define SMC_SRCSEL             IO_PLL
-#define SMC_DIVISOR            40
-/* LQSPI */
-#define LQSPI_SRCSEL           IO_PLL
-#define LQSPI_DIVISOR          10
-/* SDIO */
-#define SDIO0_CD_SEL           0
-#define SDIO0_WP_SEL           15
-#define SDIO_SRCSEL            IO_PLL
-#define SDIO_DIVISOR           20
-/* UART */
-#define UART_SRCSEL            IO_PLL
-#define UART_DIVISOR           20
-/* SPI */
-#define SPI_SRCSEL             IO_PLL
-#define SPI_DIVISOR            20
-/* CAN */
-#define CAN_SRCSEL             IO_PLL
-#define CAN_DIVISOR0           42
-#define CAN_DIVISOR1           1
-/* FPGA0 */
-#define FPGA0_SRCSEL           IO_PLL
-#define FPGA0_DIVISOR0         40 // 15
-#define FPGA0_DIVISOR1         1
-/* FPGA1 */
-#define FPGA1_SRCSEL           IO_PLL
-#define FPGA1_DIVISOR0         15
-#define FPGA1_DIVISOR1         1
-/* FPGA2 */
-#define FPGA2_SRCSEL           IO_PLL
-#define FPGA2_DIVISOR0         15
-#define FPGA2_DIVISOR1         1
-/* FPGA3 */
-#define FPGA3_SRCSEL           IO_PLL
-#define FPGA3_DIVISOR0         15
-#define FPGA3_DIVISOR1         1
-/* PCAP */
-#define PCAP_SRCSEL            IO_PLL
-#define PCAP_DIVISOR           15
-#endif
-void memtest_mio_init(void)
-{
-       unsigned int RegVal=0;
-
-       /* SLCR unlock */
-       Xil_Out32(SLCR_UNLOCK, 0xDF0D);
-
-       /* LSPI */
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_LQSPI | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO1, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_LQSPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO2, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_LQSPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO3, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_LQSPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO4, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_LQSPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO5, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_LQSPI | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO6, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_LQSPI | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO8, RegVal);
-
-       /* GEM0 */
-       RegVal = (DISABLE_RCVR | LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO16, RegVal);
-
-       RegVal = (DISABLE_RCVR | LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO17, RegVal);
-
-       RegVal = (DISABLE_RCVR | LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO18, RegVal);
-
-       RegVal = (DISABLE_RCVR | LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO19, RegVal);
-
-       RegVal = (DISABLE_RCVR | LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO20, RegVal);
-
-       RegVal = (DISABLE_RCVR | LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO21, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO22, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO23, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO24, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO25, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO26, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_GEM | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO27, RegVal);
-
-       /* MDIO0 */
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_MDIO0 | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO52, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_MDIO0 | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO53, RegVal);
-
-       /* USB0 */
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_GPIO | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO7, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO28, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO29, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO30, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO31, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO32, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO33, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO34, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO35, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO36, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO37, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO38, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_USB | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO39, RegVal);
-
-       /* SPI1 */
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_SPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO10, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_SPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO11, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_SPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO12, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_SPI | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO13, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_SPI | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO14, RegVal);
-
-       /* SDIO0 */
-       RegVal =  (LVCMOS18 | SLOW_CMOS | MIO_GPIO | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO0, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_GPIO | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO15, RegVal);
-
-       RegVal = ((SDIO0_CD_SEL << SDIO0_CD_SEL_SHIFT) | SDIO0_WP_SEL);
-       Xil_Out32(SLCR_SDIO0_WP_CD, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_SDIO | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO40, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_SDIO | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO41, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_SDIO | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO42, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_SDIO | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO43, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_SDIO | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO44, RegVal);
-
-       RegVal = (LVCMOS18 | FAST_CMOS | MIO_SDIO | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO45, RegVal);
-
-       /* CAN0 */
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_GPIO | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO9, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_CAN | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO46, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_CAN | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO47, RegVal);
-
-       /* UART1 */
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_UART | TRI_ENABLE_OUT);
-       Xil_Out32(SLCR_MIO48, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_UART | TRI_ENABLE_IN);
-       Xil_Out32(SLCR_MIO49, RegVal);
-
-       /* I2C0 */
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_I2C | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO50, RegVal);
-
-       RegVal = (LVCMOS18 | SLOW_CMOS | MIO_I2C | TRI_ENABLE_IN_OUT);
-       Xil_Out32(SLCR_MIO51, RegVal);
-
-       Xil_Out32(SLCR_LOCK, 0x767B);
-
-}
-
-void memtest_arm_pll_init(void)
-{
-       unsigned int RegVal=0;
-
-       /* Upadte arm pll configuration */
-       Xil_Out32(SLCR_ARM_PLL_CFG, ((ARM_PLL_LOCK_CNT << PLL_LOCK_CNT_SHIFT) | (ARM_PLL_CP << PLL_CP_SHIFT) | ( ARM_PLL_RES << PLL_RES_SHIFT)));
-
-       /* Update slcr_pll_fbdiv value */
-       RegVal = Xil_In32(SLCR_ARM_PLL_CTRL);
-       RegVal &= ~(0x7F << PLL_FDIV_SHIFT);
-       RegVal |= (ARM_PLL_FDIV << PLL_FDIV_SHIFT);
-       Xil_Out32(SLCR_ARM_PLL_CTRL, RegVal);
-
-       /* Put PLL in bypass mode */
-       RegVal = Xil_In32(SLCR_ARM_PLL_CTRL);
-       RegVal |= PLL_BYPASS_FORCE;
-       Xil_Out32(SLCR_ARM_PLL_CTRL, RegVal);
-
-       /* Assert reset to PLL */
-       RegVal = Xil_In32(SLCR_ARM_PLL_CTRL);
-       RegVal |= PLL_RESET;
-       Xil_Out32(SLCR_ARM_PLL_CTRL, RegVal);
-
-       /* Deassert reset to PLL */
-       RegVal = Xil_In32(SLCR_ARM_PLL_CTRL);
-       RegVal &= ~PLL_RESET;
-       Xil_Out32(SLCR_ARM_PLL_CTRL, RegVal);
-
-       /* Check PLL is locked */
-       while(!(Xil_In32(SLCR_PLL_STATUS) & 0x1));
-
-       /* Remove PLL bypass mode */
-       RegVal = Xil_In32(SLCR_ARM_PLL_CTRL);
-       RegVal &= ~PLL_BYPASS_FORCE;
-       Xil_Out32(SLCR_ARM_PLL_CTRL, RegVal);
-
-}
-
-void memtest_ddr_pll_init(void)
-{
-       unsigned int RegVal=0;
-
-       /* Upadte ddr pll configuration */
-       Xil_Out32(SLCR_DDR_PLL_CFG, ((DDR_PLL_LOCK_CNT << PLL_LOCK_CNT_SHIFT) | (DDR_PLL_CP << PLL_CP_SHIFT) | (DDR_PLL_RES << PLL_RES_SHIFT)));
-
-       /* Update slcr_pll_fbdiv value */
-       RegVal = Xil_In32(SLCR_DDR_PLL_CTRL);
-       RegVal &= ~(0x7F << PLL_FDIV_SHIFT);
-       RegVal |= (DDR_PLL_FDIV << PLL_FDIV_SHIFT);
-       Xil_Out32(SLCR_DDR_PLL_CTRL, RegVal);
-
-       /* Put PLL in bypass mode */
-       RegVal = Xil_In32(SLCR_DDR_PLL_CTRL);
-       RegVal |= PLL_BYPASS_FORCE;
-       Xil_Out32(SLCR_DDR_PLL_CTRL, RegVal);
-
-       /* Assert reset to PLL */
-       RegVal = Xil_In32(SLCR_DDR_PLL_CTRL);
-       RegVal |= PLL_RESET;
-       Xil_Out32(SLCR_DDR_PLL_CTRL, RegVal);
-
-       /* Deassert reset to PLL */
-       RegVal = Xil_In32(SLCR_DDR_PLL_CTRL);
-       RegVal &= ~PLL_RESET;
-       Xil_Out32(SLCR_DDR_PLL_CTRL, RegVal);
-
-       /* Check PLL is locked */
-       while(!(Xil_In32(SLCR_PLL_STATUS) & 0x2));
-
-       /* Remove PLL bypass mode */
-       RegVal = Xil_In32(SLCR_DDR_PLL_CTRL);
-       RegVal &= ~PLL_BYPASS_FORCE;
-       Xil_Out32(SLCR_DDR_PLL_CTRL, RegVal);
-}
-
-
-void memtest_io_pll_init(void)
-{
-       unsigned int RegVal=0;
-
-       /* Upadte io pll configuration */
-       Xil_Out32(SLCR_IO_PLL_CFG, ((IO_PLL_LOCK_CNT << PLL_LOCK_CNT_SHIFT) | (IO_PLL_CP << PLL_CP_SHIFT) | (IO_PLL_RES << PLL_RES_SHIFT)));
-
-       /* Update slcr_pll_fbdiv value */
-       RegVal = Xil_In32(SLCR_IO_PLL_CTRL);
-       RegVal &= ~(0x7F << PLL_FDIV_SHIFT);
-       RegVal |= (IO_PLL_FDIV << PLL_FDIV_SHIFT);
-       Xil_Out32(SLCR_IO_PLL_CTRL, RegVal);
-
-       /* Put PLL in bypass mode */
-       RegVal = Xil_In32(SLCR_IO_PLL_CTRL);
-       RegVal |= PLL_BYPASS_FORCE;
-       Xil_Out32(SLCR_IO_PLL_CTRL, RegVal);
-
-       /* Assert reset to PLL */
-       RegVal = Xil_In32(SLCR_IO_PLL_CTRL);
-       RegVal |= PLL_RESET;
-       Xil_Out32(SLCR_IO_PLL_CTRL, RegVal);
-
-       /* Deassert reset to PLL */
-       RegVal = Xil_In32(SLCR_IO_PLL_CTRL);
-       RegVal &= ~PLL_RESET;
-       Xil_Out32(SLCR_IO_PLL_CTRL, RegVal);
-
-       /* Check PLL is locked */
-       while(!(Xil_In32(SLCR_PLL_STATUS) & 0x4));
-
-       /* Remove PLL bypass mode */
-       RegVal = Xil_In32(SLCR_IO_PLL_CTRL);
-       RegVal &= ~PLL_BYPASS_FORCE;
-       Xil_Out32(SLCR_IO_PLL_CTRL, RegVal);
-}
-
-
-void memtest_pll_init(void)
-{
-       /* SLCR unlock */
-       Xil_Out32(SLCR_UNLOCK, 0xDF0D);
-
-       /* ARM PLL initialization */
-       memtest_arm_pll_init();
-
-       /* DDR PLL initialization */
-//     memtest_ddr_pll_init();
-
-       /* IO PLL initialization */
-       memtest_io_pll_init();
-
-       /* SLCR lock */
-       Xil_Out32(SLCR_LOCK, 0x767B);
-
-}
-
-void memtest_clock_init(void)
-{
-
-       /* SLCR unlock */
-       Xil_Out32(SLCR_UNLOCK, 0xDF0D);
-
-#if 1
-       /* ARM */
-       Xil_Out32(SLCR_ARM_CLK_CTRL, (CPU_PERI_CLKACT_ENABLE | CPU_1XCLKACT_ENABLE | CPU_2XCLKACT_ENABLE | CPU_3OR2XCLKACT_ENABLE |
-                                                       CPU_6OR4XCLKACT_ENABLE | (CPU_DIVISOR << CPU_DIVISOR_SHIFT) | (CPU_SRCSEL << CPU_SRCSEL_SHIFT)));
-
-       /* DDR */
-       Xil_Out32(SLCR_DDR_CLK_CTRL, ((DDR_2XCLK_DIVISOR << DDR_2XCLK_DIVISOR_SHIFT) | (DDR_3XCLK_DIVISOR << DDR_3XCLK_DIVISOR_SHIFT) |
-                                               DDR_2XCLKACT_ENABLE | DDR_3XCLKACT_ENABLE));
-
-       /* QSPI */
-       Xil_Out32(SLCR_LQSPI_CLK_CTRL, ((LQSPI_DIVISOR << LQSPI_DIVISOR_SHIFT) | (LQSPI_SRCSEL << LQSPI_SRCSEL_SHIFT) | LQSPI_CLKACT_ENABLE));
-#endif
-       /* GEM0 */
-       Xil_Out32(SLCR_GEM0_RCLK_CTRL, ((GEM0_RX_SRCSEL << GEM0_RX_SRCSEL_SHIFT) | GEM0_RX_CLKACT_ENABLE));
-       Xil_Out32(SLCR_GEM0_CLK_CTRL, ((GEM0_DIVISOR1 << GEM0_DIVISOR1_SHIFT) | (GEM0_DIVISOR0 << GEM0_DIVISOR0_SHIFT) | (GEM0_SRCSEL << GEM0_SRCSEL_SHIFT) | GEM0_CLKACT_ENABLE));
-
-#if 1
-       /* USB0 */
-       /* USB Reference clock coming in externally hence no need to set */
-       Xil_Out32(SLCR_USB0_CLK_CTRL, ((USB0_DIVISOR1 << USB0_DIVISOR1_SHIFT) | (USB0_DIVISOR0 << USB0_DIVISOR0_SHIFT) | (USB0_SRCSEL << USB0_SRCSEL_SHIFT) | USB0_CLKACT_ENABLE));
-
-       /* SPI1 */
-       Xil_Out32(SLCR_SPI_CLK_CTRL, ((SPI_DIVISOR << SPI_DIVISOR_SHIFT) | (SPI_SRCSEL << SPI_SRCSEL_SHIFT) | SPI1_CLKACT_ENABLE));
-
-       /* SDIO0 */
-       Xil_Out32(SLCR_SDIO_CLK_CTRL, ((SDIO_DIVISOR << SDIO_DIVISOR_SHIFT)| (SDIO_SRCSEL << SDIO_SRCSEL_SHIFT) | SDIO0_CLKACT_ENABLE));
-
-       /* CAN0 */
-       Xil_Out32(SLCR_CAN_CLK_CTRL, ((CAN_DIVISOR1 << CAN_DIVISOR1_SHIFT) | (CAN_DIVISOR0 << CAN_DIVISOR0_SHIFT) | (CAN_SRCSEL << CAN_SRCSEL_SHIFT) | CAN0_CLKACT_ENABLE));
-
-       /* UART1 */ 
-       Xil_Out32(SLCR_UART_CLK_CTRL, ((UART_DIVISOR << UART_DIVISOR_SHIFT) | (UART_SRCSEL << UART_SRCSEL_SHIFT) | UART1_CLKACT_ENABLE));
-
-       /* FPGA0 */ 
-       Xil_Out32(SLCR_FPGA0_CLK_CTRL, ((FPGA0_DIVISOR1 << FPGA0_DIVISOR1_SHIFT) | (FPGA0_DIVISOR0 << FPGA0_DIVISOR0_SHIFT) | (FPGA0_SRCSEL << FPGA0_SRCSEL_SHIFT)));
-
-       /* FPGA1 */ 
-       Xil_Out32(SLCR_FPGA1_CLK_CTRL, ((FPGA1_DIVISOR1 << FPGA1_DIVISOR1_SHIFT) | (FPGA1_DIVISOR0 << FPGA1_DIVISOR0_SHIFT) | (FPGA1_SRCSEL << FPGA1_SRCSEL_SHIFT)));
-
-       /* FPGA2 */ 
-       Xil_Out32(SLCR_FPGA2_CLK_CTRL, ((FPGA2_DIVISOR1 << FPGA2_DIVISOR1_SHIFT) | (FPGA2_DIVISOR0 << FPGA2_DIVISOR0_SHIFT) | (FPGA2_SRCSEL << FPGA2_SRCSEL_SHIFT)));
-
-       /* FPGA3 */ 
-       Xil_Out32(SLCR_FPGA3_CLK_CTRL, ((FPGA3_DIVISOR1 << FPGA3_DIVISOR1_SHIFT) | (FPGA3_DIVISOR0 << FPGA3_DIVISOR0_SHIFT) | (FPGA3_SRCSEL << FPGA3_SRCSEL_SHIFT)));
-
-       /* PCAP */ 
-       Xil_Out32(SLCR_PCAP_CLK_CTRL, ((PCAP_DIVISOR << PCAP_DIVISOR_SHIFT) | (PCAP_SRCSEL << PCAP_SRCSEL_SHIFT) | PCAP_CLKACT_ENABLE));
-
-       /*IIC0*/
-       /*MDIO0*/
-       /*GPIO*/
-       /* Enable interface clock */
-       Xil_Out32(SLCR_APER_CLK_CTRL, (SLCR_DMA_CPU_2XCLKACT_ENABLE | SLCR_USB0_CPU_1XCLKACT_ENABLE | SLCR_GEM0_CPU_1XCLKACT_ENABLE |
-                                                 SLCR_SDI0_CPU_1XCLKACT_ENABLE | SLCR_SPI1_CPU_1XCLKACT_ENABLE | SLCR_CAN0_CPU_1XCLKACT_ENABLE |
-                                                 SLCR_I2C0_CPU_1XCLKACT_ENABLE | SLCR_UART1_CPU_1XCLKACT_ENABLE | SLCR_GPIO_CPU_1XCLKACT_ENABLE |
-                                                 SLCR_LQSPI_CPU_1XCLKACT_ENABLE | SLCR_SMC_CPU_1XCLKACT_ENABLE));
-
-       /* DCI */
-       Xil_Out32(SLCR_DCI_CLK_CTRL, ((DCI_DIVISOR1 << DCI_DIVISOR1_SHIFT) | (DCI_DIVISOR0 << DCI_DIVISOR0_SHIFT) | DCI_CLKACT_ENABLE));
-#endif
-       /* SLCR lock */
-       Xil_Out32(SLCR_LOCK, 0x767B);
-}
-
-void from_burst_main(void)
-{
-#ifdef CONFIG_ZYNQ_MIO_INIT
-       memtest_mio_init();
-#endif
-#ifdef CONFIG_ZYNQ_PLL_INIT
-       memtest_pll_init();
-#endif
-#ifdef CONFIG_ZYNQ_MIO_INIT
-       memtest_clock_init();
-#endif
-}
-
 #ifdef CONFIG_FPGA
 Xilinx_desc fpga = XILINX_XC7Z020_DESC(0);
 #endif
 
 int board_init(void)
 {
-       /* taken from burst, some DDR/MIO/Clock setup hacked in */
-
-       from_burst_main();
-
        /* temporary hack to clear pending irqs before Linux as it 
           will hang Linux */