VxWorks

开发平台：
C/C++

vmArch32Lib.c：源码内容
							/* vmArch32Lib.c - VM (VxVMI) library for PentiumPro/2/3/4 32 bit mode */
/* Copyright 2002 Wind River Systems, Inc. */
#include "copyright_wrs.h"
/*
modification history
--------------------
01a,12jun02,hdn  written
*/
/*
DESCRIPTION:
vmArch32Lib.c provides the virtual memory mapping and virtual address
translation that works with the unbundled VM library VxVMI.
It provides 2 routines that are linked in when INCLUDE_MMU_FULL and 
INCLUDE_MMU_P6_32BIT are both defined in the BSP.
*/
/* includes */
#include "vxWorks.h"
#include "errno.h"
#include "mmuLib.h"
#include "private/vmLibP.h"
#include "arch/i86/mmuPro32Lib.h"
/* imports */
IMPORT UINT8 *		globalPageBlockArray;	/* vmLib.c */
IMPORT MMU_LIB_FUNCS	mmuLibFuncs;		/* mmuPro32Lib.c */
/* defines */
#define NOT_PAGE_ALIGNED(addr)  (((UINT)(addr)) & ((UINT)pageSize - 1))
#define MMU_PAGE_MAP		(*(mmuLibFuncs.mmuPageMap))
#define MMU_TRANSLATE		(*(mmuLibFuncs.mmuTranslate))
/****************************************************************************
*
* vmArch32LibInit - initialize the arch specific unbundled VM library (VxVMI Option)
*
* This routine links the arch specific unbundled VM library into 
* the VxWorks system.  It is called automatically when %INCLUDE_MMU_FULL 
* and %INCLUDE_MMU_P6_32BIT are both defined in the BSP.
*
* RETURNS: N/A
*/
void vmArch32LibInit (void)
    {
    } 
/*******************************************************************************
*
* vmArch32Map - map 32bit physical space into 32bit virtual space (VxVMI Option)
*
* This routine maps 32bit physical pages into a contiguous block of 32bit 
* virtual memory.  <virtAddr> and <physAddr> must be on page boundaries,
* and <len> must be evenly divisible by the page size.  After the call to
* vmMap(), the state of all pages in the the newly mapped virtual memory is
* valid, writable, and cacheable.
*
* The vmArch32Map() routine can fail if the specified virtual address space
* conflicts with the translation tables of the global virtual memory space.
* The global virtual address space is architecture-dependent and is
* initialized at boot time with calls to vmGlobalMap() by vmGlobalMapInit(). 
* If a conflict results, `errno' is set to S_vmLib_ADDR_IN_GLOBAL_SPACE.  
* To avoid this conflict, use vmGlobalInfoGet() to ascertain which portions 
* of the virtual address space are reserved for the global virtual address 
* space.  If <context> is specified as NULL, the current virtual memory 
* context is used.
*
* This routine should not be called from interrupt level.
*
* AVAILABILITY
* This routine is distributed as a component of the unbundled virtual memory
* support option, VxVMI.
*
* RETURNS: OK, or ERROR if <virtAddr> or <physAddr> are not 
* on page boundaries, <len> is not a multiple of the page size, 
* the validation fails, or the mapping fails.
*
* ERRNO:
* S_vmLib_NOT_PAGE_ALIGNED,
* S_vmLib_ADDR_IN_GLOBAL_SPACE
*/
STATUS vmArch32Map 
    (
    VM_CONTEXT_ID context, 	/* context - NULL == currentContext */
    void * virtAddr, 		/* virtual address */
    void * physAddr,		/* physical address */
    UINT32 stateMask,		/* state mask */
    UINT32 state,		/* state */
    UINT32 len			/* len of virtual and physical spaces */
    )
    {
    INT32 pageSize      = vmPageSizeGet ();
    INT32 pageBlockSize = vmPageBlockSizeGet ();
    INT8 * thisVirtPage = (INT8 *) virtAddr;
    INT8 * thisPhysPage = (INT8 *) physAddr;
    FAST UINT32 numBytesProcessed = 0;
    STATUS retVal = OK;
    if (!vmLibInfo.vmLibInstalled)
	return (ERROR);
    if (context == NULL)
	context = vmCurrentGet ();
    if ((NOT_PAGE_ALIGNED (thisVirtPage)) ||
        (NOT_PAGE_ALIGNED (thisPhysPage)) ||
        (NOT_PAGE_ALIGNED (len)))
	{
	errno = S_vmLib_NOT_PAGE_ALIGNED;
        return (ERROR); 
	}
    /* take mutual exclusion semaphore to protect translation table */
    semTake (&context->sem, WAIT_FOREVER);
    while (numBytesProcessed < len)
	{
	/* make sure there isn't a conflict with global virtual memory */
	if (globalPageBlockArray[(UINT32) thisVirtPage / pageBlockSize])
	    {
	    errno = S_vmLib_ADDR_IN_GLOBAL_SPACE;
	    retVal = ERROR;
	    break;
	    }
	if (MMU_PAGE_MAP (context->mmuTransTbl, thisVirtPage, 
			  thisPhysPage) == ERROR)
	    {
	    retVal = ERROR;
	    break;
	    }
        if (vmStateSet (context, thisVirtPage, pageSize,
			stateMask, state) != OK)
	    {
	    retVal = ERROR;
	    break;
	    }
	thisVirtPage += pageSize;
	thisPhysPage += pageSize;
	numBytesProcessed += pageSize;
	}
    semGive (&context->sem);
    return (retVal);
    }
/*******************************************************************************
*
* vmArch32Translate - translate a 32bit virtual address to a 32bit physical address (VxVMI Option)
*
* This routine retrieves mapping information for a 32bit virtual address from 
* the page translation tables.  If the specified virtual address has never been
* mapped, the returned status can be either OK or ERROR; however, if it is
* OK, then the returned physical address will be -1.  If <context> is
* specified as NULL, the current context is used.
*
* This routine is callable from interrupt level.
*
* AVAILABILITY
* This routine is distributed as a component of the unbundled virtual memory
* support option, VxVMI.
*
* RETURNS: OK, or ERROR if the validation or translation fails.
*/
STATUS vmArch32Translate 
    (
    VM_CONTEXT_ID context, 	/* context - NULL == currentContext */
    void * virtAddr, 		/* virtual address */
    void ** physAddr		/* place to put result */
    )
    {
    STATUS retVal;
    if (!vmLibInfo.vmLibInstalled)
	return (ERROR);
    if (context == NULL)
	context = vmCurrentGet ();
    retVal = MMU_TRANSLATE (context->mmuTransTbl, virtAddr, physAddr);
    return (retVal);
    }

						