Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

rdimon-aem.S @ 679

Last change on this file since 679 was 444, checked in by satin@…, 6 years ago
add newlib,libalmos-mkh, restructure shared_syscalls.h and mini-libc
File size: 18.6 KB

Line
1	/* Copyright (c) 2005-2013 ARM Ltd. All rights reserved.
2
3	Redistribution and use in source and binary forms, with or without
4	modification, are permitted provided that the following conditions
5	are met:
6	1. Redistributions of source code must retain the above copyright
7	notice, this list of conditions and the following disclaimer.
8	2. Redistributions in binary form must reproduce the above copyright
9	notice, this list of conditions and the following disclaimer in the
10	documentation and/or other materials provided with the distribution.
11	3. The name of the company may not be used to endorse or promote
12	products derived from this software without specific prior written
13	permission.
14
15	THIS SOFTWARE IS PROVIDED BY ARM LTD ``AS IS'' AND ANY EXPRESS OR IMPLIED
16	WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
17	MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18	IN NO EVENT SHALL ARM LTD BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
19	SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
20	TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
21	PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
22	LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
23	NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
24	SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */
25
26	/* This file gives a basic initialisation of a Cortex-A series core. It is
27	the bare minimum required to get Cortex-A core running with a semihosting
28	interface.
29
30	It sets up a basic 1:1 phsyical address to virtual address mapping;
31	turns the MMU on; enables branch prediction; activates any integrated
32	caches; enables the Advanced SIMD and VFP co-processors; and installs
33	basic exception handlers.
34
35	It does not handle peripherals, and assumes all memory is Normal.
36
37	It does not change processor state from the startup privilege and security
38	level.
39
40	This has only been tested to work in ARM state.
41
42	By default it assumes exception vectors are located from address 0.
43	However, if this is not true they can be moved by defining the
44	_rdimon_vector_base symbol. For example if you have HIVECS enabled you
45	may pass --defsym _rdimon_vector_base=0xffff0000 on the linker command
46	line. */
47
48	/* __ARM_ARCH_PROFILE is defined from GCC 4.8 onwards, however __ARM_ARCH_7A
49	has been defined since 4.2 onwards, which is when v7-a support was added
50	and hence 'A' profile support was added in the compiler. Allow for this
51	file to be built with older compilers. */
52	#if defined(__ARM_ARCH_7A__) \|\| (__ARM_ARCH_PROFILE == 'A')
53	.syntax unified
54	.arch armv7-a
55	.arm
56
57	@ CPU Initialisation
58	.globl _rdimon_hw_init_hook
59	.type _rdimon_hw_init_hook, %function
60
61	_rdimon_hw_init_hook:
62	@ Only run the code on CPU 0 - otherwise spin
63	mrc 15, 0, r4, cr0, cr0, 5 @ Read MPIDR
64	ands r4, r4, #15
65	spin:
66	bne spin
67
68	mov r10, lr @ Save LR for final return
69
70	#ifdef __ARMEB__
71	@ Setup for Big Endian
72	setend be
73	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
74	orr r4, r4, #(1<<25) @ Switch to Big Endian (Set SCTLR.EE)
75	mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
76	#else
77	@ Setup for Little Endian
78	setend le
79	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
80	bic r4, r4, #(1<<25) @ Switch to LE (unset SCTLR.EE)
81	mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
82	#endif
83
84	bl is_a15_a7
85
86	@ For Cortex-A15 and Cortex-A7 only:
87	@ Write zero into the ACTLR to turn everything on.
88	itt eq
89	moveq r4, #0
90	mcreq 15, 0, r4, c1, c0, 1
91	isb
92
93	@ For Cortex-A15 and Cortex-A7 only:
94	@ Set ACTLR:SMP bit before enabling the caches and MMU,
95	@ or performing any cache and TLB maintenance operations.
96	ittt eq
97	mrceq 15, 0, r4, c1, c0, 1 @ Read ACTLR
98	orreq r4, r4, #(1<<6) @ Enable ACTLR:SMP
99	mcreq 15, 0, r4, c1, c0, 1 @ Write ACTLR
100	isb
101
102	@ Setup for exceptions being taken to Thumb/ARM state
103	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
104	#if defined(__thumb__)
105	orr r4, r4, #(1 << 30) @ Enable SCTLR.TE
106	#else
107	bic r4, r4, #(1 << 30) @ Disable SCTLR.TE
108	#endif
109	mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
110
111	bl __reset_caches
112
113	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
114	orr r4, r4, #(1<<22) @ Enable unaligned mode
115	bic r4, r4, #2 @ Disable alignment faults
116	bic r4, r4, #1 @ Disable MMU
117	mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
118
119	mov r4, #0
120	mcr 15, 0, r4, cr8, cr7, 0 @ Write TLBIALL - Invaliidate unified
121	@ TLB
122	@ Setup MMU Primary table P=V mapping.
123	mvn r4, #0
124	mcr 15, 0, r4, cr3, cr0, 0 @ Write DACR
125
126	mov r4, #0 @ Always use TTBR0, no LPAE
127	mcr 15, 0, r4, cr2, cr0, 2 @ Write TTBCR
128	adr r4, page_table_addr @ Load the base for vectors
129	ldr r4, [r4]
130	mrc p15, 0, r0, c0, c0, 5 @ read MPIDR
131	tst r0, #0x80000000 @ bis[31]
132	@ Set page table flags - there are two page table flag formats for the
133	@ architecture. For systems without multiprocessor extensions we use 0x1
134	@ which is Inner cacheable/Outer non-cacheable. For systems with
135	@ multiprocessor extensions we use 0x59 which is Inner/Outer write-back,
136	@ no write-allocate, and cacheable. See the ARMARM-v7AR for more details.
137	it ne
138	addne r4, r4, #0x58
139	add r4, r4, #1
140
141	mcr 15, 0, r4, cr2, cr0, 0 @ Write TTBR0
142
143	mov r0, #34 @ 0x22 @ TR0 and TR1 - normal memory
144	orr r0, r0, #(1 << 19) @ Shareable
145	mcr 15, 0, r0, cr10, cr2, 0 @ Write PRRR
146	movw r0, #0x33
147	movt r0, #0x33
148	mcr 15, 0, r0, cr10, cr2, 1 @ Write NMRR
149	mrc 15, 0, r0, cr1, cr0, 0 @ Read SCTLR
150	bic r0, r0, #(1 << 28) @ Clear TRE bit
151	mcr 15, 0, r0, cr1, cr0, 0 @ Write SCTLR
152
153	@ Now install the vector code - we move the Vector code from where it is
154	@ in the image to be based at _rdimon_vector_base. We have to do this copy
155	@ as the code is all PC-relative. We actually cheat and do a BX <reg> so
156	@ that we are at a known address relatively quickly and have to move as
157	@ little code as possible.
158	mov r7, #(VectorCode_Limit - VectorCode)
159	adr r5, VectorCode
160	adr r6, vector_base_addr @ Load the base for vectors
161	ldr r6, [r6]
162
163	copy_loop: @ Do the copy
164	ldr r4, [r5], #4
165	str r4, [r6], #4
166	subs r7, r7, #4
167	bne copy_loop
168
169	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
170	bic r4, r4, #0x1000 @ Disable I Cache
171	bic r4, r4, #4 @ Disable D Cache
172	orr r4, r4, #1 @ Enable MMU
173	bic r4, r4, #(1 << 28) @ Clear TRE bit
174	mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
175	mrc 15, 0, r4, cr1, cr0, 2 @ Read CPACR
176	orr r4, r4, #0x00f00000 @ Turn on VFP Co-procs
177	bic r4, r4, #0x80000000 @ Clear ASEDIS bit
178	mcr 15, 0, r4, cr1, cr0, 2 @ Write CPACR
179	isb
180	mov r4, #0
181	mcr 15, 0, r4, cr7, cr5, 4 @ Flush prefetch buffer
182	mrc 15, 0, r4, cr1, cr0, 2 @ Read CPACR
183	ubfx r4, r4, #20, #4 @ Extract bits [20, 23)
184	cmp r4, #0xf @ If not all set then the CPU does not
185	itt eq @ have FP or Advanced SIMD.
186	moveq r4, #0x40000000 @ Enable FP and Advanced SIMD
187	mcreq 10, 7, r4, cr8, cr0, 0 @ vmsr fpexc, r4
188	skip_vfp_enable:
189	bl __enable_caches @ Turn caches on
190	bx r10 @ Return to CRT startup routine
191
192	@ This enable us to be more precise about which caches we want
193	init_cpu_client_enable_dcache:
194	init_cpu_client_enable_icache:
195	mov r0, #1
196	bx lr
197
198	vector_base_addr:
199	.word _rdimon_vector_base
200	.weak _rdimon_vector_base
201	page_table_addr:
202	.word page_tables
203
204	@ Vector code - must be PIC and in ARM state.
205	VectorCode:
206	b vector_reset
207	b vector_undef
208	b vector_swi
209	b vector_prefetch
210	b vector_dataabt
211	b vector_reserved
212	b vector_irq
213	b vector_fiq
214
215	vector_reset:
216	adr sp, vector_sp_base
217	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
218	mov r4, #0
219	b vector_common
220	vector_undef:
221	adr sp, vector_sp_base
222	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
223	mov r4, #1
224	b vector_common
225	vector_swi:
226	adr sp, vector_sp_base
227	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
228	mov r4, #2
229	b vector_common
230	vector_prefetch:
231	adr sp, vector_sp_base
232	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
233	mov r4, #3
234	b vector_common
235	vector_dataabt:
236	adr sp, vector_sp_base
237	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
238	mov r4, #4
239	b vector_common
240	vector_reserved:
241	adr sp, vector_sp_base
242	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
243	mov r4, #5
244	b vector_common
245	vector_irq:
246	adr sp, vector_sp_base
247	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
248	mov r4, #6
249	b vector_common
250	vector_fiq:
251	adr sp, vector_sp_base
252	push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
253	mov r4, #7
254	b vector_common
255	vector_common:
256	adr r1, vector_common_adr @ Find where we're going to
257	ldr r1, [r1]
258	bx r1 @ And branch there
259	vector_common_adr:
260	.word vector_common_2 @ Common handling code
261
262	@ Vector stack
263	.p2align 3 @ Align to 8 byte boundary boundary to
264	@ keep ABI compatibility
265	.fill 32, 4, 0 @ 32-entry stack is enough for vector
266	@ handlers.
267	vector_sp_base:
268	VectorCode_Limit:
269	@ End of PIC code for vectors
270
271	@ Common Handling of vectors
272	.type vector_common_2, %function
273	vector_common_2:
274	mrs r1, APSR
275	mrs r2, SPSR
276	push {r1, r2} @ Save PSRs
277
278	@ Output the vector we have caught
279	bl out_nl
280	adr r0, which_vector
281	bl out_string
282	adr r0, vector_names
283	mov r1, #11
284	mla r0, r4, r1, r0
285	bl out_string
286	bl out_nl
287
288	@ Dump the registers
289	adrl r6, register_names
290	mov r7, #0
291	dump_r_loop:
292	mov r0, r6
293	bl out_string
294	add r6, r6, #6
295	ldr r0, [sp, r7, lsl #2]
296	bl out_word
297	bl out_nl
298	add r7, r7, #1
299	cmp r7, #16
300	blt dump_r_loop
301	adr r0, end
302	bl out_string
303
304	@ And exit
305	mov r0, #24
306	orr r1, r4, #0x20000
307	svc 0x00123456
308
309	@ Output the string in r0
310	out_string:
311	push {lr}
312	mov r1, r0
313	mov r0, #4
314	svc 0x00123456
315	pop {pc}
316
317	@ Output a New-line
318	out_nl:
319	mov r0, #10
320	@ Fallthrough
321
322	@ Output the character in r0
323	out_char:
324	push {lr}
325	strb r0, [sp, #-4]!
326	mov r0, #3
327	mov r1, sp
328	svc 0x00123456
329	add sp, sp, #4
330	pop {pc}
331
332	@ Output the value of r0 as a hex-word
333	out_word:
334	push {r4, r5, r6, lr}
335	mov r4, r0
336	mov r5, #28
337	adr r6, hexchars
338	word_loop:
339	lsr r0, r4, r5
340	and r0, r0, #15
341	ldrb r0, [r6, r0]
342	bl out_char
343	subs r5, r5, #4
344	bpl word_loop
345	pop {r4, r5, r6, pc}
346
347	hexchars:
348	.ascii "0123456789abcdef"
349
350	which_vector:
351	.asciz "Hit vector:"
352	end:
353	.asciz "End.\n"
354
355	vector_names:
356	.asciz "reset "
357	.asciz "undef "
358	.asciz "swi "
359	.asciz "prefetch "
360	.asciz "data abort"
361	.asciz "reserved "
362	.asciz "irq "
363	.asciz "fiq "
364
365	register_names:
366	.asciz "apsr "
367	.asciz "spsr "
368	.asciz "r0 "
369	.asciz "r1 "
370	.asciz "r2 "
371	.asciz "r3 "
372	.asciz "r4 "
373	.asciz "r5 "
374	.asciz "r6 "
375	.asciz "r7 "
376	.asciz "r8 "
377	.asciz "r9 "
378	.asciz "r10 "
379	.asciz "r11 "
380	.asciz "r12 "
381	.asciz "r14 "
382
383	.p2align 3
384
385
386	@ Enable the caches
387	__enable_caches:
388	mov r0, #0
389	mcr 15, 0, r0, cr8, cr7, 0 @ Invalidate all unified-TLB
390	mov r0, #0
391	mcr 15, 0, r0, cr7, cr5, 6 @ Invalidate branch predictor
392	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
393	orr r4, r4, #0x800 @ Enable branch predictor
394	mcr 15, 0, r4, cr1, cr0, 0 @ Set SCTLR
395	mov r5, lr @ Save LR as we're going to BL
396	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
397	bl init_cpu_client_enable_icache
398	cmp r0, #0
399	it ne
400	orrne r4, r4, #0x1000 @ Enable I-Cache
401	bl init_cpu_client_enable_dcache
402	cmp r0, #0
403	it ne
404	orrne r4, r4, #4
405	mcr 15, 0, r4, cr1, cr0, 0 @ Enable D-Cache
406	bx r5 @ Return
407
408	__reset_caches:
409	mov ip, lr @ Save LR
410	mov r0, #0
411	mcr 15, 0, r0, cr7, cr5, 6 @ Invalidate branch predictor
412	mrc 15, 0, r6, cr1, cr0, 0 @ Read SCTLR
413	mrc 15, 0, r0, cr1, cr0, 0 @ Read SCTLR!
414	bic r0, r0, #0x1000 @ Disable I cache
415	mcr 15, 0, r0, cr1, cr0, 0 @ Write SCTLR
416	mrc 15, 1, r0, cr0, cr0, 1 @ Read CLIDR
417	tst r0, #3 @ Harvard Cache?
418	mov r0, #0
419	it ne
420	mcrne 15, 0, r0, cr7, cr5, 0 @ Invalidate Instruction Cache?
421
422	mrc 15, 0, r1, cr1, cr0, 0 @ Read SCTLR (again!)
423	orr r1, r1, #0x800 @ Enable branch predictor
424
425	@ If we're not enabling caches we have
426	@ no more work to do.
427	bl init_cpu_client_enable_icache
428	cmp r0, #0
429	it ne
430	orrne r1, r1, #0x1000 @ Enable I-Cache now -
431	@ We actually only do this if we have a
432	@ Harvard style cache.
433	it eq
434	bleq init_cpu_client_enable_dcache
435	itt eq
436	cmpeq r0, #0
437	beq Finished1
438
439	mcr 15, 0, r1, cr1, cr0, 0 @ Write SCTLR (turn on Branch predictor & I-cache)
440
441	mrc 15, 1, r0, cr0, cr0, 1 @ Read CLIDR
442	ands r3, r0, #0x7000000
443	lsr r3, r3, #23 @ Total cache levels << 1
444	beq Finished1
445
446	mov lr, #0 @ lr = cache level << 1
447	Loop11:
448	mrc 15, 1, r0, cr0, cr0, 1 @ Read CLIDR
449	add r2, lr, lr, lsr #1 @ r2 holds cache 'set' position
450	lsr r1, r0, r2 @ Bottom 3-bits are Ctype for this level
451	and r1, r1, #7 @ Get those 3-bits alone
452	cmp r1, #2
453	blt Skip1 @ No cache or only I-Cache at this level
454	mcr 15, 2, lr, cr0, cr0, 0 @ Write CSSELR
455	mov r1, #0
456	isb sy
457	mrc 15, 1, r1, cr0, cr0, 0 @ Read CCSIDR
458	and r2, r1, #7 @ Extract line length field
459	add r2, r2, #4 @ Add 4 for the line length offset (log2 16 bytes)
460	movw r0, #0x3ff
461	ands r0, r0, r1, lsr #3 @ r0 is the max number on the way size
462	clz r4, r0 @ r4 is the bit position of the way size increment
463	movw r5, #0x7fff
464	ands r5, r5, r1, lsr #13 @ r5 is the max number of the index size (right aligned)
465	Loop21:
466	mov r7, r0 @ r7 working copy of max way size
467	Loop31:
468	orr r1, lr, r7, lsl r4 @ factor in way number and cache number
469	orr r1, r1, r5, lsl r2 @ factor in set number
470	tst r6, #4 @ D-Cache on?
471	ite eq
472	mcreq 15, 0, r1, cr7, cr6, 2 @ No - invalidate by set/way
473	mcrne 15, 0, r1, cr7, cr14, 2 @ yes - clean + invalidate by set/way
474	subs r7, r7, #1 @ Decrement way number
475	bge Loop31
476	subs r5, r5, #1 @ Decrement set number
477	bge Loop21
478	Skip1:
479	add lr, lr, #2 @ increment cache number
480	cmp r3, lr
481	bgt Loop11
482	Finished1:
483	@ Now we know the caches are clean we can:
484	mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
485	bic r4, r4, #4 @ Disable D-Cache
486	mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
487	mov r4, #0
488	mcr 15, 0, r4, cr7, cr5, 6 @ Write BPIALL
489
490	bx ip @ Return
491
492	@ Set Z if this is a Cortex-A15 or Cortex_A7
493	@ Other flags corrupted
494	is_a15_a7:
495	mrc 15, 0, r8, c0, c0, 0
496	movw r9, #0xfff0
497	movt r9, #0xff0f
498	and r8, r8, r9
499	movw r9, #0xc0f0
500	movt r9, #0x410f
501	cmp r8, r9
502	movw r9, #0xc070
503	movt r9, #0x410f
504	it ne
505	cmpne r8, r9
506	bx lr
507
508	@ Descriptor type: Section
509	@ Bufferable: True
510	@ Cacheable: True
511	@ Execute Never: False
512	@ Domain: 0
513	@ Impl. Defined: 0
514	@ Access: 0/11 Full access
515	@ TEX: 001
516	@ Shareable: False
517	@ Not Global: False
518	@ Supersection: False
519	#define PT(X) \
520	.word X;
521	#define PT2(X) \
522	PT(X) PT(X + 0x100000) PT(X + 0x200000) PT(X + 0x300000)
523	#define PT3(X) \
524	PT2(X) PT2(X + 0x400000) PT2(X + 0x800000) PT2(X + 0xc00000)
525	#define PT4(X) \
526	PT3(X) PT3(X + 0x1000000) PT3(X + 0x2000000) PT3(X + 0x3000000)
527	#define PT5(X) \
528	PT4(X) PT4(X + 0x4000000) PT4(X + 0x8000000) PT4(X + 0xc000000)
529	#define PT6(X) \
530	PT5(X) PT5(X + 0x10000000) PT5(X + 0x20000000) PT5(X + 0x30000000)
531	#define PT7(X) \
532	PT6(X) PT6(X + 0x40000000) PT6(X + 0x80000000) PT6(X + 0xc0000000)
533
534	.section page_tables_section, "aw", %progbits
535	.p2align 14
536	page_tables:
537	PT7(0x1c0e)
538
539	#endif //#if defined(__ARM_ARCH_7A__) \|\| __ARM_ARCH_PROFILE == 'A'

Note: See TracBrowser for help on using the repository browser.

Download in other formats:

Original Format