serial_mailbox.c

来自「嵌入式系统开发 TOPPERS and JSP Kernel Release 」· C语言 代码 · 共 264 行

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2002 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 * 
 *  惧淡螟侯涪荚は·Free Software Foundation によって给山されている 
 *  GNU General Public License の Version 2 に淡揭されている掘凤か·笆
 *  布の(1)×(4)の掘凤を塔たす眷圭に嘎り·塑ソフトウェア∈塑ソフトウェ
 *  アを猖恃したものを崔むˉ笆布票じ∷を蝗脱ˇ剩澜ˇ猖恃ˇ浩芹邵∈笆布·
 *  网脱と钙ぶ∷することを痰浸で钓满するˉ
 *  (1) 塑ソフトウェアをソ〖スコ〖ドの妨で网脱する眷圭には·惧淡の螟侯
 *      涪山绩·この网脱掘凤および布淡の痰瘦沮惮年が·そのままの妨でソ〖
 *      スコ〖ド面に崔まれていることˉ
 *  (2) 塑ソフトウェアを浩网脱材墙なバイナリコ〖ド∈リロケ〖タブルオブ
 *      ジェクトファイルやライブラリなど∷の妨で网脱する眷圭には·网脱
 *      に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟侯涪山绩·
 *      この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *  (3) 塑ソフトウェアを浩网脱稍材墙なバイナリコ〖ドの妨または怠达に寥
 *      み哈んだ妨で网脱する眷圭には·肌のいずれかの掘凤を塔たすことˉ
 *    (a) 网脱に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟侯
 *        涪山绩·この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *    (b) 网脱の妨轮を·侍に年める数恕によって·惧淡螟侯涪荚に鼠桂する
 *        ことˉ
 *  (4) 塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じるいかなる禄
 *      巢からも·惧淡螟侯涪荚を倘勒することˉ
 * 
 *  塑ソフトウェアは·痰瘦沮で捏丁されているものであるˉ惧淡螟侯涪荚は·
 *  塑ソフトウェアに簇して·その努脱材墙拉も崔めて·いかなる瘦沮も乖わ
 *  ないˉまた·塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じたい
 *  かなる禄巢に簇しても·その勒扦を砷わないˉ
 * 
 *  @(#) $Id: serial_mailbox.c,v 1.4 2002/04/10 11:20:09 takayuki Exp $
 */


/*
 * Windowsのメ〖ルスロットを蝗ったシリアルインタ〖フェ〖スモジュ〖ル
 *  (庙)舍奶のシリアル(COMデバイス)は蝗えません
 */

#include <jsp_services.h>
#include "kernel_id.h"

#define TRANSLATE_PORTID(x) \
	x = (x != 0) ? (x) : CONSOLE_PORTID 

#define CHECK_PORTID(x) \
	( (x) > 0 && (x) <= NUM_PORT )

#define CLOSE_HANDLE(x) \
	CloseHandle(x), x=INVALID_HANDLE_VALUE;

#define INHNO_SERIAL	3
#define NUM_PORT 1
#define SIO_POLINTERVAL 300

	/* プロトタイピング */
void	serial_initialize(VP_INT portid);
ER		serial_open(ID portid);
int		serial_close(ID portid, int flush);
ER_UINT serial_read(ID portid, char *buf, unsigned int len);
ER_UINT serial_write(ID portid, char *buf, unsigned int len);
ER		serial_ioctl(ID portid, UINT ioctl);
void	serial_handler(void);

typedef struct serial_port_control_block {
	char *	InDevName;
	HANDLE	InDevHandle;
	ID		InSemaphore;

	char *	OutDevName;
	HANDLE	OutDevHandle;

	HANDLE	MailWatcherHandle;
	DWORD	MailWatcherID;
} SPCB;

SPCB spcb[NUM_PORT] =
{
	{
		"\\\\.\\mailslot\\toppers\\serial_in", INVALID_HANDLE_VALUE, SEM_SERIAL1_IN,
		"\\\\.\\mailslot\\toppers\\serial_out", INVALID_HANDLE_VALUE,
		INVALID_HANDLE_VALUE, 0
	}
};

DWORD WINAPI
MailWatcher(LPVOID param)
{
	SPCB * cb = (SPCB *)param;
	DWORD count;
	char Buffer;

	while(1==1)
	{
		ReadFile(cb->InDevHandle,&Buffer,0,&count,NULL);
		/*{
			count = GetLastError();
			syscall(sig_sem(cb->InSemaphore));
			CloseHandle(cb->MailWatcherHandle);
			cb->MailWatcherHandle = INVALID_HANDLE_VALUE;
			ExitThread(0);
		}*/
		syscall(sig_sem(cb->InSemaphore));
		SuspendThread(GetCurrentThread());
	}
	return 0;
}

Inline void
CloseAllHandles(SPCB * cb)
{
	if(cb->MailWatcherHandle != INVALID_HANDLE_VALUE)
	{
		TerminateThread(cb->MailWatcherHandle,0);
		CLOSE_HANDLE(cb->MailWatcherHandle);

		if(cb->OutDevHandle != INVALID_HANDLE_VALUE)
			CLOSE_HANDLE(cb->OutDevHandle);
	
		if(cb->InDevHandle != INVALID_HANDLE_VALUE)
			CLOSE_HANDLE(cb->InDevHandle);
	}
}


/*
 *  シリアルインタフェ〖スドライバの弹瓢
 */
void
serial_initialize(VP_INT portid)
{
	syscall(serial_open((int)portid));
	syslog(LOG_NOTICE, "Serial driver service starts on port %d.", portid);
}

ER
serial_open(ID portid)
{
	SPCB * cb;

	TRANSLATE_PORTID(portid);
	if(!CHECK_PORTID(portid))
		return E_PAR;

	cb = &spcb[portid-1];


	if((cb->OutDevHandle = CreateFile(cb->OutDevName,GENERIC_WRITE,FILE_SHARE_READ|FILE_SHARE_WRITE,NULL,OPEN_EXISTING,FILE_ATTRIBUTE_NORMAL,NULL)) == INVALID_HANDLE_VALUE)
	{
		CloseAllHandles(cb);
		return E_OBJ;
	}

	if((cb->InDevHandle = CreateMailslot(cb->InDevName,0,MAILSLOT_WAIT_FOREVER,NULL)) == INVALID_HANDLE_VALUE)
	{
		CloseAllHandles(cb);
		return E_OBJ;
	}

	if((cb->MailWatcherHandle = CreateThread(NULL,0,MailWatcher,(void *)cb,CREATE_SUSPENDED,&cb->MailWatcherID)) == NULL)
	{
		cb->MailWatcherHandle = INVALID_HANDLE_VALUE;
		CloseAllHandles(cb);
		return E_OBJ;
	}

	return E_OK;
}

int
serial_close(ID portid, int flush)
{
	SPCB * cb;

	TRANSLATE_PORTID(portid);
	if(!CHECK_PORTID(portid))
		return E_PAR;

	cb = &spcb[portid-1];
	if(cb->MailWatcherHandle == INVALID_HANDLE_VALUE)
		return E_OBJ;

	if(flush != 0)
		FlushFileBuffers(cb->OutDevHandle);

	CloseAllHandles(cb);

	return E_OK;
}

ER_UINT
serial_read(ID portid, char * buf, unsigned int len)
{
	SPCB * cb;
	DWORD cnt;

	if(len == 0)
		return 0;
	TRANSLATE_PORTID(portid);
	if(!CHECK_PORTID(portid) || buf == 0l)
		return E_PAR;

	cb = &spcb[portid-1];
	if(cb->MailWatcherHandle == INVALID_HANDLE_VALUE)
		return E_OBJ;

	while(len>0)
	{
		GetMailslotInfo(cb->InDevHandle,NULL,&cnt,NULL,NULL);
		if(cnt == MAILSLOT_NO_MESSAGE)
		{
			ResumeThread(cb->MailWatcherHandle);
			syscall(wai_sem(cb->InSemaphore));
		}

		if(ReadFile(cb->InDevHandle,buf,len,&cnt,NULL)==0)
		{
			cnt = GetLastError();
			return E_OBJ;
		}

		len -= cnt;
		buf += cnt;
	}

	return E_OK;
}

ER_UINT
serial_write(ID portid,char * buf, unsigned int len)
{
	SPCB * cb;
	DWORD cnt;

	if(len == 0)
		return 0;
	TRANSLATE_PORTID(portid);
	if(!CHECK_PORTID(portid) || buf == 0l)
		return E_PAR;

	cb = &spcb[portid-1];
	if(cb->MailWatcherHandle == INVALID_HANDLE_VALUE)
		return E_OBJ;

	if(WriteFile(cb->OutDevHandle,buf,len,&cnt,NULL) == 0)
		return E_OBJ;
	
	return (UINT)cnt;
}

int
serial_ioctl(ID portid,UINT ioctl)
{
	return E_OK;
}

void
serial_handler(void)
{}