1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2013 Atmel Corporation
4 * Bo Shen <voice.shen@atmel.com>
9 #include <asm/arch/at91_common.h>
10 #include <asm/arch/at91_pit.h>
11 #include <asm/arch/at91_pmc.h>
12 #include <asm/arch/at91_rstc.h>
13 #include <asm/arch/at91_wdt.h>
14 #include <asm/arch/clk.h>
17 static void switch_to_main_crystal_osc(void)
19 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC;
22 tmp = readl(&pmc->mor);
23 tmp &= ~AT91_PMC_MOR_OSCOUNT(0xff);
24 tmp &= ~AT91_PMC_MOR_KEY(0xff);
25 tmp |= AT91_PMC_MOR_MOSCEN;
26 tmp |= AT91_PMC_MOR_OSCOUNT(8);
27 tmp |= AT91_PMC_MOR_KEY(0x37);
28 writel(tmp, &pmc->mor);
29 while (!(readl(&pmc->sr) & AT91_PMC_IXR_MOSCS))
32 #if defined(CONFIG_SAMA5D2)
33 /* Enable a measurement of the external oscillator */
34 tmp = readl(&pmc->mcfr);
35 tmp |= AT91_PMC_MCFR_CCSS_XTAL_OSC;
36 tmp |= AT91_PMC_MCFR_RCMEAS;
37 writel(tmp, &pmc->mcfr);
39 while (!(readl(&pmc->mcfr) & AT91_PMC_MCFR_MAINRDY))
42 if (!(readl(&pmc->mcfr) & AT91_PMC_MCFR_MAINF_MASK))
46 tmp = readl(&pmc->mor);
48 * some boards have an external oscillator with driving.
49 * in this case we need to disable the internal SoC driving (bypass mode)
51 #if defined(CONFIG_SPL_AT91_MCK_BYPASS)
52 tmp |= AT91_PMC_MOR_OSCBYPASS;
54 tmp &= ~AT91_PMC_MOR_OSCBYPASS;
56 tmp &= ~AT91_PMC_MOR_KEY(0xff);
57 tmp |= AT91_PMC_MOR_KEY(0x37);
58 writel(tmp, &pmc->mor);
60 tmp = readl(&pmc->mor);
61 tmp |= AT91_PMC_MOR_MOSCSEL;
62 tmp &= ~AT91_PMC_MOR_KEY(0xff);
63 tmp |= AT91_PMC_MOR_KEY(0x37);
64 writel(tmp, &pmc->mor);
66 while (!(readl(&pmc->sr) & AT91_PMC_IXR_MOSCSELS))
69 #if !defined(CONFIG_SAMA5D2)
70 /* Wait until MAINRDY field is set to make sure main clock is stable */
71 while (!(readl(&pmc->mcfr) & AT91_PMC_MAINRDY))
75 #if !defined(CONFIG_SAMA5D4) && !defined(CONFIG_SAMA5D2)
76 tmp = readl(&pmc->mor);
77 tmp &= ~AT91_PMC_MOR_MOSCRCEN;
78 tmp &= ~AT91_PMC_MOR_KEY(0xff);
79 tmp |= AT91_PMC_MOR_KEY(0x37);
80 writel(tmp, &pmc->mor);
84 __weak void matrix_init(void)
86 /* This only be used for sama5d4 soc now */
89 __weak void redirect_int_from_saic_to_aic(void)
91 /* This only be used for sama5d4 soc now */
94 /* empty stub to satisfy current lowlevel_init, can be removed any time */
99 void board_init_f(ulong dummy)
103 switch_to_main_crystal_osc();
105 #ifdef CONFIG_SAMA5D2
106 configure_2nd_sram_as_l2_cache();
109 #if !defined(CONFIG_WDT_AT91)
110 /* disable watchdog */
114 /* PMC configuration */
117 at91_clock_init(CONFIG_SYS_AT91_MAIN_CLOCK);
121 redirect_int_from_saic_to_aic();
125 board_early_init_f();
131 debug("spl_init() failed: %d\n", ret);
135 preloader_console_init();