/* 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 addresstranslation 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);    }