wdbVioLib.c
上传用户:nvosite88
上传日期:2007-01-17
资源大小:4983k
文件大小:3k
源码类别:

VxWorks

开发平台:

C/C++

  1. /* wdbVioLib.c - virtual I/O library for WDB */
  2. /* Copyright 1984-1994 Wind River Systems, Inc. */
  3. /*
  4. modification history
  5. --------------------
  6. 01b,25may95,ms  included intLib.h, fixed invalid VIO channel detection.
  7. 01b,24may95,ms   added wdbVioChannelUnregister().
  8. 01a,08nov94,ms   written.
  9. */
  10. /*
  11. DESCRIPTION
  12. */
  13. #include "wdb/wdb.h"
  14. #include "wdb/dll.h"
  15. #include "intLib.h"
  16. #include "wdb/wdbEvtLib.h"
  17. #include "wdb/wdbSvcLib.h"
  18. #include "wdb/wdbVioLib.h"
  19. /* local variables */
  20. static dll_t wdbVioDevList;
  21. /* forward declarations */
  22. static UINT32 wdbVioWrite (WDB_MEM_XFER *pMemXfer, UINT32 *pBytesWriten);
  23. /******************************************************************************
  24. *
  25. * wdbVioLibInit - initialize the VIO library
  26. */
  27. void wdbVioLibInit (void)
  28.     {
  29.     dll_init (&wdbVioDevList);
  30.     wdbSvcAdd (WDB_VIO_WRITE, wdbVioWrite, xdr_WDB_MEM_XFER, xdr_UINT32);
  31.     }
  32. /******************************************************************************
  33. *
  34. * wdbVioChannelUnregister - unregister a VIO channel.
  35. */ 
  36. void wdbVioChannelUnregister
  37.     (
  38.     WDB_VIO_NODE * pVioNode
  39.     )
  40.     {
  41.     int lockKey;
  42.     lockKey = intLock();
  43.     dll_remove (&pVioNode->node);
  44.     intUnlock (lockKey);
  45.     }
  46. /******************************************************************************
  47. *
  48. * wdbVioChannelRegister - register a VIO channel.
  49. *
  50. * RETURNS: OK, or ERROR if the VIO channel is already registered.
  51. */
  52. STATUS wdbVioChannelRegister
  53.     (
  54.     WDB_VIO_NODE * pVioNode
  55.     )
  56.     {
  57.     WDB_VIO_NODE * pThisNode;
  58.     int lockKey;
  59.     for (pThisNode =  (WDB_VIO_NODE *)dll_head (&wdbVioDevList);
  60.  pThisNode != (WDB_VIO_NODE *)dll_end  (&wdbVioDevList);
  61.  pThisNode =  (WDB_VIO_NODE *)dll_next (&pThisNode->node)
  62. )
  63. {
  64. if (pThisNode->channel == pVioNode->channel)
  65.     return (ERROR);
  66. }
  67.     lockKey = intLock();
  68.     dll_insert (&pVioNode->node, &wdbVioDevList);
  69.     intUnlock (lockKey);
  70.     return (OK);
  71.     }
  72. /******************************************************************************
  73. *
  74. * wdbVioWrite - RPC to put data in a VIO device (from the host to the target).
  75. */
  76. static UINT32 wdbVioWrite
  77.     (
  78.     WDB_MEM_XFER * pMemXfer,
  79.     UINT32 * pBytesWritten
  80.     )
  81.     {
  82.     WDB_VIO_NODE * pThisNode;
  83.     for (pThisNode =  (WDB_VIO_NODE *)dll_head (&wdbVioDevList);
  84.  pThisNode != (WDB_VIO_NODE *)dll_end  (&wdbVioDevList);
  85.  pThisNode =  (WDB_VIO_NODE *)dll_next (&pThisNode->node)
  86. )
  87. {
  88. if (pThisNode->channel == (UINT32)pMemXfer->destination)
  89.     {
  90.     *pBytesWritten = (*pThisNode->inputRtn)(pThisNode,
  91.     pMemXfer->source,
  92.     pMemXfer->numBytes);
  93.     return (OK);
  94.     }
  95. }
  96.     return (WDB_ERR_INVALID_VIO_CHANNEL);
  97.     }