Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Normal
Revision Log

source: ssp_qb_r5f100le_cs/trunk/arch/rl78_ca78k0r/prc_support.asm@ 93

Last change on this file since 93 was 93, checked in by nmir-saito, 9 years ago
add Combined package of SSP kernel for QB-R5F100LE-TB(RL78 processor)
File size: 8.5 KB

Rev	Line
[93]	1	;
	2	; TOPPERS/SSP Kernel
	3	; Smallest Set Profile Kernel
	4	;
	5	; Copyright (C) 2014 by Naoki Saito
	6	; Nagoya Municipal Industrial Research Institute, JAPAN
	7	;
	8	; ãLì ÒÍCÈºÌ (1)`(4) Ìðð½·êÉÀèC{\tgEF
	9	; Ai{\tgEFAðüÏµ½àÌðÜÞDÈº¯¶jðgpE¡»EüÏE
	10	; ÄzziÈºCpÆÄÔj·é±Æð³Åø·éD
	11	; (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
	12	; \¦C±Ìpð¨æÑºLÌ³ÛØKèªC»ÌÜÜÌ`Å\[X
	13	; R[hÉÜÜêÄ¢é±ÆD
	14	; (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉgp
	15	; Å«é`ÅÄzz·éêÉÍCÄzzÉº¤hL
	16	gipÒ}
	17	; j
	18	AÈÇjÉCãLÌì \¦C±Ìpð¨æÑºLÌ³Û
	19	; ØKèðfÚ·é±ÆD
	20	; (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉgp
	21	; Å«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±ÆD
	22	; (a) ÄzzÉº¤hL
	23	gipÒ}j
	24	AÈÇjÉCãLÌì
	25	; \¦C±Ìpð¨æÑºLÌ³ÛØKèðfÚ·é±ÆD
	26	; (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉñ
	27	; ·é±ÆD
	28	; (4) {\tgEFAÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶é¢©Èé¹Q
	29	; ©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆDÜ½C
	30	; {\tgEFAÌ[UÜ½ÍGh[U©çÌ¢©ÈéRÉîÃ
	31	; ¿©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
	32	;
	33	; {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨æ
	34	; ÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚIÉÎ·
	35	; éK«àÜßÄC¢©ÈéÛØàsíÈ¢DÜ½C{\tgEFAÌp
	36	; Éæè¼ÚIÜ½ÍÔÚIÉ¶¶½¢©Èé¹QÉÖµÄàC»ÌÓCð
	37	; íÈ¢D
	38	;
	39	;
	40
	41	;
	42	; J[lÀÌvZbTË¶ª
	43	;
	44
	45	;
	46	; }Nè`ÌCN[h
	47	;
	48	$INCLUDE(prc_support_def.inc)
	49
	50	;
	51	; O[oV{
	52	;
	53	; RpCªgp·é saddrÌæÌWX^
	54	extrn _@RTARG0,_@RTARG2,_@RTARG4,_@RTARG6,_@SEGAX,_@SEGDE
	55	extrn _@NRARG0,_@NRARG1,_@NRARG2,_@NRARG3
	56	extrn _@NRAT00,_@NRAT02,_@NRAT04,_@NRAT06
	57	; kernel_cfg.c
	58	extrn __kernel_istkpt ; X^bN\|C^Ìúl
	59	; prc_config.c
	60	extrn _t_lock_cpu ; CPUbNóÔÖÌÚs
	61	extrn __kernel_intnest ; ÝÌlXgJE^
	62	extrn __kernel_lock_flag ; CPUbNtO
	63	; task.c
	64	extrn __kernel_dispatcher ; fBXpb`
	65	extrn __kernel_reqflg ; fBXpb`vtO
	66	extrn __kernel_disdsp ; fBXpb`Ö~óÔ
	67	extrn __kernel_search_schedtsk ; ÅDæxÌT[`
	68	extrn __kernel_run_task ; ^XNÌJn
	69	; startup.c
	70	extrn __kernel_exit_kernel ; J[lÌI¹
	71
	72	; prc_support.asm
	73	public __kernel_start_dispatch ; fBXpb`ÌJn
	74	public __kernel_call_exit_kernel ; I¹ÌR[
	75	public __kernel_interrupt_entry ; ÝÌüû(¤Ê)
	76	public __kernel_int_return ; WX^ðAµÄÝ¶³Ö^[
	77	public _unused_interrupt ; ¢gpÝÌ
	78
	79	;
	80	; RpCÅgp·ésaddrÌæÌWX^ðÛ¶
	81	;
	82	restore_saddr_regs macro
	83	$if (ALLOC_REGVAR_TO_SADDR) ; -qr IvVðgp·éê
	84	pop ax ; WX^A
	85	movw _@NRAT06, ax ;
	86	pop ax ;
	87	movw _@NRAT04, ax ;
	88	pop ax ;
	89	movw _@NRAT02, ax ;
	90	pop ax ;
	91	movw _@NRAT00, ax ;
	92	pop ax ;
	93	movw _@NRARG3, ax ;
	94	pop ax ;
	95	movw _@NRARG2, ax ;
	96	pop ax ;
	97	movw _@NRARG1, ax ;
	98	pop ax ;
	99	movw _@NRARG0, ax ;
	100	$endif
	101	pop ax ; WX^A
	102	movw _@SEGDE, ax ;
	103	pop ax ;
	104	movw _@SEGAX, ax ;
	105	pop ax ;
	106	movw _@RTARG6, ax ;
	107	pop ax ;
	108	movw _@RTARG4, ax ;
	109	pop ax ;
	110	movw _@RTARG2, ax ;
	111	pop ax ;
	112	movw _@RTARG0, ax ;
	113	endm
	114
	115	;
	116	; X^bN\|C^ðú»
	117	;
	118	reset_sp macro
	119	movw de, #__kernel_istkpt
	120	mov es, #00H
	121	movw ax, es:[de]
	122	movw sp, ax
	123	endm
	124
	125	;
	126	; PSW Ì ISP1 = 1, ISP0 = 1 ÉµÄÝÌ}XNðð·é
	127	;
	128	clear_pswisp_mask macro
	129	mov a, psw
	130	and a, #0f9h
	131	or a, #06h ; PSW.ISP{1,0}=(1,1)
	132	mov psw, a
	133	endm
	134
	135	@@CODE CSEG BASE
	136
	137	;
	138	; J[lÌ®ìJnÉKvÆ³êéãnðs¤½ßÌÖ
	139	; sta_ker(startup.c) ©çÄÑo³êéD
	140	;
	141	__kernel_start_dispatch:
	142	;
	143	; CPUbNóÔÆSÝbNóÔÆðæÊ·éKvª éêC
	144	; CPUbNóÔÉµCSÝbNÌóÔðð·éD
	145	;
	146	call !!_t_lock_cpu
	147	$_IF (TMIN_INTPRI_EQU_MINUS4)
	148	clear_pswisp_mask
	149	$ELSE
	150	ei
	151	$ENDIF
	152	;
	153	; X^bN\|C^ðú»·é
	154	; sta_ker ©ç start_dispatch ÌÖR[ÉæéX^bNÁïªð
	155	; NA·é½ßCX^bN\|C^ðú»·éD
	156	;
	157	reset_sp
	158
	159	;
	160	; dispatcher (task.c) ÖWv·é
	161	; ÖR[ÉµÈ¢ÌÍX^bNðßñ·é½ßD
	162	;
	163	; dispatcher (kernel/task.c) ÌÄÑoµ
	164	br !!__kernel_dispatcher
	165
	166
	167	;
	168	; I¹ÌÄÑoµ
	169	; X^bN\|C^ðú»µCexit_kernel ðÄÑo·D
	170	;
	171	__kernel_call_exit_kernel:
	172	reset_sp
	173	br __kernel_exit_kernel
	174
	175
	176	@@BASE CSEG BASE
	177
	178	;
	179	; Ý/CPUáOÌoüû(¤Ê)
	180	; J[lÇÌÝÜ½ÍCPUáOÌêÉWX^Û¶ãCÄÑo³êéD
	181	;
	182	; Oñð
	183	; EPSWWX^ÌIErbg=0, ISPÍót¯½ÝÌISP.
	184	; EnhÌAhXª bc Éi[³êÄ¢é.
	185	; ECPUáOnhÌüû©ç½êCX^bN\|C^Ì
	186	; æªÔn(p_excinf)ª ax Éi[³êÄ¨èC
	187	; ±êÍCPUáOnhÌø(p_excinf)ÆµÄ»ÌÜÜn³êéD
	188	;
	189	; WX^ªX^bNãÉÇÌæ¤ÉÛ¶³êÄ¢é©ðÈºÉ¦·.
	190	; }ÍÀÑÌÝð\»µ½àÌÅ èCTCYðl¶µÄ¢È¢±ÆÉÓ·éD
	191	; ³mÉÍf[^V[gðQÆÌ±ÆD
	192	; ±Ì}ÅÍãªáÊ, ºªÊÌAhXÅ, X^bNÍ}Ìº¤©ç
	193	; ãûüÉü©ÁÄÏÝã°çêéàÌÆ·é.
	194	;
	195	; ¦1 saddrÌæÌ[NGAÍRpCIvV -qr ðwè·éêÉ
	196	; Û¶ªKvÅ èCÊíÍÛ¶µÈ¢DÛ¶·éêÍAZuIvV
	197	; ÉÄuALLOC_REGVAR_TO_SADDRvðè`·é±ÆD
	198	;
	199	; ¦2 CPUáOÌüûðoRµ½êÌÝÛ¶³êé
	200	;
	201	;
	202	; ---------------<-- p_excinf(¦)
	203	; \| saddrÌæ \|
	204	; \|[NpGA\|
	205	; \| (16byte)¦1 \|
	206	; ---------------<-- p_excinf
	207	; \| saddrÌæ \|
	208	; \|ZOgîñ\|
	209	; \| i[pGA \|
	210	; \| (4byte) \|
	211	; ---------------
	212	; \| saddrÌæ \|
	213	; \| ^C \|
	214	; \| øGA \|
	215	; \| (8byte) \|
	216	; ---------------
	217	; \| ES,CS(2byte) \|
	218	; ---------------
	219	; \| HL(2byte) \|
	220	; ---------------
	221	; \| DE(2byte) \|
	222	; ---------------
	223	; \| BC(2byte) \|
	224	; ---------------
	225	; \| AX(2byte) \|
	226	; ---------------
	227	; \| PC(2byte) \|
	228	; ---------------
	229	; \| PSW(1byte) \|
	230	; ---------------
	231	;
	232	; nh©ç^[µ½ãÍ, ½dÝÅÈ, ©ÂC
	233	; reqflg ª TRUEC©ÂCdisdsp ª FALSE ÌÉCinterrupt_dispatch Öªò·éD
	234	;
	235	; ½dÝ©Ç¤©ÍÝlXgJE^ÌlÅ»è·é.
	236	; intnest > 0 ÈçÎ½dÝÅ éÆ»è·é.
	237	;
	238
	239	__kernel_interrupt_entry:
	240	inc !__kernel_intnest ; lXgJE^ðCNg
	241	ei ; ÝÂ(IPLÍó¯t¯çê½ÝÌx)
	242	call bc ; ÝnhÄÑoµ
	243	di ; ÝÖ~
	244	dec !__kernel_intnest ; lXgJE^ðfNg
	245	bnz $__kernel_int_return ; ßèæªñ^XNReLXg(ñ[)ÈçPÉ^[
	246	movw ax,!__kernel_reqflg ; fBXpb`vª é©Ç¤©
	247	cmpw ax, #0
	248	bz $__kernel_int_return ; È¯êÎCPÉ^[
	249	movw ax, #0
	250	movw !__kernel_reqflg, ax ; reqflg = FALSE ÉßµÄ¨
	251	movw ax, !__kernel_disdsp ; fBXpb`Ö~©Ç¤©
	252	cmpw ax, #0
	253	bnz $__kernel_int_return ; Ö~ÈçCPÉ^[
	254
	255	;
	256	; ÝÌoû(fBXpb`t«)
	257	; CPU bNÌóÔÉÚsµCVK^XNðJn·é
	258	;
	259	; OñðF
	260	; PSWWX^ÌIEtO = 0 (ÝÖ~)
	261	; PSWWX^ÌISP{1,0} = ó¯t¯½ÝÌÝx
	262	;
	263	__kernel_interrupt_dispatch:
	264	call !!_t_lock_cpu
	265	$_IF (TMIN_INTPRI_EQU_MINUS4)
	266	clear_pswisp_mask
	267	$ELSE
	268	ei
	269	$ENDIF
	270	call !!__kernel_search_schedtsk
	271	movw ax, bc
	272	call !!__kernel_run_task
	273
	274	; run_task ©çÌ^[ãÌóÔ: CPUbNóÔ
	275	; __kernel_int_return Ì reti Å PSW Ì IE, ISP Í
	276	; Ý¶OÌóÔÉßé½ßClock_flag ¾¯³Éß·D
	277	movw ax, #0
	278	movw !__kernel_lock_flag, ax ; lock_flag ðNA
	279
	280	;
	281	; WX^AµÄÝ©ç^[
	282	;
	283	__kernel_int_return:
	284	restore_saddr_regs ; saddrÌæÌWX^A
	285	pop ax ; ES, CS ÌA
	286	mov cs, a ;
	287	mov a, x ;
	288	mov es, a ;
	289	pop hl ; WX^ðA
	290	pop de
	291	pop bc
	292	pop ax
	293	reti
	294
	295	;
	296	; ³À[v(OÌ½ß)
	297	;
	298	_loop:
	299	br $_loop
	300
	301	;
	302	; ¢gpÝ
	303	;
	304	_unused_interrupt:
	305	reti
	306
	307	end

Note: See TracBrowser for help on using the repository browser.

Download in other formats: