source: asp3_tinet_ecnl_arm/trunk/asp3_dcre/arch/arm_gcc/common/gic_kernel_impl.c@ 352

Last change on this file since 352 was 352, checked in by coas-nagasima, 6 years ago

arm向けASP3版ECNLを追加
  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
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 * 上記著作権者は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
9 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
10 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
11 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
12 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
13 * スコード中に含まれていること．
14 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
15 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
16 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
17 * の無保証規定を掲載すること．
18 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
19 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
20 * と．
21 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
22 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
23 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
24 * 報告すること．
25 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
26 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
27 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
28 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
29 * 免責すること．
30 *
31 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
32 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
33 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
34 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
35 * の責任を負わない．
36 *
37 * $Id$
38 */
39
40/*
41 * カーネルの割込みコントローラ依存部（GIC用）
42 */
43
44#include "kernel_impl.h"
45#include "interrupt.h"
46#include <sil.h>
47#include "arm.h"
48
49/*
50 * CPUインタフェースの操作
51 */
52
53/*
54 * CPUインタフェースの初期化
55 */
56void
57gicc_initialize(void)
58{
59 /*
60 * CPUインタフェースをディスエーブル
61 */
62 sil_wrw_mem(GICC_CTLR, GICC_CTLR_DISABLE);
63
64 /*
65 * 割込み優先度マスクを最低優先度に設定
66 */
67 gicc_set_priority((GIC_PRI_LEVEL - 1) << GIC_PRI_SHIFT);
68
69 /*
70 * 割込み優先度の全ビット有効に
71 */
72 sil_wrw_mem(GICC_BPR, 0U);
73
74 /*
75 * アクティブな割込みがあれば，EOIによりクリアする
76 */
77 sil_wrw_mem(GICC_EOIR, sil_rew_mem(GICC_IAR));
78
79 /*
80 * CPUインタフェースをイネーブル
81 */
82#ifdef TOPPERS_SAFEG_SECURE
83 sil_wrw_mem(GICC_CTLR, (GICC_CTLR_FIQEN|GICC_CTLR_ENABLEGRP1
84 |GICC_CTLR_ENABLEGRP0));
85#else /* TOPPERS_SAFEG_SECURE */
86 sil_wrw_mem(GICC_CTLR, GICC_CTLR_ENABLE);
87#endif /* TOPPERS_SAFEG_SECURE */
88}
89
90/*
91 * CPUインタフェースの終了処理
92 */
93void
94gicc_terminate(void)
95{
96 sil_wrw_mem(GICC_CTLR, GICC_CTLR_DISABLE);
97}
98
99/*
100 * ディストリビュータの操作
101 */
102
103/*
104 * ディストリビュータの初期化
105 */
106void
107gicd_initialize(void)
108{
109 int i;
110
111 /*
112 * ディストリビュータをディスエーブル
113 */
114 sil_wrw_mem(GICD_CTLR, GICD_CTLR_DISABLE);
115
116#ifdef TOPPERS_SAFEG_SECURE
117 /*
118 * すべての割込みをグループ1（IRQ）に設定
119 */
120 for (i = 0; i < (GIC_TNUM_INTNO + 31) / 32; i++) {
121 sil_wrw_mem(GICD_IGROUPR(i), 0xffffffffU);
122 }
123#endif /* TOPPERS_SAFEG_SECURE */
124
125 /*
126 * すべての割込みを禁止
127 */
128 for (i = 0; i < (GIC_TNUM_INTNO + 31) / 32; i++) {
129 sil_wrw_mem(GICD_ICENABLER(i), 0xffffffffU);
130 }
131
132 /*
133 * すべての割込みペンディングをクリア
134 */
135 for (i = 0; i < (GIC_TNUM_INTNO + 31) / 32; i++) {
136 sil_wrw_mem(GICD_ICPENDR(i), 0xffffffffU);
137 }
138
139 /*
140 * すべての割込みを最低優先度に設定
141 */
142 for (i = 0; i < (GIC_TNUM_INTNO + 3) / 4; i++){
143 sil_wrw_mem(GICD_IPRIORITYR(i), 0xffffffffU);
144 }
145
146 /*
147 * すべての共有ペリフェラル割込みのターゲットをプロセッサ0に設定
148 */
149 for (i = GIC_INTNO_SPI0 / 4; i < (GIC_TNUM_INTNO + 3) / 4; i++) {
150 sil_wrw_mem(GICD_ITARGETSR(i), 0x01010101U);
151 }
152
153 /*
154 * すべてのペリフェラル割込みをレベルトリガに設定
155 */
156 for (i = GIC_INTNO_PPI0 / 16; i < (GIC_TNUM_INTNO + 15) / 16; i++) {
157#ifdef GIC_ARM11MPCORE
158 sil_wrw_mem(GICD_ICFGR(i), 0x55555555U);
159#else /* GIC_ARM11MPCORE */
160 sil_wrw_mem(GICD_ICFGR(i), 0x00000000U);
161#endif /* GIC_ARM11MPCORE */
162 }
163
164 /*
165 * ディストリビュータをイネーブル
166 */
167 sil_wrw_mem(GICD_CTLR, GICD_CTLR_ENABLE);
168}
169
170/*
171 * ディストリビュータの終了処理
172 */
173void
174gicd_terminate(void)
175{
176 sil_wrw_mem(GICD_CTLR, GICD_CTLR_DISABLE);
177}
178
179#ifndef OMIT_GIC_INITIALIZE_INTERRUPT
180
181/*
182 * 割込み要求ラインの属性の設定
183 *
184 * ASPカーネルでの利用を想定して，パラメータエラーはアサーションでチェッ
185 * クしている．
186 */
187Inline void
188config_int(INTNO intno, ATR intatr, PRI intpri)
189{
190 assert(VALID_INTNO(intno));
191 assert(TMIN_INTPRI <= intpri && intpri <= TMAX_INTPRI);
192
193 /*
194 * 割込みを禁止
195 *
196 * 割込みを受け付けたまま，レベルトリガ／エッジトリガの設定や，割
197 * 込み優先度の設定を行うのは危険なため，割込み属性にかかわらず，
198 * 一旦マスクする．
199 */
200 disable_int(intno);
201
202 /*
203 * 割込みをコンフィギュレーション
204 */
205#ifdef TOPPERS_SAFEG_SECURE
206 gicd_config_group(intno, 1U);
207#endif /* TOPPERS_SAFEG_SECURE */
208
209 if ((intatr & TA_EDGE) != 0U) {
210#ifdef GIC_ARM11MPCORE
211 gicd_config(intno, GICD_ICFGRn_EDGE|GICD_ICFGRn_1_N);
212#else /* GIC_ARM11MPCORE */
213 gicd_config(intno, GICD_ICFGRn_EDGE);
214#endif /* GIC_ARM11MPCORE */
215 clear_int(intno);
216 }
217 else {
218#ifdef GIC_ARM11MPCORE
219 gicd_config(intno, GICD_ICFGRn_LEVEL|GICD_ICFGRn_1_N);
220#else /* GIC_ARM11MPCORE */
221 gicd_config(intno, GICD_ICFGRn_LEVEL);
222#endif /* GIC_ARM11MPCORE */
223 }
224
225 /*
226 * 割込み優先度とターゲットプロセッサを設定
227 */
228 gicd_set_priority(intno, INT_IPM(intpri));
229 gicd_set_target(intno, 1U << arm_prc_index());
230
231 /*
232 * 割込みを許可
233 */
234 if ((intatr & TA_ENAINT) != 0U) {
235 enable_int(intno);
236 }
237}
238
239/*
240 * 割込み管理機能の初期化
241 */
242void
243initialize_interrupt(void)
244{
245 uint_t i;
246 const INTINIB *p_intinib;
247
248 for (i = 0; i < tnum_cfg_intno; i++) {
249 p_intinib = &(intinib_table[i]);
250 config_int(p_intinib->intno, p_intinib->intatr, p_intinib->intpri);
251 }
252}
253
254#endif /* OMIT_GIC_INITIALIZE_INTERRUPT */
Note: See TracBrowser for help on using the repository browser.