blob: 338df8769ef07b0e37876078d1dfa52431496d14 [file] [log] [blame]
wdenkf39748a2004-06-09 13:37:52 +00001/*
2 * (C) Copyright 2002
3 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
4 * Marius Groeger <mgroeger@sysgo.de>
5 *
6 * (C) Copyright 2002
Detlev Zundel792a09e2009-05-13 10:54:10 +02007 * Gary Jennejohn, DENX Software Engineering, <garyj@denx.de>
wdenkf39748a2004-06-09 13:37:52 +00008 *
9 * See file CREDITS for list of people who contributed to this
10 * project.
11 *
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License as
14 * published by the Free Software Foundation; either version 2 of
15 * the License, or (at your option) any later version.
16 *
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
25 * MA 02111-1307 USA
26 */
27
28/*
29 * CPU specific code
30 */
31
32#include <common.h>
33#include <command.h>
34#include <arm920t.h>
Jean-Christophe PLAGNIOL-VILLARD677e62f2009-04-05 13:02:43 +020035#include <asm/system.h>
wdenkf39748a2004-06-09 13:37:52 +000036
Wolfgang Denkd87080b2006-03-31 18:32:53 +020037#ifdef CONFIG_USE_IRQ
38DECLARE_GLOBAL_DATA_PTR;
39#endif
40
Jean-Christophe PLAGNIOL-VILLARDb3acb6c2009-04-05 13:06:31 +020041static void cache_flush(void);
wdenkf39748a2004-06-09 13:37:52 +000042
wdenkf39748a2004-06-09 13:37:52 +000043int cpu_init (void)
44{
45 /*
46 * setup up stacks if necessary
47 */
48#ifdef CONFIG_USE_IRQ
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020049 IRQ_STACK_START = _armboot_start - CONFIG_SYS_MALLOC_LEN - CONFIG_SYS_GBL_DATA_SIZE - 4;
wdenkf39748a2004-06-09 13:37:52 +000050 FIQ_STACK_START = IRQ_STACK_START - CONFIG_STACKSIZE_IRQ;
51#endif
52 return 0;
53}
54
55int cleanup_before_linux (void)
56{
57 /*
58 * this function is called just before we call linux
59 * it prepares the processor for linux
60 *
61 * we turn off caches etc ...
62 */
63
wdenkf39748a2004-06-09 13:37:52 +000064 disable_interrupts ();
65
66 /* turn off I/D-cache */
Jean-Christophe PLAGNIOL-VILLARDb3acb6c2009-04-05 13:06:31 +020067 icache_disable();
68 dcache_disable();
wdenkf39748a2004-06-09 13:37:52 +000069
70 /* flush I/D-cache */
Jean-Christophe PLAGNIOL-VILLARDb3acb6c2009-04-05 13:06:31 +020071 cache_flush();
72
73 return 0;
wdenkf39748a2004-06-09 13:37:52 +000074}
75
Jean-Christophe PLAGNIOL-VILLARDb3acb6c2009-04-05 13:06:31 +020076/* flush I/D-cache */
77static void cache_flush (void)
wdenkf39748a2004-06-09 13:37:52 +000078{
Jean-Christophe PLAGNIOL-VILLARDb3acb6c2009-04-05 13:06:31 +020079 unsigned long i = 0;
wdenkf39748a2004-06-09 13:37:52 +000080
Jean-Christophe PLAGNIOL-VILLARDb3acb6c2009-04-05 13:06:31 +020081 asm ("mcr p15, 0, %0, c7, c7, 0": :"r" (i));
wdenkf39748a2004-06-09 13:37:52 +000082}