1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
262011840SMasahiro Yamada /*
362011840SMasahiro Yamada  * (C) Copyright 2010
462011840SMasahiro Yamada  * Reinhard Meyer, reinhard.meyer@emk-elektronik.de
562011840SMasahiro Yamada  * (C) Copyright 2009
662011840SMasahiro Yamada  * Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
762011840SMasahiro Yamada  */
862011840SMasahiro Yamada 
962011840SMasahiro Yamada #include <common.h>
1062011840SMasahiro Yamada #include <asm/io.h>
1162011840SMasahiro Yamada #include <asm/arch/hardware.h>
1262011840SMasahiro Yamada #include <asm/arch/at91_pit.h>
1362011840SMasahiro Yamada #include <asm/arch/at91_gpbr.h>
1462011840SMasahiro Yamada #include <asm/arch/clk.h>
1562011840SMasahiro Yamada 
1662011840SMasahiro Yamada #ifndef CONFIG_SYS_AT91_MAIN_CLOCK
1762011840SMasahiro Yamada #define CONFIG_SYS_AT91_MAIN_CLOCK 0
1862011840SMasahiro Yamada #endif
1962011840SMasahiro Yamada 
arch_cpu_init(void)2062011840SMasahiro Yamada int arch_cpu_init(void)
2162011840SMasahiro Yamada {
2262011840SMasahiro Yamada 	return at91_clock_init(CONFIG_SYS_AT91_MAIN_CLOCK);
2362011840SMasahiro Yamada }
2462011840SMasahiro Yamada 
arch_preboot_os(void)2562011840SMasahiro Yamada void arch_preboot_os(void)
2662011840SMasahiro Yamada {
2762011840SMasahiro Yamada 	ulong cpiv;
2862011840SMasahiro Yamada 	at91_pit_t *pit = (at91_pit_t *) ATMEL_BASE_PIT;
2962011840SMasahiro Yamada 
3062011840SMasahiro Yamada 	cpiv = AT91_PIT_MR_PIV_MASK(readl(&pit->piir));
3162011840SMasahiro Yamada 
3262011840SMasahiro Yamada 	/*
3362011840SMasahiro Yamada 	 * Disable PITC
3462011840SMasahiro Yamada 	 * Add 0x1000 to current counter to stop it faster
3562011840SMasahiro Yamada 	 * without waiting for wrapping back to 0
3662011840SMasahiro Yamada 	 */
3762011840SMasahiro Yamada 	writel(cpiv + 0x1000, &pit->mr);
3862011840SMasahiro Yamada }
3962011840SMasahiro Yamada 
4062011840SMasahiro Yamada #if defined(CONFIG_DISPLAY_CPUINFO)
print_cpuinfo(void)4162011840SMasahiro Yamada int print_cpuinfo(void)
4262011840SMasahiro Yamada {
4380402f34SHeiko Schocher 	char __maybe_unused buf[32];
4462011840SMasahiro Yamada 
4562011840SMasahiro Yamada 	printf("CPU: %s\n", ATMEL_CPU_NAME);
4662011840SMasahiro Yamada 	printf("Crystal frequency: %8s MHz\n",
4762011840SMasahiro Yamada 					strmhz(buf, get_main_clk_rate()));
4862011840SMasahiro Yamada 	printf("CPU clock        : %8s MHz\n",
4962011840SMasahiro Yamada 					strmhz(buf, get_cpu_clk_rate()));
5062011840SMasahiro Yamada 	printf("Master clock     : %8s MHz\n",
5162011840SMasahiro Yamada 					strmhz(buf, get_mck_clk_rate()));
5262011840SMasahiro Yamada 
5362011840SMasahiro Yamada 	return 0;
5462011840SMasahiro Yamada }
5562011840SMasahiro Yamada #endif
56