From 3c4d7491790f57d9722e3b8ec2c8b5bf2f27e499 Mon Sep 17 00:00:00 2001 From: Ryuji Fuchikami Date: Sat, 1 Mar 2014 11:41:19 +0900 Subject: [PATCH] add cortex-a9 base --- kernel/build/arm/cortex_a9/gcc/Makefile | 150 +++++++++++++++++++++ kernel/include/arch/proc/arm/arm_v7a/proc.h | 85 ++++++++++++ kernel/include/arch/proc/arm/arm_v7a/procatr.h | 72 ++++++++++ .../source/arch/proc/arm/arm_v7a/gcc/arm_v7a.inc | 36 +++++ kernel/source/arch/proc/arm/arm_v7a/gcc/kcre_ctx.S | 49 +++++++ kernel/source/arch/proc/arm/arm_v7a/gcc/kdis_int.S | 28 ++++ kernel/source/arch/proc/arm/arm_v7a/gcc/kena_int.S | 34 +++++ kernel/source/arch/proc/arm/arm_v7a/gcc/kirq_hdr.S | 116 ++++++++++++++++ kernel/source/arch/proc/arm/arm_v7a/gcc/krst_ctx.S | 31 +++++ kernel/source/arch/proc/arm/arm_v7a/gcc/kswi_ctx.S | 42 ++++++ kernel/source/arch/proc/arm/arm_v7a/gcc/kwai_int.S | 27 ++++ kernel/source/arch/proc/arm/arm_v7a/val_int.c | 18 +++ 12 files changed, 688 insertions(+) create mode 100644 kernel/build/arm/cortex_a9/gcc/Makefile create mode 100644 kernel/include/arch/proc/arm/arm_v7a/proc.h create mode 100644 kernel/include/arch/proc/arm/arm_v7a/procatr.h create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/arm_v7a.inc create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/kcre_ctx.S create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/kdis_int.S create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/kena_int.S create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/kirq_hdr.S create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/krst_ctx.S create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/kswi_ctx.S create mode 100644 kernel/source/arch/proc/arm/arm_v7a/gcc/kwai_int.S create mode 100644 kernel/source/arch/proc/arm/arm_v7a/val_int.c diff --git a/kernel/build/arm/cortex_a9/gcc/Makefile b/kernel/build/arm/cortex_a9/gcc/Makefile new file mode 100644 index 0000000..711140e --- /dev/null +++ b/kernel/build/arm/cortex_a9/gcc/Makefile @@ -0,0 +1,150 @@ +# ---------------------------------------------------------------------------- +# Hyper Operating System V4 Advance +# makefile for Cortex-M3 +# +# Copyright (C) 1998-2011 by Project HOS +# http://sourceforge.jp/projects/hos/ +# ---------------------------------------------------------------------------- + + + +# -------------------------------------- +# %jp{各種設定}%en{setting} +# -------------------------------------- + +# %jp{ターゲットライブラリ名}%en{target library name} +TARGET ?= libhosv4a + + +# %jp{ツール定義}%jp{tools} +GCC_ARCH ?= arm-none-eabi- +CMD_CC ?= $(GCC_ARCH)gcc +CMD_ASM ?= $(GCC_ARCH)gcc +CMD_LIBR ?= $(GCC_ARCH)ar + + +# %jp{アーキテクチャ定義}%en{architecture} +ARCH_NAME ?= cortex_a9 +ARCH_PROC ?= arm/arm_v7a +ARCH_IRC ?= none +ARCH_CC ?= gcc + + +# %jp{ディレクトリ定義}%en{directories} +TOP_DIR = ../../../../.. +KERNEL_DIR = $(TOP_DIR)/kernel +KERNEL_MAKINC_DIR = $(KERNEL_DIR)/build/common/gmake +INC_PROC_DIR = $(KERNEL_DIR)/include/arch/proc/$(ARCH_PROC) +INC_IRC_DIR = $(KERNEL_DIR)/include/arch/irc/$(ARCH_IRC) +SRC_PROC_DIR = $(KERNEL_DIR)/source/arch/proc/$(ARCH_PROC) +SRC_PROC_CC_DIR = $(KERNEL_DIR)/source/arch/proc/$(ARCH_PROC)/$(ARCH_CC) +SRC_IRC_DIR = $(KERNEL_DIR)/source/arch/irc/$(ARCH_IRC) +SRC_IRC_CC_DIR = $(KERNEL_DIR)/source/arch/irc/$(ARCH_IRC)/$(ARCH_CC) +CFGRTR_DIR = $(TOP_DIR)/cfgrtr/build/gcc + + +# %jp{コンフィギュレータ定義}%en{kernel configurator} +CFGRTR = h4acfg-$(ARCH_NAME) + + +# %jp{カーネル指定}%en{kernel flag} +KERNEL = Yes + + +# %jp{共通定義読込み}%en{common setting} +include $(KERNEL_MAKINC_DIR)/common.inc + + +# %jp{パス設定}%en{add source directories} +INC_DIRS += $(INC_PROC_DIR) $(INC_IRC_DIR) +SRC_DIRS += $(SRC_PROC_DIR) $(SRC_PROC_DIR) $(SRC_PROC_CC_DIR) $(SRC_IRC_DIR) $(SRC_IRC_CC_DIR) + + +# %jp{オプションフラグ}%en{option flags} +AFLAGS = -mcpu=cortex-a9 -mthumb +CFLAGS = -mcpu=cortex-a9 -mthumb +ARFLAGS = + + +# %jp{コンパイラ依存の設定読込み}%en{compiler dependent definitions} +include $(KERNEL_MAKINC_DIR)/$(ARCH_CC)_d.inc + +# %jp{ライブラリ生成用設定読込み}%en{definitions for library} +include $(KERNEL_MAKINC_DIR)/maklib_d.inc + + + + +# -------------------------------------- +# %jp{ソースファイル}%en{source files} +# -------------------------------------- + +# %jp{アセンブラファイルの追加}%en{assembry sources} +ASRCS += $(SRC_PROC_CC_DIR)/kdis_int.S +ASRCS += $(SRC_PROC_CC_DIR)/kena_int.S +ASRCS += $(SRC_PROC_CC_DIR)/kcre_ctx.S +ASRCS += $(SRC_PROC_CC_DIR)/krst_ctx.S +ASRCS += $(SRC_PROC_CC_DIR)/kswi_ctx.S +ASRCS += $(SRC_PROC_CC_DIR)/kwai_int.S +ASRCS += $(SRC_PROC_CC_DIR)/kirq_hdr.S + +# %jp{C言語ファイルの追加}%en{C sources} +CSRCS += $(SRC_PROC_DIR)/val_int.c + +# %jp{カーネル共通ソースの追加}%en{kernel common sources} +include $(KERNEL_MAKINC_DIR)/knlsrc.inc + + + + +# -------------------------------------- +# %jp{ルール定義}%en{rules} +# -------------------------------------- + +# %jp{ALL}%en{all} +.PHONY : all +all: makelib_all + $(MAKE) -C $(CFGRTR_DIR) TARGET=$(CFGRTR) ARCH_PROC=$(ARCH_PROC) ARCH_IRC=$(ARCH_IRC) + +# %jp{クリーン}%en{clean} +.PHONY : clean +clean: makelib_clean + $(MAKE) -C $(CFGRTR_DIR) TARGET=$(CFGRTR) ARCH_PROC=$(ARCH_PROC) ARCH_IRC=$(ARCH_IRC) clean + $(RM) -f *.lst + +# %jp{依存関係更新}%en{make depend} +.PHONY : depend +depend: makelib_depend + +# %jp{ソース一括コピー}%en{source files copy} +.PHONY : srccpy +srccpy: makelib_srccpy + + +# %jp{ライブラリ生成用設定読込み}%en{rules for library} +include $(KERNEL_MAKINC_DIR)/maklib_r.inc + +# %jp{コンパイラ依存のルール定義読込み}%en{rules for compiler} +include $(KERNEL_MAKINC_DIR)/$(ARCH_CC)_r.inc + + + + +# -------------------------------------- +# %jp{依存関係}%en{dependency} +# -------------------------------------- + +# %jp{カーネル依存関係読込み}{dependency list of kernel sources} +include $(KERNEL_MAKINC_DIR)/knldep.inc + + +$(OBJS_DIR)/val_int.$(EXT_OBJ) : $(COMMON_HEADERS) +$(OBJS_DIR)/kini_irc.$(EXT_OBJ) : $(COMMON_HEADERS) +$(OBJS_DIR)/kexe_irc.$(EXT_OBJ) : $(COMMON_HEADERS) +$(OBJS_DIR)/ena_int.$(EXT_OBJ) : $(COMMON_HEADERS) +$(OBJS_DIR)/dis_int.$(EXT_OBJ) : $(COMMON_HEADERS) +$(OBJS_DIR)/vclr_int.$(EXT_OBJ) : $(COMMON_HEADERS) + + + +# end of file diff --git a/kernel/include/arch/proc/arm/arm_v7a/proc.h b/kernel/include/arch/proc/arm/arm_v7a/proc.h new file mode 100644 index 0000000..9ad1038 --- /dev/null +++ b/kernel/include/arch/proc/arm/arm_v7a/proc.h @@ -0,0 +1,85 @@ +/** + * Hyper Operating System V4 Advance + * + * @file proc.h + * @brief %jp{コンテキスト制御}%en{context control} + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#ifndef _KERNEL__arch__proc__arm__arm_v7a__proc_h__ +#define _KERNEL__arch__proc__arm__arm_v7a__proc_h__ + + + +#define _KERNEL_IMSK_F 0x40 /**< %jp{FIQ割込みマスクビット} */ +#define _KERNEL_IMSK_I 0x80 /**< %jp{IRQ割込みマスクビット} */ + +#define _KERNEL_IMSK_LV0 0xc0 /**< %jp{割込みマスクレベル0(すべてマスク)} */ +#define _KERNEL_IMSK_LV1 0x80 /**< %jp{割込みマスクレベル1(FIQのみ許可)} */ +#define _KERNEL_IMSK_LV2 0x00 /**< %jp{割込みマスクレベル2(すべて許可)} */ + + + +/** %jp{コンテキスト制御ブロック} */ +typedef struct _kernel_t_ctxcb +{ + VP sp; +} _KERNEL_T_CTXCB; + +/** %jp{割込みコンテキスト制御ブロック} */ +typedef struct _kernel_t_ictxcb +{ + UB imsk; + UB intcnt; + VP isp; +} _KERNEL_T_ICTXCB; + + +extern _KERNEL_T_ICTXCB _kernel_ictxcb; /**< %jp{割込みコンテキスト制御ブロック} */ + + + +#ifdef __cplusplus +extern "C" { +#endif + +void _kernel_ena_int(void); /**< %jp{割込み許可} */ +void _kernel_dis_int(void); /**< %jp{割込み禁止} */ +void _kernel_wai_int(void); /**< %jp{割込み待ち(アイドル時の処理)} */ + +void _kernel_cre_ctx(_KERNEL_T_CTXCB *pk_ctxcb, VP isp, FP entry, VP_INT par1, VP_INT par2); /**< %jp{実行コンテキストの作成} */ +void _kernel_rst_ctx(VP_INT par1, VP_INT par2, FP entry, VP isp); /**< %jp{実行コンテキストのリスタート} */ +void _kernel_sta_ctx(_KERNEL_T_CTXCB *pk_ctxcb); /**< %jp{実行コンテキストの開始} */ +void _kernel_swi_ctx(_KERNEL_T_CTXCB *pk_ctxinf_nxt, _KERNEL_T_CTXCB *pk_ctxcb_now); /**< %jp{実行コンテキストの切替} */ + +#ifdef __cplusplus +} +#endif + + + +#define _KERNEL_INI_PRC() do {} while (0) /**< %jp{プロセッサ固有の初期化} */ + +#define _KERNEL_INI_INT(stksz, stk) do { _kernel_ictxcb.isp = (VB *)(stk) + (stksz); } while (0) /**< %jp{割込み初期化} */ +#define _KERNEL_ENA_INT() _kernel_ena_int() /**< %jp{割込み許可} */ +#define _KERNEL_DIS_INT() _kernel_dis_int() /**< %jp{割込み禁止} */ +#define _KERNEL_WAI_INT() _kernel_wai_int() /**< %jp{割込み待ち(アイドル時の処理)} */ + +#define _KERNEL_CRE_CTX(pk_ctxcb, stksz, stk, isp, entry, exinf1, exinf2) \ + _kernel_cre_ctx((pk_ctxcb), (isp), (entry), (exinf1), (exinf2)) /**< %jp{実行コンテキストの作成} */ +#define _KERNEL_DEL_CTX(pk_ctxcb) do {} while (0) /**< %jp{実行コンテキストの削除} */ +#define _KERNEL_RST_CTX(pk_ctxcb, stksz, stk, isp, entry, exinf1, exinf2) \ + _kernel_rst_ctx((exinf1), (exinf2), (entry), (isp)) /**< %jp{実行コンテキストのリスタート} */ +#define _KERNEL_STA_CTX(pk_ctxcb) _kernel_sta_ctx(pk_ctxcb) +#define _KERNEL_SWI_CTX(pk_ctxcb_now, pk_ctxinf_nxt) \ + _kernel_swi_ctx((pk_ctxinf_nxt), (pk_ctxcb_now)) /**< %jp{実行コンテキストの切替} */ + + +#endif /* _KERNEL__arch__proc__arm__arm_v7a__proc_h__ */ + + + +/* end of file */ diff --git a/kernel/include/arch/proc/arm/arm_v7a/procatr.h b/kernel/include/arch/proc/arm/arm_v7a/procatr.h new file mode 100644 index 0000000..4f11177 --- /dev/null +++ b/kernel/include/arch/proc/arm/arm_v7a/procatr.h @@ -0,0 +1,72 @@ +/** + * Hyper Operating System V4 Advance + * + * @file ctxctl.h + * @brief %jp{コンテキスト制御}%en{context control} + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#ifndef _KERNEL__arch__proc__arm__arm_v7a__procatr_h__ +#define _KERNEL__arch__proc__arm__arm_v7a__procatr_h__ + + + +/* %jp{プロセッサアーキテクチャ定義のあるインクルードパス} */ +#define _KERNEL_PROCATR_INC_PATH "arm/arm_v7a" + + +/* %jp{プロセッサアーキテクチャに依存した属性} */ +#define _KERNEL_PROCATR_CTX_STK FALSE /**< %jp{コンテキスト生成にスタック領域の指定が必要か？} */ +#define _KERNEL_PROCATR_CTX_STKSZ FALSE /**< %jp{コンテキスト生成にスタックサイズの指定が必要か？} */ +#define _KERNEL_PROCATR_CTX_ISP TRUE /**< %jp{コンテキスト生成に初期スタックポインタ値が必要か？} */ +#define _KERNEL_PROCATR_CTX_DEL FALSE /**< %jp{別コンテキストからのコンテキスト削除が必要か？} */ +#define _KERNEL_PROCATR_CTX_RST TRUE /**< %jp{自コンテキストのリスタートが可能か？} */ + +#define _KERNEL_PROCATR_TMIN_STKSZ (4*16) /**< %jp{最低限必要なスタックサイズ(byte単位)} */ +#define _KERNEL_PROCATR_DEF_SYSSTKSZ 64 +#define _KERNEL_PROCATR_DEF_INTSTKSZ 256 + +#define _KERNEL_PROCATR_SPT_SMP FALSE /**< %jp{SMPに対応しているか？} */ +#define _KERNEL_PROCATR_SPT_MULTINT TRUE /**< %jp{多重割込みに対応しているか？} */ + +#define _KERNEL_PROCATR_TMIN_INHNO 0 /**< %jp{割込みハンドラ番号の最小値} */ +#define _KERNEL_PROCATR_TMAX_INHNO 1 /**< %jp{割込みハンドラ番号の最大値} */ + +#define _KERNEL_PROCATR_TMIN_EXCNO 0 /**< %jp{CPU例外ハンドラ番号の最小値} */ +#define _KERNEL_PROCATR_TMAX_EXCNO 4 /**< %jp{CPU例外ハンドラ番号の最大値} */ + +#define _KERNEL_PROCATR_SYSSTK_NUM 2 /**< %jp{システムスタックは何本必要か？} */ + +#define _KERNEL_PROCATR_SIGNED_INT 0 /**< %jp{符号付整数と符号無し整数のどちらが得意か？(符号付き:1, 符号無し:-1, 同じ:0)} */ +#define _KERNEL_PROCATR_TBIT_INT 32 /**< %jp{プロセッサに最適な整数型のビット数} */ +#define _KERNEL_PROCATR_TBIT_PTR 32 /**< %jp{ポインタのビット数} */ +#define _KERNEL_PROCATR_MEM_ALIGN 32 /**< %jp{適切なメモリのアライメント(byte単位)} */ +#define _KERNEL_PROCATR_STK_ALIGN 8 /**< %jp{適切なスタックのアライメント(byte単位)} */ +#define _KERNEL_PROCATR_ALLOW_UNALIGN FALSE /**< %jp{アンアラインアクセスは可能か？} */ + +#define _KERNEL_PROCATR_SYS_CTX FALSE /**< %jp{コンテキスト状態管理をプロセッサで実施するか？} */ +#define _KERNEL_PROCATR_SYS_LOC FALSE /**< %jp{CPUロック状態管理をプロセッサで実施するか？} */ +#define _KERNEL_PROCATR_SYS_DSP FALSE /**< %jp{ディスパッチ禁止状態管理をプロセッサで実施するか？} */ +#define _KERNEL_PROCATR_SYS_SYS FALSE /**< %jp{システム状態管理をプロセッサで実施するか？} */ +#define _KERNEL_PROCATR_SYS_DLY FALSE /**< %jp{遅延ディスパッチ保留状態管理をプロセッサで実施するか？} */ + + +/* %jp{ARM固有の定数} */ +#define _KERNEL_ARM_INHNO_IRQ 0 /**< %jp{IRQ割込みの割込みハンドラ番号} */ +#define _KERNEL_ARM_INHNO_FIQ 1 /**< %jp{FIQ割込みの割込みハンドラ番号} */ + +#define _KERNEL_ARM_EXCNO_RST 0 /**< %jp{リセットのCPU例外ハンドラ番号} */ +#define _KERNEL_ARM_EXCNO_UND 1 /**< %jp{無効命令例外のCPU例外ハンドラ番号} */ +#define _KERNEL_ARM_EXCNO_SWI 2 /**< %jp{ソフトウェア割込みのCPU例外ハンドラ番号} */ +#define _KERNEL_ARM_EXCNO_PRE 3 /**< %jp{プリフェッチアボートのCPU例外ハンドラ番号} */ +#define _KERNEL_ARM_EXCNO_ABT 4 /**< %jp{データアボートのCPU例外ハンドラ番号} */ + + + +#endif /* _KERNEL__arch__proc__arm__arm_v7a__procatr_h__ */ + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/arm_v7a.inc b/kernel/source/arch/proc/arm/arm_v7a/gcc/arm_v7a.inc new file mode 100644 index 0000000..7746d59 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/arm_v7a.inc @@ -0,0 +1,36 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2006 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +/* %jp{割込みハンドラ番号}%en{interruput handler number} */ +#define INHNO_IRQ 0 +#define INHNO_FIQ 1 + + +/* %jp{_KERNEL_T_ICTXCB構造体オフセット} */ +#define ICTXCB_IMSK 0 +#define ICTXCB_INTCNT 1 +#define ICTXCB_ISP 4 + + +/* %jp{プロセッサモード定義} */ +#define Mode_USR 0x10 /* USR モード */ +#define Mode_FIQ 0x11 /* FIQ モード */ +#define Mode_IRQ 0x12 /* IRQ モード */ +#define Mode_SVC 0x13 /* SVC モード */ +#define Mode_ABT 0x17 /* ABT モード */ +#define Mode_UND 0x1b /* UND モード */ +#define Mode_SYS 0x1f /* SYS モード */ +#define Mode_MASK 0x1f /* モードビットマスク */ + +/* %jp{フラグ定義} */ +#define T_Bit 0x20 /* T ビット */ +#define F_Bit 0x40 /* F ビット */ +#define I_Bit 0x80 /* I ビット */ + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/kcre_ctx.S b/kernel/source/arch/proc/arm/arm_v7a/gcc/kcre_ctx.S new file mode 100644 index 0000000..05ce658 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/kcre_ctx.S @@ -0,0 +1,49 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#include "arm_v7a.inc" + + + .code 16 + .text + .align 2 + +/************************************************ + 実行コンテキストの作成 + void _kernel_cre_ctx( + _KERNEL_T_CTXCB *pk_ctxcb, r0 :作成するコンテキスト + VP isp, r1 :スタックポインタ + FP entry, r2 :実行アドレス + VP_INT par1, r3 :実行時パラメータ + VP_INT par2) sp[0]:実行時パラメータ + ************************************************/ + .global _kernel_cre_ctx +_kernel_cre_ctx: + sub r1, #36 /* スタックを確保 */ + str r2, [r1, #0] /* r4 部分にentryを設定 */ + str r3, [r1, #4] /* r5 部分にpar1を設定 */ + ldr r2, [sp, #0] /* par2を取り出し */ + str r2, [r1, #8] /* r6 部分にpar2を設定 */ + adr r2, ctx_entry /* エントリーアドレス設定 */ + add r2, #1 /* Thumbモードアドレスとして設定 */ + str r2, [r1, #32] /* lr 部分にエントリーアドレスを設定 */ + str r1, [r0] /* ctxcb に新 sp を保存 */ + bx lr /* リターン */ + +/************************************************ + 実行コンテキストエントリーアドレス + ************************************************/ +ctx_entry: + mov r0, r5 /* par1を設定 */ + mov r1, r6 /* par2を設定 */ + bx r4 /* entry を実行 */ + + .end + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/kdis_int.S b/kernel/source/arch/proc/arm/arm_v7a/gcc/kdis_int.S new file mode 100644 index 0000000..8877fa6 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/kdis_int.S @@ -0,0 +1,28 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#include "arm_v7a.inc" + + + .text + .align 2 + +/************************************************ + 割り込み禁止 + void _kernel_dis_int(void) + ************************************************/ + .global _kernel_dis_int +_kernel_dis_int: + cpsid fi /* 割り込み禁止 */ + bx lr /* リターン */ + + + .end + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/kena_int.S b/kernel/source/arch/proc/arm/arm_v7a/gcc/kena_int.S new file mode 100644 index 0000000..143d7b0 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/kena_int.S @@ -0,0 +1,34 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#include "arm_v7a.inc" + + .code 32 + .text + .align 2 + +/************************************************ + 割り込み許可 + void _kernel_ena_int(void) + ************************************************/ + .global _kernel_ena_int + .global _kernel_ictxcb +_kernel_ena_int: + ldr r1, =_kernel_ictxcb + mrs r0, cpsr /* cpsr取得 */ + ldrb r1, [r1, #ICTXCB_IMSK] /* 割込みマスク値取得 */ + bic r0, r0, #(F_Bit | I_Bit) /* FビットとIビットをクリア */ + orr r0, r0, r1 /* 割込みマスク設定 */ + msr cpsr_c, r0 /* cpsr設定 */ + bx lr /* リターン */ + + + .end + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/kirq_hdr.S b/kernel/source/arch/proc/arm/arm_v7a/gcc/kirq_hdr.S new file mode 100644 index 0000000..a1aed71 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/kirq_hdr.S @@ -0,0 +1,116 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#include "arm_v7a.inc" + + + .code 32 + .text + .align 2 + + .global _kernel_ictxcb + .global _kernel_sta_inh + .global _kernel_end_inh + .global _kernel_exe_inh + +/************************************************ + IRQ handler + ************************************************/ + .global _kernel_irq_hdr +_kernel_irq_hdr: + /* ---- レジスタ退避 */ + sub lr, lr, #4 /* リターンアドレス算出 */ + /* srsfd #Mode_SYS! */ /* lr_irq, spsr_irqをSYSモードスタックに退避 */ + .long 0xf96d051f + cps #Mode_SYS /* SYSモードに移行 */ + stmfd sp!, {r0-r3, r12, lr} /* 汎用レジスタ退避 */ + mrs r2, cpsr /* cpsrをr2に退避 */ + cpsid fi /* 割り込み禁止 */ + + /* ---- 割込みマスク設定 */ + ldr r0, =_kernel_ictxcb + ldr r3, [r0, #ICTXCB_IMSK] /* 古いimsk値を取り出し */ + and r2, r2, #(F_Bit | I_Bit) + strb r2, [r0, #ICTXCB_IMSK] /* cpsr値をimsk値に設定 */ + + /* ---- 多重割込み判定 */ + ldrb r1, [r0, #ICTXCB_INTCNT] /* 割り込みネストカウンタ値取得 */ + add r1, r1, #1 /* 割り込みネストカウンタインクリメント */ + strb r1, [r0, #ICTXCB_INTCNT] /* 割り込みネストカウンタ設定 */ + cmp r1, #1 + bne multiple_int /* 多重割り込みなら分岐 */ + + /* ---- SPを割込みコンテキストのものに切替え */ + mov r1, sp /* タスクのSPを保存 */ + ldr sp, [r0, #ICTXCB_ISP] /* 割り込み用スタックに切り替え */ + stmfd sp!, {r1, r3} /* タスクのSPと旧imask保存 */ + + /* ---- 割込み開始処理 */ + bl _kernel_sta_inh /* 割り込み開始 */ + + /* ---- 割込みハンドラ実行 */ + mov r0, #INHNO_IRQ + bl _kernel_exe_inh + + /* ---- 割込み処理の終了設定 */ + ldmfd sp!, {r1, r3} /* 汎用レジスタ復帰 */ + mov sp, r1 /* SPを元のコンテキストのものに戻す */ + ldr r0, =_kernel_ictxcb /* 割り込みネストカウンタのアドレス取得 */ + mov r1, #0 /* 割り込みネストカウンタを0に戻す */ + strb r1, [r0, #ICTXCB_INTCNT] /* 割り込みネストカウンタ値設定 */ + + /* ---- 割込みマスク値復帰処理 */ + ldr r1, [sp, #28] /* spsr_irq 値取り出し */ + and r1, r1, #(F_Bit | I_Bit) + cmp r1, r3 /* 旧imsk値と比較 */ + bne return_int /* 不一致なら終了処理スキップ */ + strb r3, [r0, #ICTXCB_IMSK] /* マスク値復帰 */ + + /* ---- 割込み終了処理 */ + bl _kernel_end_inh /* 割り込み終了処理 */ + + ldr r0, =_kernel_ictxcb + ldr r1, [sp, #28] /* spsr_irq 値取り出し */ + ldrb r0, [r0, #ICTXCB_IMSK] /* この時点でのimsk値取り出し */ + bic r1, r1, #(F_Bit | I_Bit) + and r0, r0, #(F_Bit | I_Bit) + orr r1, r1, r0 + str r1, [sp, #28] /* spsr_irq にimsk値反映 */ + +return_int: + /* ---- 復帰処理 */ + ldmfd sp!, {r0-r3, r12, lr} /* 汎用レジスタ復帰 */ + rfefd sp! /* リターン */ + + + /* ---- 多重割り込み処理 */ +multiple_int: + /* ---- スタックを8バイトアライメントに移動 */ + mov r1, sp /* 割り込み発生時のSYSモードのSPに8の倍数の保証されないので */ + bic sp, sp, #0x7 + stmfd sp!, {r0, r1} /* タスクのSPを割り込み用スタックに保存(8の倍数になるようにr1も) */ + + /* ---- 割り込みハンドラ実行 */ + mov r0, #INHNO_IRQ + bl _kernel_exe_inh + + /* ---- スタックアライメント復帰 */ + ldmfd sp!, {r0, r1} /* 汎用レジスタ復帰 */ + mov sp, r1 + + /* ---- 割り込みカウンタ復帰 */ + ldrb r1, [r0, #ICTXCB_INTCNT] + add r1, r1, #1 + strb r1, [r0, #ICTXCB_INTCNT] + b return_int /* 復帰処理 */ + + + .end + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/krst_ctx.S b/kernel/source/arch/proc/arm/arm_v7a/gcc/krst_ctx.S new file mode 100644 index 0000000..93b4c83 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/krst_ctx.S @@ -0,0 +1,31 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#include "arm_v7a.inc" + + + .text + .align 2 + +/************************************************ + 実行コンテキストのリスタート + void _kernel_rst_ctx( + VP_INT par1, r0 : 実行時パラメータ + VP_INT par2, r1 : 実行時パラメータ + FP entry, r2 : 実行アドレス + VP isp) r3 : スタックポインタ + ************************************************/ + .global _kernel_rst_ctx +_kernel_rst_ctx: + mov sp, r3 /* スタックを初期値にリセット */ + bx r2 /* エントリーアドレスから再開始 */ + + .end + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/kswi_ctx.S b/kernel/source/arch/proc/arm/arm_v7a/gcc/kswi_ctx.S new file mode 100644 index 0000000..2ba7585 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/kswi_ctx.S @@ -0,0 +1,42 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#include "arm_v7a.inc" + + + .text + .align 2 + +/************************************************ + 実行コンテキストの切替 + void _kernel_swi_ctx( + _KERNEL_T_CTXCB *pk_ctxinf_nxt, r0 : 現在のコンテキストの保存先 + _KERNEL_T_CTXCB *pk_ctxinf_now) r1 : 切り替えるコンテキスト + ************************************************/ + .global _kernel_swi_ctx +_kernel_swi_ctx: + stmfd sp!, {r4-r11, lr} /* レジスタ保存 */ + str sp, [r1] /* スタックポインタ保存 */ + /* --- そのまま _kernel_sta_ctx に続ける */ + + +/************************************************ + 実行コンテキストの開始 + void _kernel_sta_ctx( + _KERNEL_T_CTXCB *pk_ctxcb) r0: 実行を開始するコンテキスト + ************************************************/ + .global _kernel_sta_ctx +_kernel_sta_ctx: + ldr sp, [r0] /* スタックポインタ復帰 */ + ldmfd sp!, {r4-r11, pc} /* レジスタ復帰 */ + + .end + + +; end of file + diff --git a/kernel/source/arch/proc/arm/arm_v7a/gcc/kwai_int.S b/kernel/source/arch/proc/arm/arm_v7a/gcc/kwai_int.S new file mode 100644 index 0000000..2a0abda --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/gcc/kwai_int.S @@ -0,0 +1,27 @@ +/** + * Hyper Operating System V4 Advance + * + * Copyright (C) 1998-2014 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + + +#include "arm_v7a.inc" + + .text + .align 2 + +/************************************************ + 割り込み待ち(CPUのアイドル処理) + void _kernel_wai_int(void); + ************************************************/ + .global _kernel_wai_int +_kernel_wai_int: + /* mcr p15, 0, r0, c7, c0, 4 */ /* WaitForInterrupt */ + b _kernel_wai_int + + + .end + + +/* end of file */ diff --git a/kernel/source/arch/proc/arm/arm_v7a/val_int.c b/kernel/source/arch/proc/arm/arm_v7a/val_int.c new file mode 100644 index 0000000..ee341e5 --- /dev/null +++ b/kernel/source/arch/proc/arm/arm_v7a/val_int.c @@ -0,0 +1,18 @@ +/** + * Hyper Operating System V4 Advance + * + * @file val_int.c + * @brief %jp{割込み用変数定義} + * + * Copyright (C) 1998-2006 by Project HOS + * http://sourceforge.jp/projects/hos/ + */ + +#include "core/core.h" + + +_KERNEL_T_ICTXCB _kernel_ictxcb; /**< %jp{割込みコンテキスト制御ブロック} */ + + +/* end of file */ + -- 2.11.0