source: anotherchoice/tags/jsp-1.4.4-full-UTF8/config/m16c-renesas/oaks16_mini/serial_mini.c@ 26

/*
 *  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-2004 by Ryosuke Takeuchi
 *              Platform Development Center RICOH COMPANY,LTD. JAPAN
 * 
 *  上記著作権者
は，Free Software Foundation によってå…
¬è¡¨ã•ã‚Œã¦ã„ã‚‹ 
 *  GNU General Public License の Version 2 に記述されている条件か，以
 *  下の(1)〜(4)ã®æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ï¼ˆæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§
 *  アを改変したものを含む．以下同じ）を使用・複製・改変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
 *  利用と呼ぶ）することを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを再利用可能なバイナリコード（リロケータブルオブ
 *      ã‚¸ã‚§ã‚¯ãƒˆãƒ•ã‚¡ã‚¤ãƒ«ã‚„ãƒ©ã‚¤ãƒ–ãƒ©ãƒªãªã©ï¼‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œåˆ©ç”¨
 *      に伴うドキュメント（利用者
マニュアルなど）に，上記の著作権表示，
 *      この利用条件および下記の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを再利用不可能なバイナリコードの形または機器に組
 *      ã¿è¾¼ã‚“ã å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ãšã‚Œã‹ã®æ¡ä»¶ã‚’æº€ãŸã™ã“ã¨ï¼Ž
 *    (a) 利用に伴うドキュメント（利用者
マニュアルなど）に，上記の著作
 *        権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 利用の形æ…
‹ã‚’，別に定める方法によって，上記著作権者
ã«å ±å‘Šã™ã‚‹
 *        こと．
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
をå…
è²¬ã™ã‚‹ã“と．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
は，
 *  本ソフトウェアに関して，その適用可能性も含めて，いかなる保証も行わ
 *  ない．また，本ソフトウェアの利用により直接的または間接的に生じたい
 *  ã‹ãªã‚‹æå®³ã«é–¢ã—ã¦ã‚‚ï¼Œãã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  @(#) $Id: serial_mini.c,v 1.4 2007/01/05 02:33:59 honda Exp $
 */

/*
 *      シリアルインタフェースドライバ
 */

#include <t_services.h>
#include <serial.h>
#include <hw_serial.h>
#include "kernel_id.h"

/*
 *  シリアルポート管理ブロックの定義
 */

#define SERIAL_BUFSZ    9       /* シリアルインタフェース用バッファのサイズ */

typedef struct serial_queue_block {
        BOOL openflag;                          /* オープン済みフラグ */
        UH   base;                                      /* hardware port base address */
        ID   rsemid;                            /* receive semaphore id */
        ID   ssemid;                            /* send semaphore id */
        char head;                                      /* queue head */
        char tail;                                      /* queue tail */
        char size;                                      /* バッファサイズ */
        char buffer[SERIAL_BUFSZ];      /* バッファエリア */
} SQUE;

static SQUE     in_queue[TNUM_SIOP] ={
        FALSE, TADR_SFR_UART0_BASE, SERIAL_RCV_SEM1, SERIAL_SND_SEM1, 0, 0, SERIAL_BUFSZ, "",
        FALSE, TADR_SFR_UART1_BASE, SERIAL_RCV_SEM2, SERIAL_SND_SEM2, 0, 0, SERIAL_BUFSZ, ""
};

/*
 *  シリアルポート管理ブロックの定義と初期化
 */

#define get_sque(portid)        (&(in_queue[portid-1]))

/*
 *  SFR UARTの初期化
 */
Inline void
SFR_uart_initialize(ID portid)
{
        SQUE  *q;
        VB *ip = (VB*)(TADR_SFR_INT_BASE+TADR_SFR_S0RIC_OFFSET);

        q = get_sque(portid);
                                /* 送受信モードレジスタの初期化 */
        sil_wrb_mem((VP)(q->base+TADR_SFR_UMR_OFFSET), MR_DEF);
                                /* 送信制御レジスタの初期化 */
        sil_wrb_mem((VP)(q->base+TADR_SFR_UC0_OFFSET), C0_DEF);
                                /* 転送速度レジスタの初期化 */
        sil_wrb_mem((VP)(q->base+TADR_SFR_UBRG_OFFSET), BRG1_DEF);
                                /* 割込みレベルの設定 */
        set_ic_ilvl((VP)(ip + ((INT)portid-1)*2), RB_LEVEL);
        sil_wrb_mem((VP)(q->base+TADR_SFR_UC1_OFFSET), C1R_DEF);
        sil_reb_mem((VP)(q->base+TADR_SFR_URB_OFFSET));         /* ダミーデータ受信 */
        sil_reb_mem((VP)(q->base+TADR_SFR_URB_OFFSET));         /* ダミーデータ受信 */
        q->openflag = TRUE;
}

/*
 *  SQUEの受信バッファからサイズを取り出す
 */
Inline int
queue_size(SQUE *q)
{
        int size = q->head - q->tail;
        if(size < 0)
                size += q->size;
        return size;
}

/*
 *  シリアルインタフェースドライバの起動
 */
void
serial_initialize(VP_INT exinf)
{
        SFR_uart_initialize(LOGTASK_PORTID);
}

/*
 *  シリアルポートのオープン
 */
ER
serial_opn_por(ID portid)
{
        SQUE  *q;
        VB    *ip=(VB*)(TADR_SFR_INT_BASE+TADR_SFR_S0RIC_OFFSET);
        ER      ercd;

        if (!(1 <= portid && portid <= TNUM_SIOP)) {
                return(E_ID);           /* ポート番号のチェック */
        }
        q = get_sque(portid);

        _syscall(loc_cpu());
        if (q->openflag) {              /* オープン済みかのチェック */
                ercd = E_OBJ;
        }
        else {
                SFR_uart_initialize(portid);
                ercd = E_OK;
        }
        _syscall(unl_cpu());
        return(ercd);
}

/*
 *  シリアルポートのクローズ
 */
ER
serial_cls_por(ID portid)
{
        SQUE  *q;
        VB    *ip=(VB*)(TADR_SFR_INT_BASE+TADR_SFR_S0RIC_OFFSET);
        ER      ercd;

        if (!(1 <= portid && portid <= TNUM_SIOP)) {
                return(E_ID);           /* ポート番号のチェック */
        }
        q = get_sque(portid);

        _syscall(loc_cpu());
        if (!(q->openflag)) {   /* オープン済みかのチェック */
                ercd = E_OBJ;
        }
        else {
                set_ic_ilvl((VP)(ip + ((INT)portid-1)*2), 0);
                sil_wrb_mem((VP)(q->base+TADR_SFR_UC1_OFFSET), C1S_DEF);
                q->openflag = FALSE;
                ercd = E_OK;
        }
        _syscall(unl_cpu());
        return(ercd);
}

/*
 *  シリアルポートへの送信
 */

ER_UINT
serial_wri_dat(ID portid, char *buf, UINT len)
{
        SQUE    *q;
        unsigned int    i;
        unsigned char   c;

        if (!(1 <= portid && portid <= TNUM_SIOP)) {
                return(E_ID);           /* ポート番号のチェック */
        }

        q = get_sque(portid);
        if (!(q->openflag)) {   /* オープン済みかのチェック */
                return(E_OBJ);
        }

        wai_sem(q->ssemid);
        for (i = 0; i < len; i++) {
                while((sil_reb_mem((VP)(q->base+TADR_SFR_UC1_OFFSET)) & 0x2) == 0);
                sil_wrb_mem((VP)(q->base+TADR_SFR_UTB_OFFSET), *buf++);
        }
        sig_sem(q->ssemid);
        return(len);
}

/*
 *  シリアルポートからの受信
 */

ER_UINT
serial_rea_dat(ID portid, char *buf, UINT len)
{
        SQUE    *q;
        UINT    i;

        if (!(1 <= portid && portid <= TNUM_SIOP)) {
                return(E_ID);           /* ポート番号のチェック */
        }

        q = get_sque(portid);
        if (!(q->openflag)) {   /* オープン済みかのチェック */
                return(E_OBJ);
        }

        for (i = 0; i < len; i++) {
                if (queue_size(q) == 0)
                        wai_sem(q->rsemid);
                else
                        pol_sem(q->rsemid);
                _syscall(loc_cpu());
                *buf++ = q->buffer[q->tail++];
                if (q->tail >= q->size) {
                        q->tail = 0;
                }
                _syscall(unl_cpu());
        }
        return(len);
}

/*
 *  シリアルポートの制御
 */
ER
serial_ctl_por(ID portid, UINT ioctl)
{
        return(E_OK);
}

/*
 *  シリアルポート状æ…
‹ã®å‚ç…
§
 */
ER
serial_ref_por(ID portid, T_SERIAL_RPOR *pk_rpor)
{
        SQUE    *q;

        if (sns_ctx()) {                /* コンテキストのチェック */
                return(E_CTX);
        }
        if (!(1 <= portid && portid <= TNUM_SIOP)) {
                return(E_ID);           /* ポート番号のチェック */
        }

        q = get_sque(portid);
        if (!(q->openflag)) {   /* オープン済みかのチェック */
                return(E_OBJ);
        }

        pk_rpor->reacnt = queue_size(q);
        pk_rpor->wricnt = 0;
        return(E_OK);
}

/*
 *  シリアルポート割込みサービスルーチン
 */

void
serial_handler_in(ID portid)
{
        SQUE    *q;
        int             rdata;                          /* 受信バッファ */

        q = get_sque(portid);
        if (queue_size(q) < q->size) {
                rdata = sil_reb_mem((VP)(q->base+TADR_SFR_URB_OFFSET)); /* データ受信 */
                q->buffer[q->head++] = rdata;
                if (q->head >= q->size)
                        q->head = 0;
                isig_sem(q->rsemid);
        }
}

/*
 *  割込みハンドラ
 */

void
serial_in_handler1(void)
{
        serial_handler_in(1);
}

void
serial_in_handler2(void)
{
        serial_handler_in(2);
}