pm.c

AT91RM9200-U-Boot at91rm9200u-boot移植源代码

/****************************************************************************
*
*                   SciTech OS Portability Manager Library
*
*  ========================================================================
*
*    The contents of this file are subject to the SciTech MGL Public
*    License Version 1.0 (the "License"); you may not use this file
*    except in compliance with the License. You may obtain a copy of
*    the License at http://www.scitechsoft.com/mgl-license.txt
*
*    Software distributed under the License is distributed on an
*    "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
*    implied. See the License for the specific language governing
*    rights and limitations under the License.
*
*    The Original Code is Copyright (C) 1991-1998 SciTech Software, Inc.
*
*    The Initial Developer of the Original Code is SciTech Software, Inc.
*    All Rights Reserved.
*
*  ========================================================================
*
* Language:     ANSI C
* Environment:  32-bit OS/2 VDD
*
* Description:  Implementation for the OS Portability Manager Library, which
*               contains functions to implement OS specific services in a
*               generic, cross platform API. Porting the OS Portability
*               Manager library is the first step to porting any SciTech
*               products to a new platform.
*
****************************************************************************/

#include "pmapi.h"
#include "drvlib/os/os.h"
#include "sdd/sddhelp.h"
#include "mtrr.h"

#define TRACE(a)

/*--------------------------- Global variables ----------------------------*/

#define MAX_MEMORY_SHARED           100
#define MAX_MEMORY_MAPPINGS         100

// TODO: I think the global and linear members will be the same, but not sure yet.
typedef struct {
    void    *linear;
    ulong   global;
    ulong   length;
    int     npages;
    } memshared;

typedef struct {
    ulong   physical;
    ulong   linear;
    ulong   length;
    int     npages;
    ibool   isCached;
    } mmapping;

static int          numMappings = 0;
static memshared    shared[MAX_MEMORY_MAPPINGS] = {0};
static mmapping     maps[MAX_MEMORY_MAPPINGS];
ibool               _PM_haveBIOS = TRUE;
char                _PM_cntPath[PM_MAX_PATH] = "";     /* there just isn't any */
uchar               *_PM_rmBufAddr = NULL;
ushort _VARAPI      PM_savedDS = 0;   /* why can't I use the underscore prefix? */

HVDHSEM             hevFarCallRet = NULL;
HVDHSEM             hevIRet       = NULL;
HHOOK               hhookUserReturnHook = NULL;
HHOOK               hhookUserIRetHook   = NULL;

static void (PMAPIP fatalErrorCleanup)(void) = NULL;

/*----------------------------- Implementation ----------------------------*/

/* Functions to read and write CMOS registers */

ulong   PMAPI _PM_getPDB(void);
uchar   PMAPI _PM_readCMOS(int index);
void    PMAPI _PM_writeCMOS(int index,uchar value);

VOID HOOKENTRY UserReturnHook(PVOID pRefData, PCRF pcrf);
VOID HOOKENTRY UserIRetHook(PVOID pRefData, PCRF pcrf);

void PMAPI PM_init(void)
{
    MTRR_init();

    // Initialize VDD-specific data
    // Note: PM_init must be (obviously) called in VDM task context!
    VDHCreateSem(&hevFarCallRet, VDH_EVENTSEM);
    VDHCreateSem(&hevIRet, VDH_EVENTSEM);
    hhookUserReturnHook = VDHAllocHook(VDH_RETURN_HOOK, (PFNARM)UserReturnHook, 0);
    hhookUserIRetHook   = VDHAllocHook(VDH_RETURN_HOOK, (PFNARM)UserIRetHook, 0);

    if ((hevIRet == NULL) || (hevFarCallRet == NULL) ||
        (hhookUserReturnHook == NULL) || (hhookUserIRetHook == NULL)) {
        // something failed, we can't go on
        // TODO: take some action here!
        }
}

/* Do some cleaning up */
void PMAPI PM_exit(void)
{
    /* Note: Hooks allocated during or after VDM creation are deallocated automatically */
    if (hevIRet != NULL)
        VDHDestroySem(hevIRet);

    if (hevFarCallRet != NULL)
        VDHDestroySem(hevFarCallRet);
}

ibool PMAPI PM_haveBIOSAccess(void)
{ return _PM_haveBIOS; }

long PMAPI PM_getOSType(void)
{ return /*_OS_OS2VDD*/ _OS_OS2; }  //FIX!!

int PMAPI PM_getModeType(void)
{ return PM_386; }

void PMAPI PM_backslash(char *s)
{
    uint pos = strlen(s);
    if (s[pos-1] != '\\') {
        s[pos] = '\\';
        s[pos+1] = '\0';
        }
}

void PMAPI PM_setFatalErrorCleanup(
    void (PMAPIP cleanup)(void))
{
    fatalErrorCleanup = cleanup;
}

void PMAPI PM_fatalError(const char *msg)
{
    if (fatalErrorCleanup)
        fatalErrorCleanup();
//    Fatal_Error_Handler(msg,0);  TODO: implement somehow!
}

/****************************************************************************
PARAMETERS:
len     - Place to store the length of the buffer
rseg    - Place to store the real mode segment of the buffer
roff    - Place to store the real mode offset of the buffer

REMARKS:
This function returns the address and length of the global VESA transfer
buffer.
****************************************************************************/
void * PMAPI PM_getVESABuf(
    uint *len,
    uint *rseg,
    uint *roff)
{
    if (_PM_rmBufAddr) {
        *len = 0; //VESA_BUF_SIZE;
        *rseg = (ulong)(_PM_rmBufAddr) >> 4;
        *roff = (ulong)(_PM_rmBufAddr) & 0xF;
        return _PM_rmBufAddr;
        }
    return NULL;
}

int PMAPI PM_int386(int intno, PMREGS *in, PMREGS *out)
{
    /* Unused in VDDs */
    return 0;
}

char * PMAPI PM_getCurrentPath(char *path,int maxLen)
{
    strncpy(path, _PM_cntPath, maxLen);
    path[maxLen - 1] = 0;
    return path;
}

char PMAPI PM_getBootDrive(void)
{
    ulong   boot = 3;
    boot = VDHQuerySysValue(0, VDHGSV_BOOTDRV);
    return (char)('a' + boot - 1);
}

const char * PMAPI PM_getVBEAFPath(void)
{
    static char path[CCHMAXPATH];
    strcpy(path,"x:\\");
    path[0] = PM_getBootDrive();
    return path;
}

const char * PMAPI PM_getNucleusPath(void)
{
        static char path[CCHMAXPATH];
        strcpy(path,"x:\\os2\\drivers");
        path[0] = PM_getBootDrive();
        PM_backslash(path);
        strcat(path,"nucleus");
        return path;
}

const char * PMAPI PM_getNucleusConfigPath(void)
{
    static char path[256];
    strcpy(path,PM_getNucleusPath());
    PM_backslash(path);
    strcat(path,"config");
    return path;
}

const char * PMAPI PM_getUniqueID(void)
{ return PM_getMachineName(); }

const char * PMAPI PM_getMachineName(void)
{
    return "Unknown";
}

int PMAPI PM_kbhit(void)
{ return 1; }

int PMAPI PM_getch(void)
{ return 0; }

PM_HWND PMAPI PM_openConsole(PM_HWND hwndUser,int device,int xRes,int yRes,int bpp,ibool fullScreen)
{
    /* Unused in VDDs */
    return NULL;
}

int PMAPI PM_getConsoleStateSize(void)
{
    /* Unused in VDDs */
    return 1;
}

void PMAPI PM_saveConsoleState(void *stateBuf,PM_HWND hwndConsole)
{
    /* Unused in VDDs */
}

void PMAPI PM_setSuspendAppCallback(int (_ASMAPIP saveState)(int flags))
{
    /* Unused in VDDs */
}

void PMAPI PM_restoreConsoleState(const void *stateBuf,PM_HWND hwndConsole)
{
    /* Unused in VDDs */
}

void PMAPI PM_closeConsole(PM_HWND hwndConsole)
{
    /* Unused in VDDs */
}

void PMAPI PM_setOSCursorLocation(int x,int y)
{
    uchar *_biosPtr = PM_getBIOSPointer();
    PM_setByte(_biosPtr+0x50,x);
    PM_setByte(_biosPtr+0x51,y);
}

void PMAPI PM_setOSScreenWidth(int width,int height)
{
    uchar *_biosPtr = PM_getBIOSPointer();
    PM_setByte(_biosPtr+0x4A,width);
    PM_setByte(_biosPtr+0x84,height-1);
}

/****************************************************************************
REMARKS:
Allocate a block of shared memory. For OS/2 VDD we allocate shared memory
as locked, global memory that is accessible from any memory context
(including interrupt time context), which allows us to load our important
data structure and code such that we can access it directly from a ring
0 interrupt context.
****************************************************************************/
void * PMAPI PM_mallocShared(long size)
{
    ULONG       nPages = (size + 0xFFF) >> 12;
    int         i;

    /* First find a free slot in our shared memory table */
    for (i = 0; i < MAX_MEMORY_SHARED; i++) {
        if (shared[i].linear == 0)
            break;
        }
    if (i < MAX_MEMORY_SHARED) {
        shared[i].linear = VDHAllocPages(NULL, nPages, VDHAP_SYSTEM | VDHAP_FIXED);
        shared[i].npages = nPages;
        shared[i].global = (ULONG)shared[i].linear;
        return (void*)shared[i].global;
        }
    return NULL;
}

/****************************************************************************
REMARKS:
Free a block of shared memory
****************************************************************************/
void PMAPI PM_freeShared(void *p)
{
    int i;

    /* Find a shared memory block in our table and free it */
    for (i = 0; i < MAX_MEMORY_SHARED; i++) {
        if (shared[i].global == (ulong)p) {
            VDHFreePages(shared[i].linear);
            shared[i].linear = 0;
            break;
            }
        }
}

void * PMAPI PM_mapToProcess(void *base,ulong limit)
{ return (void*)base; }

ibool PMAPI PM_doBIOSPOST(
    ushort axVal,
    ulong BIOSPhysAddr,
    void *mappedBIOS,
    ulong BIOSLen)
{
    // TODO: Figure out how to do this
    return false;
}

void * PMAPI PM_getBIOSPointer(void)
{ return (void*)0x400; }

void * PMAPI PM_getA0000Pointer(void)
{ return PM_mapPhysicalAddr(0xA0000,0xFFFF,true); }

/****************************************************************************
PARAMETERS:
base        - Physical base address of the memory to maps in
limit       - Limit of physical memory to region to maps in

RETURNS:
Linear address of the newly mapped memory.