-
Notifications
You must be signed in to change notification settings - Fork 0
/
start.s
140 lines (117 loc) · 5.32 KB
/
start.s
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
.text
.org 0x80000
.include "data.s"
// Setup Frame Buffer
.equ SCREEN_WIDTH, 640
.equ SCREEN_HEIGH, 480
.equ BITS_PER_PIXEL, 32
.equ MAIL_BASE, 0xB880 // Mailbox Base Address
.equ MAIL_WRITE, 0x20 // Mailbox Write Register
.equ MAIL_TAGS, 0x8 // Mailbox Channel 8: Tags (ARM to VC)
.equ PERIPHERAL_BASE, 0x3F000000 // Peripheral Base Address
.equ Get_Allocate_Buffer, 0x00040001 // Frame Buffer: Allocate Buffer (Response: Frame Buffer Base Address In Bytes, Frame Buffer Size In Bytes)
.equ Set_Physical_Display, 0x00048003 // Frame Buffer: Set Physical (Display) Width/Height (Response: Width In Pixels, Height In Pixels)
.equ Set_Virtual_Buffer, 0x00048004 // Frame Buffer: Set Virtual (Buffer) Width/Height (Response: Width In Pixels, Height In Pixels)
.equ Set_Depth, 0x00048005 // Frame Buffer: Set Depth (Response: Bits Per Pixel)
.equ Set_Virtual_Offset, 0x00048009 // Frame Buffer: Set Virtual Offset (Response: X In Pixels, Y In Pixels)
.equ Set_Palette, 0x0004800B // Frame Buffer: Set Palette (Response: RGBA Palette Values (Index 0 To 255))
.equ Set_Pixel_Order, 0x00048006 // Frame Buffer: Set Pixel Order
.equ Get_Pixel_pitch, 0x00048006 // Frame Buffer: Set Pixel Order
// UART data
.equ Set_Power, 0x00028001 // UART: Set Power
.equ Set_ClkRate, 0x00038002 // UART: Set Clock Rate
.equ MMIO_BASE_ALTA, 0x3f20
.equ GPFSEL0, 0x0000
.equ GPFSEL1, 0x0004
.equ GPPUD, 0x0094
.equ GPPUDCLK0, 0x0098
.equ UART0_DR, 0x1000
.equ UART0_FR, 0x1018
.equ UART0_IBRD, 0x1024
.equ UART0_FBRD, 0x1028
.equ UART0_LCRH, 0x102C
.equ UART0_CR, 0x1030
.equ UART0_IMSC, 0x1038
.equ UART0_ICR, 0x1044
// Return CPU ID (0..3) Of The CPU Executed On
.section ".text.boot"
.globl _start
_start:
mrs x1, mpidr_el1 // X0 = Multiprocessor Affinity Register (MPIDR)
and x1, x1, #3 // X0 = CPU ID (Bits 0..1)
cbz x1, StackInit // IF (CPU ID == 0) Branch To Finit else (Core ID 1..3) CoreLoop
// Infinite Loop For Core 1, 2 and 3
CoreLoop:
b CoreLoop
StackInit:
// set stack before our code
ldr x1, =_start
mov sp, x1
// clear bss
ldr x1, =__bss_start
ldr w2, =__bss_size
_StackInit_loop:
cbz w2, FB_Init
str xzr, [x1], #8
sub w2, w2, #1
cbnz w2, _StackInit_loop
// Core 0 Init the framebuffer
FB_Init:
ldr x0, =(FB_STRUCT + MAIL_TAGS)
ldr x1, =MAIL_BASE
ldr x2, =FB_POINTER
orr x1,x1,PERIPHERAL_BASE
str w0,[x1,MAIL_WRITE + MAIL_TAGS] // Mail Box Write
ldr w0,[x2] // W0 = Frame Buffer Pointer
cbz w0,FB_Init // IF (Frame Buffer Pointer == Zero) Re-Initialize Frame Buffer
and w0,w0,0x3FFFFFFF // Convert Mail Box Frame Buffer Pointer From BUS Address To Physical Address ($CXXXXXXX -> $3XXXXXXX)
str w0,[x2] // Store Frame Buffer Pointer Physical Address
add w10,w0,wzr
b main
.align 16
FB_STRUCT: // Mailbox Property Interface Buffer Structure
.word FB_STRUCT_END - FB_STRUCT // Buffer Size In Bytes (Including The Header Values, The End Tag And Padding)
.word 0x00000000 // Buffer Request/Response Code
// Request Codes: $00000000 Process Request Response Codes: $80000000 Request Successful, $80000001 Partial Response
// Sequence Of Concatenated Tags
.word Set_Physical_Display // Tag Identifier
.word 0x00000008 // Value Buffer Size In Bytes
.word 0x00000008 // 1 bit (MSB) Request/Response Indicator (0=Request, 1=Response), 31 bits (LSB) Value Length In Bytes
.word SCREEN_WIDTH // Value Buffer
.word SCREEN_HEIGH // Value Buffer
.word Set_Virtual_Buffer // Tag Identifier
.word 0x00000008 // Value Buffer Size In Bytes
.word 0x00000008 // 1 bit (MSB) Request/Response Indicator (0=Request, 1=Response), 31 bits (LSB) Value Length In Bytes
.word SCREEN_WIDTH // Value Buffer
.word SCREEN_HEIGH // Value Buffer
.word Set_Virtual_Offset // Tag Identifier
.word 0x00000008 // Value Buffer Size In Bytes
.word 0x00000008 // 1 bit (MSB) Request/Response Indicator (0=Request, 1=Response), 31 bits (LSB) Value Length In Bytes
FB_OFFSET_X:
.word 0 // Value Buffer
FB_OFFSET_Y:
.word 0 // Value Buffer
.word Set_Depth // Tag Identifier
.word 0x00000004 // Value Buffer Size In Bytes
.word 0x00000004 // 1 bit (MSB) Request/Response Indicator (0=Request, 1=Response), 31 bits (LSB) Value Length In Bytes
.word BITS_PER_PIXEL // Value Buffer
.word 0x48006 // Tag Identifier
.word 0x00000004 // Value Buffer Size In Bytes
.word 0x00000004 // 1 bit (MSB) Request/Response Indicator (0=Request, 1=Response), 31 bits (LSB) Value Length In Bytes
.word 0 // RGB, not BGR preferably
.word Set_Palette // Tag Identifier
.word 0x00000010 // Value Buffer Size In Bytes
.word 0x00000010 // 1 bit (MSB) Request/Response Indicator (0=Request, 1=Response), 31 bits (LSB) Value Length In Bytes
.word 0 // Value Buffer (Offset: First Palette Index To Set (0-255))
.word 2 // Value Buffer (Length: Number Of Palette Entries To Set (1-256))
FB_PAL:
.word 0x00000000,0xFFFFFFFF // RGBA Palette Values (Offset To Offset+Length-1)
.word Get_Allocate_Buffer // Tag Identifier
.word 0x00000008 // Value Buffer Size In Bytes
.word 0x00000008 // 1 bit (MSB) Request/Response Indicator (0=Request, 1=Response), 31 bits (LSB) Value Length In Bytes
FB_POINTER:
.word 0 // FrameBuffer Pointer
FB_SIZE:
.word 0 // FrameBuffer Size
.word 0x00000000 // $0 (End Tag)
FB_STRUCT_END: