1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
|
/*
* boot.S - simple register setup code for stand-alone Linux booting
*
* Copyright (C) 2011 ARM Limited. All rights reserved.
*
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE.txt file.
*/
.syntax unified
.arch_extension sec
.arch_extension virt
.text
#ifdef SEMIHOSTING
@ Helper definitions and macros for semihosting
SYS_OPEN = 0x01
SYS_CLOSE = 0x02
SYS_WRITE0 = 0x04
SYS_READ = 0x06
SYS_FLEN = 0x0C
SYS_GET_CMDLINE = 0x15
SYS_REPORTEXC = 0x18
.macro semihost what
@ Make a semihosting call. Note that on return r0 is always
@ either the return value or is trashed.
mov r0, \what
#if defined(MACH_MPS)
@ M profile semihosting is via bpkt
bkpt 0xab
#elif defined(__thumb__)
@ Otherwise, different SVC numbers for ARM or Thumb mode
svc 0xab
#else
svc 0x123456
#endif
.endm
.macro exit
@ Exit via semihosting call
@ REASON_APP_EXIT = 0x20026
mov r1, 0x20000
orr r1, r1, 0x26
semihost SYS_REPORTEXC
@ This point is never reached.
.endm
.macro fail string
@ Print the message pointed to by string out via semihosting,
@ and then exit.
ldr r1, =\string
semihost SYS_WRITE0
exit
.endm
#endif
.globl _start
_start:
#ifdef SMP
#ifdef VEXPRESS
@
@ Program architected timer frequency
@
mrc p15, 0, r0, c0, c1, 1 @ CPUID_EXT_PFR1
lsr r0, r0, #16
and r0, r0, #1 @ Check generic timer support
beq 1f
ldr r0, =24000000 @ 24MHz timer frequency
mcr p15, 0, r0, c14, c0, 0 @ CNTFRQ
1:
#endif
@
@ CPU initialisation
@
mrc p15, 0, r4, c0, c0, 5 @ MPIDR (ARMv7 only)
and r4, r4, #15 @ CPU number
@
@ Hypervisor / TrustZone initialization
@
@ Set all interrupts to be non-secure
ldr r0, =0x2c001000 @ Dist GIC base
ldr r1, [r0, #0x04] @ Type Register
cmp r4, #0
andeq r1, r1, #0x1f
movne r1, #0
add r2, r0, #0x080 @ Security Register 0
mvn r3, #0
2: str r3, [r2]
sub r1, r1, #1
add r2, r2, #4 @ Next security register
cmp r1, #-1
bne 2b
@ Set GIC priority mask bit [7] = 1
ldr r0, =0x2c002000 @ CPU GIC base
mov r1, #0x80
str r1, [r0, #0x4] @ GIC ICCPMR
@ Set NSACR to allow coprocessor access from non-secure
mrc p15, 0, r0, c1, c1, 2
ldr r1, =0x43fff
orr r0, r0, r1
mcr p15, 0, r0, c1, c1, 2
@ Leave monitor.S trap in place for the transition...
mov r0, #0xf0000000
mcr p15, 0, r0, c12, c0, 1 @ Monitor vector base address
@ Set up hvbar so hvc comes back here.
ldr r0, =vectors
mov r7, #0xfffffff0
smc #0 @ Set HVBAR
@ We can't call hvc from secure mode, so drop down first.
mov r7, #0xffffffff
smc #0 @ Change to NS-mode
@ This is how we enter hyp mode, for booting the next stage.
hvc #0
/* Once we get rid of monitor.S, use these smc vectors too! */
vectors:
.word 0 /* reset */
.word 0 /* undef */
.word 0 /* svc */
.word 0 /* pabt */
.word 0 /* dabt */
b into_hyp_mode /* hvc */
.word 0 /* irq */
.word 0 /* fiq */
into_hyp_mode:
@ Check CPU nr again
mrc p15, 0, r0, c0, c0, 5 @ MPIDR (ARMv7 only)
and r0, r0, #15 @ CPU number
cmp r0, #0 @ primary CPU?
beq 2f
@
@ Secondary CPUs (following the RealView SMP booting protocol)
@
ldr r1, =filesystem - 0x100
adr r2, 1f
ldmia r2, {r3 - r7} @ move the code to a location
stmia r1, {r3 - r7} @ less likely to be overridden
#ifdef VEXPRESS
ldr r0, =0x1c010030 @ VE SYS_FLAGS register
#else
ldr r0, =0x10000030 @ RealView SYS_FLAGS register
#endif
mov pc, r1 @ branch to the relocated code
1:
#ifdef VEXPRESS
wfe
#endif
ldr r1, [r0]
cmp r1, #0
beq 1b
mov pc, r1 @ branch to the given address
#endif
2:
@
@ UART initialisation (38400 8N1)
@
#ifdef MACH_MPS
ldr r0, =0x1f005000 @ UART3 base (MPS)
#elif defined (VEXPRESS)
ldr r0, =0x1c090000 @ UART base (Versatile Express)
#else
ldr r0, =0x10009000 @ UART base (RealView/EB)
#endif
mov r1, #0x10 @ ibrd
str r1, [r0, #0x24]
mov r1, #0xc300
orr r1, #0x0001 @ cr
str r1, [r0, #0x30]
#ifdef SEMIHOSTING
@
@ Get kernel, initrd, command line via semihosting
@
mov r0, SYS_GET_CMDLINE
ldr r1, =semiblk
ldr r2, =sh_cmdline
str r2, [r1]
@ We have huge amounts of space between us and where we're
@ going to put the kernel, so we can allow for an enormous
@ command line length.
mov r3, 0x2000
str r3, [r1, #4]
semihost SYS_GET_CMDLINE
cmp r0, 0
bne 1f
ldr r3, [r1, #4]
cmp r3, 0x2000
blt 2f
1:
@ Failed to get command line, or truncated
fail get_cmd_failed
2:
@ That gives us one big NUL terminated string.
@ We expect:
@ --kernel kernelfilename
@ --initrd initrdfilename
@ --
@ and the remainder of the string is kernel args
@ r2 is still the command line here
1:
@ Skip any leading whitespace, stop if we hit the end
ldrb r0, [r2]
cmp r0, 32
bne 2f
add r2, r2, 1
b 1b
2:
cmp r0, 0
bne 3f
@ If we hit the end of the string before '--' it's invalid
fail bad_cmd_line
3:
ldr r1, =dashdashkernel
bl matchword
cmp r0, 0
beq 2f
@ found --kernel, r2 points at next word
@ load at offset -0x40 to allow for uImage header
ldr r1, =kernel
sub r1, r1, 0x40
bl loadfile
b 1b
2:
adr r1, dashdashinitrd
bl matchword
cmp r0, 0
beq 2f
@ found --initrd, r2 points at next word
ldr r1, =filesystem
bl loadfile
@ now r3 is length of the initrd, fix up our ATAGS
ldr r1, =atag_initrd_sz
str r3, [r1]
b 1b
2:
adr r1, dashdash
bl matchword
cmp r0, 0
beq 2f
@ found --, r2 points at next word
@ handle rest of string (if any) as kernel args
@ If we didn't have an initrd, write the ATAG_CMDLINE
@ over the top of the ATAG_INITRD2
ldr r0, =atag_cmdline
ldr r4, [r0, #4] @ ATAG_CMDLINE magic number
ldr r1, =atag_initrd_sz
ldr r1, [r1]
cmp r1, 0
itt eq
ldreq r0, =atag_initrd
streq r4, [r0, #4]
add r3, r0, #8
@ copy string from r2 to r3
1: ldrb r1, [r2],#1
strb r1, [r3],#1
cmp r1, 0
bne 1b
@ zero-pad to word boundary
1: tst r3, #3
beq 1f
strb r1, [r3],#1
b 1b
1: @ now write the length word
sub r4, r3, r0
lsr r4, r4, #2
str r4, [r0]
@ and terminate the ATAGS list with an ATAG_NONE node
str r1, [r3, #0]
str r1, [r3, #4]
b run_kernel
2:
@ unrecognised option
fail bad_cmd_line
matchword:
@ Subroutine: if the first word (up to space or end)
@ in the string r2 matches the word pointed at by r1
@ then return with r0 != 0 and r2 pointing at the
@ space/end. Otherwise return with r0 = 0, r2 unchanged.
mov r3, r2
1:
ldrb r0, [r2]
ldrb r4, [r1]
cmp r4, 0
beq 1f
cmp r4, r0
bne matchfail
add r2, r2, 1
add r1, r1, 1
b 1b
1:
@ end of matched string, is r2 at end of word?
cmp r0, 32
itt ne
cmpne r0, 0
bne matchfail
@ Success
mov r0, 1
bx lr
1: @ not end of string, match?
matchfail:
mov r2, r3
mov r0, 0
bx lr
loadfile:
@ Subroutine: r2 points to a filename argument (possibly with
@ leading spaces, space or NUL terminated), r1 is the address
@ to load it at. Load the file via semihosting to the
@ specified address. On exit r2 points to the space/NUL
@ after the filename, and r3 is the length of the file in bytes
@ We modify the filename string in place, temporarily
mov r5, r1
adr r1, loading_str
semihost SYS_WRITE0
@ skip leading spaces
1: ldrb r0, [r2]
cmp r0, 32
bne 1f
add r2, r2, 1
b 1b
1: mov r3, r2
@ advance until next space or NUL
1: ldrb r0, [r2]
cmp r0, 32
ite ne
cmpne r0, 0
beq 1f
add r2, r2, 1
b 1b
1: @ filename is r3 to r2, save terminating byte and nul terminate
mov r4, r0
mov r0, 0
strb r0, [r2]
mov r1, r3
semihost SYS_WRITE0
adr r1, colonspace_str
semihost SYS_WRITE0
adr r1, semiblk
str r3, [r1] @ filename
mov r0, 1
str r0, [r1, #4] @ file mode: "rb"
subs r0, r2, r3
bne 1f
fail nofilename
1: str r0, [r1, #8] @ file name length
semihost SYS_OPEN
cmp r0, -1
bne 1f
fail openfailed
1: @ now we can restore the terminating byte
strb r4, [r2]
mov r4, r0
str r0, [r1] @ filehandle
semihost SYS_FLEN
cmp r0, -1
bne 1f
fail flenfailed
1: adr r1, semiblk
mov r3, r0
str r4, [r1] @ filehandle
str r5, [r1, #4] @ buffer
str r0, [r1, #8] @ length
semihost SYS_READ
cmp r0, 0
beq 1f
fail readfailed
1: adr r1, semiblk
str r4, [r1]
semihost SYS_CLOSE
cmp r0, 0
beq 1f
fail closefailed
1: @ Success! r2 is pointing to the space/NUL after the filename,
@ r3 is the length of the file in bytes
adr r1, ok_str
semihost SYS_WRITE0
bx lr
#endif
run_kernel:
@
@ Kernel parameters
@
mov r0, #0
#ifdef MACH_MPS
ldr r1, =10000 @ MPS (temporary)
#elif defined (VEXPRESS)
ldr r1, =2272 @ Versatile Express
#else
ldr r1, =827 @ RealView/EB
#endif
adr r2, atags
mov r3, #0
ldr lr, =kernel
#ifdef THUMB2_KERNEL
orr lr, lr, #1 @ Thumb-2 kernel
#endif
mov pc, lr @ jump to the kernel
@
@ Data
@
#ifdef SEMIHOSTING
.org 0x500
@ Put the constant pool here as otherwise the assembler will
@ put it immediately after our atags and it will be overwritten
@ by the semihosting command line.
.ltorg
@ block of four words used to pass/return values in semihosting calls
.align 2
semiblk:
.long 0,0,0,0
dashdashkernel:
.asciz "--kernel"
.align 2
dashdashinitrd:
.asciz "--initrd"
.align 2
dashdash:
.asciz "--"
.align 2
get_cmd_failed:
.asciz "Failed to get semihosting command line\n"
.align 2
bad_cmd_line:
.asciz "Bad command line format (unknown option?)\n"
.align 2
nofilename:
.asciz "Expected filename argument\n"
.align 2
openfailed:
.asciz "open failed!\n"
.align 2
flenfailed:
.asciz "could not find length of file!\n"
.align 2
readfailed:
.asciz "could not read file!\n"
.align 2
closefailed:
.asciz "could not close file!\n"
.align 2
loading_str:
.asciz "Loading: "
.align 2
colonspace_str:
.asciz ": "
.align 2
ok_str:
.asciz "OK\n"
.align 2
atags:
@ Template for our ATAGs: we will edit these: the INITRD2
@ is optional and the CMDLINE will be expanded to include
@ the actual command line.
@ The important thing here is that any editing we do
@ to the template should only make it shorter, so we
@ don't accidentally overwrite the semihosting commandline
@ until the very end when we copy the tail end of the
@ semihosting command line into the ATAG_CMDLINE node
@ as the kernel parameters.
@ ATAG_CORE
.long 2
.long 0x54410001
@ ATAG_INITRD2
atag_initrd:
.long 4
.long 0x54420005
.long filesystem @ address
atag_initrd_sz:
.long 0 @ size
@ ATAG_CMDLINE
atag_cmdline:
.long 0 @ length
.long 0x54410009
@ command line string will start here
sh_cmdline:
@ Semihosting command line will be written here
#else /* not SEMIHOSTING */
.org 0x200
@ Static ATAGS for when kernel/etc are compiled into the ELF file
atags:
@ ATAG_CORE
.long 2
.long 0x54410001
@ ATAG_CMDLINE
.long (1f - .) >> 2
.long 0x54410009
/* The kernel boot command line is defined in the Make system */
.asciz KCMD
.align 2
1:
#ifdef USE_INITRD
@ ATAG_INITRD2
.long 4
.long 0x54420005
.long filesystem
.long fs_size
#endif
@ ATAG_NONE
.long 0
.long 0x00000000
#endif /* not SEMIHOSTING */
|