excalibur.c

uItron 4.0 Toppers实现源码1.4版

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

/*
 *    Excalibur-ARM 柒婶怠墙脱ドライバ
 */
#include <s_services.h>
#include <excalibur.h>

/*
 * 柒婶UART脱 词白SIOドライバ
 */

/*
 *  シリアルI/Oポ〖ト介袋步ブロック
 */
typedef struct sio_port_initialization_block {

} SIOPINIB;

/*
 *  シリアルI/Oポ〖ト瓷妄ブロック
 */
struct sio_port_control_block {
    const SIOPINIB  *siopinib; /* シリアルI/Oポ〖ト介袋步ブロック */
    VP_INT          exinf;     /* 橙磨攫鼠 */
    BOOL    openflag;          /* オ〖プン貉みフラグ */
    BOOL    sendflag;          /* 流慨充哈みイネ〖ブルフラグ */
    BOOL    getready;          /* 矢机を减慨した觉轮 */
    BOOL    putready;          /* 矢机を流慨できる觉轮 */
};

/*
 * シリアルI/Oポ〖ト介袋步ブロック
 */
const SIOPINIB siopinib_table[TNUM_SIOP] = {{}};

/*
 *  シリアル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)UART_RSR) & UART_RSR_RX_LEVEL) > 0x00);
}

/*
 * 矢机を流慨できるか?
 */
Inline BOOL
uart_putready(SIOPCB *siopcb)
{
  return((sil_rew_mem((VP)UART_TSR) & UART_TSR_TX_LEVEL) < UART_TX_FIFO_MAX);
}

/*
 *  减慨した矢机の艰り叫し
 */
Inline UB
uart_getchar(SIOPCB *siopcb)
{
    return((UB)sil_rew_mem((VP)UART_RD));  
}

/*
 *  流慨する矢机の今き哈み
 */
Inline void
uart_putchar(SIOPCB *siopcb, UB c)
{
    sil_wrw_mem((VP)UART_TD, (VW)c);
}

/*
 *  流慨充哈み钓材
 */
Inline void
uart_enable_send(SIOPCB *siopcb)
{
    sil_wrw_mem((VP)UART_IES,(VW)UART_INT_T);
}

/*
 *  流慨充哈み敦贿
 */
Inline void
uart_disable_send(SIOPCB *siopcb)
{
    sil_wrw_mem((VP)UART_IEC,(VW)UART_INT_T);
}

/*
 *  减慨充哈み钓材
 */
Inline void
uart_enable_rcv(SIOPCB *siopcb)
{
    sil_wrw_mem((VP)UART_IES,(VW)UART_INT_R);
}

/*
 *  减慨充哈み敦贿
 */
Inline void
uart_disable_rcv(SIOPCB *siopcb)
{
    sil_wrw_mem((VP)UART_IEC,(VW)UART_INT_R);
}



/*
 * カ〖ネル弹瓢箕のログ叫蜗脱の介袋步
 */
void
uart_init(void){
    /* Data 8bit, 1 stop bit, No parity */
    sil_wrw_mem((VP)UART_MC,(VW)UART_DATA_FOMAT);
    
    /* Set bound rate */
    sil_wrw_mem((VP)UART_DIV_LO,(VW)(CAL_BPS(UART_BPS,AHB1_CLK/2) & 0xff));
    sil_wrw_mem((VP)UART_DIV_HI,
                (VW)(CAL_BPS(UART_BPS,AHB1_CLK/2) & 0xff00) >> 8);

    /* clear FIFO  TxThr = 0 RxThr = 1*/
    sil_wrw_mem((VP)UART_FCR,(VW)(UART_FCR_TC | UART_FCR_RC));
  
    /* Clear interrupt */
    sil_wrw_mem((VP)UART_IEC,
                (VW)(UART_INT_R | UART_INT_T | UART_INT_TI | UART_INT_M));
}


/*
 *  オンチップのUARTからのポ〖リング叫蜗
 */
void
uart_putc(char c)
{
    UW buf_level;
    
    do{
        buf_level = sil_rew_mem((VP)UART_TSR) & UART_TSR_TX_LEVEL;
    }while(buf_level >= UART_TX_FIFO_MAX);
    
    sil_wrw_mem((VP)UART_TD,(VW)c);
}

/*
 *  SIOドライバの介袋步ル〖チン
 *  1ポ〖トしかないため·あまり罢蹋はない
 */
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)
{
    return(siopcb_table[0].openflag);
}


/*
 * シリアル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();
    
    /* Data 8bit, 1 stop bit, No parity */
    sil_wrw_mem((VP)UART_MC,(VW)UART_DATA_FOMAT);
    
    /* Set bound rate */
    sil_wrw_mem((VP)UART_DIV_LO,(VW)(CAL_BPS(UART_BPS,AHB1_CLK/2) & 0xff));
    sil_wrw_mem((VP)UART_DIV_HI,
                (VW)(CAL_BPS(UART_BPS,AHB1_CLK/2) & 0xff00) >> 8);

    /* clear FIFO  TxThr = 0 RxThr = 1*/
    sil_wrw_mem((VP)UART_FCR,(VW)(UART_FCR_TC | UART_FCR_RC));
  
    /* Clear interrupt */
    sil_wrw_mem((VP)UART_IEC,
                (VW)(UART_INT_R | UART_INT_T | UART_INT_TI | UART_INT_M));

    /* 减慨充哈み钓材 */
    sil_wrw_mem((VP)UART_IES,(VW)UART_INT_R);
    
    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)) {
        /*
         *  流慨材墙コ〖ルバックル〖チンを钙び叫すˉ
         */
        uart_ierdy_snd(siopcb->exinf);
    }
}


/*
 *  SIOの充哈みサ〖ビスル〖チン
 */
void
uart_isr()
{
    uart_isr_siop(&(siopcb_table[0]));
}