board/keymile/km83xx/km83xx.c - github/trini/u-boot - Gitiles

 /*
  * Copyright (C) 2006 Freescale Semiconductor, Inc.
  *                    Dave Liu <daveliu@freescale.com>
  *
  * Copyright (C) 2007 Logic Product Development, Inc.
  *                    Peter Barada <peterb@logicpd.com>
  *
  * Copyright (C) 2007 MontaVista Software, Inc.
  *                    Anton Vorontsov <avorontsov@ru.mvista.com>
  *
  * (C) Copyright 2008 - 2010
  * Heiko Schocher, DENX Software Engineering, hs@denx.de.
  *
  * This program is free software; you can redistribute it and/or
  * modify it under the terms of the GNU General Public License as
  * published by the Free Software Foundation; either version 2 of
  * the License, or (at your option) any later version.
  */

 #include <common.h>
 #include <ioports.h>
 #include <mpc83xx.h>
 #include <i2c.h>
 #include <miiphy.h>
 #include <asm/io.h>
 #include <asm/mmu.h>
 #include <asm/processor.h>
 #include <pci.h>
 #include <libfdt.h>
 #include <post.h>

 #include "../common/common.h"

 const qe_iop_conf_t qe_iop_conf_tab[] = {
 	/* port pin dir open_drain assign */
 #if defined(CONFIG_MPC8360)
 	/* MDIO */
 	{0,  1, 3, 0, 2}, /* MDIO */
 	{0,  2, 1, 0, 1}, /* MDC */

 	/* UCC4 - UEC */
 	{1, 14, 1, 0, 1}, /* TxD0 */
 	{1, 15, 1, 0, 1}, /* TxD1 */
 	{1, 20, 2, 0, 1}, /* RxD0 */
 	{1, 21, 2, 0, 1}, /* RxD1 */
 	{1, 18, 1, 0, 1}, /* TX_EN */
 	{1, 26, 2, 0, 1}, /* RX_DV */
 	{1, 27, 2, 0, 1}, /* RX_ER */
 	{1, 24, 2, 0, 1}, /* COL */
 	{1, 25, 2, 0, 1}, /* CRS */
 	{2, 15, 2, 0, 1}, /* TX_CLK - CLK16 */
 	{2, 16, 2, 0, 1}, /* RX_CLK - CLK17 */

 	/* DUART - UART2 */
 	{5,  0, 1, 0, 2}, /* UART2_SOUT */
 	{5,  2, 1, 0, 1}, /* UART2_RTS */
 	{5,  3, 2, 0, 2}, /* UART2_SIN */
 	{5,  1, 2, 0, 3}, /* UART2_CTS */
 #elif !defined(CONFIG_MPC8309)
 	/* Local Bus */
 	{0, 16, 1, 0, 3}, /* LA00 */
 	{0, 17, 1, 0, 3}, /* LA01 */
 	{0, 18, 1, 0, 3}, /* LA02 */
 	{0, 19, 1, 0, 3}, /* LA03 */
 	{0, 20, 1, 0, 3}, /* LA04 */
 	{0, 21, 1, 0, 3}, /* LA05 */
 	{0, 22, 1, 0, 3}, /* LA06 */
 	{0, 23, 1, 0, 3}, /* LA07 */
 	{0, 24, 1, 0, 3}, /* LA08 */
 	{0, 25, 1, 0, 3}, /* LA09 */
 	{0, 26, 1, 0, 3}, /* LA10 */
 	{0, 27, 1, 0, 3}, /* LA11 */
 	{0, 28, 1, 0, 3}, /* LA12 */
 	{0, 29, 1, 0, 3}, /* LA13 */
 	{0, 30, 1, 0, 3}, /* LA14 */
 	{0, 31, 1, 0, 3}, /* LA15 */

 	/* MDIO */
 	{3,  4, 3, 0, 2}, /* MDIO */
 	{3,  5, 1, 0, 2}, /* MDC */

 	/* UCC4 - UEC */
 	{1, 18, 1, 0, 1}, /* TxD0 */
 	{1, 19, 1, 0, 1}, /* TxD1 */
 	{1, 22, 2, 0, 1}, /* RxD0 */
 	{1, 23, 2, 0, 1}, /* RxD1 */
 	{1, 26, 2, 0, 1}, /* RxER */
 	{1, 28, 2, 0, 1}, /* Rx_DV */
 	{1, 30, 1, 0, 1}, /* TxEN */
 	{1, 31, 2, 0, 1}, /* CRS */
 	{3, 10, 2, 0, 3}, /* TxCLK->CLK17 */
 #endif

 	/* END of table */
 	{0,  0, 0, 0, QE_IOP_TAB_END},
 };

 static int board_init_i2c_busses(void)
 {
 	I2C_MUX_DEVICE *dev = NULL;
 	uchar *dtt_bus = (uchar *)"pca9547:70:a";

 	/* Set up the Bus for the DTTs */
 	dev = i2c_mux_ident_muxstring(dtt_bus);
 	if (dev == NULL)
 		printf("Error couldn't add Bus for DTT\n");

 	return 0;
 }

 #if defined(CONFIG_SUVD3)
 const uint upma_table[] = {
 	0x1ffedc00, 0x0ffcdc80, 0x0ffcdc80, 0x0ffcdc04, /* Words 0 to 3 */
 	0x0ffcdc00, 0xffffcc00, 0xffffcc01, 0xfffffc01, /* Words 4 to 7 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 8 to 11 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 12 to 15 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 16 to 19 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 20 to 23 */
 	0x9cfffc00, 0x00fffc80, 0x00fffc80, 0x00fffc00, /* Words 24 to 27 */
 	0xffffec04, 0xffffec01, 0xfffffc01, 0xfffffc01, /* Words 28 to 31 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 32 to 35 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 36 to 39 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 40 to 43 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 44 to 47 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 48 to 51 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 52 to 55 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 56 to 59 */
 	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01  /* Words 60 to 63 */
 };
 #endif

 static int piggy_present(void)
 {
 	struct km_bec_fpga __iomem *base =
 		(struct km_bec_fpga __iomem *)CONFIG_SYS_KMBEC_FPGA_BASE;

 	return in_8(&base->bprth) & PIGGY_PRESENT;
 }

 #if defined(CONFIG_KMVECT1)
 int ethernet_present(void)
 {
 	/* ethernet port connected to simple switch without piggy */
 	return 1;
 }
 #else
 int ethernet_present(void)
 {
 	return piggy_present();
 }
 #endif


 int board_early_init_r(void)
 {
 	struct km_bec_fpga *base =
 		(struct km_bec_fpga *)CONFIG_SYS_KMBEC_FPGA_BASE;
 #if defined(CONFIG_SUVD3)
 	immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
 	fsl_lbc_t *lbc = &immap->im_lbc;
 	u32 *mxmr = &lbc->mamr;
 #endif

 #if defined(CONFIG_MPC8360)
 	unsigned short	svid;
 	/*
 	 * Because of errata in the UCCs, we have to write to the reserved
 	 * registers to slow the clocks down.
 	 */
 	svid =  SVR_REV(mfspr(SVR));
 	switch (svid) {
 	case 0x0020:
 		/*
 		 * MPC8360ECE.pdf QE_ENET10 table 4:
 		 * IMMR + 0x14A8[4:5] = 11 (clk delay for UCC 2)
 		 * IMMR + 0x14A8[18:19] = 11 (clk delay for UCC 1)
 		 */
 		setbits_be32((void *)(CONFIG_SYS_IMMR + 0x14a8), 0x0c003000);
 		break;
 	case 0x0021:
 		/*
 		 * MPC8360ECE.pdf QE_ENET10 table 4:
 		 * IMMR + 0x14AC[24:27] = 1010
 		 */
 		clrsetbits_be32((void *)(CONFIG_SYS_IMMR + 0x14ac),
 			0x00000050, 0x000000a0);
 		break;
 	}
 #endif

 	/* enable the PHY on the PIGGY */
 	setbits_8(&base->pgy_eth, 0x01);
 	/* enable the Unit LED (green) */
 	setbits_8(&base->oprth, WRL_BOOT);
 	/* enable Application Buffer */
 	setbits_8(&base->oprtl, OPRTL_XBUFENA);

 #if defined(CONFIG_SUVD3)
 	/* configure UPMA for APP1 */
 	upmconfig(UPMA, (uint *) upma_table,
 		sizeof(upma_table) / sizeof(uint));
 	out_be32(mxmr, CONFIG_SYS_MAMR);
 #endif
 	return 0;
 }

 int misc_init_r(void)
 {
 	/* add board specific i2c busses */
 	board_init_i2c_busses();
 	return 0;
 }

 #if defined(CONFIG_KMVECT1)
 #include <mv88e6352.h>
 /* Marvell MV88E6122 switch configuration */
 static struct mv88e_sw_reg extsw_conf[] = {
 	/* port 1, FRONT_MDI, autoneg */
 	{ PORT(1), PORT_PHY, NO_SPEED_FOR },
 	{ PORT(1), PORT_CTRL, FORWARDING | EGRS_FLD_ALL },
 	{ PHY(1), PHY_1000_CTRL, NO_ADV },
 	{ PHY(1), PHY_SPEC_CTRL, AUTO_MDIX_EN },
 	{ PHY(1), PHY_CTRL, PHY_100_MBPS | AUTONEG_EN | AUTONEG_RST |
 		FULL_DUPLEX },
 	/* port 2, unused */
 	{ PORT(2), PORT_CTRL, PORT_DIS },
 	{ PHY(2), PHY_CTRL, PHY_PWR_DOWN },
 	{ PHY(2), PHY_SPEC_CTRL, SPEC_PWR_DOWN },
 	/* port 3, BP_MII (CPU), PHY mode, 100BASE */
 	{ PORT(3), PORT_CTRL, FORWARDING | EGRS_FLD_ALL },
 	/* port 4, ESTAR to slot 11, SerDes, 1000BASE-X */
 	{ PORT(4), PORT_STATUS, NO_PHY_DETECT },
 	{ PORT(4), PORT_PHY, SPEED_1000_FOR },
 	{ PORT(4), PORT_CTRL, FORWARDING | EGRS_FLD_ALL },
 	/* port 5, ESTAR to slot 13, SerDes, 1000BASE-X */
 	{ PORT(5), PORT_STATUS, NO_PHY_DETECT },
 	{ PORT(5), PORT_PHY, SPEED_1000_FOR },
 	{ PORT(5), PORT_CTRL, FORWARDING | EGRS_FLD_ALL },
 	/*
 	 * Errata Fix: 1.9V Output from Internal 1.8V Regulator,
 	 * acc . MV-S300889-00D.pdf , clause 4.5
 	 */
 	{ PORT(5), 0x1A, 0xADB1 },
 	/* port 6, unused, this port has no phy */
 	{ PORT(6), PORT_CTRL, PORT_DIS },
 };
 #endif

 int last_stage_init(void)
 {
 #if defined(CONFIG_KMVECT1)
 	struct km_bec_fpga __iomem *base =
 		(struct km_bec_fpga __iomem *)CONFIG_SYS_KMBEC_FPGA_BASE;
 	u8 tmp_reg;

 	/* Release mv88e6122 from reset */
 	tmp_reg = in_8(&base->res1[0]) | 0x10; /* DIRECT3 register */
 	out_8(&base->res1[0], tmp_reg);	       /* GP28 as output */
 	tmp_reg = in_8(&base->gprt3) | 0x10;   /* GP28 to high */
 	out_8(&base->gprt3, tmp_reg);

 	/* configure MV88E6122 switch */
 	char *name = "UEC2";

 	if (miiphy_set_current_dev(name))
 		return 0;

 	mv88e_sw_program(name, CONFIG_KM_MVEXTSW_ADDR, extsw_conf,
 		ARRAY_SIZE(extsw_conf));

 	mv88e_sw_reset(name, CONFIG_KM_MVEXTSW_ADDR);

 	if (piggy_present()) {
 		setenv("ethact", "UEC2");
 		setenv("netdev", "eth1");
 		puts("using PIGGY for network boot\n");
 	} else {
 		setenv("netdev", "eth0");
 		puts("using frontport for network boot\n");
 	}
 #endif

 #if defined(CONFIG_KMCOGE5NE)
 	struct bfticu_iomap *base =
 		(struct bfticu_iomap *)CONFIG_SYS_BFTIC3_BASE;
 	u8 dip_switch = in_8((u8 *)&(base->mswitch)) & BFTICU_DIPSWITCH_MASK;

 	if (dip_switch != 0) {
 		/* start bootloader */
 		puts("DIP:   Enabled\n");
 		setenv("actual_bank", "0");
 	}
 #endif
 	set_km_env();
 	return 0;
 }

 int fixed_sdram(void)
 {
 	immap_t *im = (immap_t *)CONFIG_SYS_IMMR;
 	u32 msize = 0;
 	u32 ddr_size;
 	u32 ddr_size_log2;

 	out_be32(&im->sysconf.ddrlaw[0].ar, (LAWAR_EN | 0x1e));
 	out_be32(&im->ddr.csbnds[0].csbnds, (CONFIG_SYS_DDR_CS0_BNDS) | 0x7f);
 	out_be32(&im->ddr.cs_config[0], CONFIG_SYS_DDR_CS0_CONFIG);
 	out_be32(&im->ddr.timing_cfg_0, CONFIG_SYS_DDR_TIMING_0);
 	out_be32(&im->ddr.timing_cfg_1, CONFIG_SYS_DDR_TIMING_1);
 	out_be32(&im->ddr.timing_cfg_2, CONFIG_SYS_DDR_TIMING_2);
 	out_be32(&im->ddr.timing_cfg_3, CONFIG_SYS_DDR_TIMING_3);
 	out_be32(&im->ddr.sdram_cfg, CONFIG_SYS_DDR_SDRAM_CFG);
 	out_be32(&im->ddr.sdram_cfg2, CONFIG_SYS_DDR_SDRAM_CFG2);
 	out_be32(&im->ddr.sdram_mode, CONFIG_SYS_DDR_MODE);
 	out_be32(&im->ddr.sdram_mode2, CONFIG_SYS_DDR_MODE2);
 	out_be32(&im->ddr.sdram_interval, CONFIG_SYS_DDR_INTERVAL);
 	out_be32(&im->ddr.sdram_clk_cntl, CONFIG_SYS_DDR_CLK_CNTL);
 	udelay(200);
 	setbits_be32(&im->ddr.sdram_cfg, SDRAM_CFG_MEM_EN);

 	msize = CONFIG_SYS_DDR_SIZE << 20;
 	disable_addr_trans();
 	msize = get_ram_size(CONFIG_SYS_DDR_BASE, msize);
 	enable_addr_trans();
 	msize /= (1024 * 1024);
 	if (CONFIG_SYS_DDR_SIZE != msize) {
 		for (ddr_size = msize << 20, ddr_size_log2 = 0;
 			(ddr_size > 1);
 			ddr_size = ddr_size >> 1, ddr_size_log2++)
 			if (ddr_size & 1)
 				return -1;
 		out_be32(&im->sysconf.ddrlaw[0].ar,
 			(LAWAR_EN | ((ddr_size_log2 - 1) & LAWAR_SIZE)));
 		out_be32(&im->ddr.csbnds[0].csbnds,
 			(((msize / 16) - 1) & 0xff));
 	}

 	return msize;
 }

 phys_size_t initdram(int board_type)
 {
 	immap_t *im = (immap_t *)CONFIG_SYS_IMMR;
 	u32 msize = 0;

 	if ((in_be32(&im->sysconf.immrbar) & IMMRBAR_BASE_ADDR) != (u32)im)
 		return -1;

 	out_be32(&im->sysconf.ddrlaw[0].bar,
 		CONFIG_SYS_DDR_BASE & LAWBAR_BAR);
 	msize = fixed_sdram();

 #if defined(CONFIG_DDR_ECC) && !defined(CONFIG_ECC_INIT_VIA_DDRCONTROLLER)
 	/*
 	 * Initialize DDR ECC byte
 	 */
 	ddr_enable_ecc(msize * 1024 * 1024);
 #endif

 	/* return total bus SDRAM size(bytes)  -- DDR */
 	return msize * 1024 * 1024;
 }

 int checkboard(void)
 {
 	puts("Board: Keymile " CONFIG_KM_BOARD_NAME);

 	if (piggy_present())
 		puts(" with PIGGY.");
 	puts("\n");
 	return 0;
 }

 #if defined(CONFIG_OF_BOARD_SETUP)
 void ft_board_setup(void *blob, bd_t *bd)
 {
 	ft_cpu_setup(blob, bd);
 }
 #endif

 #if defined(CONFIG_HUSH_INIT_VAR)
 int hush_init_var(void)
 {
 	ivm_read_eeprom();
 	return 0;
 }
 #endif

 #if defined(CONFIG_POST)
 int post_hotkeys_pressed(void)
 {
 	int testpin = 0;
 	struct km_bec_fpga *base =
 		(struct km_bec_fpga *)CONFIG_SYS_KMBEC_FPGA_BASE;
 	int testpin_reg = in_8(&base->CONFIG_TESTPIN_REG);
 	testpin = (testpin_reg & CONFIG_TESTPIN_MASK) != 0;
 	debug("post_hotkeys_pressed: %d\n", !testpin);
 	return testpin;
 }

 ulong post_word_load(void)
 {
 	void* addr = (ulong *) (CPM_POST_WORD_ADDR);
 	debug("post_word_load 0x%08lX:  0x%08X\n", (ulong)addr, in_le32(addr));
 	return in_le32(addr);

 }
 void post_word_store(ulong value)
 {
 	void* addr = (ulong *) (CPM_POST_WORD_ADDR);
 	debug("post_word_store 0x%08lX: 0x%08lX\n", (ulong)addr, value);
 	out_le32(addr, value);
 }

 int arch_memory_test_prepare(u32 *vstart, u32 *size, phys_addr_t *phys_offset)
 {
 	*vstart = CONFIG_SYS_MEMTEST_START;
 	*size = CONFIG_SYS_MEMTEST_END - CONFIG_SYS_MEMTEST_START;
 	debug("arch_memory_test_prepare 0x%08X 0x%08X\n", *vstart, *size);

 	return 0;
 }
 #endif
	/*
	* Copyright (C) 2006 Freescale Semiconductor, Inc.
	* Dave Liu <daveliu@freescale.com>
	*
	* Copyright (C) 2007 Logic Product Development, Inc.
	* Peter Barada <peterb@logicpd.com>
	*
	* Copyright (C) 2007 MontaVista Software, Inc.
	* Anton Vorontsov <avorontsov@ru.mvista.com>
	*
	* (C) Copyright 2008 - 2010
	* Heiko Schocher, DENX Software Engineering, hs@denx.de.
	*
	* This program is free software; you can redistribute it and/or
	* modify it under the terms of the GNU General Public License as
	* published by the Free Software Foundation; either version 2 of
	* the License, or (at your option) any later version.
	*/

	#include <common.h>
	#include <ioports.h>
	#include <mpc83xx.h>
	#include <i2c.h>
	#include <miiphy.h>
	#include <asm/io.h>
	#include <asm/mmu.h>
	#include <asm/processor.h>
	#include <pci.h>
	#include <libfdt.h>
	#include <post.h>

	#include "../common/common.h"

	const qe_iop_conf_t qe_iop_conf_tab[] = {
	/* port pin dir open_drain assign */
	#if defined(CONFIG_MPC8360)
	/* MDIO */
	{0, 1, 3, 0, 2}, /* MDIO */
	{0, 2, 1, 0, 1}, /* MDC */

	/* UCC4 - UEC */
	{1, 14, 1, 0, 1}, /* TxD0 */
	{1, 15, 1, 0, 1}, /* TxD1 */
	{1, 20, 2, 0, 1}, /* RxD0 */
	{1, 21, 2, 0, 1}, /* RxD1 */
	{1, 18, 1, 0, 1}, /* TX_EN */
	{1, 26, 2, 0, 1}, /* RX_DV */
	{1, 27, 2, 0, 1}, /* RX_ER */
	{1, 24, 2, 0, 1}, /* COL */
	{1, 25, 2, 0, 1}, /* CRS */
	{2, 15, 2, 0, 1}, /* TX_CLK - CLK16 */
	{2, 16, 2, 0, 1}, /* RX_CLK - CLK17 */

	/* DUART - UART2 */
	{5, 0, 1, 0, 2}, /* UART2_SOUT */
	{5, 2, 1, 0, 1}, /* UART2_RTS */
	{5, 3, 2, 0, 2}, /* UART2_SIN */
	{5, 1, 2, 0, 3}, /* UART2_CTS */
	#elif !defined(CONFIG_MPC8309)
	/* Local Bus */
	{0, 16, 1, 0, 3}, /* LA00 */
	{0, 17, 1, 0, 3}, /* LA01 */
	{0, 18, 1, 0, 3}, /* LA02 */
	{0, 19, 1, 0, 3}, /* LA03 */
	{0, 20, 1, 0, 3}, /* LA04 */
	{0, 21, 1, 0, 3}, /* LA05 */
	{0, 22, 1, 0, 3}, /* LA06 */
	{0, 23, 1, 0, 3}, /* LA07 */
	{0, 24, 1, 0, 3}, /* LA08 */
	{0, 25, 1, 0, 3}, /* LA09 */
	{0, 26, 1, 0, 3}, /* LA10 */
	{0, 27, 1, 0, 3}, /* LA11 */
	{0, 28, 1, 0, 3}, /* LA12 */
	{0, 29, 1, 0, 3}, /* LA13 */
	{0, 30, 1, 0, 3}, /* LA14 */
	{0, 31, 1, 0, 3}, /* LA15 */

	/* MDIO */
	{3, 4, 3, 0, 2}, /* MDIO */
	{3, 5, 1, 0, 2}, /* MDC */

	/* UCC4 - UEC */
	{1, 18, 1, 0, 1}, /* TxD0 */
	{1, 19, 1, 0, 1}, /* TxD1 */
	{1, 22, 2, 0, 1}, /* RxD0 */
	{1, 23, 2, 0, 1}, /* RxD1 */
	{1, 26, 2, 0, 1}, /* RxER */
	{1, 28, 2, 0, 1}, /* Rx_DV */
	{1, 30, 1, 0, 1}, /* TxEN */
	{1, 31, 2, 0, 1}, /* CRS */
	{3, 10, 2, 0, 3}, /* TxCLK->CLK17 */
	#endif

	/* END of table */
	{0, 0, 0, 0, QE_IOP_TAB_END},
	};

	static int board_init_i2c_busses(void)
	{
	I2C_MUX_DEVICE *dev = NULL;
	uchar dtt_bus = (uchar )"pca9547:70:a";

	/* Set up the Bus for the DTTs */
	dev = i2c_mux_ident_muxstring(dtt_bus);
	if (dev == NULL)
	printf("Error couldn't add Bus for DTT\n");

	return 0;
	}

	#if defined(CONFIG_SUVD3)
	const uint upma_table[] = {
	0x1ffedc00, 0x0ffcdc80, 0x0ffcdc80, 0x0ffcdc04, /* Words 0 to 3 */
	0x0ffcdc00, 0xffffcc00, 0xffffcc01, 0xfffffc01, /* Words 4 to 7 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 8 to 11 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 12 to 15 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 16 to 19 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 20 to 23 */
	0x9cfffc00, 0x00fffc80, 0x00fffc80, 0x00fffc00, /* Words 24 to 27 */
	0xffffec04, 0xffffec01, 0xfffffc01, 0xfffffc01, /* Words 28 to 31 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 32 to 35 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 36 to 39 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 40 to 43 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 44 to 47 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 48 to 51 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 52 to 55 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01, /* Words 56 to 59 */
	0xfffffc01, 0xfffffc01, 0xfffffc01, 0xfffffc01 /* Words 60 to 63 */
	};
	#endif

	static int piggy_present(void)
	{
	struct km_bec_fpga __iomem *base =
	(struct km_bec_fpga __iomem *)CONFIG_SYS_KMBEC_FPGA_BASE;

	return in_8(&base->bprth) & PIGGY_PRESENT;
	}

	#if defined(CONFIG_KMVECT1)
	int ethernet_present(void)
	{
	/* ethernet port connected to simple switch without piggy */
	return 1;
	}
	#else
	int ethernet_present(void)
	{
	return piggy_present();
	}
	#endif


	int board_early_init_r(void)
	{
	struct km_bec_fpga *base =
	(struct km_bec_fpga *)CONFIG_SYS_KMBEC_FPGA_BASE;
	#if defined(CONFIG_SUVD3)
	immap_t immap = (immap_t ) CONFIG_SYS_IMMR;
	fsl_lbc_t *lbc = &immap->im_lbc;
	u32 *mxmr = &lbc->mamr;
	#endif

	#if defined(CONFIG_MPC8360)
	unsigned short svid;
	/*
	* Because of errata in the UCCs, we have to write to the reserved
	* registers to slow the clocks down.
	*/
	svid = SVR_REV(mfspr(SVR));
	switch (svid) {
	case 0x0020:
	/*
	* MPC8360ECE.pdf QE_ENET10 table 4:
	* IMMR + 0x14A8[4:5] = 11 (clk delay for UCC 2)
	* IMMR + 0x14A8[18:19] = 11 (clk delay for UCC 1)
	*/
	setbits_be32((void *)(CONFIG_SYS_IMMR + 0x14a8), 0x0c003000);
	break;
	case 0x0021:
	/*
	* MPC8360ECE.pdf QE_ENET10 table 4:
	* IMMR + 0x14AC[24:27] = 1010
	*/
	clrsetbits_be32((void *)(CONFIG_SYS_IMMR + 0x14ac),
	0x00000050, 0x000000a0);
	break;
	}
	#endif

	/* enable the PHY on the PIGGY */
	setbits_8(&base->pgy_eth, 0x01);
	/* enable the Unit LED (green) */
	setbits_8(&base->oprth, WRL_BOOT);
	/* enable Application Buffer */
	setbits_8(&base->oprtl, OPRTL_XBUFENA);

	#if defined(CONFIG_SUVD3)
	/* configure UPMA for APP1 */
	upmconfig(UPMA, (uint *) upma_table,
	sizeof(upma_table) / sizeof(uint));
	out_be32(mxmr, CONFIG_SYS_MAMR);
	#endif
	return 0;
	}

	int misc_init_r(void)
	{
	/* add board specific i2c busses */
	board_init_i2c_busses();
	return 0;
	}

	#if defined(CONFIG_KMVECT1)
	#include <mv88e6352.h>
	/* Marvell MV88E6122 switch configuration */
	static struct mv88e_sw_reg extsw_conf[] = {
	/* port 1, FRONT_MDI, autoneg */
	{ PORT(1), PORT_PHY, NO_SPEED_FOR },
	{ PORT(1), PORT_CTRL, FORWARDING \| EGRS_FLD_ALL },
	{ PHY(1), PHY_1000_CTRL, NO_ADV },
	{ PHY(1), PHY_SPEC_CTRL, AUTO_MDIX_EN },
	{ PHY(1), PHY_CTRL, PHY_100_MBPS \| AUTONEG_EN \| AUTONEG_RST \|
	FULL_DUPLEX },
	/* port 2, unused */
	{ PORT(2), PORT_CTRL, PORT_DIS },
	{ PHY(2), PHY_CTRL, PHY_PWR_DOWN },
	{ PHY(2), PHY_SPEC_CTRL, SPEC_PWR_DOWN },
	/* port 3, BP_MII (CPU), PHY mode, 100BASE */
	{ PORT(3), PORT_CTRL, FORWARDING \| EGRS_FLD_ALL },
	/* port 4, ESTAR to slot 11, SerDes, 1000BASE-X */
	{ PORT(4), PORT_STATUS, NO_PHY_DETECT },
	{ PORT(4), PORT_PHY, SPEED_1000_FOR },
	{ PORT(4), PORT_CTRL, FORWARDING \| EGRS_FLD_ALL },
	/* port 5, ESTAR to slot 13, SerDes, 1000BASE-X */
	{ PORT(5), PORT_STATUS, NO_PHY_DETECT },
	{ PORT(5), PORT_PHY, SPEED_1000_FOR },
	{ PORT(5), PORT_CTRL, FORWARDING \| EGRS_FLD_ALL },
	/*
	* Errata Fix: 1.9V Output from Internal 1.8V Regulator,
	* acc . MV-S300889-00D.pdf , clause 4.5
	*/
	{ PORT(5), 0x1A, 0xADB1 },
	/* port 6, unused, this port has no phy */
	{ PORT(6), PORT_CTRL, PORT_DIS },
	};
	#endif

	int last_stage_init(void)
	{
	#if defined(CONFIG_KMVECT1)
	struct km_bec_fpga __iomem *base =
	(struct km_bec_fpga __iomem *)CONFIG_SYS_KMBEC_FPGA_BASE;
	u8 tmp_reg;

	/* Release mv88e6122 from reset */
	tmp_reg = in_8(&base->res1[0]) \| 0x10; /* DIRECT3 register */
	out_8(&base->res1[0], tmp_reg); /* GP28 as output */
	tmp_reg = in_8(&base->gprt3) \| 0x10; /* GP28 to high */
	out_8(&base->gprt3, tmp_reg);

	/* configure MV88E6122 switch */
	char *name = "UEC2";

	if (miiphy_set_current_dev(name))
	return 0;

	mv88e_sw_program(name, CONFIG_KM_MVEXTSW_ADDR, extsw_conf,
	ARRAY_SIZE(extsw_conf));

	mv88e_sw_reset(name, CONFIG_KM_MVEXTSW_ADDR);

	if (piggy_present()) {
	setenv("ethact", "UEC2");
	setenv("netdev", "eth1");
	puts("using PIGGY for network boot\n");
	} else {
	setenv("netdev", "eth0");
	puts("using frontport for network boot\n");
	}
	#endif

	#if defined(CONFIG_KMCOGE5NE)
	struct bfticu_iomap *base =
	(struct bfticu_iomap *)CONFIG_SYS_BFTIC3_BASE;
	u8 dip_switch = in_8((u8 *)&(base->mswitch)) & BFTICU_DIPSWITCH_MASK;

	if (dip_switch != 0) {
	/* start bootloader */
	puts("DIP: Enabled\n");
	setenv("actual_bank", "0");
	}
	#endif
	set_km_env();
	return 0;
	}

	int fixed_sdram(void)
	{
	immap_t im = (immap_t )CONFIG_SYS_IMMR;
	u32 msize = 0;
	u32 ddr_size;
	u32 ddr_size_log2;

	out_be32(&im->sysconf.ddrlaw[0].ar, (LAWAR_EN \| 0x1e));
	out_be32(&im->ddr.csbnds[0].csbnds, (CONFIG_SYS_DDR_CS0_BNDS) \| 0x7f);
	out_be32(&im->ddr.cs_config[0], CONFIG_SYS_DDR_CS0_CONFIG);
	out_be32(&im->ddr.timing_cfg_0, CONFIG_SYS_DDR_TIMING_0);
	out_be32(&im->ddr.timing_cfg_1, CONFIG_SYS_DDR_TIMING_1);
	out_be32(&im->ddr.timing_cfg_2, CONFIG_SYS_DDR_TIMING_2);
	out_be32(&im->ddr.timing_cfg_3, CONFIG_SYS_DDR_TIMING_3);
	out_be32(&im->ddr.sdram_cfg, CONFIG_SYS_DDR_SDRAM_CFG);
	out_be32(&im->ddr.sdram_cfg2, CONFIG_SYS_DDR_SDRAM_CFG2);
	out_be32(&im->ddr.sdram_mode, CONFIG_SYS_DDR_MODE);
	out_be32(&im->ddr.sdram_mode2, CONFIG_SYS_DDR_MODE2);
	out_be32(&im->ddr.sdram_interval, CONFIG_SYS_DDR_INTERVAL);
	out_be32(&im->ddr.sdram_clk_cntl, CONFIG_SYS_DDR_CLK_CNTL);
	udelay(200);
	setbits_be32(&im->ddr.sdram_cfg, SDRAM_CFG_MEM_EN);

	msize = CONFIG_SYS_DDR_SIZE << 20;
	disable_addr_trans();
	msize = get_ram_size(CONFIG_SYS_DDR_BASE, msize);
	enable_addr_trans();
	msize /= (1024 * 1024);
	if (CONFIG_SYS_DDR_SIZE != msize) {
	for (ddr_size = msize << 20, ddr_size_log2 = 0;
	(ddr_size > 1);
	ddr_size = ddr_size >> 1, ddr_size_log2++)
	if (ddr_size & 1)
	return -1;
	out_be32(&im->sysconf.ddrlaw[0].ar,
	(LAWAR_EN \| ((ddr_size_log2 - 1) & LAWAR_SIZE)));
	out_be32(&im->ddr.csbnds[0].csbnds,
	(((msize / 16) - 1) & 0xff));
	}

	return msize;
	}

	phys_size_t initdram(int board_type)
	{
	immap_t im = (immap_t )CONFIG_SYS_IMMR;
	u32 msize = 0;

	if ((in_be32(&im->sysconf.immrbar) & IMMRBAR_BASE_ADDR) != (u32)im)
	return -1;

	out_be32(&im->sysconf.ddrlaw[0].bar,
	CONFIG_SYS_DDR_BASE & LAWBAR_BAR);
	msize = fixed_sdram();

	#if defined(CONFIG_DDR_ECC) && !defined(CONFIG_ECC_INIT_VIA_DDRCONTROLLER)
	/*
	* Initialize DDR ECC byte
	*/
	ddr_enable_ecc(msize * 1024 * 1024);
	#endif

	/* return total bus SDRAM size(bytes) -- DDR */
	return msize * 1024 * 1024;
	}

	int checkboard(void)
	{
	puts("Board: Keymile " CONFIG_KM_BOARD_NAME);

	if (piggy_present())
	puts(" with PIGGY.");
	puts("\n");
	return 0;
	}

	#if defined(CONFIG_OF_BOARD_SETUP)
	void ft_board_setup(void blob, bd_t bd)
	{
	ft_cpu_setup(blob, bd);
	}
	#endif

	#if defined(CONFIG_HUSH_INIT_VAR)
	int hush_init_var(void)
	{
	ivm_read_eeprom();
	return 0;
	}
	#endif

	#if defined(CONFIG_POST)
	int post_hotkeys_pressed(void)
	{
	int testpin = 0;
	struct km_bec_fpga *base =
	(struct km_bec_fpga *)CONFIG_SYS_KMBEC_FPGA_BASE;
	int testpin_reg = in_8(&base->CONFIG_TESTPIN_REG);
	testpin = (testpin_reg & CONFIG_TESTPIN_MASK) != 0;
	debug("post_hotkeys_pressed: %d\n", !testpin);
	return testpin;
	}

	ulong post_word_load(void)
	{
	void* addr = (ulong *) (CPM_POST_WORD_ADDR);
	debug("post_word_load 0x%08lX: 0x%08X\n", (ulong)addr, in_le32(addr));
	return in_le32(addr);

	}
	void post_word_store(ulong value)
	{
	void* addr = (ulong *) (CPM_POST_WORD_ADDR);
	debug("post_word_store 0x%08lX: 0x%08lX\n", (ulong)addr, value);
	out_le32(addr, value);
	}

	int arch_memory_test_prepare(u32 vstart, u32 size, phys_addr_t *phys_offset)
	{
	*vstart = CONFIG_SYS_MEMTEST_START;
	*size = CONFIG_SYS_MEMTEST_END - CONFIG_SYS_MEMTEST_START;
	debug("arch_memory_test_prepare 0x%08X 0x%08X\n", vstart, size);

	return 0;
	}
	#endif