source: ssp_qb_r5f100le_cs/trunk/arch/arm_m_gcc/prc_config.c

Last change on this file was 95, checked in by nmir-saito, 9 years ago

ファイルの mime-type 変更
  • Property svn:mime-type set to text/plain; charset=shift_jis
File size: 7.1 KB
Line 
1/*
2 * TOPPERS/SSP Kernel
3 * Smallest Set Profile Kernel
4 *
5 * Copyright (C) 2008 by Embedded and Real-Time Systems Laboratory
6 * Graduate School of Information Science, Nagoya Univ., JAPAN
7 * Copyright (C) 2010 by Meika Sugimoto
8 *
9 * 上記著作権者は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
10 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
11 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
12 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
13 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
14 * スコード中に含まれていること．
15 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
16 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
17 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
18 * の無保証規定を掲載すること．
19 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
20 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
21 * と．
22 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
23 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
24 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
25 * 報告すること．
26 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
27 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
28 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
29 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
30 * 免責すること．
31 *
32 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
33 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
34 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
35 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
36 * の責任を負わない．
37 *
38 * @(#) $Id: prc_config.c 1304 2008-08-27 07:28:36Z ertl-honda $
39 */
40
41/*
42 * プロセッサ依存モジュール（ARM-M用）
43 */
44
45#include "kernel_impl.h"
46#include "check.h"
47#include "task.h"
48
49#include <t_syslog.h>
50
51/*
52 * CPUロックフラグ実現のための変数
53 */
54volatile bool_t lock_flag; /* CPUロックフラグの値を保持する変数 */
55volatile uint32_t saved_iipm; /* 割込み優先度マスクを保存する変数 */
56
57/* 割込みネスト数の管理 */
58uint8_t intnest;
59
60/*
61 * ベクタテーブル(kernel_cfg.c)
62 */
63extern const FP vector_table[];
64
65/*
66 * システム例外・割込みの（例外番号 4〜15）
67 * 割込み優先度設定レジスタへのアクセスのための配列
68 */
69static const unsigned int nvic_sys_pri_reg[] = {
70 0,
71 NVIC_SYS_PRI1,
72 NVIC_SYS_PRI2,
73 NVIC_SYS_PRI3
74};
75
76/*
77 * 例外と割込みの割込み優先度をセット
78 *
79 * excnoはARM-Mで定められている Exception Number を指定．
80 */
81void
82set_exc_int_priority(uint32_t excno, uint8_t pri){
83 uint32_t tmp, reg;
84
85 /*
86 * 割込み優先度設定レジスタの決定
87 */
88 if ((EXCNO_MPU <= excno) && (excno <= IRQNO_SYSTICK)) {
89 /*
90 * Exception Number 4(Memory Management)から
91 * Exception Number 15(SysTick)までの割込み優先度はシステム優先度
92 * レジスタにより設定．
93 */
94 reg = nvic_sys_pri_reg[excno >> 2];
95 }
96 else if ((TMIN_INTNO < excno) && (excno <= TMAX_INTNO)){
97 /*
98 * IRQ割込みなら
99 */
100 reg = NVIC_PRI0 + (((excno - (TMIN_INTNO + 1)) >> 2) * 4);
101 }
102 else {
103 return ;
104 }
105
106 tmp = sil_rew_mem((void *)reg);
107 tmp &= ~(0xFF << (8 * (excno & 0x03)));
108 tmp |= (pri << (8 - TBITW_IPRI)) << (8 * (excno & 0x03));
109 sil_wrw_mem((void *)reg, tmp);
110}
111
112/*
113 * 例外の許可
114 *
115 * Memory Management, Bus Fault, Usage Fault は禁止・許可が買おう
116 */
117void
118enable_exc(EXCNO excno)
119{
120 uint32_t tmp;
121
122 switch (excno) {
123 case EXCNO_MPU:
124 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
125 tmp |= NVIC_SYS_HND_CTRL_MEM;
126 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
127 break;
128 case EXCNO_BUS:
129 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
130 tmp |= NVIC_SYS_HND_CTRL_BUS;
131 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
132 break;
133 case EXCNO_USAGE:
134 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
135 tmp |= NVIC_SYS_HND_CTRL_USAGE;
136 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
137 break;
138 }
139}
140
141/*
142 * 例外の禁止
143 */
144void
145disable_exc(EXCNO excno)
146{
147 uint32_t tmp;
148
149 switch (excno) {
150 case EXCNO_MPU:
151 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
152 tmp &= ~NVIC_SYS_HND_CTRL_MEM;
153 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
154 break;
155 case EXCNO_BUS:
156 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
157 tmp &= ~NVIC_SYS_HND_CTRL_BUS;
158 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
159 break;
160 case EXCNO_USAGE:
161 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
162 tmp &= ~NVIC_SYS_HND_CTRL_USAGE;
163 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
164 break;
165 }
166}
167
168
169/*
170 * プロセッサ依存の初期化
171 */
172void
173prc_initialize(void)
174{
175 /*
176 * CPUロックフラグ実現のための変数の初期化
177 */
178 lock_flag = true;
179 saved_iipm = IIPM_ENAALL;
180
181 /* 割込みネスト数の初期化 */
182 intnest = 0u;
183
184 /*
185 * ベクタテーブルを設定
186 */
187 sil_wrw_mem((void*)NVIC_VECTTBL, (uint32_t)vector_table);
188
189 /*
190 * SVCハンドラの優先度を設定
191 */
192 set_exc_int_priority(EXCNO_SVCALL, 0);
193
194 /*
195 * SVCハンドラを有効に
196 */
197 x_enable_int(EXCNO_SVCALL);
198}
199
200/*
201 * プロセッサ依存の終了処理
202 */
203void
204prc_terminate(void)
205{
206 while(1)
207 ;
208}
209
210/*
211 * 割込み要求ライン属性の設定
212 */
213void
214x_config_int(INTNO intno, ATR intatr, PRI intpri)
215{
216 //assert(VALID_INTNO_CFGINT(intno));
217 //assert(TMIN_INTPRI <= intpri && intpri <= TMAX_INTPRI);
218
219 /*
220 * 一旦割込みを禁止する
221 */
222 (void)x_disable_int(intno);
223 x_clear_int(intno);
224
225 /*
226 * 割込み優先度をセット
227 */
228 set_exc_int_priority(intno, intpri);
229
230 /*
231 * 割込み要求マスク解除(必要な場合)
232 * 同時に割込み優先度もセットされる
233 */
234 if ((intatr & TA_ENAINT) != 0U) {
235 (void) x_enable_int(intno);
236 }
237}
238
239
240#ifndef OMIT_DEFAULT_EXC_HANDLER
241/*
242 * Trapa以外の例外で登録されていない例外が発生すると呼び出される
243 */
244void
245default_exc_handler(void *p_excinf)
246{
247 uint32_t basepri = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_BASEPRI);
248 uint32_t pc = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_PC);
249 uint32_t xpsr = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_XPSR);
250 uint32_t excno = get_ipsr() & IPSR_ISR_NUMBER;
251
252 syslog(LOG_EMERG, "\nUnregistered Exception occurs.");
253 syslog(LOG_EMERG, "Excno = %08x PC = %08x XPSR = %08x basepri = %08X, p_excinf = %08X",
254 excno, pc, xpsr, basepri, p_excinf);
255
256 target_exit();
257}
258#endif /* OMIT_DEFAULT_EXC_HANDLER */
259
260#ifndef OMIT_DEFAULT_INT_HANDLER
261/*
262 * 未登録の割込みが発生した場合に呼び出される
263 */
264void
265default_int_handler(void *p_excinf)
266{
267 uint32_t basepri = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_BASEPRI);
268 uint32_t pc = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_PC);
269 uint32_t xpsr = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_XPSR);
270 uint32_t excno = get_ipsr() & IPSR_ISR_NUMBER;
271
272 syslog(LOG_EMERG, "\nUnregistered Interrupt occurs.");
273 syslog(LOG_EMERG, "Excno = %08x PC = %08x XPSR = %08x basepri = %08X, p_excinf = %08X",
274 excno, pc, xpsr, basepri, p_excinf);
275
276 target_exit();
277}
278#endif /* OMIT_DEFAULT_INT_HANDLER */
Note: See TracBrowser for help on using the repository browser.