pacint.s

itron

/* ------------------------------------------------------------------------ */
/*  Hyper Operating System V4  μITRON4.0慌屯 Real-Time OS                  */
/*    プロセッサ藐据步コンポ〖ネント (ARM gcc脱)                            */
/*                                                                          */
/*                                  Copyright (C) 1998-2002 by Project HOS  */
/*                                  http://sourceforge.jp/projects/hos/     */
/* ------------------------------------------------------------------------ */


#include "pacarm.inc"


				.text
				.align	4

				.global	_HOS_UndefinedHandler
				.global	_HOS_SwiHandler
				.global	_HOS_PrefetchHandler
				.global	_HOS_AbortHandler


/************************************************
  Undefined ハンドラ
*************************************************/
_HOS_UndefinedHandler:
				b		_HOS_UndefinedHandler



/************************************************
  SWI ハンドラ
*************************************************/
				.extern	hospac_arm_imsk
_HOS_SwiHandler:
			/* SWI戎规粕み叫し */
				ldr		r13, [lr, #-4]
				bic		r13, r13, #0xff000000

				teq 	r13, #0x10		/* カ〖ネルコ〖ルは #10 とする */
				bne 	swi_ret

			/* パラメ〖タ〖を冉年 */
				cmp		a1, #3
				and		a1, a1, #0x03
				addls	pc, pc, a1, lsl #2
				b		swi_ret
				b		swi_dis_int
				b		swi_ena_int

			/* IRQ/FIQからの牲耽 (a1 = 2) */
				ldr		r13, =pac_arm_swi_ret
				ldmia	r13, {a1, r13, lr}
				msr		spsr_csxf, r13
				subs	pc, lr, #0

			/* 充り哈み敦贿(a1 = 0) */
swi_dis_int:
				mov		r13, #(Mode_USR | I_Bit | F_Bit)
				msr 	spsr_cf, r13
				subs	pc, lr, #0

			/* 充り哈み钓材(a1 = 1) */
swi_ena_int:
				ldr		r13, =hospac_arm_imsk
				ldr		r13, [r13]
				msr 	spsr_cf, r13

swi_ret:
			/* 经丸ここに毋嘲借妄怠菇 */
				subs	pc, lr, #0


/************************************************
  Prefetch ハンドラ
*************************************************/
_HOS_PrefetchHandler:
				b		_HOS_PrefetchHandler



/************************************************
  Abort ハンドラ
*************************************************/
_HOS_AbortHandler:
				b		_HOS_AbortHandler



/************************************************
  グロ〖バル恃眶
*************************************************/
				.data
				.comm	pac_arm_swi_ret, 12		/* a1, cpsr, lr の猛畔し脱 */


				.end


/* ------------------------------------------------------------------------ */
/*  Copyright (C) 1998-2002 by Project HOS                                  */
/* ------------------------------------------------------------------------ */