void
tcp_echo_srv_task (intptr_t exinf)
{
ID tskid, cepid, repid;
ER error = E_OK;
syscall(get_tid(&tskid));
syslog(LOG_NOTICE, "[TCP ECHO SRV:%d] started.", tskid);
while (true) {
syscall(slp_tsk());
if ((error = get_tcp_cep (&cepid)) != E_OK) {
syslog(LOG_NOTICE, "[TES:00 EXT] CEP create error: %s", itron_strerror(error));
continue;
}
while (true) {
if ((error = get_tcp_rep (&repid)) != E_OK) {
syslog(LOG_NOTICE, "[TES:00 EXT] REP create error: %s", itron_strerror(error));
break;
}
else if ((error = tcp_echo_srv(cepid, repid)) != E_OK) {
error = free_tcp_rep(repid, error != E_DLT);
break;
}
}
if ((error = free_tcp_cep(cepid)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d EXT] CEP delete error: %s", cepid, itron_strerror(error));
}
}
static ER
tcp_discard_srv (ID cepid, ID repid)
{
static char buffer[BUF_SIZE];
T_IPEP dst;
ER_UINT rlen;
ER error;
SYSTIM time;
uint32_t total;
uint16_t count;
uint8_t *buf = buffer;
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_FEVR)) != E_OK) {
syslog(LOG_NOTICE, "[TDS:%02d RCV] accept error: %s", cepid, itron_strerror(error));
return error;
}
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK) {
syslog(LOG_NOTICE, "[TDS:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
return error;
}
#endif /* of #ifdef USE_TCP_EXTENTIONS */
count = total = 0;
get_tim(&time);
syslog(LOG_NOTICE, "[TDS:%02d RCV] connected: %6ld, from: %s.%d",
cepid, time / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
while ((rlen = tcp_rcv_dat(cepid, buf, BUF_SIZE - 1, TMO_FEVR)) > 0) {
count ++;
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TDS:%02d RCV] count: %4d, len: %4d, data: %02x -> %02x",
cepid, count, (uint16_t)rlen, *buf, *(buf + rlen - 1));
#endif /* of #ifdef SHOW_RCV_RANGE */
total += rlen;
}
if (rlen != 0)
syslog(LOG_NOTICE, "[TDS:%02d RCV] recv error: %s", cepid, itron_strerror(rlen));
if ((error = tcp_sht_cep(cepid)) != E_OK)
syslog(LOG_NOTICE, "[TDS:%02d RCV] shutdown error: %s", cepid, itron_strerror(error));
if ((error = tcp_cls_cep(cepid, TMO_FEVR)) != E_OK)
syslog(LOG_NOTICE, "[TDS:%02d RCV] close error: %s", cepid, itron_strerror(error));
get_tim(&time);
syslog(LOG_NOTICE, "[TDS:%02d RCV] finished: %6ld, rcv: %4d, len: %ld",
cepid, time / SYSTIM_HZ, count, total);
return error;
}
static ER
tcp_echo_srv (ID cepid, ID repid)
{
ER_UINT rlen, slen;
ER error = E_OK;
SYSTIM now;
uint32_t total;
uint16_t soff, scount, rcount;
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_FEVR)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d ACP] error: %s", cepid, itron_strerror(error));
return error;
}
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_EXTENTIONS */
scount = rcount = total = 0;
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d ACP] connected: %6lu, from: %s.%u",
cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
while (true) {
if ((rlen = tcp_rcv_dat(cepid, buffer, BUF_SIZE - 1, RCV_TMO)) <= 0) {
if (rlen != E_OK)
syslog(LOG_NOTICE, "[TES:%02d RCV] error: %s",
cepid, itron_strerror(rlen));
break;
}
rcount ++;
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d RCV] rcount: %4d, len: %4d, data %02x -> %02x",
cepid, rcount, (uint16_t)rlen, *buffer, *(buffer + rlen - 1));
#endif /* of #ifdef SHOW_RCV_RANGE */
total += rlen;
soff = 0;
while (rlen > 0) {
scount ++;
if ((slen = tcp_snd_dat(cepid, &buffer[soff], rlen, SND_TMO)) < 0) {
syslog(LOG_NOTICE, "[TES:%02d SND] error: %s",
cepid, itron_strerror(slen));
goto err_fin;
}
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d SND] scount: %4d, len: %4d", cepid, scount, (uint16_t)slen);
#endif /* of #ifdef SHOW_RCV_RANGE */
rlen -= slen;
soff += slen;
}
}
err_fin:
#ifdef USE_TCP_SHT_CEP
if ((error = tcp_sht_cep(cepid)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d SHT] error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_SHT_CEP */
if ((error = tcp_cls_cep(cepid, CLS_TMO)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d CLS] error: %s", cepid, itron_strerror(error));
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d FIN] finished: %6lu, snd: %4u, rcv: %4u, len: %lu",
cepid, now / SYSTIM_HZ, scount, rcount, total);
return error;
}
static ER
tcp_echo_srv (ID cepid, ID repid)
{
ER_UINT rblen, sblen;
SYSTIM now;
ER error;
uint32_t total;
uint16_t rlen, slen, soff, scount, rcount;
char *rbuf, *sbuf, head, tail;
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_FEVR)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d ACP] error: %s", cepid, itron_strerror(error));
return error;
}
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_EXTENTIONS */
scount = rcount = total = 0;
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d ACP] connected: %6lu, from: %s.%u",
cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
while (true) {
if ((rblen = tcp_rcv_buf(cepid, (void**)&rbuf, RCV_TMO)) <= 0) {
if (rblen != E_OK)
syslog(LOG_NOTICE, "[TES:%02d RCV] error: %s",
cepid, itron_strerror(rblen));
break;
}
head = *rbuf;
tail = *(rbuf + rblen - 1);
rcount ++;
//syslog(LOG_NOTICE, "[TES:%02d RCV] len: %4d", cepid, (uint16_t)rblen);
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d RCV] rcount: %4d, len: %4d, data %02x -> %02x",
cepid, rcount, (uint16_t)rblen, head, tail);
#endif /* of #ifdef SHOW_RCV_RANGE */
rlen = (uint16_t)rblen;
total += rblen;
soff = 0;
while (rlen > 0) {
if ((sblen = tcp_get_buf(cepid, (void**)&sbuf, SND_TMO)) < 0) {
syslog(LOG_NOTICE, "[TES:%02d GET] error: %s",
cepid, itron_strerror(sblen));
goto err_fin;
}
//syslog(LOG_NOTICE, "[TES:%02d SND] len: %4d", cepid, (uint16_t)sblen);
scount ++;
slen = rlen < (uint16_t)sblen ? rlen : (uint16_t)sblen;
memcpy(sbuf, rbuf + soff, slen);
if ((error = tcp_snd_buf(cepid, slen)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d SND] error: %s",
cepid, itron_strerror(error));
goto err_fin;
}
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d SND] scount: %4d, len: %4d", cepid, scount, slen);
#endif /* of #ifdef SHOW_RCV_RANGE */
rlen -= slen;
soff += slen;
}
if ((error = tcp_rel_buf(cepid, rblen)) < 0) {
syslog(LOG_NOTICE, "[TES:%02d REL] error: %s", cepid, itron_strerror(error));
break;
}
}
err_fin:
#ifdef USE_TCP_SHT_CEP
if ((error = tcp_sht_cep(cepid)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d SHT] error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_SHT_CEP */
if ((error = tcp_cls_cep(cepid, CLS_TMO)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d CLS] error: %s", cepid, itron_strerror(error));
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d FIN] finished: %6lu, snd: %4u, rcv: %4u, len: %lu",
cepid, now / SYSTIM_HZ, scount, rcount, total);
return error;
}
static ER
tcp_echo_srv (ID cepid, ID repid)
{
SYSTIM now;
ER error;
uint32_t total;
uint16_t rlen, slen, soff, scount, rcount;
char head, tail;
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d ACP] error: %s", cepid, itron_strerror(error));
return error;
}
/* 相手から接続されるまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
if (nblk_error == E_OK) {
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d ACP] connected: %6lu, from: %s.%u",
cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
}
else {
syslog(LOG_NOTICE, "[TES:%02d ACP] error: %s", cepid, itron_strerror(nblk_error));
return nblk_error;
}
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_EXTENTIONS */
scount = rcount = total = 0;
while (true) {
if ((error = tcp_rcv_dat(cepid, buffer, BUF_SIZE - 1, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d RCV] error: %s",
cepid, itron_strerror(error));
break;
}
/* 受信完了まで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
if (nblk_rlen < 0) {
syslog(LOG_NOTICE, "[TES:%02d RCV] error: %s",
cepid, itron_strerror(nblk_rlen));
break;
}
else if (nblk_rlen == 0)
break;
rlen = nblk_rlen;
head = *buffer;
tail = *(buffer + rlen - 1);
rcount ++;
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d RCV] rcount: %4d, len: %4d, data %02x -> %02x",
cepid, rcount, rlen, head, tail);
#endif /* of #ifdef SHOW_RCV_RANGE */
total += rlen;
soff = 0;
while (rlen > 0) {
scount ++;
if ((error = tcp_snd_dat(cepid, &buffer[soff], rlen, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d SND] error: %s",
cepid, itron_strerror(error));
goto err_fin;
}
/* 送信完了まで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
if (nblk_slen < 0) {
syslog(LOG_NOTICE, "[TES:%02d SND] error: %s",
cepid, itron_strerror(nblk_slen));
goto err_fin;
}
slen = nblk_slen;
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d SND] scount: %4d, len: %4d",
cepid, scount, slen);
#endif /* of #ifdef SHOW_RCV_RANGE */
rlen -= slen;
soff += slen;
}
}
err_fin:
#ifdef USE_TCP_SHT_CEP
if ((error = tcp_sht_cep(cepid)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d SHT] error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_SHT_CEP */
if ((error = tcp_cls_cep(cepid, TMO_NBLK)) != E_WBLK)
syslog(LOG_NOTICE, "[TES:%02d CLS] error: %s", cepid, itron_strerror(error));
/* 開放が完了するまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d FIN] finished: %6lu, snd: %4u, rcv: %4u, len: %lu",
cepid, now / SYSTIM_HZ, scount, rcount, total);
return error == E_WBLK ? E_OK : error;
}
static ER
tcp_echo_srv (ID cepid, ID repid)
{
ER error;
SYSTIM now;
uint32_t total;
uint16_t rblen, sblen, rlen, slen, soff, scount, rcount;
char *rbuf, *sbuf, head, tail;
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d ACP] error: %s", cepid, itron_strerror(error));
return error;
}
/* 相手から接続されるまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
if (nblk_error == E_OK) {
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d ACP] connected: %6lu, from: %s.%u",
cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
}
else {
syslog(LOG_NOTICE, "[TES:%02d ACP] error: %s", cepid, itron_strerror(nblk_error));
return nblk_error;
}
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_EXTENTIONS */
rlen = scount = rcount = total = 0;
while (true) {
if ((error = tcp_rcv_buf(cepid, (void**)&rbuf, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d RCV] error: %s", cepid, itron_strerror(error));
break;
}
/* 受信するまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
if (nblk_rlen < 0) { /* エラー */
syslog(LOG_NOTICE, "[TES:%02d RCV] error: %s",
cepid, itron_strerror(nblk_rlen));
break;
}
else if (nblk_rlen == 0) /* 受信終了 */
break;
rblen = nblk_rlen;
/* バッファの残りにより、受信長を調整する。*/
if (rblen > BUF_SIZE - rlen)
rblen = BUF_SIZE - rlen;
total += rblen;
rlen = rblen;
head = *rbuf;
tail = *(rbuf + rblen - 1);
rcount ++;
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d RCV] "
"rcount: %4d, len: %4d, data %02x -> %02x",
cepid, rcount, rblen, head, tail);
#endif /* of #ifdef SHOW_RCV_RANGE */
memcpy(buffer, rbuf, rblen);
if ((error = tcp_rel_buf(cepid, rlen)) < 0) {
syslog(LOG_NOTICE, "[TES:%02d REL] error: %s",
cepid, itron_strerror(error));
break;
}
soff = 0;
while (rlen > 0) {
if ((error = tcp_get_buf(cepid, (void**)&sbuf, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d GET] error: %s",
cepid, itron_strerror(error));
goto err_fin;
}
/* 送信バッファの獲得が完了するまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
if (nblk_slen < 0) {
syslog(LOG_NOTICE, "[TES:%02d GET] error: %s",
cepid, itron_strerror(nblk_slen));
goto err_fin;
}
sblen = nblk_slen;
scount ++;
slen = sblen < rlen ? sblen : rlen;
memcpy(sbuf, buffer + soff, slen);
if ((error = tcp_snd_buf(cepid, slen)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d SND] error: %s",
cepid, itron_strerror(error));
goto err_fin;
}
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d SND] scount: %4d, len: %4d",
cepid, scount, slen);
#endif /* of #ifdef SHOW_RCV_RANGE */
rlen -= slen;
soff += slen;
}
}
err_fin:
#ifdef USE_TCP_SHT_CEP
if ((error = tcp_sht_cep(cepid)) != E_OK)
syslog(LOG_NOTICE, "[TES:%02d SHT] error: %s", cepid, itron_strerror(error));
#endif /* of #ifdef USE_TCP_SHT_CEP */
if ((error = tcp_cls_cep(cepid, TMO_NBLK)) != E_WBLK)
syslog(LOG_NOTICE, "[TES:%02d CLS] error: %s", cepid, itron_strerror(error));
/* 開放が完了するまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_NBLK_READY));
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d FIN] finished: %6lu, snd: %4u, rcv: %4u, len: %lu",
cepid, now / SYSTIM_HZ, scount, rcount, total);
return error == E_WBLK ? E_OK : error;
}
static ER
tcp_discard_srv (ID cepid, ID repid)
{
T_IPEP dst;
ER_UINT rlen;
ER error;
SYSTIM time;
uint32_t total;
uint16_t count;
uint8_t *buf;
#ifdef SHOW_RCV_DATA
uint_t ix;
#endif /* of #ifdef SHOW_RCV_DATA */
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_FEVR)) != E_OK) {
syslog(LOG_NOTICE, "[TDS:%02d ACP] accept error: %s", cepid, itron_strerror(error));
return error;
}
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK) {
syslog(LOG_NOTICE, "[TDS:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
return error;
}
#endif /* of #ifdef USE_TCP_EXTENTIONS */
count = total = 0;
get_tim(&time);
syslog(LOG_NOTICE, "[TDS:%02d RCV] connected: %6ld, from: %s.%d",
cepid, time / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
while ((rlen = tcp_rcv_buf(cepid, (void*)&buf, TMO_FEVR)) > 0) {
count ++;
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TDS:%02d RCV] count: %4d, len: %4d, data: %02x -> %02x",
cepid, count, (uint16_t)rlen, *buf, *(buf + rlen - 1));
#endif /* of #ifdef SHOW_RCV_RANGE */
#ifdef SHOW_RCV_DATA
for (ix = 0; ix < rlen; ix ++)
cons_putchar(CONSOLE_PORTID, *(buf + ix));
#endif /* of #ifdef SHOW_RCV_DATA */
if ((error = tcp_rel_buf(cepid, rlen)) != E_OK) {
syslog(LOG_NOTICE, "[TDS:%02d RCV] rel buf error: %s",
cepid, itron_strerror(error));
rlen = 0;
break;
}
total += rlen;
}
if (rlen != 0)
syslog(LOG_NOTICE, "[TDS:%02d RCV] recv buf error: %s", cepid, itron_strerror(rlen));
if ((error = tcp_sht_cep(cepid)) != E_OK)
syslog(LOG_NOTICE, "[TDS:%02d RCV] shutdown error: %s", cepid, itron_strerror(error));
if ((error = tcp_cls_cep(cepid, TMO_FEVR)) != E_OK)
syslog(LOG_NOTICE, "[TDS:%02d RCV] close error: %s", cepid, itron_strerror(error));
get_tim(&time);
syslog(LOG_NOTICE, "[TDS:%02d RCV] finished: %6ld, rcv: %4d, len: %ld",
cepid, time / SYSTIM_HZ, count, total);
return error;
}
ER
tcp_echo_srv_rcv (ID cepid, ID repid)
{
ER_UINT rlen;
ER error;
SYSTIM now;
uint16_t blen, last;
char head, tail;
if ((error = psnd_dtq(DTQ_TCP_ECHO_SRV_SND, (intptr_t)cepid)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d RCV] sync error: %s", cepid, itron_strerror(error));
return error;
}
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_FEVR)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d ACP] accept error = %s", cepid, itron_strerror(error));
return error;
}
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
return error;
}
#endif /* of #ifdef USE_TCP_EXTENTIONS */
syscall(get_tim(&now));
syslog(LOG_NOTICE, "[TES:%02d ACP] connected: %6ld, from: %s.%d",
cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
sptr = rptr = buffer;
snd_count = snd_total = rcv_count = rcv_total = chars = 0;
ena_rcv = true;
while (true) {
/* 受信サイズを計算する。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
if (sptr > rptr)
blen = sptr - rptr;
else
blen = sizeof(buffer) - (rptr - buffer);
syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
/* 受信する。*/
if ((rlen = tcp_rcv_dat(cepid, rptr, blen, TMO_FEVR)) <= 0) {
if (rlen < 0)
syslog(LOG_NOTICE, "[TES:%02d RCV] recv error = %s",
cepid, itron_strerror(rlen));
break;
}
head = *rptr;
tail = *(rptr + rlen - 1);
#ifdef SHOW_RCV_RANGE
syslog(LOG_NOTICE, "[TES:%02d RCV] len: %4d, data %02x -> %02x",
cepid, (uint16_t)rlen, head, tail);
#endif /* of #ifdef SHOW_RCV_RANGE */
rcv_count ++;
rcv_total += rlen;
syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
/* 受信ポインタを進める。*/
if (rptr - buffer + rlen >= sizeof(buffer))
rptr -= sizeof(buffer) - rlen;
else
rptr += rlen;
/* バッファ内の文字数を増やす。*/
last = chars;
chars += (uint16_t)rlen;
/* バッファ内に文字が入れば、送信タスクを起床する。*/
if (last == 0 && chars > 0)
sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
/* バッファ内に空きがあれば、受信タスクを起床する。*/
if (sizeof(buffer) - chars > 0)
sig_sem(SEM_TCP_ECHO_SRV_RCV_READY);
syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
/* バッファに空きができるまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_RCV_READY));
}
/* 受信完了 */
ena_rcv = false;
/* 受信バッファに文字が入るのを待っている送信タスクを起床する。*/
if (chars == 0)
sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
/* コネクションの切断が完了するまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_CLS_READY));
return error;
}
ER
tcp_echo_srv_rcv (ID cepid, ID repid)
{
ER error;
uint16_t blen;
if ((error = psnd_dtq(DTQ_TCP_ECHO_SRV_SND, (intptr_t)cepid)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d RCV] sync error: %s", cepid, itron_strerror(error));
return error;
}
if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d ACP] accept error = %s", cepid, itron_strerror(error));
return error;
}
/* コネクション開設完了まで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_RCV_READY));
/* 待っている間にエラーになったら、コネクションの開設待ちに戻る。*/
if (rcv_error != E_OK)
return rcv_error;
#ifdef USE_TCP_EXTENTIONS
if ((error = free_tcp_rep(repid, true)) != E_OK) {
syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
return error;
}
#endif /* of #ifdef USE_TCP_EXTENTIONS */
while (true) {
/* 受信サイズを計算する。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
if (sptr > rptr)
blen = sptr - rptr;
else
blen = sizeof(buffer) - (rptr - buffer);
syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
/* 受信する。*/
if ((error = tcp_rcv_dat(cepid, rptr, blen, TMO_NBLK)) != E_WBLK) {
syslog(LOG_NOTICE, "[TES:%02d RCV] recv error = %s", cepid, itron_strerror(error));
break;
}
/* 受信バッファに空ができるまで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_RCV_READY));
/* 待っている間に、受信文字数が 0 になるか、エラーになったら終了する。*/
if (rcv_error <= 0)
break;
}
/* 受信完了 */
ena_rcv = false;
/* 受信バッファに文字が入るのを待っている送信タスクを起床する。*/
if (chars == 0)
sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
/* コネクション切断完了まで待つ。*/
syscall(wai_sem(SEM_TCP_ECHO_SRV_CLS_READY));
return error == E_WBLK ? E_OK : error;
}
