blob: 904bfb227e5b2534cecf429213d55aa7f23bf905 [file] [log] [blame]
Wolfgang Denk72a087e2006-10-24 14:27:35 +02001/*
2 * Copyright (C) 2005-2006 Atmel Corporation
3 *
4 * See file CREDITS for list of people who contributed to this
5 * project.
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2 of
10 * the License, or (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
20 * MA 02111-1307 USA
21 */
22#include <common.h>
23#include <command.h>
24
25#include <asm/io.h>
26#include <asm/sections.h>
27#include <asm/sysreg.h>
28
Haavard Skinnemoendf548d32006-11-19 18:06:53 +010029#include <asm/arch/clk.h>
Wolfgang Denk72a087e2006-10-24 14:27:35 +020030#include <asm/arch/memory-map.h>
Wolfgang Denk72a087e2006-10-24 14:27:35 +020031
32#include "hsmc3.h"
Haavard Skinnemoendf548d32006-11-19 18:06:53 +010033
34/* Sanity checks */
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020035#if (CONFIG_SYS_CLKDIV_CPU > CONFIG_SYS_CLKDIV_HSB) \
36 || (CONFIG_SYS_CLKDIV_HSB > CONFIG_SYS_CLKDIV_PBA) \
37 || (CONFIG_SYS_CLKDIV_HSB > CONFIG_SYS_CLKDIV_PBB)
Haavard Skinnemoendf548d32006-11-19 18:06:53 +010038# error Constraint fCPU >= fHSB >= fPB{A,B} violated
39#endif
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020040#if defined(CONFIG_PLL) && ((CONFIG_SYS_PLL0_MUL < 1) || (CONFIG_SYS_PLL0_DIV < 1))
Haavard Skinnemoendf548d32006-11-19 18:06:53 +010041# error Invalid PLL multiplier and/or divider
42#endif
Wolfgang Denk72a087e2006-10-24 14:27:35 +020043
44DECLARE_GLOBAL_DATA_PTR;
45
46int cpu_init(void)
47{
Wolfgang Denk72a087e2006-10-24 14:27:35 +020048 extern void _evba(void);
Wolfgang Denk72a087e2006-10-24 14:27:35 +020049
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020050 gd->cpu_hz = CONFIG_SYS_OSC0_HZ;
Wolfgang Denk72a087e2006-10-24 14:27:35 +020051
Haavard Skinnemoendf548d32006-11-19 18:06:53 +010052 /* TODO: Move somewhere else, but needs to be run before we
53 * increase the clock frequency. */
54 hsmc3_writel(MODE0, 0x00031103);
55 hsmc3_writel(CYCLE0, 0x000c000d);
56 hsmc3_writel(PULSE0, 0x0b0a0906);
57 hsmc3_writel(SETUP0, 0x00010002);
Wolfgang Denk72a087e2006-10-24 14:27:35 +020058
Haavard Skinnemoen3ace2522008-05-02 15:21:40 +020059 clk_init();
Wolfgang Denk72a087e2006-10-24 14:27:35 +020060
Haavard Skinnemoen3ace2522008-05-02 15:21:40 +020061 /* Update the CPU speed according to the PLL configuration */
62 gd->cpu_hz = get_cpu_clk_rate();
63
64 /* Set up the exception handler table and enable exceptions */
Wolfgang Denk72a087e2006-10-24 14:27:35 +020065 sysreg_write(EVBA, (unsigned long)&_evba);
66 asm volatile("csrf %0" : : "i"(SYSREG_EM_OFFSET));
Wolfgang Denk72a087e2006-10-24 14:27:35 +020067
Wolfgang Denk72a087e2006-10-24 14:27:35 +020068 return 0;
69}
70
71void prepare_to_boot(void)
72{
73 /* Flush both caches and the write buffer */
74 asm volatile("cache %0[4], 010\n\t"
75 "cache %0[0], 000\n\t"
76 "sync 0" : : "r"(0) : "memory");
77}
78
79int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
80{
81 /* This will reset the CPU core, caches, MMU and all internal busses */
82 __builtin_mtdr(8, 1 << 13); /* set DC:DBE */
83 __builtin_mtdr(8, 1 << 30); /* set DC:RES */
84
85 /* Flush the pipeline before we declare it a failure */
86 asm volatile("sub pc, pc, -4");
87
88 return -1;
89}