162011840SMasahiro Yamada /* 262011840SMasahiro Yamada * (C) Copyright 2014 DENX Software Engineering 362011840SMasahiro Yamada * Heiko Schocher <hs@denx.de> 462011840SMasahiro Yamada * 562011840SMasahiro Yamada * Based on: 662011840SMasahiro Yamada * Copyright (C) 2013 Atmel Corporation 762011840SMasahiro Yamada * Bo Shen <voice.shen@atmel.com> 862011840SMasahiro Yamada * 962011840SMasahiro Yamada * SPDX-License-Identifier: GPL-2.0+ 1062011840SMasahiro Yamada */ 1162011840SMasahiro Yamada 1262011840SMasahiro Yamada #include <common.h> 1362011840SMasahiro Yamada #include <asm/io.h> 1462011840SMasahiro Yamada #include <asm/arch/at91_common.h> 1562011840SMasahiro Yamada #include <asm/arch/at91sam9_matrix.h> 1662011840SMasahiro Yamada #include <asm/arch/at91_pit.h> 1762011840SMasahiro Yamada #include <asm/arch/at91_pmc.h> 1862011840SMasahiro Yamada #include <asm/arch/at91_rstc.h> 1962011840SMasahiro Yamada #include <asm/arch/at91_wdt.h> 2062011840SMasahiro Yamada #include <asm/arch/clk.h> 2162011840SMasahiro Yamada #include <spl.h> 2262011840SMasahiro Yamada 2362011840SMasahiro Yamada DECLARE_GLOBAL_DATA_PTR; 2462011840SMasahiro Yamada 2562011840SMasahiro Yamada static void enable_ext_reset(void) 2662011840SMasahiro Yamada { 2762011840SMasahiro Yamada struct at91_rstc *rstc = (struct at91_rstc *)ATMEL_BASE_RSTC; 2862011840SMasahiro Yamada 2962011840SMasahiro Yamada writel(AT91_RSTC_KEY | AT91_RSTC_MR_URSTEN, &rstc->mr); 3062011840SMasahiro Yamada } 3162011840SMasahiro Yamada 3262011840SMasahiro Yamada void lowlevel_clock_init(void) 3362011840SMasahiro Yamada { 3462011840SMasahiro Yamada struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 3562011840SMasahiro Yamada 3662011840SMasahiro Yamada if (!(readl(&pmc->sr) & AT91_PMC_MOSCS)) { 3762011840SMasahiro Yamada /* Enable Main Oscillator */ 3862011840SMasahiro Yamada writel(AT91_PMC_MOSCS | (0x40 << 8), &pmc->mor); 3962011840SMasahiro Yamada 4062011840SMasahiro Yamada /* Wait until Main Oscillator is stable */ 4162011840SMasahiro Yamada while (!(readl(&pmc->sr) & AT91_PMC_MOSCS)) 4262011840SMasahiro Yamada ; 4362011840SMasahiro Yamada } 4462011840SMasahiro Yamada 4562011840SMasahiro Yamada /* After stabilization, switch to Main Oscillator */ 4662011840SMasahiro Yamada if ((readl(&pmc->mckr) & AT91_PMC_CSS) == AT91_PMC_CSS_SLOW) { 4762011840SMasahiro Yamada unsigned long tmp; 4862011840SMasahiro Yamada 4962011840SMasahiro Yamada tmp = readl(&pmc->mckr); 5062011840SMasahiro Yamada tmp &= ~AT91_PMC_CSS; 5162011840SMasahiro Yamada tmp |= AT91_PMC_CSS_MAIN; 5262011840SMasahiro Yamada writel(tmp, &pmc->mckr); 5362011840SMasahiro Yamada while (!(readl(&pmc->sr) & AT91_PMC_MCKRDY)) 5462011840SMasahiro Yamada ; 5562011840SMasahiro Yamada 5662011840SMasahiro Yamada tmp &= ~AT91_PMC_PRES; 5762011840SMasahiro Yamada tmp |= AT91_PMC_PRES_1; 5862011840SMasahiro Yamada writel(tmp, &pmc->mckr); 5962011840SMasahiro Yamada while (!(readl(&pmc->sr) & AT91_PMC_MCKRDY)) 6062011840SMasahiro Yamada ; 6162011840SMasahiro Yamada } 6262011840SMasahiro Yamada 6362011840SMasahiro Yamada return; 6462011840SMasahiro Yamada } 6562011840SMasahiro Yamada 6662011840SMasahiro Yamada void __weak matrix_init(void) 6762011840SMasahiro Yamada { 6862011840SMasahiro Yamada } 6962011840SMasahiro Yamada 7062011840SMasahiro Yamada void __weak at91_spl_board_init(void) 7162011840SMasahiro Yamada { 7262011840SMasahiro Yamada } 7362011840SMasahiro Yamada 7441d41a93SBo Shen void __weak spl_board_init(void) 7541d41a93SBo Shen { 7641d41a93SBo Shen } 7741d41a93SBo Shen 7841d41a93SBo Shen void board_init_f(ulong dummy) 7962011840SMasahiro Yamada { 8062011840SMasahiro Yamada struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 8162011840SMasahiro Yamada 8262011840SMasahiro Yamada lowlevel_clock_init(); 8362011840SMasahiro Yamada at91_disable_wdt(); 8462011840SMasahiro Yamada 8562011840SMasahiro Yamada /* 8662011840SMasahiro Yamada * At this stage the main oscillator is supposed to be enabled 8762011840SMasahiro Yamada * PCK = MCK = MOSC 8862011840SMasahiro Yamada */ 8962011840SMasahiro Yamada writel(0x00, &pmc->pllicpr); 9062011840SMasahiro Yamada 9162011840SMasahiro Yamada /* Configure PLLA = MOSC * (PLL_MULA + 1) / PLL_DIVA */ 9262011840SMasahiro Yamada at91_plla_init(CONFIG_SYS_AT91_PLLA); 9362011840SMasahiro Yamada 9462011840SMasahiro Yamada /* PCK = PLLA = 2 * MCK */ 9562011840SMasahiro Yamada at91_mck_init(CONFIG_SYS_MCKR); 9662011840SMasahiro Yamada 9762011840SMasahiro Yamada /* Switch MCK on PLLA output */ 9862011840SMasahiro Yamada at91_mck_init(CONFIG_SYS_MCKR_CSS); 9962011840SMasahiro Yamada 10062011840SMasahiro Yamada #if defined(CONFIG_SYS_AT91_PLLB) 10162011840SMasahiro Yamada /* Configure PLLB */ 10262011840SMasahiro Yamada at91_pllb_init(CONFIG_SYS_AT91_PLLB); 10362011840SMasahiro Yamada #endif 10462011840SMasahiro Yamada 10562011840SMasahiro Yamada /* Enable External Reset */ 10662011840SMasahiro Yamada enable_ext_reset(); 10762011840SMasahiro Yamada 10862011840SMasahiro Yamada /* Initialize matrix */ 10962011840SMasahiro Yamada matrix_init(); 11062011840SMasahiro Yamada 11162011840SMasahiro Yamada gd->arch.mck_rate_hz = CONFIG_SYS_MASTER_CLOCK; 11262011840SMasahiro Yamada /* 11362011840SMasahiro Yamada * init timer long enough for using in spl. 11462011840SMasahiro Yamada */ 11562011840SMasahiro Yamada timer_init(); 11662011840SMasahiro Yamada 11762011840SMasahiro Yamada /* enable clocks for all PIOs */ 118*d85e8914SBo Shen #ifdef CONFIG_AT91SAM9X5 119*d85e8914SBo Shen at91_periph_clk_enable(ATMEL_ID_PIOAB); 120*d85e8914SBo Shen at91_periph_clk_enable(ATMEL_ID_PIOCD); 121*d85e8914SBo Shen #else 12262011840SMasahiro Yamada at91_periph_clk_enable(ATMEL_ID_PIOA); 12362011840SMasahiro Yamada at91_periph_clk_enable(ATMEL_ID_PIOB); 12462011840SMasahiro Yamada at91_periph_clk_enable(ATMEL_ID_PIOC); 125*d85e8914SBo Shen #endif 12662011840SMasahiro Yamada /* init console */ 12762011840SMasahiro Yamada at91_seriald_hw_init(); 12862011840SMasahiro Yamada preloader_console_init(); 12962011840SMasahiro Yamada 13062011840SMasahiro Yamada mem_init(); 13162011840SMasahiro Yamada 13262011840SMasahiro Yamada at91_spl_board_init(); 13362011840SMasahiro Yamada } 134