source: asp3_tinet_ecnl_arm/trunk/asp3_dcre/arch/arm_gcc/common/gic_support.S@ 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/plain;charset=UTF-8
File size: 6.0 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-2017 by Embedded and Real-Time Systems Laboratory
8 * Graduate School of Information Science, Nagoya Univ., JAPAN
9 *
10 * 上記著作権者は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
11 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
12 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
13 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
14 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
15 * スコード中に含まれていること．
16 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
17 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
18 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
19 * の無保証規定を掲載すること．
20 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
21 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
22 * と．
23 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
24 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
25 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
26 * 報告すること．
27 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
28 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
29 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
30 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
31 * 免責すること．
32 *
33 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
34 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
35 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
36 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
37 * の責任を負わない．
38 *
39 * $Id$
40 */
41
42/*
43 * カーネルの割込みコントローラ依存部のアセンブリ言語部（GIC用）
44 */
45
46#define TOPPERS_MACRO_ONLY
47#define TOPPERS_ASM_MACRO
48#define UINT_C(val) (val) /* uint_t型の定数を作るマクロ */
49#define ULONG_C(val) (val) /* ulong_t型の定数を作るマクロ */
50#define CAST(type, val) (val) /* 型キャストを行うマクロ */
51#define GIC_REG(base, offset) ((base) + (offset))
52#include "kernel_impl.h"
53#include "core_asm.inc"
54
55#if __TARGET_ARCH_ARM < 6
56#error gic_suport.S supports ARMv6 or later.
57#endif /* __TARGET_ARCH_ARM < 6 */
58
59/*
60 * 割込みハンドラ呼出し前の割込みコントローラ操作
61 *
62 * r4に割込み番号を返す．irc_end_intで用いる情報（割込み発生前の割込み
63 * 優先度マスク）を，スタックの先頭に保存する．
64 */
65 ATEXT
66 AALIGN(2)
67 AGLOBAL(irc_begin_int)
68ALABEL(irc_begin_int)
69 /*
70 * 割込み要因を取得する．
71 */
72 ldr r1, =GICC_IAR
73 ldr r3, [r1]
74
75 /*
76 * 割込み要因の割込み優先度を求め，割込み優先度マスクに設定する．
77 */
78 ldr r1, =GICC_RPR /* 受け付けた割込みの割込み優先度を取得 */
79 ldr r0, [r1]
80 ldr r1, =GICC_PMR /* 割込み発生前の割込み優先度を取得 */
81 ldr r2, [r1]
82 str r0, [r1] /* 新しい割込み優先度マスクをセットする */
83 asm_data_sync_barrier r0 /* 割込み優先度マスクがセットされるのを待つ */
84 str r2, [sp] /* irc_end_intで用いる情報を保存 */
85
86 /*
87 * EOIを発行する．
88 */
89 ldr r1, =GICC_EOIR /* EOIレジスタへの書込み */
90 str r3, [r1]
91
92 /*
93 * 割込み番号を返値としてリターンする．
94 */
95 lsl r4, r3, #22 /* 下位10ビットを取り出す */
96 lsr r4, r4, #22
97 bx lr
98
99/*
100 * 割込みハンドラ呼出し後の割込みコントローラ操作
101 */
102 ATEXT
103 AALIGN(2)
104 AGLOBAL(irc_end_int)
105ALABEL(irc_end_int)
106 /*
107 * 割込み優先度マスクを元に戻す．
108 */
109 ldr r2, [sp] /* irc_begin_intで保存した情報を復帰 */
110 ldr r1, =GICC_PMR /* 割込み優先度マスクを元に戻す */
111 str r2, [r1]
112 bx lr
113
114/*
115 * CPU例外発生前の割込み優先度の取得
116 *
117 * CPU例外の発生で割込み優先度が変わることはないため，現在の割込み優先
118 * 度を返す．
119 */
120 ATEXT
121 AALIGN(2)
122 AGLOBAL(irc_get_intpri)
123ALABEL(irc_get_intpri)
124 /*
125 * 割込み優先度マスクを外部表現に変換して返す．
126 */
127 ldr r1, =GICC_PMR
128 ldr r0, [r1]
129 asr r0, r0, #GIC_PRI_SHIFT
130 sub r0, r0, #GIC_PRI_MASK
131 bx lr
132
133/*
134 * CPU例外ハンドラ呼出し前の割込みコントローラ操作
135 *
136 * irc_end_excで用いる情報（CPU例外発生前の割込み優先度マスク）を，スタッ
137 * クの先頭に保存する．
138 */
139 ATEXT
140 AALIGN(2)
141 AGLOBAL(irc_begin_exc)
142ALABEL(irc_begin_exc)
143 /*
144 * 割込み優先度マスクを保存する．
145 */
146 ldr r1, =GICC_PMR /* 現在の割込み優先度を取得 */
147 ldr r2, [r1]
148 str r2, [sp] /* irc_end_excで用いる情報を保存 */
149 bx lr
150
151/*
152 * CPU例外ハンドラ呼出し後の割込みコントローラ操作
153 */
154 ATEXT
155 AALIGN(2)
156 AGLOBAL(irc_end_exc)
157ALABEL(irc_end_exc)
158 /*
159 * 割込み優先度マスクを元に戻す．
160 */
161 ldr r2, [sp] /* irc_begin_excで保存した情報を復帰 */
162 ldr r1, =GICC_PMR /* 割込み優先度マスクを元に戻す */
163 str r2, [r1]
164 bx lr
Note: See TracBrowser for help on using the repository browser.