2 * (C) Copyright 2013 Keymile AG
3 * Valentin Longchamp <valentin.longchamp@keymile.com>
5 * Copyright 2011,2012 Freescale Semiconductor, Inc.
7 * SPDX-License-Identifier: GPL-2.0+
13 #include <linux/compiler.h>
15 #include <asm/processor.h>
16 #include <asm/cache.h>
17 #include <asm/immap_85xx.h>
18 #include <asm/fsl_law.h>
19 #include <asm/fsl_serdes.h>
20 #include <asm/fsl_portals.h>
21 #include <asm/fsl_liodn.h>
24 #include "../common/common.h"
27 DECLARE_GLOBAL_DATA_PTR;
31 printf("Board: Keymile %s\n", CONFIG_KM_BOARD_NAME);
36 /* TODO: implement the I2C deblocking function */
37 int i2c_make_abort(void)
45 int board_early_init_f(void)
47 ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
49 /* board only uses the DDR_MCK0, so disable the DDR_MCK1/2/3 */
50 setbits_be32(&gur->ddrclkdr, 0x001f000f);
52 /* take the Zarlinks out of reset as soon as possible */
53 qrio_prst(ZL30158_RST, false, false);
54 qrio_prst(ZL30343_RST, false, false);
56 /* and set their reset to power-up only */
57 qrio_prstcfg(ZL30158_RST, PRSTCFG_POWUP_RST);
58 qrio_prstcfg(ZL30343_RST, PRSTCFG_POWUP_RST);
63 int board_early_init_r(void)
65 /* Flush d-cache and invalidate i-cache of any FLASH data */
75 unsigned long get_board_sys_clk(unsigned long dummy)
80 #define WDMASK_OFF 0x16
82 static void qrio_wdmask(u8 bit, bool wden)
85 void __iomem *qrio_base = (void *)CONFIG_SYS_QRIO_BASE;
87 wdmask = in_be16(qrio_base + WDMASK_OFF);
92 wdmask &= ~(1 << bit);
94 out_be16(qrio_base + WDMASK_OFF, wdmask);
99 void qrio_prst(u8 bit, bool en, bool wden)
102 void __iomem *qrio_base = (void *)CONFIG_SYS_QRIO_BASE;
104 qrio_wdmask(bit, wden);
106 prst = in_be16(qrio_base + PRST_OFF);
113 out_be16(qrio_base + PRST_OFF, prst);
116 #define PRSTCFG_OFF 0x1c
118 void qrio_prstcfg(u8 bit, u8 mode)
122 void __iomem *qrio_base = (void *)CONFIG_SYS_QRIO_BASE;
124 prstcfg = in_be32(qrio_base + PRSTCFG_OFF);
126 for (i = 0; i < 2; i++) {
128 set_bit(2*bit+i, &prstcfg);
130 clear_bit(2*bit+i, &prstcfg);
133 out_be32(qrio_base + PRSTCFG_OFF, prstcfg);
136 #define NUM_SRDS_BANKS 2
139 int misc_init_r(void)
141 serdes_corenet_t *regs = (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
142 u32 expected[NUM_SRDS_BANKS] = {SRDS_PLLCR0_RFCK_SEL_100,
143 SRDS_PLLCR0_RFCK_SEL_125};
146 /* check SERDES reference clocks */
147 for (i = 0; i < NUM_SRDS_BANKS; i++) {
148 u32 actual = in_be32(®s->bank[i].pllcr0);
149 actual &= SRDS_PLLCR0_RFCK_SEL_MASK;
150 if (actual != expected[i]) {
151 printf("Warning: SERDES bank %u expects reference \
152 clock %sMHz, but actual is %sMHz\n", i + 1,
153 serdes_clock_to_string(expected[i]),
154 serdes_clock_to_string(actual));
158 /* take the mgmt eth phy out of reset */
159 qrio_prst(PHY_RST, false, false);
164 #if defined(CONFIG_HUSH_INIT_VAR)
165 int hush_init_var(void)
172 #if defined(CONFIG_LAST_STAGE_INIT)
173 int last_stage_init(void)
180 #ifdef CONFIG_SYS_DPAA_FMAN
181 void fdt_fixup_fman_mac_addresses(void *blob)
185 unsigned char mac_addr[6];
187 /* get the mac addr from env */
188 tmp = getenv("ethaddr");
190 printf("ethaddr env variable not defined\n");
193 for (i = 0; i < 6; i++) {
194 mac_addr[i] = tmp ? simple_strtoul(tmp, &end, 16) : 0;
196 tmp = (*end) ? end+1 : end;
199 /* find the correct fdt ethernet path and correct it */
200 node = fdt_path_offset(blob, "/soc/fman/ethernet@e8000");
202 printf("no /soc/fman/ethernet path offset\n");
205 ret = fdt_setprop(blob, node, "local-mac-address", &mac_addr, 6);
207 printf("error setting local-mac-address property\n");
213 void ft_board_setup(void *blob, bd_t *bd)
218 ft_cpu_setup(blob, bd);
220 base = getenv_bootm_low();
221 size = getenv_bootm_size();
223 fdt_fixup_memory(blob, (u64)base, (u64)size);
225 #if defined(CONFIG_HAS_FSL_DR_USB) || defined(CONFIG_HAS_FSL_MPH_USB)
226 fdt_fixup_dr_usb(blob, bd);
230 pci_of_setup(blob, bd);
233 fdt_fixup_liodn(blob);
234 #ifdef CONFIG_SYS_DPAA_FMAN
235 fdt_fixup_fman_ethernet(blob);
236 fdt_fixup_fman_mac_addresses(blob);