/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *
 *  TOPPERS/JSP for Blackfin
 *
 *  Copyright (C) 2004 by Suikan
 *  Copyright (C) 2004 by Ujinosuke
 *
 *  忋婰挊嶌尃?zhēng)覀蛠C埲壓偺 (1)乣(4) 偺忦審偐丆Free Software Foundation 
 *  偵傛?zhèn)羵膶鰰\偝傟偰偄傞 GNU General Public License 偺 Version 2 偵婰
 *  弎偝傟偰偄傞忦審傪枮偨偡応崌偵尷傝丆杮僜僼僩僂僃傾乮杮僜僼僩僂僃傾
 *  傪夵曄偟偨傕偺傪娷傓丏埲壓摨偠乯傪巊梡丒暋惢丒夵曄丒嵞攝晍乮埲壓丆
 *  棙梡偲屇傇乯偡傞偙偲傪柍彏偱嫋戻偡傞丏
 *  (1) 杮僜僼僩僂僃傾傪僜乕僗僐乕僪偺宍偱棙梡偡傞応崌偵偼丆忋婰偺挊嶌
 *      尃昞帵丆偙偺棙梡忦審偍傛?zhèn)褖簨L偺?hào)硶蹚貗K掕偑丆偦偺傑傑偺宍偱僜乕
 *      僗僐乕僪拞偵娷傑傟偰偄傞偙偲丏
 *  (2) 杮僜僼僩僂僃傾傪丆儔僀僽儔儕宍幃側(cè)偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒傞宍偱嵞攝晍偡傞応崌偵偼丆嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡
 *      幰儅僯儏傾儖側(cè)偳乯偵丆忋婰偺挊嶌尃昞帵丆偙偺棙梡忦審偍傛?zhèn)褖簨L
 *      偺?hào)硶蹚貗K掕傪宖嵹偡傞偙偲丏
 *  (3) 杮僜僼僩僂僃傾傪丆婡婍偵慻傒崬傓側(cè)偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒側(cè)偄宍偱嵞攝晍偡傞応崌偵偼丆師偺偄偢?jìng)陚﹤虖饘弬饢瀭絺穫? *      偲丏
 *    (a) 嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡幰儅僯儏傾儖側(cè)偳乯偵丆忋婰偺挊
 *        嶌尃昞帵丆偙偺棙梡忦審偍傛?zhèn)褖簨L偺?hào)硶蹚貗K掕傪宖嵹偡傞偙偲丏
 *    (b) 嵞攝晍偺宍懺傪丆暿偵掕傔傞曽朄偵傛?zhèn)羵膩CTOPPERS僾儘僕僃僋僩偵
 *        曬崘偡傞偙偲丏
 *  (4) 杮僜僼僩僂僃傾偺棙梡偵傛?zhèn)钂紣趽I傑偨偼娫愙揑偵惗偠傞偄偐側(cè)傞懝
 *      奞偐傜傕丆忋婰挊嶌尃?zhēng)覀▊鎮(zhèn)裈OPPERS僾儘僕僃僋僩傪柶愑偡傞偙偲丏
 * 
 *  杮僜僼僩僂僃傾偼丆柍曐徹偱採(cǎi)嫙偝傟偰偄傞傕偺偱偁傞丏忋婰挊嶌尃?zhēng)覀? *  傛?zhèn)裈OPPERS僾儘僕僃僋僩偼丆杮僜僼僩僂僃傾偵娭偟偰丆偦偺揔梡壜擻惈傕
 *  娷傔偰丆偄偐側(cè)傞曐徹傕峴傢側(cè)偄丏傑偨丆杮僜僼僩僂僃傾偺棙梡偵傛?zhèn)钂? *  愙揑傑偨偼娫愙揑偵惗偠偨偄偐側(cè)傞懝奞偵娭偟偰傕丆偦偺愑擟傪晧傢側(cè)偄丏
 * 
 *  
 */


#define _MACRO_ONLY

/*
 *	僇乕僱儖梡偺僗僞乕僩傾僢僾儌僕儏乕儖乮BLACKfin梡乯
 */
 
//#include "jsp_kernel.h"
 
			// 32bit 儗僕僗僞偵懄抣傪儘乕僪偡傞儅僋儘
#define LOAD( reg, value32 ) reg##.h = hi(value32); reg##.l = lo(value32);

			// 妱崬傒丄椺奜偐傜偺?hào)邆鑲饍妰N僄僗僩偡傞椺奜堷悢
#define RETURNREQ 0xf

#include <def_lpblackfin.h>

#include "saverestore.h"
#include "offset.h"



.section program;
.global start;
.extern __kernel_exc_vector;
.extern __kernel_device_dispatcher, __kernel_call_texrtn, __kernel_dispatch, __kernel_enadsp;
.extern __kernel_reqflg, __kernel_runtsk, __kernel_schedtsk, ldf_stack_end;
.extern _kernel_start;
.extern _mi_initialize;
.extern ___ctorloop;

start:
	R0 = 0;
	LC0 = R0;
	LC1 = R0;
	L0 = R0;
	L1 = R0;
	L2 = R0;
	L3 = R0;

	LOAD( p0, ldf_stack_end )
	sp = p0;
#ifdef USE_RUNTIME_INIT			// board_config.h 傪嶲徠
	sp += -12;
	call _mi_initialize;		// 僥乕僽儖弶婜壔
	sp += 12;
	cc = r0;					// 曉傝抣傪僠僃僢僋
invalid : 
	if cc jump invalid; 		// 旕0側(cè)傜僄儔乕
#endif
	r0 = syscfg;
	r1 = 0x4;					// 僙儖僼丒僱僗僥傿儞僌妱崬傒
	r0 = r0 | r1;
	bitset(r0, 1);				// Enable cycle counter Added by Chen Yi @srf
	syscfg = r0;				// 僙儖僼丒僱僗僩傪桳岠偵
					// TOPPERS/JSP for BLACKfin偼 emu,rst,nmi傪娗棟偟側(cè)偄
	LOAD( p0,EVT0+2*4)	// NMI儀僋僩儖
	p1 = 4;


	LOAD( r0, nmiEntry )		// NMI
	[p0++p1] = r0;

	LOAD( r0, expEntry)		// EXP
	[p0++p1] = r0;

	p0 = p0+p1;					// 梊栺椞堟?zhèn)饍X僉僢僾

	LOAD( r0, ivHWEntry)		// 僴乕僪僂僃傾僄儔乕
	[p0++p1] = r0;

	LOAD( r0, ivTMREntry)		// 僞僀儅乕
	[p0++p1] = r0;

	LOAD( r0, ivg7Entry)		// IVG7
	[p0++p1] = r0;

	LOAD( r0, ivg8Entry)		// IVG8
	r0.H = ivg8Entry;
	[p0++p1] = r0;

	LOAD( r0, ivg9Entry)		// IVG9
	[p0++p1] = r0;

	LOAD( r0, ivg10Entry)		// IVG10
	[p0++p1] = r0;

	LOAD( r0, ivg11Entry)		// IVG11
	[p0++p1] = r0;

	LOAD( r0, ivg12Entry)		// IVG12
	[p0++p1] = r0;

	LOAD( r0, ivg13Entry)		// IVG13
	[p0++p1] = r0;

	LOAD( r0, ivg14Entry)		// IVG14
	[p0++p1] = r0;

	LOAD( r0, task_level)		// IVG15偼僞僗僋偵慗堏偡傞偨傔偺僄儞僩儕乕
	[p0++p1] = r0;
	
	LOAD( p2, user)				// 僟儈乕偺?hào)邆钄話n傪愝掕
	reti = p2;
	csync;
	raise	15;					// IVG15傪惗婲偡傞丅妱傝崬傒偼抶墑敪惗偡傞丅
	
	r0 = 0xC01F(z);				// IVG15傪庴晅壜擻偵(CPU儘僢僋忬懺)
	sti r0;
	csync;
	rti;						// 儐乕僓乕儌乕僪傊慗堏偡傞
	
task_level:                     // 偙偙偐傜僞僗僋偺幚峴弴埵
    sp += -12;
#ifdef INIT_C_PLUS_PLUS
    r0 = 0;
    r1 = 0;
    call.x ___ctorloop;
#endif
    [--sp] = reti;				// 栠傝斣抧傪幪偰偰妱傝崬傒壜擻偵偡傞
    jump _kernel_start;			// kernel_stgart()偐傜偼栠偭偰偙側(cè)偄
user:
	jump	user;
start.end:

/*
*	妱崬傒張棟偺僄儞僩儕
*
*	interrupt_handler傊偼ivgXXEntry偐傜僕儍儞僾偟偰偔傞丅p0儗僕僗僞偵偼
*	妱傝崬傒儗儀儖斣崋偑奿擺偝傟偰偄傞丅
*	妱傝崬傒偲偺僱僗僩娭學(xué)傪挷傋丄僱僗僩偟偰偄側(cè)偄側(cè)傜僀儀儞僩僗僞僢僋傪僙僢僩偡傞丅
*		p2 : reqflg偺傾僪儗僗
*		r6 : 僞僗僋僗僞僢僋
*		r7 : ASTAT偺戅旔忣曬
*
*/

interrupt_dispatcher:
				// save all task context register
	save_regs;					// 儐乕僓乕儗僕僗僞偺戅旔
	r0 = 0;
	l0 = r0;
	l1 = r0;
	l2 = r0;
	l3 = r0;
	lc0 = r0;					// 惈擻掅壓梷惂偺偨傔偵LCx傪僋儕傾
	lc1 = r0;
	LOAD( p1, IPEND )			// IPEND儗僕僗僞偺傾僪儗僗
	r0 = [p1];					// IPEND偺抣傪庢摼
	r1 = 0x7fef;				// 
	r0 = r0 & r1;				// IVG15偲GID埲奜傪挷傋傞
	r0.L = ones r0;				// 張棟拞偺僀儀儞僩偺悢傪悢偊傞
	r0 += -1;					// 僀儀儞僩偺悢-1丅僱僗僩偟偰偄側(cè)偗傟偽0偵側(cè)傞丅
	cc = az;					// 僱僗僩偟偰側(cè)偗傟偽恀
	if !cc jump call_interrupt;	// 傕偟僱僗僩偟偰偄傟偽僴儞僪儔傪屇傇
								// 僱僗僩偟偰偄側(cè)偄妱傝崬傒側(cè)傜丄僗僞僢僋傪愗傝懼偊傞
	r6 = sp;					// 僞僗僋僗僞僢僋億僀儞僞傪戅旔
	LOAD( r0, ldf_stack_end)	// 僀儀儞僩僗僞僢僋億僀儞僞傪愝掕
	sp = r0;
	
call_interrupt:
	
	csync;						// Added by chen Yi @srf
	
	[--sp] = reti;				// 偙偙偱妱傝崬傒壜擻偵側(cè)傞
	r7 = astat;					// cc偵偼僱僗僩忣曬偑擖偭偰偄傞丅偦傟傪戅旔
	r0 = p0;					// 妱傝崬傒弴埵
	LOAD( p0, __kernel_device_dispatcher)
	sp += -12;					// 僟儈乕堷悢妋曐 (A)
	call	(p0);				// C尵岅偱彂偐傟偨僨僶僀僗僨傿僗僷僢僠儍傪屇傇
	sp += 12;					// 僟儈乕堷悢奐曻 (A)
	astat = r7;					// cc傪暅婣
	reti = [sp++];				// 偙偙偱嵞傃妱傝崬傒嬛巭
	if !cc jump get_back;		// 傕偟僱僗僩偟偰偄傞側(cè)傜偽丄偙偺傑傑婣傞
	
								// 偙偙偱偼妱傝崬傒偼僱僗僩偟偰偄側(cè)偄
	sp = r6;					// 僗僞僢僋傪僞僗僋僗僞僢僋偵愝掕

	LOAD( p2, __kernel_reqflg)			// reqflg偺傾僪儗僗
	r0 = [p2];					// reqflg偺抣傪庢摼
	cc = r0;					// 僨傿僗僷僢僠偐僞僗僋椺奜偺梫媮偼弌偰偄傞偐
	if !cc jump get_back(bp);	// 弌偰偄側(cè)偄側(cè)傜偽妱傝崬傑傟偨僞僗僋偵栠傞

								// 僐儞僥僉僗僩愗傝懼偊嶌嬈奐巒
	r0 = 0;						// 
	[p2] = r0;					// reqflg傪僋儕傾偡傞.
	r0 = reti;					// 僞僗僋偺?hào)邆钄話n傪庢?zhèn)鑿o偡
	r1 = 1;
	r0 = r1 | r0; 				// 僙儖僼丒僱僗僩偱偁傞偲婾憰偡傞
	[--sp] = r0;				// 栠傝斣抧傪僗僞僢僋偵偮傓
	LOAD( p0, task_context)
	
	cli r0;						// 尰嵼偺CPU儘僢僋忬懺傪庢摼
	[--sp] = r0;				// 儘僢僋忬懺傪戅旔
	
	r1 = 0xC01F(z);				// 僞僗僋僐儞僥僉僗僩偼偼CPU儘僢僋忬懺偱幚峴偡傞
#ifdef UNMANAGED_INT
    r2 = UNMANAGED_INT(z);
    r0 = r0 & r2;				// 娗棟奜妱傝崬傒偺儅僗僋忬懺傪拪弌
    r1 = r0 | r1;				// 僞僗僋僐儞僥僉僗僩偼CPU儘僢僋忬懺偱幚峴偡傞
#endif
	
	csync;						// Added by Chen Yi @srf
	sti r1;						// CPU儘僢僋 (B)
	
	reti = p0;					// 儔儀儖"task_context"傪妱傝崬傒偐傜偺?hào)邆钄話n偵偡傞
	csync;						// Added by Chen Yi @srf
	rti;						// 妱傝崬傒偐傜栠傞丅僐儞僥僉僗僩偼僞僗僋偵側(cè)傞
	csync;
task_context:					// 偙偙偼僞僗僋僐儞僥僉僗僩偱丄妱傝崬傒壜擻偱偁傞丅
	LOAD( p0, __kernel_enadsp)
	LOAD( p1, __kernel_runtsk)

	
	r2 = [p0];					// load enadsp
	cc = r2;					// 僨傿僗僷僢僠壜擻偐丠