msgqserver.c

来自「Vxworks的培训教程,大家分享下啊,」· C语言 代码 · 共 72 行

#include "vxWorks.h"
#include "errno.h"
#include "msgQLib.h"
#include "stdio.h"
#include "taskLib.h"

#define TASK_PRI		254
#define NUM_MSGS         10

typedef struct
	{
	VOIDFUNCPTR routine;
	int arg;
	} MSG_REQUEST;

LOCAL MSG_Q_ID msgQId;

STATUS serverStart (void)
	{
	void msgQServer ();

	if ((msgQId = msgQCreate (NUM_MSGS, sizeof (MSG_REQUEST), MSG_Q_PRIORITY))
		== NULL)
		return (ERROR);
	
	if (taskSpawn ("tServer", TASK_PRI, 0, 5000, (FUNCPTR) msgQServer, 
	               0,0,0,0,0,0,0,0,0,0) == ERROR)
		{
		msgQDelete (msgQId);
		return (ERROR);
		}
	
	return (OK);
	}

STATUS serverSend 
    (
	VOIDFUNCPTR routine,
	int arg
	)
	{
	MSG_REQUEST msgRequest;

	msgRequest.routine = routine;
	msgRequest.arg     = arg;

	return (msgQSend (msgQId, (char *)&msgRequest, sizeof (MSG_REQUEST),
		              WAIT_FOREVER, MSG_PRI_NORMAL));
	}

void msgQServer (void)
	{
	MSG_REQUEST msgRequest;

	FOREVER
		{
		if (msgQReceive (msgQId, (char *) &msgRequest, sizeof (msgRequest), 
			             WAIT_FOREVER) == ERROR)
			{
			printErr ("%s: msgQ failure\n", taskName(0));
			return;
			}

		if (msgRequest.routine == NULL)
			{
			msgQDelete (msgQId);
			return;
			}
		(*msgRequest.routine) (msgRequest.arg);
		}
	}