wdbviolib.c

VXWORKS源代码

/* wdbVioLib.c - virtual I/O library for WDB */

/* Copyright 1984-1994 Wind River Systems, Inc. */

/*
modification history
--------------------
01b,25may95,ms	 included intLib.h, fixed invalid VIO channel detection.
01b,24may95,ms   added wdbVioChannelUnregister().
01a,08nov94,ms   written.
*/

/*
DESCRIPTION

*/

#include "wdb/wdb.h"
#include "wdb/dll.h"
#include "intLib.h"
#include "wdb/wdbEvtLib.h"
#include "wdb/wdbSvcLib.h"
#include "wdb/wdbVioLib.h"

/* local variables */

static dll_t	wdbVioDevList;

/* forward declarations */

static UINT32 wdbVioWrite (WDB_MEM_XFER *pMemXfer, UINT32 *pBytesWriten);

/******************************************************************************
*
* wdbVioLibInit - initialize the VIO library
*/

void wdbVioLibInit (void)
    {
    dll_init (&wdbVioDevList);

    wdbSvcAdd (WDB_VIO_WRITE, wdbVioWrite, xdr_WDB_MEM_XFER, xdr_UINT32);
    }

/******************************************************************************
*
* wdbVioChannelUnregister - unregister a VIO channel.
*/ 

void wdbVioChannelUnregister
    (
    WDB_VIO_NODE *	pVioNode
    )
    {
    int lockKey;

    lockKey = intLock();
    dll_remove (&pVioNode->node);
    intUnlock (lockKey);
    }

/******************************************************************************
*
* wdbVioChannelRegister - register a VIO channel.
*
* RETURNS: OK, or ERROR if the VIO channel is already registered.
*/

STATUS wdbVioChannelRegister
    (
    WDB_VIO_NODE *	pVioNode
    )
    {
    WDB_VIO_NODE *	pThisNode;
    int lockKey;

    for (pThisNode =  (WDB_VIO_NODE *)dll_head (&wdbVioDevList);
	 pThisNode != (WDB_VIO_NODE *)dll_end  (&wdbVioDevList);
	 pThisNode =  (WDB_VIO_NODE *)dll_next (&pThisNode->node)
	)
	{
	if (pThisNode->channel == pVioNode->channel)
	    return (ERROR);
	}

    lockKey = intLock();
    dll_insert (&pVioNode->node, &wdbVioDevList);
    intUnlock (lockKey);

    return (OK);
    }

/******************************************************************************
*
* wdbVioWrite - RPC to put data in a VIO device (from the host to the target).
*/

static UINT32 wdbVioWrite
    (
    WDB_MEM_XFER *	pMemXfer,
    UINT32 *		pBytesWritten
    )
    {
    WDB_VIO_NODE *	pThisNode;

    for (pThisNode =  (WDB_VIO_NODE *)dll_head (&wdbVioDevList);
	 pThisNode != (WDB_VIO_NODE *)dll_end  (&wdbVioDevList);
	 pThisNode =  (WDB_VIO_NODE *)dll_next (&pThisNode->node)
	)
	{
	if (pThisNode->channel == (UINT32)pMemXfer->destination)
	    {
	    *pBytesWritten = (*pThisNode->inputRtn)(pThisNode,
				    pMemXfer->source,
				    pMemXfer->numBytes);
	    return (OK);
	    }
	}

    return (WDB_ERR_INVALID_VIO_CHANNEL);
    }