sys_config.c

基于ADI BLACKFIN的jbig压缩和解压缩程序

/*
 *  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
 *
 *  忋婰挊嶌尃幰偼丆埲壓偺 (1)乣(4) 偺忦審偐丆Free Software Foundation 
 *  偵傛偭偰岞昞偝傟偰偄傞 GNU General Public License 偺 Version 2 偵婰
 *  弎偝傟偰偄傞忦審傪枮偨偡応崌偵尷傝丆杮僜僼僩僂僃傾乮杮僜僼僩僂僃傾
 *  傪夵曄偟偨傕偺傪娷傓丏埲壓摨偠乯傪巊梡丒暋惢丒夵曄丒嵞攝晍乮埲壓丆
 *  棙梡偲屇傇乯偡傞偙偲傪柍彏偱嫋戻偡傞丏
 *  (1) 杮僜僼僩僂僃傾傪僜乕僗僐乕僪偺宍偱棙梡偡傞応崌偵偼丆忋婰偺挊嶌
 *      尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕偑丆偦偺傑傑偺宍偱僜乕
 *      僗僐乕僪拞偵娷傑傟偰偄傞偙偲丏
 *  (2) 杮僜僼僩僂僃傾傪丆儔僀僽儔儕宍幃側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒傞宍偱嵞攝晍偡傞応崌偵偼丆嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡
 *      幰儅僯儏傾儖側偳乯偵丆忋婰偺挊嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰
 *      偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
 *  (3) 杮僜僼僩僂僃傾傪丆婡婍偵慻傒崬傓側偳丆懠偺僜僼僩僂僃傾奐敪偵巊
 *      梡偱偒側偄宍偱嵞攝晍偡傞応崌偵偼丆師偺偄偢傟偐偺忦審傪枮偨偡偙
 *      偲丏
 *    (a) 嵞攝晍偵敽偆僪僉儏儊儞僩乮棙梡幰儅僯儏傾儖側偳乯偵丆忋婰偺挊
 *        嶌尃昞帵丆偙偺棙梡忦審偍傛傃壓婰偺柍曐徹婯掕傪宖嵹偡傞偙偲丏
 *    (b) 嵞攝晍偺宍懺傪丆暿偵掕傔傞曽朄偵傛偭偰丆TOPPERS僾儘僕僃僋僩偵
 *        曬崘偡傞偙偲丏
 *  (4) 杮僜僼僩僂僃傾偺棙梡偵傛傝捈愙揑傑偨偼娫愙揑偵惗偠傞偄偐側傞懝
 *      奞偐傜傕丆忋婰挊嶌尃幰偍傛傃TOPPERS僾儘僕僃僋僩傪柶愑偡傞偙偲丏
 * 
 *  杮僜僼僩僂僃傾偼丆柍曐徹偱採嫙偝傟偰偄傞傕偺偱偁傞丏忋婰挊嶌尃幰偍
 *  傛傃TOPPERS僾儘僕僃僋僩偼丆杮僜僼僩僂僃傾偵娭偟偰丆偦偺揔梡壜擻惈傕
 *  娷傔偰丆偄偐側傞曐徹傕峴傢側偄丏傑偨丆杮僜僼僩僂僃傾偺棙梡偵傛傝捈
 *  愙揑傑偨偼娫愙揑偵惗偠偨偄偐側傞懝奞偵娭偟偰傕丆偦偺愑擟傪晧傢側偄丏
 * 
 *  
 */

/*
 *	僞乕僎僢僩僔僗僥儉埶懚儌僕儏乕儖乮ADSP-BF537梡乯
 */

#include "jsp_kernel.h"
#include <sil.h>
#include <cdefBF53x.h>
#include <sys/exception.h>




/*
 *  僞乕僎僢僩僔僗僥儉埶懚偺弶婜壔
 */
void
sys_initialize()
{

	/*
	 *  PLL偺愝掕
	 *
	 */
	/*
	 *  27MHz*22攞=594MHz偵愝掕偡傞(600MHz)
	 *  27MHz*28攞=756MHz偵愝掕偡傞(750MHz)
	 *  CSEL = 1; SSEL = 5 (600MHz)
	 *  CSEL = 1; SSEL = 6 (750MHz)
	 */
	*pSIC_IWR = IWR_ENABLE(0);				// PLL偺傒IWR傪嫋偡
#if CSELVAL == 1 
	*pPLL_DIV = CSEL_DIV1 | SET_SSEL(SSELVAL);
#elif CSELVAL == 2
	*pPLL_DIV = CSEL_DIV2 | SET_SSEL(SSELVAL);
#elif CSELVAL == 4
	*pPLL_DIV = CSEL_DIV4 | SET_SSEL(SSELVAL);
#elif CSELVAL == 8
	*pPLL_DIV = CSEL_DIV8 | SET_SSEL(SSELVAL);
#else
#error Wrong CSELVAL. Must be one of 1,2,4,8.
#endif
	
	*pPLL_CTL = MSELVAL << 9;
		
	asm("cli r0; csync; idle; sti r0;": : :"r0");
	*pSIC_IWR = IWR_ENABLE_ALL;


}


unsigned int priority_mask[16]={
0x00000000,
0x00000000,
0x00000000,
0x00000000,
0x00000000,
0x00000000,
0x00000000,
0x00000007, // IVG7
0x00000018, // IVG8
0x000001E0, // IVG9
0x00007E00, // IVG10
0x00078000, // IVG11
0x1FF80000, // IVG12
0xE0000000, // IVG13
0x00000000, // IVG14
0x00000000  // IVG15
};


/*
* SIC_IARx傪夝愅偟偰丄僀儀儞僩弴埵偛偲偵妱傝摉偰傜傟偰偄傞妱傝崬傒
* 偺價僢僩儅僢僾傪嶌傞丅SIC_IARx偺僼傿乕儖僪抣偼桪愭弴埵-7側偺偱
* 偦偺暘曗惓偡傞丅
*/
void make_priority_mask( void )
{
	unsigned int i, priority, device, iar;
	
	
	/*
 *  妱傝崬傒弴埵偛偲偺ISR價僢僩儅僢僾偺嶌惉
 *  SIC_IARx偺愝掕偼偙偺晹暘傛傝慜偵嵪傑偣傞偙偲
 */
 
 	for ( i=0; i<16; i++ ){
 		priority_mask[i] = 0;
 	}
 
	device = 1;
	iar = *pSIC_IAR0;
	for ( i=0; i<8; i++ ){
		priority = iar & 0xf;
		iar >>= 4;
		priority_mask[priority + 7] |= device;
		device <<= 1;
	}
	
	iar = *pSIC_IAR1;
	for ( i=0; i<8; i++ ){
		priority = iar & 0xf;
		iar >>= 4;
		priority_mask[priority + 7] |= device;
		device <<= 1;
	}
	
	iar = *pSIC_IAR2;
	for ( i=0; i<8; i++ ){
		priority = iar & 0xf;
		iar >>= 4;
		priority_mask[priority + 7] |= device;
		device <<= 1;
	}
	
	iar = *pSIC_IAR3;
	for ( i=0; i<8; i++ ){
		priority = iar & 0xf;
		iar >>= 4;
		priority_mask[priority + 7] |= device;
		device <<= 1;
	}
}


/*
 * 妱傝崬傒偺嫋壜丄嬛巭
 *
 */
ER ena_int( INTNO intno )
{
	unsigned int mask;
	
	if ( intno >= DEVICE_INTERRUPT_COUNT )
		return ( E_PAR );
	else {
		mask = 1 << intno;
		*pSIC_IMASK |= mask;
		return (0);
	}
}
ER dis_int( INTNO intno )
{
	unsigned int mask;

	if ( intno > INTNO_WDG )
		return ( E_PAR );
	else {
		mask = 1 << intno;
		mask = ~mask;
		*pSIC_IMASK &= mask;
		return (0);
	}
}

/*
 * 妱傝崬傒儅僗僋偺憖嶌
 *
 *
 */
ER chg_ims( IMS ims )
{
	*pSIC_IMASK = ims;
	return( 0 );
}

extern ER get_ims( IMS * p_ims )
{
	*p_ims = *pSIC_IMASK;
	return( 0 );
}


/*
 *  妱傝崬傒傪僨僶僀僗偵妱傝摉偰傞
 */
void device_dispatcher( unsigned int priority )
{
	unsigned int candidates, count, device;
	
	candidates = priority_mask[priority] & *pSIC_ISR & *pSIC_IMASK;	// 尰嵼偺僾儔僀僆儕僥傿偵憡摉偡傞妱崬傒尮傪摿掕偡傞
	asm ( "%0 = ones %1;" :"=l"(count) :"d"(candidates)  );
	
	if ( ! count )
	{
#ifdef USE_HW_ERROR
		if ( priority == ik_hardware_err)
			dev_vector[INHNO_HW_ERROR]();
		else
#endif 
			if ( priority == ik_timer)
			dev_vector[INHNO_TIMER]();
		else
			dev_vector[INHNO_RAISE]();		//丂僜僼僩僂僃傾妱傝崬傒

	}
	else 
	{
		if ( candidates & 0x80000000 )
			device = 31;
		else
		{
			asm( "%0 = signbits %1;\n" : "=l"( device ) : "d"( candidates ) : "r2" );
			device = 30 - device;		// bit mask is converted to bit number
		}
		dev_vector[device]();
	}
}



/*
 *  僞乕僎僢僩僔僗僥儉偺廔椆
 */
void
sys_exit()
{
	while(1)
		1;
}

/*
 *  僞乕僎僢僩僔僗僥儉偺暥帤弌椡
 */
void
sys_putc(char c)
{
}