arch/arm/mach-at91/arm926ejs/cpu.c

   1 /*
   2  * (C) Copyright 2010
   3  * Reinhard Meyer, reinhard.meyer@emk-elektronik.de
   4  * (C) Copyright 2009
   5  * Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
   6  *
   7  * SPDX-License-Identifier:     GPL-2.0+
   8  */
   9
  10 #include <common.h>
  11 #include <asm/io.h>
  12 #include <asm/arch/hardware.h>
  13 #include <asm/arch/at91_pit.h>
  14 #include <asm/arch/at91_gpbr.h>
  15 #include <asm/arch/clk.h>
  16
  17 #ifndef CONFIG_SYS_AT91_MAIN_CLOCK
  18 #define CONFIG_SYS_AT91_MAIN_CLOCK 0
  19 #endif
  20
  21 int arch_cpu_init(void)
  22 {
  23         return at91_clock_init(CONFIG_SYS_AT91_MAIN_CLOCK);
  24 }
  25
  26 void arch_preboot_os(void)
  27 {
  28         ulong cpiv;
  29         at91_pit_t *pit = (at91_pit_t *) ATMEL_BASE_PIT;
  30
  31         cpiv = AT91_PIT_MR_PIV_MASK(readl(&pit->piir));
  32
  33         /*
  34          * Disable PITC
  35          * Add 0x1000 to current counter to stop it faster
  36          * without waiting for wrapping back to 0
  37          */
  38         writel(cpiv + 0x1000, &pit->mr);
  39 }
  40
  41 #if defined(CONFIG_DISPLAY_CPUINFO)
  42 int print_cpuinfo(void)
  43 {
  44         char __maybe_unused buf[32];
  45
  46         printf("CPU: %s\n", ATMEL_CPU_NAME);
  47         printf("Crystal frequency: %8s MHz\n",
  48                                         strmhz(buf, get_main_clk_rate()));
  49         printf("CPU clock        : %8s MHz\n",
  50                                         strmhz(buf, get_cpu_clk_rate()));
  51         printf("Master clock     : %8s MHz\n",
  52                                         strmhz(buf, get_mck_clk_rate()));
  53
  54         return 0;
  55 }
  56 #endif