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 | |
kevin.morfitt@fearnside-systems.co.uk | e0d8131 | 2009-11-17 18:30:34 +0900 | [diff] [blame] | 53 | #ifdef CONFIG_S3C24X0 |
Peter Pearse | 782cf16 | 2007-09-05 16:04:41 +0100 | [diff] [blame] | 54 | /* turn off the watchdog */ |
| 55 | |
| 56 | # if defined(CONFIG_S3C2400) |
kevin.morfitt@fearnside-systems.co.uk | d1cacc7 | 2009-10-10 13:30:22 +0900 | [diff] [blame] | 57 | # define pWTCON 0x15300000 |
Mike Williams | bf895ad | 2011-07-22 04:01:30 +0000 | [diff] [blame] | 58 | # define INTMSK 0x14400008 /* Interrupt-Controller base addresses */ |
Peter Pearse | 782cf16 | 2007-09-05 16:04:41 +0100 | [diff] [blame] | 59 | # define CLKDIVN 0x14800014 /* clock divisor register */ |
| 60 | #else |
kevin.morfitt@fearnside-systems.co.uk | d1cacc7 | 2009-10-10 13:30:22 +0900 | [diff] [blame] | 61 | # define pWTCON 0x53000000 |
Mike Williams | bf895ad | 2011-07-22 04:01:30 +0000 | [diff] [blame] | 62 | # define INTMSK 0x4A000008 /* Interrupt-Controller base addresses */ |
Peter Pearse | 782cf16 | 2007-09-05 16:04:41 +0100 | [diff] [blame] | 63 | # define INTSUBMSK 0x4A00001C |
| 64 | # define CLKDIVN 0x4C000014 /* clock divisor register */ |
| 65 | # endif |
| 66 | |
kevin.morfitt@fearnside-systems.co.uk | d1cacc7 | 2009-10-10 13:30:22 +0900 | [diff] [blame] | 67 | ldr r0, =pWTCON |
| 68 | mov r1, #0x0 |
| 69 | str r1, [r0] |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 70 | |
| 71 | /* |
| 72 | * mask all IRQs by setting all bits in the INTMR - default |
| 73 | */ |
| 74 | mov r1, #0xffffffff |
| 75 | ldr r0, =INTMSK |
| 76 | str r1, [r0] |
wdenk | 7ac1610 | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 77 | # if defined(CONFIG_S3C2410) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 78 | ldr r1, =0x3ff |
| 79 | ldr r0, =INTSUBMSK |
| 80 | str r1, [r0] |
wdenk | 7ac1610 | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 81 | # endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 82 | |
| 83 | /* FCLK:HCLK:PCLK = 1:2:4 */ |
| 84 | /* default FCLK is 120 MHz ! */ |
| 85 | ldr r0, =CLKDIVN |
| 86 | mov r1, #3 |
| 87 | str r1, [r0] |
kevin.morfitt@fearnside-systems.co.uk | e0d8131 | 2009-11-17 18:30:34 +0900 | [diff] [blame] | 88 | #endif /* CONFIG_S3C24X0 */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 89 | |
| 90 | /* |
| 91 | * we do sys-critical inits only at reboot, |
| 92 | * not when booting from ram! |
| 93 | */ |
wdenk | 3d3d99f | 2005-04-04 12:44:11 +0000 | [diff] [blame] | 94 | #ifndef CONFIG_SKIP_LOWLEVEL_INIT |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 95 | bl cpu_init_crit |
| 96 | #endif |
| 97 | |
Albert ARIBAUD | facdae5 | 2013-01-08 10:18:02 +0000 | [diff] [blame] | 98 | bl _main |
Heiko Schocher | 271a240 | 2010-09-17 13:10:43 +0200 | [diff] [blame] | 99 | |
| 100 | /*------------------------------------------------------------------------------*/ |
| 101 | |
Albert ARIBAUD | facdae5 | 2013-01-08 10:18:02 +0000 | [diff] [blame] | 102 | .globl c_runtime_cpu_setup |
| 103 | c_runtime_cpu_setup: |
| 104 | |
| 105 | mov pc, lr |
| 106 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 107 | /* |
| 108 | ************************************************************************* |
| 109 | * |
| 110 | * CPU_init_critical registers |
| 111 | * |
| 112 | * setup important registers |
| 113 | * setup memory timing |
| 114 | * |
| 115 | ************************************************************************* |
| 116 | */ |
| 117 | |
| 118 | |
Wolfgang Denk | f2e11a7 | 2006-04-03 15:46:10 +0200 | [diff] [blame] | 119 | #ifndef CONFIG_SKIP_LOWLEVEL_INIT |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 120 | cpu_init_crit: |
| 121 | /* |
| 122 | * flush v4 I/D caches |
| 123 | */ |
| 124 | mov r0, #0 |
| 125 | mcr p15, 0, r0, c7, c7, 0 /* flush v3/v4 cache */ |
| 126 | mcr p15, 0, r0, c8, c7, 0 /* flush v4 TLB */ |
| 127 | |
| 128 | /* |
| 129 | * disable MMU stuff and caches |
| 130 | */ |
| 131 | mrc p15, 0, r0, c1, c0, 0 |
| 132 | bic r0, r0, #0x00002300 @ clear bits 13, 9:8 (--V- --RS) |
| 133 | bic r0, r0, #0x00000087 @ clear bits 7, 2:0 (B--- -CAM) |
Yuichiro Goto | 8d4b7e9 | 2016-02-25 10:23:34 +0900 | [diff] [blame] | 134 | orr r0, r0, #0x00000002 @ set bit 1 (A) Align |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 135 | orr r0, r0, #0x00001000 @ set bit 12 (I) I-Cache |
| 136 | mcr p15, 0, r0, c1, c0, 0 |
| 137 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 138 | /* |
| 139 | * before relocating, we have to setup RAM timing |
| 140 | * because memory timing is board-dependend, you will |
wdenk | 336b2bc | 2005-04-02 23:52:25 +0000 | [diff] [blame] | 141 | * find a lowlevel_init.S in your board directory. |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 142 | */ |
| 143 | mov ip, lr |
Peter Pearse | de5b02c | 2007-08-14 10:10:52 +0100 | [diff] [blame] | 144 | |
wdenk | 336b2bc | 2005-04-02 23:52:25 +0000 | [diff] [blame] | 145 | bl lowlevel_init |
Ulf Samuelsson | 07f9b4e | 2009-03-27 23:26:43 +0100 | [diff] [blame] | 146 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 147 | mov lr, ip |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 148 | mov pc, lr |
Wolfgang Denk | f2e11a7 | 2006-04-03 15:46:10 +0200 | [diff] [blame] | 149 | #endif /* CONFIG_SKIP_LOWLEVEL_INIT */ |