vmbasearch32lib.c

VXWORKS源代码

/* vmBaseArch32Lib.c - VM (bundled) 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:

vmBaseArch32Lib.c provides the virtual memory mapping and virtual address
translation that works with the bundled VM library.
It provides 2 routines that are linked in when INCLUDE_MMU_BASIC 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 VM_CONTEXT *	currentContext;		/* vmBaseLib.c */
IMPORT MMU_LIB_FUNCS	mmuLibFuncs;		/* mmuLib.c */


/* defines */

#define NOT_PAGE_ALIGNED(addr)	(((UINT)(addr)) & ((UINT)pageSize - 1))
#define MMU_PAGE_MAP		(*(mmuLibFuncs.mmuPageMap))
#define MMU_TRANSLATE		(*(mmuLibFuncs.mmuTranslate))


/****************************************************************************
*
* vmBaseArch32LibInit - initialize the arch specific bundled VM library
*
* This routine links the arch specific bundled VM library into the VxWorks 
* system.  It is called automatically when \%INCLUDE_MMU_BASIC and 
* \%INCLUDE_MMU_P6_32BIT are both defined in the BSP.
*
* RETURNS: N/A
*/

void vmBaseArch32LibInit (void)
    {
    } 

/****************************************************************************
*
* vmBaseArch32Map - map 32bit physical to the 32bit virtual memory
*
* vmBaseArch32Map maps 32bit physical pages to 32bit virtual space then
* sets the specified state.
*
* RETURNS: OK, or ERROR if virtAddr or physical page addresses are not on
* page boundaries, len is not a multiple of page size, or mapping failed.
*/

STATUS vmBaseArch32Map 
    (
    void * virtAddr, 		/* 32bit virtual address */
    void * physAddr, 		/* 36bit physical address */
    UINT32 stateMask,		/* state mask */
    UINT32 state,		/* state */
    UINT32 len			/* length */
    )
    {
    INT32 pageSize      = vmBasePageSizeGet ();
    INT8 * thisVirtPage = (INT8 *) virtAddr;
    INT8 * thisPhysPage = (INT8 *) physAddr;
    FAST UINT32 numBytesProcessed = 0;
    STATUS retVal	= OK;

    if (!vmLibInfo.vmBaseLibInstalled)
	return (ERROR);

    if ((NOT_PAGE_ALIGNED (thisVirtPage)) ||
        (NOT_PAGE_ALIGNED (thisPhysPage)) ||
        (NOT_PAGE_ALIGNED (len)))
	{
	errno = S_vmLib_NOT_PAGE_ALIGNED;
        return (ERROR); 
	}

    semTake (&currentContext->sem, WAIT_FOREVER);

    while (numBytesProcessed < len)
	{
	if (MMU_PAGE_MAP (currentContext->mmuTransTbl,
			  thisVirtPage, thisPhysPage) != OK)
	    {
	    retVal = ERROR;
	    break;
	    }

	if (vmBaseStateSet (currentContext, thisVirtPage, 
			    pageSize, stateMask, state) != OK)
	    {
	    retVal = ERROR;
	    break;
	    }

	thisVirtPage += pageSize;
	thisPhysPage += pageSize;
	numBytesProcessed += pageSize;
	}

    semGive (&currentContext->sem);

    return (retVal);
    }

/****************************************************************************
*
* vmBaseArch32Translate - translate a 32bit virtual address to a 32bit physical address
*
* vmBaseArch32Translate may be used to retrieve the mapping information 
* for a virtual address from the page translation tables.  If the given 
* virtual address has never been mapped, either the returned status will
* be ERROR, or, the returned status will be OK, but 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.
*
* RETURNS: OK, or validation failed, or translation failed.
*/

STATUS vmBaseArch32Translate 
    (
    void *  virtAddr, 		/* virtual address */
    void ** physAddr		/* place to put result */
    )
    {
    STATUS retVal;

    if (!vmLibInfo.vmBaseLibInstalled)
	return (ERROR);

    retVal = MMU_TRANSLATE (currentContext->mmuTransTbl, virtAddr, physAddr);

    return (retVal);
    }