source: ssp_rpi3/trunk/target/rpi_arm64_gcc/start.S@ 384

Last change on this file since 384 was 384, checked in by nmir-saito, 5 years ago

add target dependent files of ssp for rpi3
  • Property svn:keywords set to Id
File size: 4.9 KB
Line 
1/*
2 * TOPPERS Software
3 * Toyohashi Open Platform for Embedded Real-Time Systems
4 *
5 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
6 * Toyohashi Univ. of Technology, JAPAN
7 * Copyright (C) 2006-2016 by Embedded and Real-Time Systems Laboratory
8 * Graduate School of Information Science, Nagoya Univ., JAPAN
9 * Copyright (C) 2018, 2019 by Naoki Saito
10 * Nagoya Municipal Industrial Research Institute, JAPAN
11 *
12 * 上記著作権者
13は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
14 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
15 * 変・再é…
16å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
17 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
18 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
19 * スコード中に含まれていること．
20 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
21 * 用できる形で再é…
22å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
23å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
24 * 者
25マニュアルなど）に，上記の著作権表示，この利用条件および下記
26 * の無保証規定を掲載すること．
27 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
28 * 用できない形で再é…
29å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
30 * と．
31 * (a) 再é…
32å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
33マニュアルなど）に，上記の著
34 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
35 * (b) 再é…
36å¸ƒã®å½¢æ…
37‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
38 * 報告すること．
39 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
40 * 害からも，上記著作権者
41およびTOPPERSプロジェクトをå…
42è²¬ã™ã‚‹ã“と．
43 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
44 * 由に基づく請求からも，上記著作権者
45およびTOPPERSプロジェクトを
46 * å…
47è²¬ã™ã‚‹ã“と．
48 *
49 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
50お
51 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
52 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
53 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
54 * の責任を負わない．
55 *
56 * $Id: start.S 384 2019-04-16 11:01:09Z nmir-saito $
57 */
58
59#define TOPPERS_MACRO_ONLY
60#define UINT64_C(val) (val) /* uint64_t型の定数を作るマクロ */
61#include "kernel_impl.h"
62
63 .text
64 .align 4
65 .global start
66 .global vectors
67start:
68 // コア0のみ利用
69 mrs x0, mpidr_el1
70 and x0, x0, #3
71 cbz x0, 2f
721:
73 // コア0以外
74 wfi
75 b 1b
762:
77 // これ以降はコア0のみ
78 msr daifset, #(AARCH64_DAIF_IRQ | AARCH64_DAIF_FIQ) // CPSR.{I,F}=1
79
80 /*
81 * スタックå…
82ˆé ­ç•ªåœ°ã‚’取り出しておく
83 */
84 adrp x1, _kernel_istkpt
85 add x1, x1, :lo12:_kernel_istkpt
86 ldr x1, [x1]
87
88 /*
89 * EL毎の処理
90 */
91 mrs x0, CurrentEL
92 and x0, x0, #(0x3 << 2)
93 cmp x0, #(0x3 << 2) // EL3?
94 bne start_el2
95
96 /*
97 * EL3
98 */
99start_el3:
100 mov x2, #0x5b1 // RW=1(EL2 is AArch64), HCE=1, SMD=1, NS=1(non-secure)
101 msr scr_el3, x2
102 isb
103
104 /* Set up CNTFRQ_EL0 */
105 ldr x0, =19200000 // 19.2MHz
106 msr CNTFRQ_EL0, x0
107
108 // EL2へ移行
109 mov x2, #0x0c9 // I=F=1, MODE=1001 (EL2h)
110 msr spsr_el3, x2
111 adr x2, start_el2
112 msr elr_el3, x2
113 eret
114
115 /*
116 * EL2
117 */
118start_el2:
119 cmp x0, #(0x1 << 2) // EL2?
120 beq start_el1
121
122 msr sp_el1, x1
123
124 mov x0, #(1 << 31) // RW=1(EL1 is AArch64)
125 orr x0, x0, #(1 << 1) // SWIO hardwired on Pi3
126 msr hcr_el2, x0 // TSC=0(SMC is not trapped)
127 isb
128
129 mrs x0, cnthctl_el2 // EL1PCTEN=1, EL1PCEN=1
130 orr x0, x0, #3
131 msr cnthctl_el2, x0
132 msr cntvoff_el2, xzr
133 isb
134
135 // EL1へ移行
136 mov x2, #0x0c5 // I,F=1, mode=0101(EL1h)
137 msr spsr_el2, x2
138 adr x2, start_el1
139 msr elr_el2, x2
140 eret
141
142 /*
143 * EL1h
144 */
145start_el1:
146 // スタックポインタとフレームポインタの初期化
147 mov sp, x1
148 mov x29, xzr
149
150 /*
151 * 例外ベクタテーブルのベースアドレス設定
152 */
153 ldr x0, =vectors
154 msr vbar_el1, x0
155
156 /*
157 * bssセクションのクリア
158 */
159 ldr x1, =__start_bss
160 ldr x2, =__end_bss
161 cmp x1, x2
162 b.hs 4f
1633:
164 str xzr, [x1], #8
165 cmp x1, x2
166 b.lo 3b
167
1684:
169 /*
170 * sta_ker呼び出し
171 */
172 bl sta_ker
173 b .
Note: See TracBrowser for help on using the repository browser.