blob: a74abf9a0979163e824785e9f28c70e68f4743bb [file] [log] [blame]
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +02001/**
2 * (C) Copyright 2005
3 * 2N Telekomunikace, Ladislav Michl <michl@2n.cz>
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * version 2.
8 *
9 * Image layout looks like following:
10 * u32 - size
11 * u32 - version
12 * ... - data
13 * u32 - crc32
14 */
15
Wolfgang Denk87a5c732006-07-21 11:38:33 +020016#include <config.h>
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +020017#include "crcek.h"
18
19/**
20 * do_crc32 - calculate CRC32 of given buffer
21 * r0 - crc
22 * r1 - pointer to buffer
23 * r2 - buffer len
24 */
25 .macro do_crc32
26 ldr r5, FFFFFFFF
27 eor r0, r0, r5
28 adr r3, CRC32_TABLE
291:
30 ldrb r4, [r1], #1
31 eor r4, r4, r0
32 and r4, r4, #0xff
33 ldr r4, [r3, r4, lsl#2]
34 eor r0, r4, r0, lsr#8
35 subs r2, r2, #0x1
36 bne 1b
37 eor r0, r0, r5
38 .endm
39
40 .macro crcuj, offset, size
41 mov r0, #0
42 ldr r1, \offset
Wolfgang Denk87a5c732006-07-21 11:38:33 +020043 ldr r2, [r1], #4
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +020044 cmp r2, r0 @ no data, no problem
45 beq 2f
46 tst r2, #3 @ unaligned size
47 bne 2f
48 ldr r3, \size
49 cmp r2, r3 @ bogus size
50 bhi 2f
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +020051 do_crc32
52 ldr r1, [r1]
532:
54 cmp r0, r1
55 .endm
56
57 .macro wait, reg
Wolfgang Denk87a5c732006-07-21 11:38:33 +020058 mov \reg, #0x100000
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +0200593:
60 subs \reg, \reg, #0x1
61 bne 3b
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +020062 .endm
Wolfgang Denk87a5c732006-07-21 11:38:33 +020063
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +020064.text
65.globl crcek
66crcek:
Wolfgang Denk87a5c732006-07-21 11:38:33 +020067 /* Enable I-cache */
68 mrc p15, 0, r1, c0, c0, 0 @ read C15 ID register
69 mrc p15, 0, r1, c0, c0, 1 @ read C15 Cache information register
70 mrc p15, 0, r1, c1, c0, 0 @ read C15 Control register
71 orr r1, r1, #0x1000 @ enable I-cache, map interrupt vector 0xffff0000
72 mcr p15, 0, r1, c1, c0, 0 @ write C15 Control register
73 mov r1, #0x00
74 mcr p15, 0, r1, c7, c5, 0 @ Flush I-cache
75 nop
76 nop
77 nop
78 nop
79
80 /* Setup clocking mode */
81 ldr r0, MPU_CLKM_BASE @ base of CLOCK unit
82 ldrh r1, [r0, #0x18] @ ARM_SYST - get reset status
83 bic r1, r1, #(7 << 11) @ clear clock select
84 orr r1, r1, #(2 << 11) @ set synchronous scalable
85 mov r2, #0
86loop:
87 cmp r2, #1 @ this loop will wait for at least 100 cycles
88 streqh r1, [r0, #0x18] @ before issuing next request from MPU
89 add r2, r2, #1 @ on the 1st run code is loaded into I-cache
90 cmp r2, #16 @ and second run will set clocking mode
91 bne loop
92 nop
93
94 /* Setup clock dividers */
95 ldr r1, CKCTL_VAL
96 orr r1, r1, #0x2000 @ enable DSP clock
97 strh r1, [r0] @ setup clock divisors
98
99 /* Setup DPLL to generate requested freq */
100 ldr r0, DPLL1_BASE @ base of DPLL1 register
101 mov r1, #0x0010 @ set PLL_ENABLE
102 orr r1, r1, #0x2000 @ set IOB to new locking
103 orr r1, r1, #(OMAP5910_DPLL_MUL << 7) @ setup multiplier CLKREF
104 orr r1, r1, #(OMAP5910_DPLL_DIV << 5) @ setup divider CLKREF
105 strh r1, [r0] @ write
106
107locking:
108 ldrh r1, [r0] @ get DPLL value
109 tst r1, #0x01
110 beq locking @ while LOCK not set
111
112 /* Enable clock */
113 ldr r0, MPU_CLKM_BASE @ base of CLOCK unit
114 mov r1, #(1 << 10) @ disable idle mode do not check
115 @ nWAKEUP pin, other remain active
Wolfgang Denkb9365a22006-07-21 11:56:05 +0200116 strh r1, [r0, #0x04]
Wolfgang Denk87a5c732006-07-21 11:38:33 +0200117 ldr r1, EN_CLK_VAL
118 strh r1, [r0, #0x08]
119 mov r1, #0x003f @ FLASH.RP not enabled in idle and
120 strh r1, [r0, #0x0c] @ max delayed ( 32 x CLKIN )
121
122
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +0200123 mov r6, #0
124 crcuj _LOADER1_OFFSET, _LOADER_SIZE
125 bne crc1_bad
126 orr r6, r6, #1
127crc1_bad:
128 crcuj _LOADER2_OFFSET, _LOADER_SIZE
129 bne crc2_bad
130 orr r6, r6, #2
131crc2_bad:
132 ldr r3, _LOADER1_OFFSET
133 ldr r4, _LOADER2_OFFSET
Wolfgang Denk87a5c732006-07-21 11:38:33 +0200134 teq r6, #3
135 bne one_is_bad @ one of them (or both) has bad crc
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +0200136 ldr r1, [r3, #4]
137 ldr r2, [r4, #4]
138 cmp r1, r2 @ boot 2nd loader if versions differ
139 beq boot_1st
140 b boot_2nd
141one_is_bad:
142 tst r6, #1
143 bne boot_1st
144 tst r6, #2
145 bne boot_2nd
146@ We are doomed, so let user know.
Wolfgang Denk87a5c732006-07-21 11:38:33 +0200147hell:
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +0200148 ldr r0, GPIO_BASE @ configure GPIO pins
149 ldr r1, GPIO_DIRECTION
150 strh r1, [r0, #0x08]
151blink_loop:
152 mov r1, #0x08
153 strh r1, [r0, #0x04]
154 wait r3
155 mov r1, #0x10
156 strh r1, [r0, #0x04]
157 wait r3
158 b blink_loop
159boot_1st:
160 add pc, r3, #8
161boot_2nd:
162 add pc, r4, #8
163
164_LOADER_SIZE:
165 .word LOADER_SIZE - 8 @ minus size and crc32
166_LOADER1_OFFSET:
167 .word LOADER1_OFFSET
168_LOADER2_OFFSET:
169 .word LOADER2_OFFSET
170
171FFFFFFFF:
172 .word 0xffffffff
173CRC32_TABLE:
174 .word 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419
175 .word 0x706af48f, 0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4
176 .word 0xe0d5e91e, 0x97d2d988, 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07
177 .word 0x90bf1d91, 0x1db71064, 0x6ab020f2, 0xf3b97148, 0x84be41de
178 .word 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7, 0x136c9856
179 .word 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, 0x14015c4f, 0x63066cd9
180 .word 0xfa0f3d63, 0x8d080df5, 0x3b6e20c8, 0x4c69105e, 0xd56041e4
181 .word 0xa2677172, 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b
182 .word 0x35b5a8fa, 0x42b2986c, 0xdbbbc9d6, 0xacbcf940, 0x32d86ce3
183 .word 0x45df5c75, 0xdcd60dcf, 0xabd13d59, 0x26d930ac, 0x51de003a
184 .word 0xc8d75180, 0xbfd06116, 0x21b4f4b5, 0x56b3c423, 0xcfba9599
185 .word 0xb8bda50f, 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924
186 .word 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, 0x76dc4190
187 .word 0x01db7106, 0x98d220bc, 0xefd5102a, 0x71b18589, 0x06b6b51f
188 .word 0x9fbfe4a5, 0xe8b8d433, 0x7807c9a2, 0x0f00f934, 0x9609a88e
189 .word 0xe10e9818, 0x7f6a0dbb, 0x086d3d2d, 0x91646c97, 0xe6635c01
190 .word 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e, 0x6c0695ed
191 .word 0x1b01a57b, 0x8208f4c1, 0xf50fc457, 0x65b0d9c6, 0x12b7e950
192 .word 0x8bbeb8ea, 0xfcb9887c, 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3
193 .word 0xfbd44c65, 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2
194 .word 0x4adfa541, 0x3dd895d7, 0xa4d1c46d, 0xd3d6f4fb, 0x4369e96a
195 .word 0x346ed9fc, 0xad678846, 0xda60b8d0, 0x44042d73, 0x33031de5
196 .word 0xaa0a4c5f, 0xdd0d7cc9, 0x5005713c, 0x270241aa, 0xbe0b1010
197 .word 0xc90c2086, 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f
198 .word 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, 0x59b33d17
199 .word 0x2eb40d81, 0xb7bd5c3b, 0xc0ba6cad, 0xedb88320, 0x9abfb3b6
200 .word 0x03b6e20c, 0x74b1d29a, 0xead54739, 0x9dd277af, 0x04db2615
201 .word 0x73dc1683, 0xe3630b12, 0x94643b84, 0x0d6d6a3e, 0x7a6a5aa8
202 .word 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1, 0xf00f9344
203 .word 0x8708a3d2, 0x1e01f268, 0x6906c2fe, 0xf762575d, 0x806567cb
204 .word 0x196c3671, 0x6e6b06e7, 0xfed41b76, 0x89d32be0, 0x10da7a5a
205 .word 0x67dd4acc, 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5
206 .word 0xd6d6a3e8, 0xa1d1937e, 0x38d8c2c4, 0x4fdff252, 0xd1bb67f1
207 .word 0xa6bc5767, 0x3fb506dd, 0x48b2364b, 0xd80d2bda, 0xaf0a1b4c
208 .word 0x36034af6, 0x41047a60, 0xdf60efc3, 0xa867df55, 0x316e8eef
209 .word 0x4669be79, 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236
210 .word 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, 0xc5ba3bbe
211 .word 0xb2bd0b28, 0x2bb45a92, 0x5cb36a04, 0xc2d7ffa7, 0xb5d0cf31
212 .word 0x2cd99e8b, 0x5bdeae1d, 0x9b64c2b0, 0xec63f226, 0x756aa39c
213 .word 0x026d930a, 0x9c0906a9, 0xeb0e363f, 0x72076785, 0x05005713
214 .word 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38, 0x92d28e9b
215 .word 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, 0x86d3d2d4, 0xf1d4e242
216 .word 0x68ddb3f8, 0x1fda836e, 0x81be16cd, 0xf6b9265b, 0x6fb077e1
217 .word 0x18b74777, 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c
218 .word 0x8f659eff, 0xf862ae69, 0x616bffd3, 0x166ccf45, 0xa00ae278
219 .word 0xd70dd2ee, 0x4e048354, 0x3903b3c2, 0xa7672661, 0xd06016f7
220 .word 0x4969474d, 0x3e6e77db, 0xaed16a4a, 0xd9d65adc, 0x40df0b66
221 .word 0x37d83bf0, 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9
222 .word 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, 0xbad03605
223 .word 0xcdd70693, 0x54de5729, 0x23d967bf, 0xb3667a2e, 0xc4614ab8
224 .word 0x5d681b02, 0x2a6f2b94, 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b
225 .word 0x2d02ef8d
226
227GPIO_BASE:
228 .word 0xfffce000
Wolfgang Denk87a5c732006-07-21 11:38:33 +0200229MPU_CLKM_BASE:
230 .word 0xfffece00
231DPLL1_BASE:
232 .word 0xfffecf00
233
234CKCTL_VAL:
235 .word OMAP5910_ARM_CKCTL
236EN_CLK_VAL:
237 .word OMAP5910_ARM_EN_CLK
Wolfgang Denkac7eb8a32005-09-14 23:53:32 +0200238GPIO_DIRECTION:
239 .word 0x0000ffe7
240
241.end