561 lines
14 KiB
C
561 lines
14 KiB
C
/*****************************************************************************/
|
||
/* ここから */
|
||
/*****************************************************************************/
|
||
|
||
#include <stdio.h>
|
||
#include <stdlib.h>
|
||
#include <string.h>
|
||
#include <ctype.h>
|
||
#include <unistd.h>
|
||
#include <sys/types.h>
|
||
#include <sys/time.h>
|
||
|
||
#include "wonx_include/comm.h"
|
||
|
||
#include "wonx_configure.h"
|
||
#include "WonX.h"
|
||
#include "etc.h"
|
||
|
||
/*****************************************************************************/
|
||
/* 互換関数の定義 */
|
||
/*****************************************************************************/
|
||
|
||
/*
|
||
* Xサーバとの同期の整合性がとれなくなるなどの問題が考えられるので，
|
||
* 互換関数の内部は UNIXTimer_Pause(), UNIXTimer_Unpause() でくくり，
|
||
* タイマ割り込みを一時停止して処理を行う．また，unpause するまえに，
|
||
* かならず sync するようにする．
|
||
*/
|
||
|
||
/*
|
||
* タイマの一時停止の２重解除の問題が出てくるので，
|
||
* 互換関数から互換関数を呼んではいけない．
|
||
* (一時停止はネストされるが，いちおう)
|
||
* 似たような処理をする関数の場合は，必ず static な別関数に処理をまとめ，
|
||
* そっちを呼び出すようにすること．
|
||
* 引数の表示の問題もあるしね．
|
||
*/
|
||
|
||
void comm_open(void)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_open() : \n");
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_open", "Serial port has already opened.");
|
||
|
||
WWSerialPort_ON(ww_serial_port);
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_open() : return value = none\n");
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return;
|
||
}
|
||
|
||
void comm_close(void)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_close() : \n");
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (!WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_close", "Serial port is not opened.");
|
||
|
||
WWSerialPort_OFF(ww_serial_port);
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_close() : return value = none\n");
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return;
|
||
}
|
||
|
||
static void comm_output(unsigned char c)
|
||
{
|
||
if (c == '\n') printf("\\n");
|
||
else if (c == '\r') printf("\\r");
|
||
else if (c == '\t') printf("\\t");
|
||
else if (isprint(c)) fputc(c, stdout);
|
||
else printf("^%02x", (int)c);
|
||
fflush(stdout);
|
||
return;
|
||
}
|
||
|
||
static int comm_input(int timeout)
|
||
{
|
||
int tmp;
|
||
int c;
|
||
fd_set bitmap;
|
||
struct timeval t;
|
||
struct timeval * t_p;
|
||
|
||
/*
|
||
* 0 のときは，即時
|
||
* -1 のときは，無期限待ち
|
||
*/
|
||
if (timeout == -1) {
|
||
t_p = NULL;
|
||
} else {
|
||
tmp = WONX_SERIAL_PORT_TIMETICKS * timeout;
|
||
t.tv_sec = tmp / 1000;
|
||
t.tv_usec = (tmp % 1000) * 1000;
|
||
t_p = &t;
|
||
}
|
||
|
||
FD_ZERO(&bitmap);
|
||
FD_SET(fileno(stdin), &bitmap);
|
||
|
||
/*
|
||
* FreeBSD3.4 で実験したところ，
|
||
* アラームシグナルを使用する場合，select()でのブロック中に
|
||
* アラームシグナルが発生すると，その直後にselect()もタイムアウト
|
||
* してしまうので，注意．
|
||
* (select() がタイムアウトした後にアラームシグナルが発生する場合は，
|
||
* 正常に動作した)
|
||
* 論理上は問題が無いが，期待した時間だけ待ってくれないという現象が
|
||
* 起きる可能性がある．
|
||
*/
|
||
select(fileno(stdin) + 1, &bitmap, NULL, NULL, t_p);
|
||
|
||
c = FD_ISSET(fileno(stdin), &bitmap) ? fgetc(stdin) : -1;
|
||
c = (c == '\n') ? '\r' : c;
|
||
|
||
return (c);
|
||
}
|
||
|
||
int comm_send_char(unsigned char c)
|
||
{
|
||
int ret;
|
||
|
||
WWSerialPort ww_serial_port;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_send_char() : character = 0x%02x\n", (int)c);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (!WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_send_char", "Serial port is not opened.");
|
||
|
||
printf("output to serial port : ");
|
||
comm_output(c);
|
||
printf("\n");
|
||
fflush(stdout);
|
||
ret = 0;
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_send_char() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
int comm_receive_char(void)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
int c;
|
||
int ret;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_receive_char() : \n");
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (!WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_receive_char", "Serial port is not opened.");
|
||
|
||
c = comm_input(WWSerialPort_GetReceiveTimeout(ww_serial_port));
|
||
|
||
if (c == -1) ret = ERR_SIO_TIMEOUT;
|
||
else ret = c;
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_receive_char() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
int comm_receive_with_timeout(int timeout)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
int c;
|
||
int ret;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_receive_with_timeout() : timeout = %d\n", timeout);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (!WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_receive_with_timeout", "Serial port is not opened.");
|
||
|
||
c = comm_input(timeout);
|
||
|
||
if (c == -1) ret = ERR_SIO_TIMEOUT;
|
||
else ret = c;
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_receive_with_timeout() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
int comm_send_string(char * string)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
int ret;
|
||
int i;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_send_string() : string = %s\n", string);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (!WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_send_string", "Serial port is not opened.");
|
||
|
||
printf("output to serial port : ");
|
||
for (i = 0; string[i]; i++) {
|
||
comm_output(string[i]);
|
||
}
|
||
printf("\n");
|
||
fflush(stdout);
|
||
ret = 0;
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_send_string() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
int comm_send_block(void * buffer, int size)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
int ret;
|
||
int i;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_send_block() : buffer = %p, size = %d\n", buffer, size);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (!WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_send_block", "Serial port is not opened.");
|
||
|
||
printf("output to serial port : ");
|
||
for (i = 0; i < size; i++) {
|
||
comm_output(((char *)buffer)[i]);
|
||
}
|
||
printf("\n");
|
||
fflush(stdout);
|
||
ret = 0;
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_send_block() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
int comm_receive_block(void * buffer, int size)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
int ret;
|
||
int c;
|
||
int i;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_receive_block() : buffer = %p, size = %d\n",
|
||
buffer, size);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (!WWSerialPort_IsON(ww_serial_port))
|
||
WonX_Error("comm_receive_block", "Serial port is not opened.");
|
||
|
||
ret = 0;
|
||
for (i = 0; i < size; i++) {
|
||
c = comm_input(WWSerialPort_GetReceiveTimeout(ww_serial_port));
|
||
if (c == -1) {
|
||
ret = ERR_SIO_TIMEOUT;
|
||
break;
|
||
}
|
||
((char *)buffer)[i] = c;
|
||
}
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_receive_block() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
void comm_set_timeout(int recv_timeout, int send_timeout)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_set_timeout() : receive_timeout = %d, send_timeout = %d\n", recv_timeout, send_timeout);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
WWSerialPort_SetReceiveTimeout(ww_serial_port, recv_timeout);
|
||
WWSerialPort_SetSendTimeout( ww_serial_port, send_timeout);
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_set_timeout() : return value = none\n");
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return;
|
||
}
|
||
|
||
void comm_set_baudrate(int baudrate)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_set_baudrate() : baudrate = %d\n", baudrate);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
switch (baudrate) {
|
||
case COMM_SPEED_9600: WWSerialPort_SetBaudrate9600( ww_serial_port); break;
|
||
case COMM_SPEED_38400: WWSerialPort_SetBaudrate38400(ww_serial_port); break;
|
||
default: WonX_Error("comm_set_baudrate", "Invalid baudrate");
|
||
}
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_set_baudrate() : return value = none\n");
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return;
|
||
}
|
||
|
||
int comm_get_baudrate(void)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
int ret = 0;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_get_baudrate() : \n");
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
if (WWSerialPort_IsBaudrate9600(ww_serial_port))
|
||
ret = COMM_SPEED_9600;
|
||
else if (WWSerialPort_IsBaudrate38400(ww_serial_port))
|
||
ret = COMM_SPEED_38400;
|
||
else WonX_Error("comm_get_baudrate", "Invalid baudrate");
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_get_baudrate() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
void comm_set_cancel_key(unsigned int pattern)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_set_cancel_key() : pattern = %u\n", (int)pattern);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
WWSerialPort_SetCancelKey(ww_serial_port, pattern);
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_set_cancel_key() : return value = none\n");
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return;
|
||
}
|
||
|
||
unsigned int comm_get_cancel_key(void)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
unsigned int ret;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_get_cancel_key() : \n");
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
/* ここに処理を書く */
|
||
ret = WWSerialPort_GetCancelKey(ww_serial_port);
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_get_cancel_key() : return value = %u\n", (int)ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
int comm_xmodem(void * xmodem)
|
||
{
|
||
WWSerialPort ww_serial_port;
|
||
int ret;
|
||
|
||
if (!WonX_IsCreated()) WonX_Create();
|
||
|
||
/* タイマを一時停止する */
|
||
UNIXTimer_Pause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
printf("call : comm_xmodem() : xmodem = %p\n", xmodem);
|
||
fflush(stdout);
|
||
|
||
ww_serial_port = WonXSerialPort_GetWWSerialPort(WonX_GetWonXSerialPort());
|
||
|
||
/* 未サポート */
|
||
printf("call : comm_xmodem() : not supported.\n");
|
||
fflush(stdout);
|
||
ret = 0;
|
||
|
||
WonXDisplay_Sync(WonX_GetWonXDisplay());
|
||
|
||
printf("call : comm_xmodem() : return value = %d\n", ret);
|
||
fflush(stdout);
|
||
|
||
/* タイマをもとに戻す */
|
||
UNIXTimer_Unpause(WonXSystem_GetUNIXTimer(WonX_GetWonXSystem()));
|
||
|
||
return (ret);
|
||
}
|
||
|
||
/*****************************************************************************/
|
||
/* ここまで */
|
||
/*****************************************************************************/
|
||
|
||
/*****************************************************************************/
|
||
/* End of File. */
|
||
/*****************************************************************************/
|