source: asp3_wo_tecs/trunk/arch/arm_gcc/common/gic_kernel_impl.c@ 306

Last change on this file since 306 was 306, checked in by ertl-honda, 7 years ago

3.1.0を反映
File size: 7.2 KB
Line 
1/*
2 * TOPPERS Software
3 * Toyohashi Open Platform for Embedded Real-Time Systems
4 *
5 * Copyright (C) 2006-2016 by Embedded and Real-Time Systems Laboratory
6 * Graduate School of Information Science, Nagoya Univ., JAPAN
7 *
8 * 上記著作権者
9は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
10 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
11 * 変・再é…
12å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
13 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
14 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
15 * スコード中に含まれていること．
16 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
17 * 用できる形で再é…
18å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
19å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
20 * 者
21マニュアルなど）に，上記の著作権表示，この利用条件および下記
22 * の無保証規定を掲載すること．
23 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
24 * 用できない形で再é…
25å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
26 * と．
27 * (a) 再é…
28å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
29マニュアルなど）に，上記の著
30 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
31 * (b) 再é…
32å¸ƒã®å½¢æ…
33‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
34 * 報告すること．
35 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
36 * 害からも，上記著作権者
37およびTOPPERSプロジェクトをå…
38è²¬ã™ã‚‹ã“と．
39 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
40 * 由に基づく請求からも，上記著作権者
41およびTOPPERSプロジェクトを
42 * å…
43è²¬ã™ã‚‹ã“と．
44 *
45 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
46お
47 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
48 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
49 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
50 * の責任を負わない．
51 *
52 * $Id: gic_kernel_impl.c 714 2016-03-31 05:52:19Z ertl-hiro $
53 */
54
55/*
56 * カーネルの割込みコントローラ依存部（GIC用）
57 */
58
59#include "kernel_impl.h"
60#include "interrupt.h"
61#include <sil.h>
62#include "arm.h"
63
64/*
65 * CPUインタフェースの操作
66 */
67
68/*
69 * CPUインタフェースの初期化
70 */
71void
72gicc_initialize(void)
73{
74 /*
75 * CPUインタフェースをディスエーブル
76 */
77 sil_wrw_mem(GICC_CTLR, GICC_CTLR_DISABLE);
78
79 /*
80 * 割込み優å…
81ˆåº¦ãƒžã‚¹ã‚¯ã‚’最低優å…
82ˆåº¦ã«è¨­å®š
83 */
84 gicc_set_priority((GIC_PRI_LEVEL - 1) << GIC_PRI_SHIFT);
85
86 /*
87 * 割込み優å…
88ˆåº¦ã®å…
89¨ãƒ“ット有効に
90 */
91 sil_wrw_mem(GICC_BPR, 0U);
92
93 /*
94 * アクティブな割込みがあれば，EOIによりクリアする
95 */
96 sil_wrw_mem(GICC_EOIR, sil_rew_mem(GICC_IAR));
97
98 /*
99 * CPUインタフェースをイネーブル
100 */
101#ifdef TOPPERS_SAFEG_SECURE
102 sil_wrw_mem(GICC_CTLR, (GICC_CTLR_FIQEN|GICC_CTLR_ENABLEGRP1
103 |GICC_CTLR_ENABLEGRP0));
104#else /* TOPPERS_SAFEG_SECURE */
105 sil_wrw_mem(GICC_CTLR, GICC_CTLR_ENABLE);
106#endif /* TOPPERS_SAFEG_SECURE */
107}
108
109/*
110 * CPUインタフェースの終了処理
111 */
112void
113gicc_terminate(void)
114{
115 sil_wrw_mem(GICC_CTLR, GICC_CTLR_DISABLE);
116}
117
118/*
119 * ディストリビュータの操作
120 */
121
122/*
123 * ディストリビュータの初期化
124 */
125void
126gicd_initialize(void)
127{
128 int i;
129
130 /*
131 * ディストリビュータをディスエーブル
132 */
133 sil_wrw_mem(GICD_CTLR, GICD_CTLR_DISABLE);
134
135#ifdef TOPPERS_SAFEG_SECURE
136 /*
137 * すべての割込みをグループ1（IRQ）に設定
138 */
139 for (i = 0; i < (GIC_TNUM_INTNO + 31) / 32; i++) {
140 sil_wrw_mem(GICD_IGROUPR(i), 0xffffffffU);
141 }
142#endif /* TOPPERS_SAFEG_SECURE */
143
144 /*
145 * すべての割込みを禁止
146 */
147 for (i = 0; i < (GIC_TNUM_INTNO + 31) / 32; i++) {
148 sil_wrw_mem(GICD_ICENABLER(i), 0xffffffffU);
149 }
150
151 /*
152 * すべての割込みペンディングをクリア
153 */
154 for (i = 0; i < (GIC_TNUM_INTNO + 31) / 32; i++) {
155 sil_wrw_mem(GICD_ICPENDR(i), 0xffffffffU);
156 }
157
158 /*
159 * すべての割込みを最低優å…
160ˆåº¦ã«è¨­å®š
161 */
162 for (i = 0; i < (GIC_TNUM_INTNO + 3) / 4; i++){
163 sil_wrw_mem(GICD_IPRIORITYR(i), 0xffffffffU);
164 }
165
166 /*
167 * すべてのå…
168±æœ‰ãƒšãƒªãƒ•ã‚§ãƒ©ãƒ«å‰²è¾¼ã¿ã®ã‚¿ãƒ¼ã‚²ãƒƒãƒˆã‚’プロセッサ0に設定
169 */
170 for (i = GIC_INTNO_SPI0 / 4; i < (GIC_TNUM_INTNO + 3) / 4; i++) {
171 sil_wrw_mem(GICD_ITARGETSR(i), 0x01010101U);
172 }
173
174 /*
175 * すべてのペリフェラル割込みをレベルトリガに設定
176 */
177 for (i = GIC_INTNO_PPI0 / 16; i < (GIC_TNUM_INTNO + 15) / 16; i++) {
178#ifdef GIC_ARM11MPCORE
179 sil_wrw_mem(GICD_ICFGR(i), 0x55555555U);
180#else /* GIC_ARM11MPCORE */
181 sil_wrw_mem(GICD_ICFGR(i), 0x00000000U);
182#endif /* GIC_ARM11MPCORE */
183 }
184
185 /*
186 * ディストリビュータをイネーブル
187 */
188 sil_wrw_mem(GICD_CTLR, GICD_CTLR_ENABLE);
189}
190
191/*
192 * ディストリビュータの終了処理
193 */
194void
195gicd_terminate(void)
196{
197 sil_wrw_mem(GICD_CTLR, GICD_CTLR_DISABLE);
198}
199
200#ifndef OMIT_GIC_INITIALIZE_INTERRUPT
201
202/*
203 * 割込み要求ラインの属性の設定
204 *
205 * ASPカーネルでの利用を想定して，パラメータエラーはアサーションでチェッ
206 * クしている．
207 */
208Inline void
209config_int(INTNO intno, ATR intatr, PRI intpri)
210{
211 assert(VALID_INTNO(intno));
212 assert(TMIN_INTPRI <= intpri && intpri <= TMAX_INTPRI);
213
214 /*
215 * 割込みを禁止
216 *
217 * 割込みを受け付けたまま，レベルトリガ／エッジトリガの設定や，割
218 * 込み優å…
219ˆåº¦ã®è¨­å®šã‚’行うのは危険なため，割込み属性にかかわらず，
220 * 一旦マスクする．
221 */
222 disable_int(intno);
223
224 /*
225 * 割込みをコンフィギュレーション
226 */
227#ifdef TOPPERS_SAFEG_SECURE
228 gicd_config_group(intno, 1U);
229#endif /* TOPPERS_SAFEG_SECURE */
230
231 if ((intatr & TA_EDGE) != 0U) {
232#ifdef GIC_ARM11MPCORE
233 gicd_config(intno, GICD_ICFGRn_EDGE|GICD_ICFGRn_1_N);
234#else /* GIC_ARM11MPCORE */
235 gicd_config(intno, GICD_ICFGRn_EDGE);
236#endif /* GIC_ARM11MPCORE */
237 clear_int(intno);
238 }
239 else {
240#ifdef GIC_ARM11MPCORE
241 gicd_config(intno, GICD_ICFGRn_LEVEL|GICD_ICFGRn_1_N);
242#else /* GIC_ARM11MPCORE */
243 gicd_config(intno, GICD_ICFGRn_LEVEL);
244#endif /* GIC_ARM11MPCORE */
245 }
246
247 /*
248 * 割込み優å…
249ˆåº¦ã¨ã‚¿ãƒ¼ã‚²ãƒƒãƒˆãƒ—ロセッサを設定
250 */
251 gicd_set_priority(intno, INT_IPM(intpri));
252 gicd_set_target(intno, 1U << arm_prc_index());
253
254 /*
255 * 割込みを許可
256 */
257 if ((intatr & TA_ENAINT) != 0U) {
258 enable_int(intno);
259 }
260}
261
262/*
263 * 割込み管理機能の初期化
264 */
265void
266initialize_interrupt(void)
267{
268 uint_t i;
269 const INTINIB *p_intinib;
270
271 for (i = 0; i < tnum_cfg_intno; i++) {
272 p_intinib = &(intinib_table[i]);
273 config_int(p_intinib->intno, p_intinib->intatr, p_intinib->intpri);
274 }
275}
276
277#endif /* OMIT_GIC_INITIALIZE_INTERRUPT */
Note: See TracBrowser for help on using the repository browser.