/*
* シリアルポートからの文字列受信（サービスコール）
*/
ER_UINT
serial_rea_dat(ID portid, char *buf, uint_t len)
{
SPCB *p_spcb;
bool_t buffer_empty;
uint_t reacnt = 0U;
char c = '\0'; /* コンパイラの警告を抑止するために初期化する */
ER ercd, rercd;
if (sns_dpn()) { /* コンテキストのチェック */
return(E_CTX);
}
if (!(1 <= portid && portid <= TNUM_PORT)) {
return(E_ID); /* ポート番号のチェック */
}
p_spcb = get_spcb(portid);
if (!(p_spcb->openflag)) { /* オープン済みかのチェック */
return(E_OBJ);
}
if (p_spcb->errorflag) { /* エラー状態かのチェック */
return(E_SYS);
}
buffer_empty = true; /* ループの1回めはwai_semする */
while (reacnt < len) {
if (buffer_empty) {
SVC(rercd = wai_sem(p_spcb->p_spinib->rcv_semid),
gen_ercd_wait(rercd, p_spcb));
}
SVC(rercd = serial_rea_chr(p_spcb, &c), rercd);
*buf++ = c;
reacnt++;
buffer_empty = (bool_t) rercd;
/*
* エコーバック処理．
*/
if ((p_spcb->ioctl & IOCTL_ECHO) != 0U) {
SVC(rercd = wai_sem(p_spcb->p_spinib->snd_semid),
gen_ercd_wait(rercd, p_spcb));
SVC(rercd = serial_wri_chr(p_spcb, c), rercd);
if (!((bool_t) rercd)) {
SVC(sig_sem(p_spcb->p_spinib->snd_semid),
gen_ercd_sys(p_spcb));
}
}
}
if (!buffer_empty) {
SVC(sig_sem(p_spcb->p_spinib->rcv_semid), gen_ercd_sys(p_spcb));
}
ercd = E_OK;
error_exit:
return(reacnt > 0U ? (ER_UINT) reacnt : ercd);
}
/*
* シリアルポートからの文字列受信（受け口関数）
*/
ER_UINT
eSerialPort_read(CELLIDX idx, char *buffer, uint_t length)
{
CELLCB *p_cellcb;
bool_t buffer_empty;
uint_t reacnt = 0U;
char c = '\0'; /* コンパイラの警告を抑止するために初期化する */
ER ercd, rercd;
if (sns_dpn()) { /* コンテキストのチェック */
return(E_CTX);
}
if (!VALID_IDX(idx)) { /* ポート番号のチェック */
return(E_ID);
}
p_cellcb = GET_CELLCB(idx);
if (!VAR_openFlag) { /* オープン済みかのチェック */
return(E_OBJ);
}
if (VAR_errorFlag) { /* エラー状態かのチェック */
return(E_SYS);
}
buffer_empty = true; /* ループの1回めはwai_semする */
while (reacnt < length) {
if (buffer_empty) {
SVC(rercd = cReceiveSemaphore_wait(),
gen_ercd_wait(rercd, p_cellcb));
}
SVC(rercd = serialPort_readChar(p_cellcb, &c), rercd);
*buffer++ = c;
reacnt++;
buffer_empty = (bool_t) rercd;
/*
* エコーバック処理．
*/
if ((VAR_ioControl & IOCTL_ECHO) != 0U) {
SVC(rercd = cSendSemaphore_wait(),
gen_ercd_wait(rercd, p_cellcb));
SVC(rercd = serialPort_writeChar(p_cellcb, c), rercd);
if (!((bool_t) rercd)) {
SVC(cSendSemaphore_signal(), gen_ercd_sys(p_cellcb));
}
}
}
if (!buffer_empty) {
SVC(cReceiveSemaphore_signal(), gen_ercd_sys(p_cellcb));
}
ercd = E_OK;
error_exit:
return(reacnt > 0U ? (ER_UINT) reacnt : ercd);
}
/*
* シリアルポートへの1文字送信
*/
static ER_BOOL
serial_wri_chr(SPCB *p_spcb, char c)
{
bool_t buffer_full;
ER ercd, rercd;
/*
* LFの前にCRを送信する．
*/
if (c == '\n' && (p_spcb->ioctl & IOCTL_CRLF) != 0U) {
/*
* 以下のコードは再帰呼出しになっているが，引数cが'\n'の場合に
* 引数cを'\r'として呼び出すことから，この再帰呼出しは2回目の
* 呼び出しで必ず止まる．
*/
SVC(rercd = serial_wri_chr(p_spcb, '\r'), rercd);
if ((bool_t) rercd) {
SVC(rercd = wai_sem(p_spcb->p_spinib->snd_semid),
gen_ercd_wait(rercd, p_spcb));
}
}
SVC(loc_cpu(), gen_ercd_sys(p_spcb));
if (p_spcb->snd_count == 0U && !(p_spcb->snd_stopped)
&& serial_snd_chr(p_spcb, c)) {
/*
* シリアルI/Oデバイスの送信レジスタに文字を入れることに成功し
* た場合．
*/
buffer_full = false;
}
else {
/*
* 送信バッファに文字を入れる．
*/
p_spcb->p_spinib->snd_buffer[p_spcb->snd_write_ptr] = c;
INC_PTR(p_spcb->snd_write_ptr, p_spcb->p_spinib->snd_bufsz);
p_spcb->snd_count++;
buffer_full = (p_spcb->snd_count == p_spcb->p_spinib->snd_bufsz);
}
SVC(unl_cpu(), gen_ercd_sys(p_spcb));
ercd = (ER_BOOL) buffer_full;
error_exit:
return(ercd);
}
/*
* シリアルポートへの1文字送信
*/
static ER_BOOL
serialPort_writeChar(CELLCB *p_cellcb, char c)
{
bool_t buffer_full;
ER ercd, rercd;
/*
* LFの前にCRを送信する．
*/
if (c == '\n' && (VAR_ioControl & IOCTL_CRLF) != 0U) {
/*
* 以下のコードは再帰呼出しになっているが，引数cが'\n'の場合に
* 引数cを'\r'として呼び出すことから，この再帰呼出しは2回目の
* 呼び出しで必ず止まる．
*/
SVC(rercd = serialPort_writeChar(p_cellcb, '\r'), rercd);
if ((bool_t) rercd) {
SVC(rercd = cSendSemaphore_wait(),
gen_ercd_wait(rercd, p_cellcb));
}
}
SVC(loc_cpu(), gen_ercd_sys(p_cellcb));
if (VAR_sendCount == 0U && !VAR_sendStopped
&& serialPort_sendChar(p_cellcb, c)) {
/*
* SIOの送信レジスタに文字を入れることに成功した場合．
*/
buffer_full = false;
}
else {
/*
* 送信バッファに文字を入れる．
*/
VAR_sendBuffer[VAR_sendWritePointer] = c;
INC_PTR(VAR_sendWritePointer, ATTR_sendBufferSize);
VAR_sendCount++;
buffer_full = (VAR_sendCount == ATTR_sendBufferSize);
}
SVC(unl_cpu(), gen_ercd_sys(p_cellcb));
ercd = (ER_BOOL) buffer_full;
error_exit:
return(ercd);
}
/*
* シリアルポートへの文字列送信（サービスコール）
*/
ER_UINT
serial_wri_dat(ID portid, const char *buf, uint_t len)
{
SPCB *p_spcb;
bool_t buffer_full;
uint_t wricnt = 0U;
ER ercd, rercd;
if (sns_dpn()) { /* コンテキストのチェック */
return(E_CTX);
}
if (!(1 <= portid && portid <= TNUM_PORT)) {
return(E_ID); /* ポート番号のチェック */
}
p_spcb = get_spcb(portid);
if (!(p_spcb->openflag)) { /* オープン済みかのチェック */
return(E_OBJ);
}
if (p_spcb->errorflag) { /* エラー状態かのチェック */
return(E_SYS);
}
buffer_full = true; /* ループの1回めはwai_semする */
while (wricnt < len) {
if (buffer_full) {
SVC(rercd = wai_sem(p_spcb->p_spinib->snd_semid),
gen_ercd_wait(rercd, p_spcb));
}
SVC(rercd = serial_wri_chr(p_spcb, *buf++), rercd);
wricnt++;
buffer_full = (bool_t) rercd;
}
if (!buffer_full) {
SVC(sig_sem(p_spcb->p_spinib->snd_semid), gen_ercd_sys(p_spcb));
}
ercd = E_OK;
error_exit:
return(wricnt > 0U ? (ER_UINT) wricnt : ercd);
}
/*
* シリアルポートへの文字列送信（受け口関数）
*/
ER_UINT
eSerialPort_write(CELLIDX idx, const char *buffer, uint_t length)
{
CELLCB *p_cellcb;
bool_t buffer_full;
uint_t wricnt = 0U;
ER ercd, rercd;
if (sns_dpn()) { /* コンテキストのチェック */
return(E_CTX);
}
if (!VALID_IDX(idx)) { /* ポート番号のチェック */
return(E_ID);
}
p_cellcb = GET_CELLCB(idx);
if (!VAR_openFlag) { /* オープン済みかのチェック */
return(E_OBJ);
}
if (VAR_errorFlag) { /* エラー状態かのチェック */
return(E_SYS);
}
buffer_full = true; /* ループの1回めはwai_semする */
while (wricnt < length) {
if (buffer_full) {
SVC(rercd = cSendSemaphore_wait(),
gen_ercd_wait(rercd, p_cellcb));
}
SVC(rercd = serialPort_writeChar(p_cellcb, *buffer++), rercd);
wricnt++;
buffer_full = (bool_t) rercd;
}
if (!buffer_full) {
SVC(cSendSemaphore_signal(), gen_ercd_sys(p_cellcb));
}
ercd = E_OK;
error_exit:
return(wricnt > 0U ? (ER_UINT) wricnt : ercd);
}