wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1 | /* |
| 2 | * armboot - Startup Code for ARM920 CPU-core |
| 3 | * |
Albert ARIBAUD | 60fbc8d | 2011-08-04 18:45:45 +0200 | [diff] [blame] | 4 | * Copyright (c) 2001 Marius Gröger <mag@sysgo.de> |
| 5 | * Copyright (c) 2002 Alex Züpke <azu@sysgo.de> |
Detlev Zundel | f1b3f2b | 2009-05-13 10:54:10 +0200 | [diff] [blame] | 6 | * Copyright (c) 2002 Gary Jennejohn <garyj@denx.de> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 7 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 8 | * SPDX-License-Identifier: GPL-2.0+ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 9 | */ |
| 10 | |
Wolfgang Denk | 0191e47 | 2010-10-26 14:34:52 +0200 | [diff] [blame] | 11 | #include <asm-offsets.h> |
Wolfgang Denk | 140f044 | 2009-07-27 10:06:39 +0200 | [diff] [blame] | 12 | #include <common.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 13 | #include <config.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 14 | |
| 15 | /* |
| 16 | ************************************************************************* |
| 17 | * |
Peter Pearse | 782cf16 | 2007-09-05 16:04:41 +0100 | [diff] [blame] | 18 | * Startup Code (called from the ARM reset exception vector) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 19 | * |
| 20 | * do important init only if we don't start from memory! |
| 21 | * relocate armboot to ram |
| 22 | * setup stack |
| 23 | * jump to second stage |
| 24 | * |
| 25 | ************************************************************************* |
| 26 | */ |
| 27 | |
Albert ARIBAUD | 9852cc6 | 2014-04-15 16:13:51 +0200 | [diff] [blame] | 28 | .globl reset |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 29 | |
Albert ARIBAUD | 9852cc6 | 2014-04-15 16:13:51 +0200 | [diff] [blame] | 30 | reset: |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 31 | /* |
| 32 | * set the cpu to SVC32 mode |
| 33 | */ |
kevin.morfitt@fearnside-systems.co.uk | d1cacc7 | 2009-10-10 13:30:22 +0900 | [diff] [blame] | 34 | mrs r0, cpsr |
| 35 | bic r0, r0, #0x1f |
| 36 | orr r0, r0, #0xd3 |
| 37 | msr cpsr, r0 |
Peter Pearse | 782cf16 | 2007-09-05 16:04:41 +0100 | [diff] [blame] | 38 | |
Jean-Christophe PLAGNIOL-VILLARD | 06f3496 | 2008-11-30 19:36:50 +0100 | [diff] [blame] | 39 | #if defined(CONFIG_AT91RM9200DK) || defined(CONFIG_AT91RM9200EK) |
Peter Pearse | de5b02c | 2007-08-14 10:10:52 +0100 | [diff] [blame] | 40 | /* |
Peter Pearse | 782cf16 | 2007-09-05 16:04:41 +0100 | [diff] [blame] | 41 | * relocate exception table |
Peter Pearse | de5b02c | 2007-08-14 10:10:52 +0100 | [diff] [blame] | 42 | */ |
| 43 | ldr r0, =_start |
| 44 | ldr r1, =0x0 |
| 45 | mov r2, #16 |
| 46 | copyex: |
| 47 | subs r2, r2, #1 |
| 48 | ldr r3, [r0], #4 |
| 49 | str r3, [r1], #4 |
| 50 | bne copyex |
| 51 | #endif |
| 52 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 53 | /* |
| 54 | * we do sys-critical inits only at reboot, |
| 55 | * not when booting from ram! |
| 56 | */ |
wdenk | 3d3d99f | 2005-04-04 12:44:11 +0000 | [diff] [blame] | 57 | #ifndef CONFIG_SKIP_LOWLEVEL_INIT |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 58 | bl cpu_init_crit |
| 59 | #endif |
| 60 | |
Albert ARIBAUD | facdae5 | 2013-01-08 10:18:02 +0000 | [diff] [blame] | 61 | bl _main |
Heiko Schocher | 271a240 | 2010-09-17 13:10:43 +0200 | [diff] [blame] | 62 | |
| 63 | /*------------------------------------------------------------------------------*/ |
| 64 | |
Albert ARIBAUD | facdae5 | 2013-01-08 10:18:02 +0000 | [diff] [blame] | 65 | .globl c_runtime_cpu_setup |
| 66 | c_runtime_cpu_setup: |
| 67 | |
| 68 | mov pc, lr |
| 69 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 70 | /* |
| 71 | ************************************************************************* |
| 72 | * |
| 73 | * CPU_init_critical registers |
| 74 | * |
| 75 | * setup important registers |
| 76 | * setup memory timing |
| 77 | * |
| 78 | ************************************************************************* |
| 79 | */ |
| 80 | |
| 81 | |
Wolfgang Denk | f2e11a7 | 2006-04-03 15:46:10 +0200 | [diff] [blame] | 82 | #ifndef CONFIG_SKIP_LOWLEVEL_INIT |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 83 | cpu_init_crit: |
| 84 | /* |
| 85 | * flush v4 I/D caches |
| 86 | */ |
| 87 | mov r0, #0 |
| 88 | mcr p15, 0, r0, c7, c7, 0 /* flush v3/v4 cache */ |
| 89 | mcr p15, 0, r0, c8, c7, 0 /* flush v4 TLB */ |
| 90 | |
| 91 | /* |
| 92 | * disable MMU stuff and caches |
| 93 | */ |
| 94 | mrc p15, 0, r0, c1, c0, 0 |
| 95 | bic r0, r0, #0x00002300 @ clear bits 13, 9:8 (--V- --RS) |
| 96 | bic r0, r0, #0x00000087 @ clear bits 7, 2:0 (B--- -CAM) |
Yuichiro Goto | 8d4b7e9 | 2016-02-25 10:23:34 +0900 | [diff] [blame] | 97 | orr r0, r0, #0x00000002 @ set bit 1 (A) Align |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 98 | orr r0, r0, #0x00001000 @ set bit 12 (I) I-Cache |
| 99 | mcr p15, 0, r0, c1, c0, 0 |
| 100 | |
Simon Glass | 9084407 | 2016-05-05 07:28:06 -0600 | [diff] [blame] | 101 | #ifndef CONFIG_SKIP_LOWLEVEL_INIT_ONLY |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 102 | /* |
| 103 | * before relocating, we have to setup RAM timing |
| 104 | * because memory timing is board-dependend, you will |
wdenk | 336b2bc | 2005-04-02 23:52:25 +0000 | [diff] [blame] | 105 | * find a lowlevel_init.S in your board directory. |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 106 | */ |
| 107 | mov ip, lr |
Peter Pearse | de5b02c | 2007-08-14 10:10:52 +0100 | [diff] [blame] | 108 | |
wdenk | 336b2bc | 2005-04-02 23:52:25 +0000 | [diff] [blame] | 109 | bl lowlevel_init |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 110 | mov lr, ip |
Simon Glass | 9084407 | 2016-05-05 07:28:06 -0600 | [diff] [blame] | 111 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 112 | mov pc, lr |
Wolfgang Denk | f2e11a7 | 2006-04-03 15:46:10 +0200 | [diff] [blame] | 113 | #endif /* CONFIG_SKIP_LOWLEVEL_INIT */ |