source: azure_iot_hub/trunk/asp3_dcre/target/gr_citrus_gcc/target_serial.c@ 388

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2006-2018 by Embedded and Real-Time Systems Laboratory
 *              Graduate School of Information Science, Nagoya Univ., JAPAN
 * 
 *  上記著作権者
は，以下の(1)～(4)ã®æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§
 *  ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
 *  変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *      また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
 *      由に基づく請求からも，上記著作権者
およびTOPPERSプロジェクトを
 *      å…
è²¬ã™ã‚‹ã“と．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
 *  に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
 *  アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
 *  ã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  @(#) $Id: target_serial.c 388 2019-05-22 11:25:18Z coas-nagasima $
 */

/*
 *              シリアルインタフェースドライバのターゲット依存部（GR-CITRUS用）
 */

#include "gr_citrus.h"
#include <t_stddef.h>
#include <t_syslog.h>
#include <errno.h>
#include <unistd.h>
#include <fcntl.h>
#include <termios.h>
#include "target_serial.h"
#include "syssvc/siofd.h"

/*
 *  SIOポート初期化ブロックの定義
 */
typedef struct sio_port_initialization_block {
        char            *path;                  /* ファイルのパス名 */
} SIOPINIB;

/*
 *  SIOポート管理ブロックの定義
 */
struct sio_port_control_block {
        const SIOPINIB *p_siopinib;     /* SIOポート初期化ブロック */
        intptr_t        exinf;                  /* 拡張情
å ± */
        bool_t          opened;         /* オープン済みフラグ */
        struct termios saved_term;      /* å…
ƒã®ç«¯æœ«åˆ¶å¾¡æƒ…
å ± */

        int_t           read_fd;                /* 読出し用ファイルディスクリプタ */
        bool_t          rcv_flag;               /* 受信文字バッファ有効フラグ */
        char            rcv_buf;                /* 受信文字バッファ */
        bool_t          rcv_rdy;                /* 受信通知コールバック許可フラグ */

        int_t           write_fd;               /* 書込み用ファイルディスクリプタ */
        bool_t          snd_flag;               /* 送信文字バッファ有効フラグ */
        char            snd_buf;                /* 送信文字バッファ */
        bool_t          snd_rdy;                /* 送信通知コールバック許可フラグ */
};

/*
 *  SIOポート初期化ブロック
 */
const SIOPINIB siopinib_table[TNUM_SIOP] = {
        { NULL }
};

/*
 *  SIOポート管理ブロックのエリア
 */
SIOPCB  siopcb_table[TNUM_SIOP];

/*
 *  SIOポートIDから管理ブロックを取り出すためのマクロ
 */
#define INDEX_SIOP(siopid)      ((uint_t)((siopid) - 1))
#define get_siopcb(siopid)      (&(siopcb_table[INDEX_SIOP(siopid)]))

/*
 *  SIOドライバの初期化
 */
void
sio_initialize(intptr_t exinf)
{
        SIOPCB  *p_siopcb;
        uint_t  i;

        /*
         *  SIOポート管理ブロックの初期化
         */
        for (i = 0; i < TNUM_SIOP; i++) {
                p_siopcb = &(siopcb_table[i]);
                p_siopcb->p_siopinib = &(siopinib_table[i]);
                p_siopcb->opened = false;
        }
}

/*
 *  SIOドライバの終了処理
 */
void
sio_terminate(intptr_t exinf)
{
        uint_t  i;

        /*
         *  オープンされているSIOポートのクローズ
         */
        for (i = 0; i < TNUM_SIOP; i++) {
                sio_cls_por(&(siopcb_table[i]));
        }
}

/*
 *  SIOポートのオープン
 */
SIOPCB *
sio_opn_por(ID siopid, intptr_t exinf)
{
        SIOPCB                  *p_siopcb;
        const SIOPINIB  *p_siopinib;
        int_t                   fd;
        struct termios  term;

        p_siopcb = get_siopcb(siopid);
        p_siopinib = p_siopcb->p_siopinib;

        if (!(p_siopcb->opened)) {
                if (p_siopinib->path != NULL) {
                        fd = siofd_open(p_siopinib->path, O_RDWR, 0777);
                        assert(fd >= 0);
                        p_siopcb->read_fd = fd;
                        p_siopcb->write_fd = fd;
                }
                else {
                        fd = STDIN_FILENO;                                      /* 標準å…
¥å‡ºåŠ›ã‚’使う */
                        p_siopcb->read_fd = STDIN_FILENO;
                        p_siopcb->write_fd = STDOUT_FILENO;
                }
                siofd_fcntl(fd, F_SETOWN, getpid());
                siofd_fcntl(fd, F_SETFL, (O_NONBLOCK | O_ASYNC));

                siofd_tcgetattr(fd, &(p_siopcb->saved_term));
                term = p_siopcb->saved_term;
                term.c_lflag &= ~(ECHO | ICANON);
                siofd_tcsetattr(fd, TCSAFLUSH, &term);

                p_siopcb->exinf = exinf;
                p_siopcb->rcv_flag = false;
                p_siopcb->rcv_rdy = false;
                p_siopcb->snd_flag = false;
                p_siopcb->snd_rdy = false;
                p_siopcb->opened = true;
        }
        return(p_siopcb);
}

/*
 *  SIOポートのクローズ
 */
void
sio_cls_por(SIOPCB *p_siopcb)
{
        int_t   fd;

        if (p_siopcb->opened) {
                fd = p_siopcb->read_fd;
                siofd_tcsetattr(fd, TCSAFLUSH, &(p_siopcb->saved_term));
                siofd_fcntl(fd, F_SETFL, 0);

                if (p_siopcb->p_siopinib->path != NULL) {
                        siofd_close(p_siopcb->read_fd);
                }

                p_siopcb->opened = false;
        }
}

/*
 *  SIOの割込みサービスルーチン
 */
bool_t
sio_isr_snd(ID siopid)
{
        SIOPCB  *p_siopcb = get_siopcb(siopid);
        int_t   n;

        if (p_siopcb->snd_flag) {
                if ((n = siofd_write(p_siopcb->write_fd, &(p_siopcb->snd_buf), 1)) > 0) {
                        p_siopcb->snd_flag = false;
                        if (p_siopcb->snd_rdy) {
                                sio_irdy_snd(p_siopcb->exinf);
                                return p_siopcb->snd_rdy;
                        }
                }
        }

        return false;
}

/*
 *  SIOの割込みサービスルーチン
 */
bool_t
sio_isr_rcv(ID siopid, char c)
{
        SIOPCB  *p_siopcb = get_siopcb(siopid);

        if (!p_siopcb->rcv_flag) {
                p_siopcb->rcv_buf = c;
                p_siopcb->rcv_flag = true;
                if (p_siopcb->rcv_rdy) {
                        sio_irdy_rcv(p_siopcb->exinf);
                        return p_siopcb->rcv_rdy;
                }
        }

        return false;
}

/*
 *  SIOポートへの文字送信
 */
bool_t
sio_snd_chr(SIOPCB *p_siopcb, char c)
{
        int_t   n;

        if (!p_siopcb->snd_flag) {
                if ((n = siofd_write(p_siopcb->write_fd, &c, 1)) > 0) {
                        return(true);
                }
                else {
                        assert(n < 0 && errno == EAGAIN);
                        p_siopcb->snd_flag = true;
                        p_siopcb->snd_buf = c;
                        return(true);
                }
        }
        else {
                return(false);
        }
}

/*
 *  SIOポートからの文字受信
 */
int_t
sio_rcv_chr(SIOPCB *p_siopcb)
{
        char    c;
        int_t   n;

        if (p_siopcb->rcv_flag) {
                p_siopcb->rcv_flag = false;
                return((int_t)(uint8_t)(p_siopcb->rcv_buf));
        }
        else if ((n = siofd_read(p_siopcb->read_fd, &c, 1)) > 0) {
                return((int_t)(uint8_t) c);
        }
        else {
                assert(n < 0 && errno == EAGAIN);
                return(-1);
        }
}

/*
 *  SIOポートからのコールバックの許可
 */
void
sio_ena_cbr(SIOPCB *p_siopcb, uint_t cbrtn)
{
        switch (cbrtn) {
        case SIO_RDY_SND:
                p_siopcb->snd_rdy = true;
                break;
        case SIO_RDY_RCV:
                p_siopcb->rcv_rdy = true;
                break;
        }
}

/*
 *  SIOポートからのコールバックの禁止
 */
void
sio_dis_cbr(SIOPCB *p_siopcb, uint_t cbrtn)
{
        switch (cbrtn) {
        case SIO_RDY_SND:
                p_siopcb->snd_rdy = false;
                break;
        case SIO_RDY_RCV:
                p_siopcb->rcv_rdy = false;
                break;
        }
}