3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Advanced Standard Profile Kernel
6 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2006-2008 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
11 * 上記著作権者は,以下の(1)〜(4)の条件を満たす場合に限り,本ソフトウェ
12 * ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
13 * 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
14 * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
15 * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
17 * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
18 * 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
19 * 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
21 * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
22 * 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
24 * (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
25 * 作権表示,この利用条件および下記の無保証規定を掲載すること.
26 * (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
28 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
29 * 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
30 * また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
31 * 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
34 * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
35 * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
36 * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
37 * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
40 * @(#) $Id: serial.c 1176 2008-07-01 10:24:46Z ertl-hiro $
49 #include "target_syssvc.h"
50 #include "target_serial.h"
52 #include "kernel_cfg.h"
55 * バッファサイズのデフォルト値とバッファの定義
57 #ifndef SERIAL_RCV_BUFSZ1
58 #define SERIAL_RCV_BUFSZ1 256 /* ポート1の受信バッファサイズ */
59 #endif /* SERIAL_RCV_BUFSZ1 */
61 #ifndef SERIAL_SND_BUFSZ1
62 #define SERIAL_SND_BUFSZ1 256 /* ポート1の送信バッファサイズ */
63 #endif /* SERIAL_SND_BUFSZ1 */
65 static char_t rcv_buffer1[SERIAL_RCV_BUFSZ1];
66 static char_t snd_buffer1[SERIAL_SND_BUFSZ1];
68 #if TNUM_PORT >= 2 /* ポート2に関する定義 */
70 #ifndef SERIAL_RCV_BUFSZ2
71 #define SERIAL_RCV_BUFSZ2 256 /* ポート2の受信バッファサイズ */
72 #endif /* SERIAL_RCV_BUFSZ2 */
74 #ifndef SERIAL_SND_BUFSZ2
75 #define SERIAL_SND_BUFSZ2 256 /* ポート2の送信バッファサイズ */
76 #endif /* SERIAL_SND_BUFSZ2 */
78 static char_t rcv_buffer2[SERIAL_RCV_BUFSZ2];
79 static char_t snd_buffer2[SERIAL_SND_BUFSZ2];
81 #endif /* TNUM_PORT >= 2 */
83 #if TNUM_PORT >= 3 /* ポート3に関する定義 */
85 #ifndef SERIAL_RCV_BUFSZ3
86 #define SERIAL_RCV_BUFSZ3 256 /* ポート3の受信バッファサイズ */
87 #endif /* SERIAL_RCV_BUFSZ3 */
89 #ifndef SERIAL_SND_BUFSZ3
90 #define SERIAL_SND_BUFSZ3 256 /* ポート3の送信バッファサイズ */
91 #endif /* SERIAL_SND_BUFSZ3 */
93 static char_t rcv_buffer3[SERIAL_RCV_BUFSZ3];
94 static char_t snd_buffer3[SERIAL_SND_BUFSZ3];
96 #endif /* TNUM_PORT >= 3 */
101 #define FC_STOP '\023' /* コントロール-S */
102 #define FC_START '\021' /* コントロール-Q */
104 #define BUFCNT_STOP(bufsz) ((bufsz) * 3 / 4) /* STOPを送る基準文字数 */
105 #define BUFCNT_START(bufsz) ((bufsz) / 2) /* STARTを送る基準文字数 */
110 typedef struct serial_port_initialization_block {
111 ID rcv_semid; /* 受信バッファ管理用セマフォのID */
112 ID snd_semid; /* 送信バッファ管理用セマフォのID */
113 uint_t rcv_bufsz; /* 受信バッファサイズ */
114 char_t *rcv_buffer; /* 受信バッファ */
115 uint_t snd_bufsz; /* 送信バッファサイズ */
116 char_t *snd_buffer; /* 送信バッファ */
119 static const SPINIB spinib_table[TNUM_PORT] = {
120 { SERIAL_RCV_SEM1, SERIAL_SND_SEM1,
121 SERIAL_RCV_BUFSZ1, rcv_buffer1,
122 SERIAL_SND_BUFSZ1, snd_buffer1 },
124 { SERIAL_RCV_SEM2, SERIAL_SND_SEM2,
125 SERIAL_RCV_BUFSZ2, rcv_buffer2,
126 SERIAL_SND_BUFSZ2, snd_buffer2 },
127 #endif /* TNUM_PORT >= 2 */
129 { SERIAL_RCV_SEM3, SERIAL_SND_SEM3,
130 SERIAL_RCV_BUFSZ3, rcv_buffer3,
131 SERIAL_SND_BUFSZ3, snd_buffer3 },
132 #endif /* TNUM_PORT >= 3 */
138 typedef struct serial_port_control_block {
139 const SPINIB *p_spinib; /* シリアルポート初期化ブロック */
140 SIOPCB *p_siopcb; /* シリアルI/Oポート管理ブロック */
141 bool_t openflag; /* オープン済みフラグ */
142 bool_t errorflag; /* エラーフラグ */
143 uint_t ioctl; /* 動作制御の設定値 */
145 uint_t rcv_read_ptr; /* 受信バッファ読出しポインタ */
146 uint_t rcv_write_ptr; /* 受信バッファ書込みポインタ */
147 uint_t rcv_count; /* 受信バッファ中の文字数 */
148 char_t rcv_fc_chr; /* 送るべきSTART/STOP */
149 bool_t rcv_stopped; /* STOPを送った状態か? */
151 uint_t snd_read_ptr; /* 送信バッファ読出しポインタ */
152 uint_t snd_write_ptr; /* 送信バッファ書込みポインタ */
153 uint_t snd_count; /* 送信バッファ中の文字数 */
154 bool_t snd_stopped; /* STOPを受け取った状態か? */
157 static SPCB spcb_table[TNUM_PORT];
160 * シリアルポートIDからシリアルポート管理ブロックを取り出すためのマクロ
162 #define INDEX_PORT(portid) ((uint_t)((portid) - 1))
163 #define get_spcb(portid) (&(spcb_table[INDEX_PORT(portid)]))
168 #define INC_PTR(ptr, bufsz) { if (++(ptr) == (bufsz)) { (ptr) = 0; }}
173 * サービスコール呼出しを含む式expを評価し,返値がエラー(負の値)の場
174 * 合には,ercにercd_expを評価した値を代入し,error_exitにgotoする.
176 #define SVC(exp, ercd_exp) \
177 { if ((exp) < 0) { ercd = (ercd_exp); goto error_exit; }}
183 gen_ercd_sys(SPCB *p_spcb)
185 p_spcb->errorflag = true;
190 * 待ちに入るサービスコールからのエラーの変換
193 gen_ercd_wait(ER rercd, SPCB *p_spcb)
195 switch (MERCD(rercd)) {
200 p_spcb->errorflag = true;
206 * シリアルインタフェースドライバの初期化ルーチン
209 serial_initialize(intptr_t exinf)
214 for (p_spcb = spcb_table, i = 0; i < TNUM_PORT; p_spcb++, i++) {
215 p_spcb->p_spinib = &(spinib_table[i]);
216 p_spcb->openflag = false;
221 * シリアルポートのオープン(サービスコール)
224 serial_opn_por(ID portid)
229 if (sns_dpn()) { /* コンテキストのチェック */
232 if (!(1 <= portid && portid <= TNUM_PORT)) {
233 return(E_ID); /* ポート番号のチェック */
235 p_spcb = get_spcb(portid);
237 SVC(dis_dsp(), gen_ercd_sys(p_spcb));
238 if (p_spcb->openflag) { /* オープン済みかのチェック */
245 p_spcb->ioctl = (IOCTL_ECHO | IOCTL_CRLF | IOCTL_FCSND | IOCTL_FCRCV);
247 p_spcb->rcv_read_ptr = p_spcb->rcv_write_ptr = 0U;
248 p_spcb->rcv_count = 0U;
249 p_spcb->rcv_fc_chr = '\0';
250 p_spcb->rcv_stopped = false;
252 p_spcb->snd_read_ptr = p_spcb->snd_write_ptr = 0U;
253 p_spcb->snd_count = 0U;
254 p_spcb->snd_stopped = false;
261 goto error_exit_enadsp;
267 p_spcb->p_siopcb = sio_opn_por(portid, (intptr_t) p_spcb);
272 sio_ena_cbr(p_spcb->p_siopcb, SIO_RDY_RCV);
273 p_spcb->openflag = true;
274 p_spcb->errorflag = false;
277 p_spcb->errorflag = true;
279 goto error_exit_enadsp;
285 SVC(ena_dsp(), gen_ercd_sys(p_spcb));
292 * シリアルポートのクローズ(サービスコール)
295 serial_cls_por(ID portid)
299 bool_t eflag = false;
301 if (sns_dpn()) { /* コンテキストのチェック */
304 if (!(1 <= portid && portid <= TNUM_PORT)) {
305 return(E_ID); /* ポート番号のチェック */
307 p_spcb = get_spcb(portid);
309 SVC(dis_dsp(), gen_ercd_sys(p_spcb));
310 if (!(p_spcb->openflag)) { /* オープン済みかのチェック */
320 sio_cls_por(p_spcb->p_siopcb);
321 p_spcb->openflag = false;
329 if (ini_sem(p_spcb->p_spinib->snd_semid) < 0) {
332 if (ini_sem(p_spcb->p_spinib->rcv_semid) < 0) {
340 ercd = gen_ercd_sys(p_spcb);
346 SVC(ena_dsp(), gen_ercd_sys(p_spcb));
355 * p_spcbで指定されるシリアルI/Oポートに対して,文字cを送信する.文字
356 * を送信レジスタにいれた場合にはtrueを返す.そうでない場合には,送信
357 * レジスタが空いたことを通知するコールバック関数を許可し,falseを返す.
358 * この関数は,CPUロック状態で呼び出される.
361 serial_snd_chr(SPCB *p_spcb, char_t c)
363 if (sio_snd_chr(p_spcb->p_siopcb, c)) {
367 sio_ena_cbr(p_spcb->p_siopcb, SIO_RDY_SND);
376 serial_wri_chr(SPCB *p_spcb, char_t c)
384 if (c == '\n' && (p_spcb->ioctl & IOCTL_CRLF) != 0U) {
385 SVC(rercd = serial_wri_chr(p_spcb, '\r'), rercd);
386 if ((bool_t) rercd) {
387 SVC(rercd = wai_sem(p_spcb->p_spinib->snd_semid),
388 gen_ercd_wait(rercd, p_spcb));
392 SVC(loc_cpu(), gen_ercd_sys(p_spcb));
393 if (p_spcb->snd_count == 0U && !(p_spcb->snd_stopped)
394 && serial_snd_chr(p_spcb, c)) {
396 * シリアルI/Oデバイスの送信レジスタに文字を入れることに成功し
405 p_spcb->p_spinib->snd_buffer[p_spcb->snd_write_ptr] = c;
406 INC_PTR(p_spcb->snd_write_ptr, p_spcb->p_spinib->snd_bufsz);
408 buffer_full = (p_spcb->snd_count == p_spcb->p_spinib->snd_bufsz);
411 SVC(unl_cpu(), gen_ercd_sys(p_spcb));
412 ercd = (ER_BOOL) buffer_full;
419 * シリアルポートへの文字列送信(サービスコール)
422 serial_wri_dat(ID portid, const char_t *buf, uint_t len)
429 if (sns_dpn()) { /* コンテキストのチェック */
432 if (!(1 <= portid && portid <= TNUM_PORT)) {
433 return(E_ID); /* ポート番号のチェック */
436 p_spcb = get_spcb(portid);
437 if (!(p_spcb->openflag)) { /* オープン済みかのチェック */
440 if (p_spcb->errorflag) { /* エラー状態かのチェック */
444 buffer_full = true; /* ループの1回めはwai_semする */
445 while (wricnt < len) {
447 SVC(rercd = wai_sem(p_spcb->p_spinib->snd_semid),
448 gen_ercd_wait(rercd, p_spcb));
450 SVC(rercd = serial_wri_chr(p_spcb, *buf++), rercd);
452 buffer_full = (bool_t) rercd;
455 SVC(sig_sem(p_spcb->p_spinib->snd_semid), gen_ercd_sys(p_spcb));
460 return(wricnt > 0U ? (ER_UINT) wricnt : ercd);
467 serial_rea_chr(SPCB *p_spcb, char_t *p_c)
472 SVC(loc_cpu(), gen_ercd_sys(p_spcb));
477 *p_c = p_spcb->p_spinib->rcv_buffer[p_spcb->rcv_read_ptr];
478 INC_PTR(p_spcb->rcv_read_ptr, p_spcb->p_spinib->rcv_bufsz);
480 buffer_empty = (p_spcb->rcv_count == 0U);
485 if (p_spcb->rcv_stopped && p_spcb->rcv_count
486 <= BUFCNT_START(p_spcb->p_spinib->rcv_bufsz)) {
487 if (!serial_snd_chr(p_spcb, FC_START)) {
488 p_spcb->rcv_fc_chr = FC_START;
490 p_spcb->rcv_stopped = false;
493 SVC(unl_cpu(), gen_ercd_sys(p_spcb));
494 ercd = (ER_BOOL) buffer_empty;
501 * シリアルポートからの文字列受信(サービスコール)
504 serial_rea_dat(ID portid, char_t *buf, uint_t len)
509 char_t c = '\0'; /* コンパイラの警告を抑止するために初期化する */
512 if (sns_dpn()) { /* コンテキストのチェック */
515 if (!(1 <= portid && portid <= TNUM_PORT)) {
516 return(E_ID); /* ポート番号のチェック */
519 p_spcb = get_spcb(portid);
520 if (!(p_spcb->openflag)) { /* オープン済みかのチェック */
523 if (p_spcb->errorflag) { /* エラー状態かのチェック */
527 buffer_empty = true; /* ループの1回めはwai_semする */
528 while (reacnt < len) {
530 SVC(rercd = wai_sem(p_spcb->p_spinib->rcv_semid),
531 gen_ercd_wait(rercd, p_spcb));
533 SVC(rercd = serial_rea_chr(p_spcb, &c), rercd);
536 buffer_empty = (bool_t) rercd;
541 if ((p_spcb->ioctl & IOCTL_ECHO) != 0U) {
542 SVC(rercd = wai_sem(p_spcb->p_spinib->snd_semid),
543 gen_ercd_wait(rercd, p_spcb));
544 SVC(rercd = serial_wri_chr(p_spcb, c), rercd);
545 if (!((bool_t) rercd)) {
546 SVC(sig_sem(p_spcb->p_spinib->snd_semid),
547 gen_ercd_sys(p_spcb));
552 SVC(sig_sem(p_spcb->p_spinib->rcv_semid), gen_ercd_sys(p_spcb));
557 return(reacnt > 0U ? (ER_UINT) reacnt : ercd);
561 * シリアルポートの制御(サービスコール)
564 serial_ctl_por(ID portid, uint_t ioctl)
568 if (sns_dpn()) { /* コンテキストのチェック */
571 if (!(1 <= portid && portid <= TNUM_PORT)) {
572 return(E_ID); /* ポート番号のチェック */
575 p_spcb = get_spcb(portid);
576 if (!(p_spcb->openflag)) { /* オープン済みかのチェック */
579 if (p_spcb->errorflag) { /* エラー状態かのチェック */
583 p_spcb->ioctl = ioctl;
588 * シリアルポート状態の参照(サービスコール)
591 serial_ref_por(ID portid, T_SERIAL_RPOR *pk_rpor)
595 if (sns_dpn()) { /* コンテキストのチェック */
598 if (!(1 <= portid && portid <= TNUM_PORT)) {
599 return(E_ID); /* ポート番号のチェック */
602 p_spcb = get_spcb(portid);
603 if (!(p_spcb->openflag)) { /* オープン済みかのチェック */
606 if (p_spcb->errorflag) { /* エラー状態かのチェック */
610 pk_rpor->reacnt = p_spcb->rcv_count;
611 pk_rpor->wricnt = p_spcb->snd_count;
616 * シリアルポートからの送信可能コールバック
619 sio_irdy_snd(intptr_t exinf)
623 p_spcb = (SPCB *) exinf;
624 if (p_spcb->rcv_fc_chr != '\0') {
628 (void) sio_snd_chr(p_spcb->p_siopcb, p_spcb->rcv_fc_chr);
629 p_spcb->rcv_fc_chr = '\0';
631 else if (!(p_spcb->snd_stopped) && p_spcb->snd_count > 0U) {
633 * 送信バッファ中から文字を取り出して送信する.
635 (void) sio_snd_chr(p_spcb->p_siopcb,
636 p_spcb->p_spinib->snd_buffer[p_spcb->snd_read_ptr]);
637 INC_PTR(p_spcb->snd_read_ptr, p_spcb->p_spinib->snd_bufsz);
638 if (p_spcb->snd_count == p_spcb->p_spinib->snd_bufsz) {
639 if (isig_sem(p_spcb->p_spinib->snd_semid) < 0) {
640 p_spcb->errorflag = true;
647 * 送信すべき文字がない場合は,送信可能コールバックを禁止する.
649 sio_dis_cbr(p_spcb->p_siopcb, SIO_RDY_SND);
654 * シリアルポートからの受信通知コールバック
657 sio_irdy_rcv(intptr_t exinf)
662 p_spcb = (SPCB *) exinf;
663 c = (char_t) sio_rcv_chr(p_spcb->p_siopcb);
664 if ((p_spcb->ioctl & IOCTL_FCSND) != 0U && c == FC_STOP) {
666 * 送信を一時停止する.送信中の文字はそのまま送信する.
668 p_spcb->snd_stopped = true;
670 else if (p_spcb->snd_stopped && (c == FC_START
671 || (p_spcb->ioctl & IOCTL_FCANY) != 0U)) {
675 p_spcb->snd_stopped = false;
676 if (p_spcb->snd_count > 0U) {
677 c = p_spcb->p_spinib->snd_buffer[p_spcb->snd_read_ptr];
678 if (serial_snd_chr(p_spcb, c)) {
679 INC_PTR(p_spcb->snd_read_ptr, p_spcb->p_spinib->snd_bufsz);
680 if (p_spcb->snd_count == p_spcb->p_spinib->snd_bufsz) {
681 if (isig_sem(p_spcb->p_spinib->snd_semid) < 0) {
682 p_spcb->errorflag = true;
689 else if ((p_spcb->ioctl & IOCTL_FCSND) != 0U && c == FC_START) {
691 * 送信に対してフロー制御している場合,START は捨てる.
694 else if (p_spcb->rcv_count == p_spcb->p_spinib->rcv_bufsz) {
696 * バッファフルの場合,受信した文字を捨てる.
703 p_spcb->p_spinib->rcv_buffer[p_spcb->rcv_write_ptr] = c;
704 INC_PTR(p_spcb->rcv_write_ptr, p_spcb->p_spinib->rcv_bufsz);
705 if (p_spcb->rcv_count == 0U) {
706 if (isig_sem(p_spcb->p_spinib->rcv_semid) < 0) {
707 p_spcb->errorflag = true;
715 if ((p_spcb->ioctl & IOCTL_FCRCV) != 0U && !(p_spcb->rcv_stopped)
717 >= BUFCNT_STOP(p_spcb->p_spinib->rcv_bufsz)) {
718 if (!serial_snd_chr(p_spcb, FC_STOP)) {
719 p_spcb->rcv_fc_chr = FC_STOP;
721 p_spcb->rcv_stopped = true;
727 * シリアルインタフェースドライバからの未送信文字の取出し
730 serial_get_chr(ID portid, char_t *p_c)
734 if (1 <= portid && portid <= TNUM_PORT) { /* ポート番号のチェック */
735 p_spcb = get_spcb(portid);
736 if (p_spcb->openflag) { /* オープン済みかのチェック */
737 if (p_spcb->snd_count > 0U) {
738 *p_c = p_spcb->p_spinib->snd_buffer[p_spcb->snd_read_ptr];
739 INC_PTR(p_spcb->snd_read_ptr, p_spcb->p_spinib->snd_bufsz);