ct11mpcore_eb.c

FDMP the body of the kernel, the Information-Technology Promotion Agency (IPA) adopted by the unexpl

/*
 *  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
 *  Copyright (C) 2003      by Advanced Data Controls, Corp
 *  Copyright (C) 2004-2006 by Embedded and Real-Time Systems Laboratory
 *              Graduate School of Information Science, Nagoya Univ., JAPAN  
 * 
 *  惧淡螟侯涪荚は·笆布の (1)×(4) の掘凤か·Free Software Foundation 
 *  によって给山されている GNU General Public License の Version 2 に淡
 *  揭されている掘凤を塔たす眷圭に嘎り·塑ソフトウェア∈塑ソフトウェア
 *  を猖恃したものを崔むˉ笆布票じ∷を蝗脱ˇ剩澜ˇ猖恃ˇ浩芹邵∈笆布·
 *  网脱と钙ぶ∷することを痰浸で钓满するˉ
 *  (1) 塑ソフトウェアをソ〖スコ〖ドの妨で网脱する眷圭には·惧淡の螟侯
 *      涪山绩·この网脱掘凤および布淡の痰瘦沮惮年が·そのままの妨でソ〖
 *      スコ〖ド面に崔まれていることˉ
 *  (2) 塑ソフトウェアを·ライブラリ妨及など·戮のソフトウェア倡券に蝗
 *      脱できる妨で浩芹邵する眷圭には·浩芹邵に燃うドキュメント∈网脱
 *      荚マニュアルなど∷に·惧淡の螟侯涪山绩·この网脱掘凤および布淡
 *      の痰瘦沮惮年を非很することˉ
 *  (3) 塑ソフトウェアを·怠达に寥み哈むなど·戮のソフトウェア倡券に蝗
 *      脱できない妨で浩芹邵する眷圭には·肌のいずれかの掘凤を塔たすこ
 *      とˉ
 *    (a) 浩芹邵に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟
 *        侯涪山绩·この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *    (b) 浩芹邵の妨轮を·侍に年める数恕によって·TOPPERSプロジェクトに
 *        鼠桂することˉ
 *  (4) 塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じるいかなる禄
 *      巢からも·惧淡螟侯涪荚およびTOPPERSプロジェクトを倘勒することˉ
 * 
 *  塑ソフトウェアは·痰瘦沮で捏丁されているものであるˉ惧淡螟侯涪荚お
 *  よびTOPPERSプロジェクトは·塑ソフトウェアに簇して·その努脱材墙拉も
 *  崔めて·いかなる瘦沮も乖わないˉまた·塑ソフトウェアの网脱により木
 *  儡弄または粗儡弄に栏じたいかなる禄巢に簇しても·その勒扦を砷わないˉ
 * 
 *  @(#) $Id: ct11mpcore_eb.c,v 1.4 2007/07/18 01:57:53 honda Exp $
 *  
 */

/*
 * ARM CT11MPCore with the RealView Emulation Board脱ドライバ
 */
#include <s_services.h>
#include <ct11mpcore_eb.h>


/*
 * シリアルI/Oポ〖ト介袋步ブロック
 */
const SIOPINIB siopinib_table[TNUM_SIOP] = {
#if EB_UART_NO ==  0
    {
		(VP)EB_UART0_BASE,
		DIC_INTID_EB_UART0
    }
#elif EB_UART_NO ==  1
    {
		(VP)EB_UART1_BASE,
		DIC_INTID_EB_UART1
    }	
#elif EB_UART_NO ==  2
    {
		(VP)EB_UART2_BASE,
		DIC_INTID_EB_UART2
    }		
#elif EB_UART_NO ==  3
    {
		(VP)EB_UART3_BASE,
		DIC_INTID_EB_UART3
    }		
#endif /* EB_UART_NO ==  0 */	
};


/*
 *  シリアルI/Oポ〖ト瓷妄ブロックのエリア
 */
SIOPCB  siopcb_table[TNUM_SIOP];


/*
 *  シリアルI/Oポ〖トIDから瓷妄ブロックを艰り叫すためのマクロ
 */
#define INDEX_SIOP(siopid)  ((UINT)((siopid) - 1))
#define get_siopcb(siopid)  (&(siopcb_table[INDEX_SIOP(siopid)]))


/*
 * 矢机を减慨したか?
 */ 
Inline BOOL
uart_getready(SIOPCB *siopcb)
{
	return ((sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_FR))
			 & EB_UART_FR_RXFE) != EB_UART_FR_RXFE);
}

/*
 * 矢机を流慨できるか?
 */
Inline BOOL
uart_putready(SIOPCB *siopcb)
{
	return ((sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_FR))
			 & EB_UART_FR_TXFF) != EB_UART_FR_TXFF);
}

/*
 *  减慨した矢机の艰り叫し
 */
Inline UB
uart_getchar(SIOPCB *siopcb)
{
	return ((UB)sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_DR)));
}

/*
 *  流慨する矢机の今き哈み
 */
Inline void
uart_putchar(SIOPCB *siopcb, UB c)
{
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_DR), c);
}

/*
 *  流慨充哈み钓材
 */
Inline void
uart_enable_send(SIOPCB *siopcb)
{
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC),
				sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC))
				| EB_UART_IMSC_TXIM);
}

/*
 *  流慨充哈み敦贿
 */
Inline void
uart_disable_send(SIOPCB *siopcb)
{
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC),
				sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC))
				& ~EB_UART_IMSC_TXIM);
}


/*
 *  减慨充哈み钓材
 */
Inline void
uart_enable_rcv(SIOPCB *siopcb)
{
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC),
				sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC))
				| EB_UART_IMSC_RXIM);
}

/*
 *  减慨充哈み敦贿
 */
Inline void
uart_disable_rcv(SIOPCB *siopcb)
{
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC),
				sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IMSC))
				& ~EB_UART_IMSC_RXIM);
}

/*
 * カ〖ネル弹瓢箕のログ叫蜗脱の介袋步
 */
void
uart_init(SIOPCB *siopcb){
	char c;
	
	/* UART匿贿 */
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_CR), 0x00);

	/* FIFOを鄂にする */
	while(uart_getready(siopcb)){
		/* バッファからの粕み哈み */
		c = uart_getchar(siopcb);
	}

	/* ボ〖レ〖トを肋年 */
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_IBRD), EB_UART_IBRD_38400);
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_FBRD), EB_UART_FBRD_38400);
	
	/*
     * FIFOを匿贿, デ〖タ墓8bit, 1stopビット,
	 */
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_LCR_H),
				 EB_UART_LCR_H_WLEN_8);
		
	/* UART浩倡 */
	sil_wrw_mem((VP)(siopcb->siopinib->reg_base + EB_UART_CR),
				sil_rew_mem((VP)(siopcb->siopinib->reg_base + EB_UART_CR))
				| EB_UART_CR_RXE | EB_UART_CR_TXE | EB_UART_CR_UARTEN);
}

/*
 * ボ〖ド弹瓢箕の介袋步
 */
void
eb_uart_init(void){
	SIOPCB  siopcb; /* ダミ〖で脱罢 */
	
	siopcb.siopinib = &(siopinib_table[0]);
	uart_init(&siopcb);
}

/*
 *  オンチップのUARTからのポ〖リング叫蜗
 */
void
uart_putc(char c)
{
	SIOPCB  siopcb; /* ダミ〖で脱罢 */
	
	siopcb.siopinib = &(siopinib_table[0]);
	while(!uart_putready(&siopcb));
	uart_putchar(&siopcb, c);
}

/*
 *  SIOドライバの介袋步ル〖チン
 */
void
uart_initialize()
{
    SIOPCB  *siopcb;
    UINT    i;

    /*
     *  シリアルI/Oポ〖ト瓷妄ブロックの介袋步
     */
    for (siopcb = siopcb_table, i = 0; i < TNUM_SIOP; siopcb++, i++) {
        siopcb->siopinib = &(siopinib_table[i]);
        siopcb->openflag = FALSE;
        siopcb->sendflag = FALSE;
    }
}


/*
 * オ〖プンしているポ〖トがあるか
 */
BOOL
uart_openflag(void)
{
    SIOPCB  *siopcb;
    UINT    i;

	for (siopcb = siopcb_table, i = 0; i < TNUM_SIOP; siopcb++, i++) {
		siopcb->siopinib = &(siopinib_table[i]);
		if(siopcb->openflag == TRUE){
			return TRUE;
		}
	}
	
    return FALSE;
}


/*
 * シリアルI/Oポ〖トのオ〖プン
 */
SIOPCB *
uart_opn_por(ID siopid, VP_INT exinf)
{
    SIOPCB      *siopcb;
    const SIOPINIB  *siopinib;

    siopcb = get_siopcb(siopid);
    siopinib = siopcb->siopinib;

	/* 介袋步 */
	uart_init(siopcb);
    
    siopcb->exinf = exinf;
    siopcb->getready = siopcb->putready = FALSE;
    siopcb->openflag = TRUE;

    return(siopcb);    
}


/*
 *  シリアルI/Oポ〖トのクロ〖ズ
 */
void
uart_cls_por(SIOPCB *siopcb)
{
    siopcb->openflag = FALSE;
}


/*
 *  シリアルI/Oポ〖トへの矢机流慨
 */
BOOL
uart_snd_chr(SIOPCB *siopcb, char c)
{
    if (uart_putready(siopcb)){
        uart_putchar(siopcb, c);
        return(TRUE);
    }
    return(FALSE);
}


/*
 *  シリアルI/Oポ〖トからの矢机减慨
 */
INT
uart_rcv_chr(SIOPCB *siopcb)
{
    if (uart_getready(siopcb)) {
        return((INT)(UB) uart_getchar(siopcb));
    }
    return(-1);
}


/*
 *  シリアルI/Oポ〖トからのコ〖ルバックの钓材
 */
void
uart_ena_cbr(SIOPCB *siopcb, UINT cbrtn)
{
    switch (cbrtn) {
        case SIO_ERDY_SND:
            uart_enable_send(siopcb);
            break;
        case SIO_ERDY_RCV:
            uart_enable_rcv(siopcb);
            break;
    }
}


/*
 *  シリアルI/Oポ〖トからのコ〖ルバックの敦贿
 */
void
uart_dis_cbr(SIOPCB *siopcb, UINT cbrtn)
{
    switch (cbrtn) {
        case SIO_ERDY_SND:
            uart_disable_send(siopcb);
            break;
        case SIO_ERDY_RCV:
            uart_disable_rcv(siopcb);
            break;
    }
}


/*
 *  シリアルI/Oポ〖トに滦する充哈み借妄
 */
static void
uart_isr_siop(SIOPCB *siopcb)
{
    if (uart_getready(siopcb)) {
        /*
         *  减慨奶梦コ〖ルバックル〖チンを钙び叫すˉ
         */
        uart_ierdy_rcv(siopcb->exinf);
    }
    if (uart_putready(siopcb)) {
        /*
         *  流慨材墙コ〖ルバックル〖チンを钙び叫すˉ
         */