3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Advanced Standard Profile Kernel
6 * Copyright (C) 2008-2011 by Embedded and Real-Time Systems Laboratory
7 * Graduate School of Information Science, Nagoya Univ., JAPAN
9 * 上記著作権者は,以下の(1)〜(4)の条件を満たす場合に限り,本ソフトウェ
10 * ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
11 * 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
12 * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
13 * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
15 * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
16 * 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
17 * 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
19 * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
20 * 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
22 * (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
23 * 作権表示,この利用条件および下記の無保証規定を掲載すること.
24 * (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
26 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
27 * 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
28 * また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
29 * 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
32 * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
33 * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
34 * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
35 * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
38 * @(#) $Id: core_config.c 2193 2011-07-25 04:34:11Z ertl-honda $
45 #include "kernel_impl.h"
52 volatile bool_t lock_flag; /* CPUロックフラグの値を保持する変数 */
53 volatile uint32_t saved_iipm; /* 割込み優先度マスクを保存する変数 */
56 * ベクタテーブル(kernel_cfg.c)
58 extern const FP vector_table[];
61 * システム例外・割込みの(例外番号 4〜15)
62 * 割込み優先度設定レジスタへのアクセスのための配列
64 static const unsigned int nvic_sys_pri_reg[] = {
74 * excnoはARM-Mで定められている Exception Number を指定.
77 set_exc_int_priority(uint32_t excno, uint32_t iipm){
83 if ((EXCNO_MPU <= excno) && (excno <= IRQNO_SYSTICK)) {
85 * Exception Number 4(Memory Management)から
86 * Exception Number 15(SysTick)までの割込み優先度はシステム優先度
89 reg = nvic_sys_pri_reg[excno >> 2];
91 else if ((TMIN_INTNO < excno) && (excno <= TMAX_INTNO)){
95 reg = NVIC_PRI0 + (((excno - (TMIN_INTNO + 1)) >> 2) * 4);
101 tmp = sil_rew_mem((void *)reg);
102 tmp &= ~(0xFF << (8 * (excno & 0x03)));
103 tmp |= iipm << (8 * (excno & 0x03));
104 sil_wrw_mem((void *)reg, tmp);
110 * Memory Management, Bus Fault, Usage Fault は禁止・許可が可能
113 enable_exc(EXCNO excno)
119 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
120 tmp |= NVIC_SYS_HND_CTRL_MEM;
121 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
124 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
125 tmp |= NVIC_SYS_HND_CTRL_BUS;
126 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
129 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
130 tmp |= NVIC_SYS_HND_CTRL_USAGE;
131 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
140 disable_exc(EXCNO excno)
146 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
147 tmp &= ~NVIC_SYS_HND_CTRL_MEM;
148 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
151 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
152 tmp &= ~NVIC_SYS_HND_CTRL_BUS;
153 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
156 tmp = sil_rew_mem((void *)NVIC_SYS_HND_CTRL);
157 tmp &= ~NVIC_SYS_HND_CTRL_USAGE;
158 sil_wrw_mem((void *)NVIC_SYS_HND_CTRL, tmp);
168 core_initialize(void)
171 * CPUロックフラグ実現のための変数の初期化
174 saved_iipm = IIPM_ENAALL;
179 sil_wrw_mem((void*)NVIC_VECTTBL, (uint32_t)vector_table);
183 * CPUロック状態でも発生するように,BASEPRIレジスタでマスクでき
186 set_exc_int_priority(EXCNO_HARD, 0);
187 set_exc_int_priority(EXCNO_MPU, 0);
188 set_exc_int_priority(EXCNO_BUS, 0);
189 set_exc_int_priority(EXCNO_USAGE, 0);
190 set_exc_int_priority(EXCNO_SVCALL, 0);
191 set_exc_int_priority(EXCNO_DEBUG, 0);
192 set_exc_int_priority(EXCNO_PENDSV, 0);
197 x_enable_int(EXCNO_SVCALL);
206 extern void software_term_hook(void);
207 void (*volatile fp)(void) = software_term_hook;
210 * software_term_hookへのポインタを,一旦volatile指定のあるfpに代
211 * 入してから使うのは,0との比較が最適化で削除されないようにするた
223 x_config_int(INTNO intno, ATR intatr, PRI intpri)
225 assert(VALID_INTNO_CFGINT(intno));
226 assert(TMIN_INTPRI <= intpri && intpri <= TMAX_INTPRI);
231 (void)x_disable_int(intno);
236 set_exc_int_priority(intno, INT_IPM(intpri));
241 if ((intatr & TA_ENAINT) != 0U) {
242 (void) x_enable_int(intno);
247 #ifndef OMIT_DEFAULT_EXC_HANDLER
249 * Trapa以外の例外で登録されていない例外が発生すると呼び出される
252 default_exc_handler(void *p_excinf)
254 uint32_t basepri = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_BASEPRI);
255 uint32_t pc = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_PC);
256 uint32_t xpsr = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_XPSR);
257 uint32_t excno = get_ipsr() & IPSR_ISR_NUMBER;
259 syslog(LOG_EMERG, "\nUnregistered Exception occurs.");
260 syslog(LOG_EMERG, "Excno = %08x PC = %08x XPSR = %08x basepri = %08X, p_excinf = %08X",
261 excno, pc, xpsr, basepri, p_excinf);
265 #endif /* OMIT_DEFAULT_EXC_HANDLER */
267 #ifndef OMIT_DEFAULT_INT_HANDLER
269 * 未登録の割込みが発生した場合に呼び出される
272 default_int_handler(void *p_excinf)
274 uint32_t basepri = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_BASEPRI);
275 uint32_t pc = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_PC);
276 uint32_t xpsr = *(((uint32_t*)p_excinf) + P_EXCINF_OFFSET_XPSR);
277 uint32_t excno = get_ipsr() & IPSR_ISR_NUMBER;
279 syslog(LOG_EMERG, "\nUnregistered Interrupt occurs.");
280 syslog(LOG_EMERG, "Excno = %08x PC = %08x XPSR = %08x basepri = %08X, p_excinf = %08X",
281 excno, pc, xpsr, basepri, p_excinf);
285 #endif /* OMIT_DEFAULT_INT_HANDLER */