Logo Search packages:      
Sourcecode: u-boot-omap4 version File versions  Download package

pm.c

;/****************************************************************************
*
*                   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.
*
*  ========================================================================
*
*                   Portions copyright (C) Josh Vanderhoof
*
* Language:     ANSI C
* Environment:  Linux
*
* 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 <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/mman.h>
#include <sys/kd.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/vt.h>
#include <sys/wait.h>
#include <sys/types.h>
#include <sys/time.h>
#include <unistd.h>
#include <termios.h>
#include <fcntl.h>
#include <syscall.h>
#include <signal.h>
#include <time.h>
#include <ctype.h>
#include <errno.h>
#include <asm/io.h>
#include <asm/types.h>
#ifdef ENABLE_MTRR
#include <asm/mtrr.h>
#endif
#include <asm/vm86.h>
#ifdef __GLIBC__
#include <sys/perm.h>
#endif

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

#define REAL_MEM_BASE       ((void *)0x10000)
#define REAL_MEM_SIZE       0x10000
#define REAL_MEM_BLOCKS     0x100
#define DEFAULT_VM86_FLAGS  (IF_MASK | IOPL_MASK)
#define DEFAULT_STACK_SIZE  0x1000
#define RETURN_TO_32_INT    255

/* Quick and dirty fix for vm86() syscall from lrmi 0.6 */
static int
vm86(struct vm86_struct *vm)
    {
    int r;
#ifdef __PIC__
    asm volatile (
     "pushl %%ebx\n\t"
     "movl %2, %%ebx\n\t"
     "int $0x80\n\t"
     "popl %%ebx"
     : "=a" (r)
     : "0" (113), "r" (vm));
#else
    asm volatile (
     "int $0x80"
     : "=a" (r)
     : "0" (113), "b" (vm));
#endif
    return r;
    }


static struct {
    int                 ready;
    unsigned short      ret_seg, ret_off;
    unsigned short      stack_seg, stack_off;
    struct vm86_struct  vm;
    } context = {0};

struct mem_block {
    unsigned int size : 20;
    unsigned int free : 1;
    };

static struct {
    int ready;
    int count;
    struct mem_block blocks[REAL_MEM_BLOCKS];
    } mem_info = {0};

int                     _PM_console_fd = -1;
int                     _PM_leds = 0,_PM_modifiers = 0;
static ibool            inited = false;
static int              tty_vc = 0;
static int              console_count = 0;
static int              startup_vc;
static int              fd_mem = 0;
static ibool            in_raw_mode = false;
#ifdef ENABLE_MTRR
static int              mtrr_fd;
#endif
static uint VESABuf_len = 1024;     /* Length of the VESABuf buffer     */
static void *VESABuf_ptr = NULL;    /* Near pointer to VESABuf          */
static uint VESABuf_rseg;           /* Real mode segment of VESABuf     */
static uint VESABuf_roff;           /* Real mode offset of VESABuf      */
#ifdef TRACE_IO
static ulong            traceAddr;
#endif

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

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

#ifdef  TRACE_IO
extern void printk(char *msg,...);
#endif

static inline void port_out(int value, int port)
{
#ifdef TRACE_IO
    printk("%04X:%04X: outb.%04X <- %02X\n", traceAddr >> 16, traceAddr & 0xFFFF, (ushort)port, (uchar)value);
#endif
    asm volatile ("outb %0,%1"
        ::"a" ((unsigned char) value), "d"((unsigned short) port));
}

static inline void port_outw(int value, int port)
{
#ifdef TRACE_IO
    printk("%04X:%04X: outw.%04X <- %04X\n", traceAddr >> 16,traceAddr & 0xFFFF, (ushort)port, (ushort)value);
#endif
    asm volatile ("outw %0,%1"
       ::"a" ((unsigned short) value), "d"((unsigned short) port));
}

static inline void port_outl(int value, int port)
{
#ifdef TRACE_IO
    printk("%04X:%04X: outl.%04X <- %08X\n", traceAddr >> 16,traceAddr & 0xFFFF, (ushort)port, (ulong)value);
#endif
    asm volatile ("outl %0,%1"
       ::"a" ((unsigned long) value), "d"((unsigned short) port));
}

static inline unsigned int port_in(int port)
{
    unsigned char value;
    asm volatile ("inb %1,%0"
            :"=a" ((unsigned char)value)
            :"d"((unsigned short) port));
#ifdef TRACE_IO
    printk("%04X:%04X:  inb.%04X -> %02X\n", traceAddr >> 16,traceAddr & 0xFFFF, (ushort)port, (uchar)value);
#endif
    return value;
}

static inline unsigned int port_inw(int port)
{
    unsigned short value;
    asm volatile ("inw %1,%0"
            :"=a" ((unsigned short)value)
            :"d"((unsigned short) port));
#ifdef TRACE_IO
    printk("%04X:%04X:  inw.%04X -> %04X\n", traceAddr >> 16,traceAddr & 0xFFFF, (ushort)port, (ushort)value);
#endif
    return value;
}

static inline unsigned int port_inl(int port)
{
    unsigned long value;
    asm volatile ("inl %1,%0"
            :"=a" ((unsigned long)value)
            :"d"((unsigned short) port));
#ifdef TRACE_IO
    printk("%04X:%04X:  inl.%04X -> %08X\n", traceAddr >> 16,traceAddr & 0xFFFF, (ushort)port, (ulong)value);
#endif
    return value;
}

static int real_mem_init(void)
{
    void    *m;
    int     fd_zero;

    if (mem_info.ready)
      return 1;

    if ((fd_zero = open("/dev/zero", O_RDONLY)) == -1)
      PM_fatalError("You must have root privledges to run this program!");
    if ((m = mmap((void *)REAL_MEM_BASE, REAL_MEM_SIZE,
          PROT_READ | PROT_WRITE | PROT_EXEC,
          MAP_FIXED | MAP_PRIVATE, fd_zero, 0)) == (void *)-1) {
      close(fd_zero);
      PM_fatalError("You must have root privledges to run this program!");
      }
    mem_info.ready = 1;
    mem_info.count = 1;
    mem_info.blocks[0].size = REAL_MEM_SIZE;
    mem_info.blocks[0].free = 1;
    return 1;
}

static void insert_block(int i)
{
    memmove(
      mem_info.blocks + i + 1,
      mem_info.blocks + i,
      (mem_info.count - i) * sizeof(struct mem_block));
    mem_info.count++;
}

static void delete_block(int i)
{
    mem_info.count--;

    memmove(
      mem_info.blocks + i,
      mem_info.blocks + i + 1,
      (mem_info.count - i) * sizeof(struct mem_block));
}

static inline void set_bit(unsigned int bit, void *array)
{
    unsigned char *a = array;
    a[bit / 8] |= (1 << (bit % 8));
}

static inline unsigned int get_int_seg(int i)
{
    return *(unsigned short *)(i * 4 + 2);
}

static inline unsigned int get_int_off(int i)
{
    return *(unsigned short *)(i * 4);
}

static inline void pushw(unsigned short i)
{
    struct vm86_regs *r = &context.vm.regs;
    r->esp -= 2;
    *(unsigned short *)(((unsigned int)r->ss << 4) + r->esp) = i;
}

ibool PMAPI PM_haveBIOSAccess(void)
{ return true; }

void PMAPI PM_init(void)
{
    void    *m;
    uint    r_seg,r_off;

    if (inited)
      return;

    /* Map the Interrupt Vectors (0x0 - 0x400) + BIOS data (0x400 - 0x502)
     * and the physical framebuffer and ROM images from (0xa0000 - 0x100000)
     */
    real_mem_init();
    if (!fd_mem && (fd_mem = open("/dev/mem", O_RDWR)) == -1) {
      PM_fatalError("You must have root privileges to run this program!");
      }
    if ((m = mmap((void *)0, 0x502,
          PROT_READ | PROT_WRITE | PROT_EXEC,
          MAP_FIXED | MAP_PRIVATE, fd_mem, 0)) == (void *)-1) {
      PM_fatalError("You must have root privileges to run this program!");
      }
    if ((m = mmap((void *)0xA0000, 0xC0000 - 0xA0000,
          PROT_READ | PROT_WRITE,
          MAP_FIXED | MAP_SHARED, fd_mem, 0xA0000)) == (void *)-1) {
      PM_fatalError("You must have root privileges to run this program!");
      }
    if ((m = mmap((void *)0xC0000, 0xD0000 - 0xC0000,
          PROT_READ | PROT_WRITE | PROT_EXEC,
          MAP_FIXED | MAP_PRIVATE, fd_mem, 0xC0000)) == (void *)-1) {
      PM_fatalError("You must have root privileges to run this program!");
      }
    if ((m = mmap((void *)0xD0000, 0x100000 - 0xD0000,
          PROT_READ | PROT_WRITE,
          MAP_FIXED | MAP_SHARED, fd_mem, 0xD0000)) == (void *)-1) {
      PM_fatalError("You must have root privileges to run this program!");
      }
    inited = 1;

    /* Allocate a stack */
    m = PM_allocRealSeg(DEFAULT_STACK_SIZE,&r_seg,&r_off);
    context.stack_seg = r_seg;
    context.stack_off = r_off+DEFAULT_STACK_SIZE;

    /* Allocate the return to 32 bit routine */
    m = PM_allocRealSeg(2,&r_seg,&r_off);
    context.ret_seg = r_seg;
    context.ret_off = r_off;
    ((uchar*)m)[0] = 0xCD;         /* int opcode */
    ((uchar*)m)[1] = RETURN_TO_32_INT;
    memset(&context.vm, 0, sizeof(context.vm));

    /* Enable kernel emulation of all ints except RETURN_TO_32_INT */
    memset(&context.vm.int_revectored, 0, sizeof(context.vm.int_revectored));
    set_bit(RETURN_TO_32_INT, &context.vm.int_revectored);
    context.ready = 1;
#ifdef ENABLE_MTRR
    mtrr_fd =  open("/dev/cpu/mtrr", O_RDWR, 0);
    if (mtrr_fd < 0)
       mtrr_fd =  open("/proc/mtrr", O_RDWR, 0);
#endif
    /* Enable I/O permissions to directly access I/O ports. We break the
     * allocation into two parts, one for the ports from 0-0x3FF and
     * another for the remaining ports up to 0xFFFF. Standard Linux kernels
     * only allow the first 0x400 ports to be enabled, so to enable all
     * 65536 ports you need a patched kernel that will enable the full
     * 8Kb I/O permissions bitmap.
     */
#ifndef TRACE_IO
    ioperm(0x0,0x400,1);
    ioperm(0x400,0x10000-0x400,1);
#endif
    iopl(3);
}

long PMAPI PM_getOSType(void)
{ return _OS_LINUX; }

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();
    fprintf(stderr,"%s\n", msg);
    fflush(stderr);
    exit(1);
}

static void ExitVBEBuf(void)
{
    if (VESABuf_ptr)
      PM_freeRealSeg(VESABuf_ptr);
    VESABuf_ptr = 0;
}

void * PMAPI PM_getVESABuf(uint *len,uint *rseg,uint *roff)
{
    if (!VESABuf_ptr) {
      /* Allocate a global buffer for communicating with the VESA VBE */
      if ((VESABuf_ptr = PM_allocRealSeg(VESABuf_len, &VESABuf_rseg, &VESABuf_roff)) == NULL)
          return NULL;
      atexit(ExitVBEBuf);
      }
    *len = VESABuf_len;
    *rseg = VESABuf_rseg;
    *roff = VESABuf_roff;
    return VESABuf_ptr;
}

/* New raw console based getch and kbhit functions */

#define KB_CAPS     LED_CAP /* 4 */
#define KB_NUMLOCK  LED_NUM /* 2 */
#define KB_SCROLL   LED_SCR /* 1 */
#define KB_SHIFT    8
#define KB_CONTROL  16
#define KB_ALT      32

/* Structure used to save the keyboard mode to disk. We save it to disk
 * so that we can properly restore the mode later if the program crashed.
 */

typedef struct {
    struct termios  termios;
    int             kb_mode;
    int             leds;
    int             flags;
    int             startup_vc;
    } keyboard_mode;

/* Name of the file used to save keyboard mode information */

#define KBMODE_DAT  "kbmode.dat"

/****************************************************************************
REMARKS:
Open the keyboard mode file on disk.
****************************************************************************/
static FILE *open_kb_mode(
    char *mode,
    char *path)
{
    if (!PM_findBPD("graphics.bpd",path))
      return NULL;
    PM_backslash(path);
    strcat(path,KBMODE_DAT);
    return fopen(path,mode);
}

/****************************************************************************
REMARKS:
Restore the keyboard to normal mode
****************************************************************************/
void _PM_restore_kb_mode(void)
{
    FILE            *kbmode;
    keyboard_mode   mode;
    char            path[PM_MAX_PATH];

    if (_PM_console_fd != -1 && (kbmode = open_kb_mode("rb",path)) != NULL) {
      if (fread(&mode,1,sizeof(mode),kbmode) == sizeof(mode)) {
          if (mode.startup_vc > 0)
            ioctl(_PM_console_fd, VT_ACTIVATE, mode.startup_vc);
          ioctl(_PM_console_fd, KDSKBMODE, mode.kb_mode);
          ioctl(_PM_console_fd, KDSETLED, mode.leds);
          tcsetattr(_PM_console_fd, TCSAFLUSH, &mode.termios);
          fcntl(_PM_console_fd,F_SETFL,mode.flags);
          }
      fclose(kbmode);
      unlink(path);
      in_raw_mode = false;
      }
}

/****************************************************************************
REMARKS:
Safely abort the event module upon catching a fatal error.
****************************************************************************/
void _PM_abort(
    int signo)
{
    char    buf[80];

    sprintf(buf,"Terminating on signal %d",signo);
    _PM_restore_kb_mode();
    PM_fatalError(buf);
}

/****************************************************************************
REMARKS:
Put the keyboard into raw mode
****************************************************************************/
void _PM_keyboard_rawmode(void)
{
    struct termios conf;
    FILE            *kbmode;
    keyboard_mode   mode;
    char            path[PM_MAX_PATH];
    int             i;
    static int sig_list[] = {
      SIGHUP,
      SIGINT,
      SIGQUIT,
      SIGILL,
      SIGTRAP,
      SIGABRT,
      SIGIOT,
      SIGBUS,
      SIGFPE,
      SIGKILL,
      SIGSEGV,
      SIGTERM,
      };

    if ((kbmode = open_kb_mode("rb",path)) == NULL) {
      if ((kbmode = open_kb_mode("wb",path)) == NULL)
          PM_fatalError("Unable to open kbmode.dat file for writing!");
      if (ioctl(_PM_console_fd, KDGKBMODE, &mode.kb_mode))
          perror("KDGKBMODE");
      ioctl(_PM_console_fd, KDGETLED, &mode.leds);
      _PM_leds = mode.leds & 0xF;
      _PM_modifiers = 0;
      tcgetattr(_PM_console_fd, &mode.termios);
      conf = mode.termios;
      conf.c_lflag &= ~(ICANON | ECHO | ISIG);
      conf.c_iflag &= ~(ISTRIP | IGNCR | ICRNL | INLCR | BRKINT | PARMRK | INPCK | IUCLC | IXON | IXOFF);
      conf.c_iflag  |= (IGNBRK | IGNPAR);
      conf.c_cc[VMIN] = 1;
      conf.c_cc[VTIME] = 0;
      conf.c_cc[VSUSP] = 0;
      tcsetattr(_PM_console_fd, TCSAFLUSH, &conf);
      mode.flags = fcntl(_PM_console_fd,F_GETFL);
      if (ioctl(_PM_console_fd, KDSKBMODE, K_MEDIUMRAW))
          perror("KDSKBMODE");
      atexit(_PM_restore_kb_mode);
      for (i = 0; i < sizeof(sig_list)/sizeof(sig_list[0]); i++)
          signal(sig_list[i], _PM_abort);
      mode.startup_vc = startup_vc;
      if (fwrite(&mode,1,sizeof(mode),kbmode) != sizeof(mode))
          PM_fatalError("Error writing kbmode.dat!");
      fclose(kbmode);
      in_raw_mode = true;
      }
}

int PMAPI PM_kbhit(void)
{
    fd_set s;
    struct timeval tv = { 0, 0 };

    if (console_count == 0)
      PM_fatalError("You *must* open a console before using PM_kbhit!");
    if (!in_raw_mode)
      _PM_keyboard_rawmode();
    FD_ZERO(&s);
    FD_SET(_PM_console_fd, &s);
    return select(_PM_console_fd+1, &s, NULL, NULL, &tv) > 0;
}

int PMAPI PM_getch(void)
{
    static uchar    c;
    int release;
    static struct kbentry ke;

    if (console_count == 0)
      PM_fatalError("You *must* open a console before using PM_getch!");
    if (!in_raw_mode)
      _PM_keyboard_rawmode();
    while (read(_PM_console_fd, &c, 1) > 0) {
      release = c & 0x80;
      c &= 0x7F;
      if (release) {
          switch(c){
            case 42: case 54: /* Shift */
                _PM_modifiers &= ~KB_SHIFT;
                break;
            case 29: case 97: /* Control */
                _PM_modifiers &= ~KB_CONTROL;
                break;
            case 56: case 100: /* Alt / AltGr */
                _PM_modifiers &= ~KB_ALT;
                break;
            }
          continue;
          }
      switch (c) {
          case 42: case 54: /* Shift */
            _PM_modifiers |= KB_SHIFT;
             break;
          case 29: case 97: /* Control */
            _PM_modifiers |= KB_CONTROL;
            break;
          case 56: case 100: /* Alt / AltGr */
            _PM_modifiers |= KB_ALT;
            break;
          case 58: /* Caps Lock */
            _PM_modifiers ^= KB_CAPS;
            ioctl(_PM_console_fd, KDSETLED, _PM_modifiers & 7);
            break;
          case 69: /* Num Lock */
            _PM_modifiers ^= KB_NUMLOCK;
            ioctl(_PM_console_fd, KDSETLED, _PM_modifiers & 7);
            break;
          case 70: /* Scroll Lock */
            _PM_modifiers ^= KB_SCROLL;
            ioctl(_PM_console_fd, KDSETLED, _PM_modifiers & 7);
            break;
          case 28:
            return 0x1C;
          default:
            ke.kb_index = c;
            ke.kb_table = 0;
            if ((_PM_modifiers & KB_SHIFT) || (_PM_modifiers & KB_CAPS))
                ke.kb_table |= K_SHIFTTAB;
            if (_PM_modifiers & KB_ALT)
                ke.kb_table |= K_ALTTAB;
            ioctl(_PM_console_fd, KDGKBENT, (ulong)&ke);
            c = ke.kb_value & 0xFF;
            return c;
          }
      }
    return 0;
}

/****************************************************************************
REMARKS:
Sleep until the virtual terminal is active
****************************************************************************/
static void wait_vt_active(
    int _PM_console_fd)
{
    while (ioctl(_PM_console_fd, VT_WAITACTIVE, tty_vc) < 0) {
      if ((errno != EAGAIN) && (errno != EINTR)) {
          perror("ioctl(VT_WAITACTIVE)");
          exit(1);
          }
      usleep(150000);
      }
}

/****************************************************************************
REMARKS:
Checks the owner of the specified virtual console.
****************************************************************************/
static int check_owner(
    int vc)
{
    struct stat sbuf;
    char fname[30];

    sprintf(fname, "/dev/tty%d", vc);
    if ((stat(fname, &sbuf) >= 0) && (getuid() == sbuf.st_uid))
      return 1;
    printf("You must be the owner of the current console to use this program.\n");
    return 0;
}

/****************************************************************************
REMARKS:
Checks if the console is currently in graphics mode, and if so we forcibly
restore it back to text mode again. This handles the case when a Nucleus or
MGL program crashes and leaves the console in graphics mode. Running the
textmode utility (or any other Nucleus/MGL program) via a telnet session
into the machine will restore it back to normal.
****************************************************************************/
static void restore_text_console(
    int console_id)
{
    if (ioctl(console_id, KDSETMODE, KD_TEXT) < 0)
      LOGWARN("ioctl(KDSETMODE) failed");
    _PM_restore_kb_mode();
}

/****************************************************************************
REMARKS:
Opens up the console device for output by finding an appropriate virutal
console that we can run on.
****************************************************************************/
PM_HWND PMAPI PM_openConsole(
    PM_HWND hwndUser,
    int device,
    int xRes,
    int yRes,
    int bpp,
    ibool fullScreen)
{
    struct vt_mode  vtm;
    struct vt_stat  vts;
    struct stat     sbuf;
    char            fname[30];

    /* Check if we have already opened the console */
    if (console_count++)
      return _PM_console_fd;

    /* Now, it would be great if we could use /dev/tty and see what it is
     * connected to. Alas, we cannot find out reliably what VC /dev/tty is
     * bound to. Thus we parse stdin through stderr for a reliable VC.
     */
    startup_vc = 0;
    for (_PM_console_fd = 0; _PM_console_fd < 3; _PM_console_fd++) {
      if (fstat(_PM_console_fd, &sbuf) < 0)
          continue;
      if (ioctl(_PM_console_fd, VT_GETMODE, &vtm) < 0)
          continue;
      if ((sbuf.st_rdev & 0xFF00) != 0x400)
          continue;
      if (!(sbuf.st_rdev & 0xFF))
          continue;
      tty_vc = sbuf.st_rdev & 0xFF;
      restore_text_console(_PM_console_fd);
      return _PM_console_fd;
      }
    if ((_PM_console_fd = open("/dev/console", O_RDWR)) < 0) {
      printf("open_dev_console: can't open /dev/console \n");
      exit(1);
      }
    if (ioctl(_PM_console_fd, VT_OPENQRY, &tty_vc) < 0)
      goto Error;
    if (tty_vc <= 0)
      goto Error;
    sprintf(fname, "/dev/tty%d", tty_vc);
    close(_PM_console_fd);

    /* Change our control terminal */
    setsid();

    /* We must use RDWR to allow for output... */
    if (((_PM_console_fd = open(fname, O_RDWR)) >= 0) &&
          (ioctl(_PM_console_fd, VT_GETSTATE, &vts) >= 0)) {
      if (!check_owner(vts.v_active))
          goto Error;
      restore_text_console(_PM_console_fd);

      /* Success, redirect all stdios */
      fflush(stdin);
      fflush(stdout);
      fflush(stderr);
      close(0);
      close(1);
      close(2);
      dup(_PM_console_fd);
      dup(_PM_console_fd);
      dup(_PM_console_fd);

      /* clear screen and switch to it */
      fwrite("\e[H\e[J", 6, 1, stderr);
      fflush(stderr);
      if (tty_vc != vts.v_active) {
          startup_vc = vts.v_active;
          ioctl(_PM_console_fd, VT_ACTIVATE, tty_vc);
          wait_vt_active(_PM_console_fd);
          }
      }
    return _PM_console_fd;

Error:
    if (_PM_console_fd > 2)
      close(_PM_console_fd);
    console_count = 0;
    PM_fatalError(
      "Not running in a graphics capable console,\n"
      "and unable to find one.\n");
    return -1;
}

#define FONT_C  0x10000     /* 64KB for font data                       */

/****************************************************************************
REMARKS:
Returns the size of the console state buffer.
****************************************************************************/
int PMAPI PM_getConsoleStateSize(void)
{
    if (!inited)
      PM_init();
    return PM_getVGAStateSize() + FONT_C*2;
}

/****************************************************************************
REMARKS:
Save the state of the Linux console.
****************************************************************************/
void PMAPI PM_saveConsoleState(void *stateBuf,int console_id)
{
    uchar   *regs = stateBuf;

    /* Save the current console font */
    if (ioctl(console_id,GIO_FONT,&regs[PM_getVGAStateSize()]) < 0)
      perror("ioctl(GIO_FONT)");

    /* Inform the Linux console that we are going into graphics mode */
    if (ioctl(console_id, KDSETMODE, KD_GRAPHICS) < 0)
      perror("ioctl(KDSETMODE)");

    /* Save state of VGA registers */
    PM_saveVGAState(stateBuf);
}

void PMAPI PM_setSuspendAppCallback(int (_ASMAPIP saveState)(int flags))
{
    /* TODO: Implement support for allowing console switching! */
}

/****************************************************************************
REMARKS:
Restore the state of the Linux console.
****************************************************************************/
void PMAPI PM_restoreConsoleState(const void *stateBuf,PM_HWND console_id)
{
    const uchar *regs = stateBuf;

    /* Restore the state of the VGA compatible registers */
    PM_restoreVGAState(stateBuf);

    /* Inform the Linux console that we are back from graphics modes */
    if (ioctl(console_id, KDSETMODE, KD_TEXT) < 0)
      LOGWARN("ioctl(KDSETMODE) failed");

    /* Restore the old console font */
    if (ioctl(console_id,PIO_FONT,&regs[PM_getVGAStateSize()]) < 0)
      LOGWARN("ioctl(KDSETMODE) failed");

    /* Coming back from graphics mode on Linux also restored the previous
     * text mode console contents, so we need to clear the screen to get
     * around this since the cursor does not get homed by our code.
     */
    fflush(stdout);
    fflush(stderr);
    printf("\033[H\033[J");
    fflush(stdout);
}

/****************************************************************************
REMARKS:
Close the Linux console and put it back to normal.
****************************************************************************/
void PMAPI PM_closeConsole(PM_HWND _PM_console_fd)
{
    /* Restore console to normal operation */
    if (--console_count == 0) {
      /* Re-activate the original virtual console */
      if (startup_vc > 0)
          ioctl(_PM_console_fd, VT_ACTIVATE, startup_vc);

      /* Close the console file descriptor */
      if (_PM_console_fd > 2)
          close(_PM_console_fd);
      _PM_console_fd = -1;
      }
}

void PM_setOSCursorLocation(int x,int y)
{
    /* Nothing to do in here */
}

/****************************************************************************
REMARKS:
Set the screen width and height for the Linux console.
****************************************************************************/
void PM_setOSScreenWidth(int width,int height)
{
    struct winsize  ws;
    struct vt_sizes vs;

    /* Resize the software terminal */
    ws.ws_col = width;
    ws.ws_row = height;
    ioctl(_PM_console_fd, TIOCSWINSZ, &ws);

    /* And the hardware */
    vs.v_rows = height;
    vs.v_cols = width;
    vs.v_scrollsize = 0;
    ioctl(_PM_console_fd, VT_RESIZE, &vs);
}

ibool PMAPI PM_setRealTimeClockHandler(PM_intHandler ih, int frequency)
{
    /* TODO: Implement this for Linux */
    return false;
}

void PMAPI PM_setRealTimeClockFrequency(int frequency)
{
    /* TODO: Implement this for Linux */
}

void PMAPI PM_restoreRealTimeClockHandler(void)
{
    /* TODO: Implement this for Linux */
}

char * PMAPI PM_getCurrentPath(
    char *path,
    int maxLen)
{
    return getcwd(path,maxLen);
}

char PMAPI PM_getBootDrive(void)
{ return '/'; }

const char * PMAPI PM_getVBEAFPath(void)
{ return PM_getNucleusConfigPath(); }

const char * PMAPI PM_getNucleusPath(void)
{
    char *env = getenv("NUCLEUS_PATH");
    return env ? env : "/usr/lib/nucleus";
}

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)
{
    static char buf[128];
    gethostname(buf, 128);
    return buf;
}

const char * PMAPI PM_getMachineName(void)
{
    static char buf[128];
    gethostname(buf, 128);
    return buf;
}

void * PMAPI PM_getBIOSPointer(void)
{
    static uchar *zeroPtr = NULL;
    if (!zeroPtr)
      zeroPtr = PM_mapPhysicalAddr(0,0xFFFFF,true);
    return (void*)(zeroPtr + 0x400);
}

void * PMAPI PM_getA0000Pointer(void)
{
    /* PM_init maps in the 0xA0000 framebuffer region 1:1 with our
     * address mapping, so we can return the address here.
     */
    if (!inited)
      PM_init();
    return (void*)(0xA0000);
}

void * PMAPI PM_mapPhysicalAddr(ulong base,ulong limit,ibool isCached)
{
    uchar   *p;
    ulong   baseAddr,baseOfs;

    if (!inited)
      PM_init();
    if (base >= 0xA0000 && base < 0x100000)
      return (void*)base;
    if (!fd_mem && (fd_mem = open("/dev/mem", O_RDWR)) == -1)
      return NULL;

    /* Round the physical address to a 4Kb boundary and the limit to a
     * 4Kb-1 boundary before passing the values to mmap. If we round the
     * physical address, then we also add an extra offset into the address
     * that we return.
     */
    baseOfs = base & 4095;
    baseAddr = base & ~4095;
    limit = ((limit+baseOfs+1+4095) & ~4095)-1;
    if ((p = mmap(0, limit+1,
          PROT_READ | PROT_WRITE, MAP_SHARED,
          fd_mem, baseAddr)) == (void *)-1)
      return NULL;
    return (void*)(p+baseOfs);
}

void PMAPI PM_freePhysicalAddr(void *ptr,ulong limit)
{
    if ((ulong)ptr >= 0x100000)
      munmap(ptr,limit+1);
}

ulong PMAPI PM_getPhysicalAddr(void *p)
{
    /* TODO: This function should find the physical address of a linear */
    /*       address. */
    return 0xFFFFFFFFUL;
}

ibool PMAPI PM_getPhysicalAddrRange(void *p,ulong length,ulong *physAddress)
{
    /* TODO: This function should find a range of physical addresses */
    /*       for a linear address. */
    return false;
}

void PMAPI PM_sleep(ulong milliseconds)
{
    /* TODO: Put the process to sleep for milliseconds */
}

int PMAPI PM_getCOMPort(int port)
{
    /* TODO: Re-code this to determine real values using the Plug and Play */
    /*       manager for the OS. */
    switch (port) {
      case 0: return 0x3F8;
      case 1: return 0x2F8;
      }
    return 0;
}

int PMAPI PM_getLPTPort(int port)
{
    /* TODO: Re-code this to determine real values using the Plug and Play */
    /*       manager for the OS. */
    switch (port) {
      case 0: return 0x3BC;
      case 1: return 0x378;
      case 2: return 0x278;
      }
    return 0;
}

void * PMAPI PM_mallocShared(long size)
{
    return PM_malloc(size);
}

void PMAPI PM_freeShared(void *ptr)
{
    PM_free(ptr);
}

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

void * PMAPI PM_mapRealPointer(uint r_seg,uint r_off)
{
    /* PM_init maps in the 0xA0000-0x100000 region 1:1 with our
     * address mapping, as well as all memory blocks in a 1:1 address
     * mapping so we can simply return the physical address in here.
     */
    if (!inited)
      PM_init();
    return (void*)MK_PHYS(r_seg,r_off);
}

void * PMAPI PM_allocRealSeg(uint size,uint *r_seg,uint *r_off)
{
    int     i;
    char    *r = (char *)REAL_MEM_BASE;

    if (!inited)
      PM_init();
    if (!mem_info.ready)
      return NULL;
    if (mem_info.count == REAL_MEM_BLOCKS)
      return NULL;
    size = (size + 15) & ~15;
    for (i = 0; i < mem_info.count; i++) {
      if (mem_info.blocks[i].free && size < mem_info.blocks[i].size) {
          insert_block(i);
          mem_info.blocks[i].size = size;
          mem_info.blocks[i].free = 0;
          mem_info.blocks[i + 1].size -= size;
          *r_seg = (uint)(r) >> 4;
          *r_off = (uint)(r) & 0xF;
          return (void *)r;
          }
      r += mem_info.blocks[i].size;
      }
    return NULL;
}

void PMAPI PM_freeRealSeg(void *mem)
{
    int     i;
    char    *r = (char *)REAL_MEM_BASE;

    if (!mem_info.ready)
      return;
    i = 0;
    while (mem != (void *)r) {
      r += mem_info.blocks[i].size;
      i++;
      if (i == mem_info.count)
          return;
      }
    mem_info.blocks[i].free = 1;
    if (i + 1 < mem_info.count && mem_info.blocks[i + 1].free) {
      mem_info.blocks[i].size += mem_info.blocks[i + 1].size;
      delete_block(i + 1);
      }
    if (i - 1 >= 0 && mem_info.blocks[i - 1].free) {
      mem_info.blocks[i - 1].size += mem_info.blocks[i].size;
      delete_block(i);
      }
}

#define DIRECTION_FLAG  (1 << 10)

static void em_ins(int size)
{
    unsigned int edx, edi;

    edx = context.vm.regs.edx & 0xffff;
    edi = context.vm.regs.edi & 0xffff;
    edi += (unsigned int)context.vm.regs.ds << 4;
    if (context.vm.regs.eflags & DIRECTION_FLAG) {
      if (size == 4)
          asm volatile ("std; insl; cld"
           : "=D" (edi) : "d" (edx), "0" (edi));
      else if (size == 2)
          asm volatile ("std; insw; cld"
           : "=D" (edi) : "d" (edx), "0" (edi));
      else
          asm volatile ("std; insb; cld"
           : "=D" (edi) : "d" (edx), "0" (edi));
      }
    else {
      if (size == 4)
          asm volatile ("cld; insl"
           : "=D" (edi) : "d" (edx), "0" (edi));
      else if (size == 2)
          asm volatile ("cld; insw"
           : "=D" (edi) : "d" (edx), "0" (edi));
      else
          asm volatile ("cld; insb"
           : "=D" (edi) : "d" (edx), "0" (edi));
      }
    edi -= (unsigned int)context.vm.regs.ds << 4;
    context.vm.regs.edi &= 0xffff0000;
    context.vm.regs.edi |= edi & 0xffff;
}

static void em_rep_ins(int size)
{
    unsigned int ecx, edx, edi;

    ecx = context.vm.regs.ecx & 0xffff;
    edx = context.vm.regs.edx & 0xffff;
    edi = context.vm.regs.edi & 0xffff;
    edi += (unsigned int)context.vm.regs.ds << 4;
    if (context.vm.regs.eflags & DIRECTION_FLAG) {
      if (size == 4)
          asm volatile ("std; rep; insl; cld"
           : "=D" (edi), "=c" (ecx)
           : "d" (edx), "0" (edi), "1" (ecx));
      else if (size == 2)
          asm volatile ("std; rep; insw; cld"
           : "=D" (edi), "=c" (ecx)
           : "d" (edx), "0" (edi), "1" (ecx));
      else
          asm volatile ("std; rep; insb; cld"
           : "=D" (edi), "=c" (ecx)
           : "d" (edx), "0" (edi), "1" (ecx));
      }
    else {
      if (size == 4)
          asm volatile ("cld; rep; insl"
           : "=D" (edi), "=c" (ecx)
           : "d" (edx), "0" (edi), "1" (ecx));
      else if (size == 2)
          asm volatile ("cld; rep; insw"
           : "=D" (edi), "=c" (ecx)
           : "d" (edx), "0" (edi), "1" (ecx));
      else
          asm volatile ("cld; rep; insb"
           : "=D" (edi), "=c" (ecx)
           : "d" (edx), "0" (edi), "1" (ecx));
      }

    edi -= (unsigned int)context.vm.regs.ds << 4;
    context.vm.regs.edi &= 0xffff0000;
    context.vm.regs.edi |= edi & 0xffff;
    context.vm.regs.ecx &= 0xffff0000;
    context.vm.regs.ecx |= ecx & 0xffff;
}

static void em_outs(int size)
{
    unsigned int edx, esi;

    edx = context.vm.regs.edx & 0xffff;
    esi = context.vm.regs.esi & 0xffff;
    esi += (unsigned int)context.vm.regs.ds << 4;
    if (context.vm.regs.eflags & DIRECTION_FLAG) {
      if (size == 4)
          asm volatile ("std; outsl; cld"
           : "=S" (esi) : "d" (edx), "0" (esi));
      else if (size == 2)
          asm volatile ("std; outsw; cld"
           : "=S" (esi) : "d" (edx), "0" (esi));
      else
          asm volatile ("std; outsb; cld"
           : "=S" (esi) : "d" (edx), "0" (esi));
      }
    else {
      if (size == 4)
          asm volatile ("cld; outsl"
           : "=S" (esi) : "d" (edx), "0" (esi));
      else if (size == 2)
          asm volatile ("cld; outsw"
           : "=S" (esi) : "d" (edx), "0" (esi));
      else
          asm volatile ("cld; outsb"
           : "=S" (esi) : "d" (edx), "0" (esi));
      }

    esi -= (unsigned int)context.vm.regs.ds << 4;
    context.vm.regs.esi &= 0xffff0000;
    context.vm.regs.esi |= esi & 0xffff;
}

static void em_rep_outs(int size)
{
    unsigned int ecx, edx, esi;

    ecx = context.vm.regs.ecx & 0xffff;
    edx = context.vm.regs.edx & 0xffff;
    esi = context.vm.regs.esi & 0xffff;
    esi += (unsigned int)context.vm.regs.ds << 4;
    if (context.vm.regs.eflags & DIRECTION_FLAG) {
      if (size == 4)
          asm volatile ("std; rep; outsl; cld"
           : "=S" (esi), "=c" (ecx)
           : "d" (edx), "0" (esi), "1" (ecx));
      else if (size == 2)
          asm volatile ("std; rep; outsw; cld"
           : "=S" (esi), "=c" (ecx)
           : "d" (edx), "0" (esi), "1" (ecx));
      else
          asm volatile ("std; rep; outsb; cld"
           : "=S" (esi), "=c" (ecx)
           : "d" (edx), "0" (esi), "1" (ecx));
      }
    else {
      if (size == 4)
          asm volatile ("cld; rep; outsl"
           : "=S" (esi), "=c" (ecx)
           : "d" (edx), "0" (esi), "1" (ecx));
      else if (size == 2)
          asm volatile ("cld; rep; outsw"
           : "=S" (esi), "=c" (ecx)
           : "d" (edx), "0" (esi), "1" (ecx));
      else
          asm volatile ("cld; rep; outsb"
           : "=S" (esi), "=c" (ecx)
           : "d" (edx), "0" (esi), "1" (ecx));
      }

    esi -= (unsigned int)context.vm.regs.ds << 4;
    context.vm.regs.esi &= 0xffff0000;
    context.vm.regs.esi |= esi & 0xffff;
    context.vm.regs.ecx &= 0xffff0000;
    context.vm.regs.ecx |= ecx & 0xffff;
}

static int emulate(void)
{
    unsigned char *insn;
    struct {
      unsigned int size : 1;
      unsigned int rep : 1;
      } prefix = { 0, 0 };
    int i = 0;

    insn = (unsigned char *)((unsigned int)context.vm.regs.cs << 4);
    insn += context.vm.regs.eip;

    while (1) {
#ifdef TRACE_IO
      traceAddr = ((ulong)context.vm.regs.cs << 16) + context.vm.regs.eip + i;
#endif
      if (insn[i] == 0x66) {
          prefix.size = 1 - prefix.size;
          i++;
          }
      else if (insn[i] == 0xf3) {
          prefix.rep = 1;
          i++;
          }
      else if (insn[i] == 0xf0 || insn[i] == 0xf2
           || insn[i] == 0x26 || insn[i] == 0x2e
           || insn[i] == 0x36 || insn[i] == 0x3e
           || insn[i] == 0x64 || insn[i] == 0x65
           || insn[i] == 0x67) {
          /* these prefixes are just ignored */
          i++;
          }
      else if (insn[i] == 0x6c) {
          if (prefix.rep)
            em_rep_ins(1);
          else
            em_ins(1);
          i++;
          break;
          }
      else if (insn[i] == 0x6d) {
          if (prefix.rep) {
            if (prefix.size)
                em_rep_ins(4);
            else
                em_rep_ins(2);
            }
          else {
            if (prefix.size)
                em_ins(4);
            else
                em_ins(2);
            }
          i++;
          break;
          }
      else if (insn[i] == 0x6e) {
          if (prefix.rep)
            em_rep_outs(1);
          else
            em_outs(1);
          i++;
          break;
          }
      else if (insn[i] == 0x6f) {
          if (prefix.rep) {
            if (prefix.size)
                em_rep_outs(4);
            else
                em_rep_outs(2);
            }
          else {
            if (prefix.size)
                em_outs(4);
            else
                em_outs(2);
            }
          i++;
          break;
          }
      else if (insn[i] == 0xec) {
          *((uchar*)&context.vm.regs.eax) = port_in(context.vm.regs.edx);
          i++;
          break;
          }
      else if (insn[i] == 0xed) {
          if (prefix.size)
            *((ulong*)&context.vm.regs.eax) = port_inl(context.vm.regs.edx);
          else
            *((ushort*)&context.vm.regs.eax) = port_inw(context.vm.regs.edx);
          i++;
          break;
          }
      else if (insn[i] == 0xee) {
          port_out(context.vm.regs.eax,context.vm.regs.edx);
          i++;
          break;
          }
      else if (insn[i] == 0xef) {
          if (prefix.size)
            port_outl(context.vm.regs.eax,context.vm.regs.edx);
          else
            port_outw(context.vm.regs.eax,context.vm.regs.edx);
          i++;
          break;
          }
      else
          return 0;
      }

    context.vm.regs.eip += i;
    return 1;
}

static void debug_info(int vret)
{
    int i;
    unsigned char *p;

    fputs("vm86() failed\n", stderr);
    fprintf(stderr, "return = 0x%x\n", vret);
    fprintf(stderr, "eax = 0x%08lx\n", context.vm.regs.eax);
    fprintf(stderr, "ebx = 0x%08lx\n", context.vm.regs.ebx);
    fprintf(stderr, "ecx = 0x%08lx\n", context.vm.regs.ecx);
    fprintf(stderr, "edx = 0x%08lx\n", context.vm.regs.edx);
    fprintf(stderr, "esi = 0x%08lx\n", context.vm.regs.esi);
    fprintf(stderr, "edi = 0x%08lx\n", context.vm.regs.edi);
    fprintf(stderr, "ebp = 0x%08lx\n", context.vm.regs.ebp);
    fprintf(stderr, "eip = 0x%08lx\n", context.vm.regs.eip);
    fprintf(stderr, "cs  = 0x%04x\n", context.vm.regs.cs);
    fprintf(stderr, "esp = 0x%08lx\n", context.vm.regs.esp);
    fprintf(stderr, "ss  = 0x%04x\n", context.vm.regs.ss);
    fprintf(stderr, "ds  = 0x%04x\n", context.vm.regs.ds);
    fprintf(stderr, "es  = 0x%04x\n", context.vm.regs.es);
    fprintf(stderr, "fs  = 0x%04x\n", context.vm.regs.fs);
    fprintf(stderr, "gs  = 0x%04x\n", context.vm.regs.gs);
    fprintf(stderr, "eflags  = 0x%08lx\n", context.vm.regs.eflags);
    fputs("cs:ip = [ ", stderr);
    p = (unsigned char *)((context.vm.regs.cs << 4) + (context.vm.regs.eip & 0xffff));
    for (i = 0; i < 16; ++i)
          fprintf(stderr, "%02x ", (unsigned int)p[i]);
    fputs("]\n", stderr);
    fflush(stderr);
}

static int run_vm86(void)
{
    unsigned int vret;

    for (;;) {
      vret = vm86(&context.vm);
      if (VM86_TYPE(vret) == VM86_INTx) {
          unsigned int v = VM86_ARG(vret);
          if (v == RETURN_TO_32_INT)
            return 1;
          pushw(context.vm.regs.eflags);
          pushw(context.vm.regs.cs);
          pushw(context.vm.regs.eip);
          context.vm.regs.cs = get_int_seg(v);
          context.vm.regs.eip = get_int_off(v);
          context.vm.regs.eflags &= ~(VIF_MASK | TF_MASK);
          continue;
          }
      if (VM86_TYPE(vret) != VM86_UNKNOWN)
          break;
      if (!emulate())
          break;
      }
    debug_info(vret);
    return 0;
}

#define IND(ereg) context.vm.regs.ereg = regs->ereg
#define OUTD(ereg) regs->ereg = context.vm.regs.ereg

void PMAPI DPMI_int86(int intno, DPMI_regs *regs)
{
    if (!inited)
      PM_init();
    memset(&context.vm.regs, 0, sizeof(context.vm.regs));
    IND(eax); IND(ebx); IND(ecx); IND(edx); IND(esi); IND(edi);
    context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
    context.vm.regs.cs = get_int_seg(intno);
    context.vm.regs.eip = get_int_off(intno);
    context.vm.regs.ss = context.stack_seg;
    context.vm.regs.esp = context.stack_off;
    pushw(DEFAULT_VM86_FLAGS);
    pushw(context.ret_seg);
    pushw(context.ret_off);
    run_vm86();
    OUTD(eax); OUTD(ebx); OUTD(ecx); OUTD(edx); OUTD(esi); OUTD(edi);
    regs->flags = context.vm.regs.eflags;
}

#define IN(ereg) context.vm.regs.ereg = in->e.ereg
#define OUT(ereg) out->e.ereg = context.vm.regs.ereg

int PMAPI PM_int86(int intno, RMREGS *in, RMREGS *out)
{
    if (!inited)
      PM_init();
    memset(&context.vm.regs, 0, sizeof(context.vm.regs));
    IN(eax); IN(ebx); IN(ecx); IN(edx); IN(esi); IN(edi);
    context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
    context.vm.regs.cs = get_int_seg(intno);
    context.vm.regs.eip = get_int_off(intno);
    context.vm.regs.ss = context.stack_seg;
    context.vm.regs.esp = context.stack_off;
    pushw(DEFAULT_VM86_FLAGS);
    pushw(context.ret_seg);
    pushw(context.ret_off);
    run_vm86();
    OUT(eax); OUT(ebx); OUT(ecx); OUT(edx); OUT(esi); OUT(edi);
    out->x.cflag = context.vm.regs.eflags & 1;
    return out->x.ax;
}

int PMAPI PM_int86x(int intno, RMREGS *in, RMREGS *out,
    RMSREGS *sregs)
{
    if (!inited)
      PM_init();
    if (intno == 0x21) {
      time_t today = time(NULL);
      struct tm *t;
      t = localtime(&today);
      out->x.cx = t->tm_year + 1900;
      out->h.dh = t->tm_mon + 1;
      out->h.dl = t->tm_mday;
      }
    else {
      unsigned int seg, off;
      seg = get_int_seg(intno);
      off = get_int_off(intno);
      memset(&context.vm.regs, 0, sizeof(context.vm.regs));
      IN(eax); IN(ebx); IN(ecx); IN(edx); IN(esi); IN(edi);
      context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
      context.vm.regs.cs = seg;
      context.vm.regs.eip = off;
      context.vm.regs.es = sregs->es;
      context.vm.regs.ds = sregs->ds;
      context.vm.regs.fs = sregs->fs;
      context.vm.regs.gs = sregs->gs;
      context.vm.regs.ss = context.stack_seg;
      context.vm.regs.esp = context.stack_off;
      pushw(DEFAULT_VM86_FLAGS);
      pushw(context.ret_seg);
      pushw(context.ret_off);
      run_vm86();
      OUT(eax); OUT(ebx); OUT(ecx); OUT(edx); OUT(esi); OUT(edi);
      sregs->es = context.vm.regs.es;
      sregs->ds = context.vm.regs.ds;
      sregs->fs = context.vm.regs.fs;
      sregs->gs = context.vm.regs.gs;
      out->x.cflag = context.vm.regs.eflags & 1;
      }
    return out->e.eax;
}

#define OUTR(ereg) in->e.ereg = context.vm.regs.ereg

void PMAPI PM_callRealMode(uint seg,uint off, RMREGS *in,
    RMSREGS *sregs)
{
    if (!inited)
      PM_init();
    memset(&context.vm.regs, 0, sizeof(context.vm.regs));
    IN(eax); IN(ebx); IN(ecx); IN(edx); IN(esi); IN(edi);
    context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
    context.vm.regs.cs = seg;
    context.vm.regs.eip = off;
    context.vm.regs.ss = context.stack_seg;
    context.vm.regs.esp = context.stack_off;
    context.vm.regs.es = sregs->es;
    context.vm.regs.ds = sregs->ds;
    context.vm.regs.fs = sregs->fs;
    context.vm.regs.gs = sregs->gs;
    pushw(DEFAULT_VM86_FLAGS);
    pushw(context.ret_seg);
    pushw(context.ret_off);
    run_vm86();
    OUTR(eax); OUTR(ebx); OUTR(ecx); OUTR(edx); OUTR(esi); OUTR(edi);
    sregs->es = context.vm.regs.es;
    sregs->ds = context.vm.regs.ds;
    sregs->fs = context.vm.regs.fs;
    sregs->gs = context.vm.regs.gs;
    in->x.cflag = context.vm.regs.eflags & 1;
}

void PMAPI PM_availableMemory(ulong *physical,ulong *total)
{
    FILE    *mem = fopen("/proc/meminfo","r");
    char    buf[1024];

    fgets(buf,1024,mem);
    fgets(buf,1024,mem);
    sscanf(buf,"Mem: %*d %*d %ld", physical);
    fgets(buf,1024,mem);
    sscanf(buf,"Swap: %*d %*d %ld", total);
    fclose(mem);
    *total += *physical;
}

void * PMAPI PM_allocLockedMem(uint size,ulong *physAddr,ibool contiguous,ibool below16M)
{
    /* TODO: Implement this for Linux */
    return NULL;
}

void PMAPI PM_freeLockedMem(void *p,uint size,ibool contiguous)
{
    /* TODO: Implement this for Linux */
}

void * PMAPI PM_allocPage(
    ibool locked)
{
    /* TODO: Implement this for Linux */
    return NULL;
}

void PMAPI PM_freePage(
    void *p)
{
    /* TODO: Implement this for Linux */
}

void PMAPI PM_setBankA(int bank)
{
    if (!inited)
      PM_init();
    memset(&context.vm.regs, 0, sizeof(context.vm.regs));
    context.vm.regs.eax = 0x4F05;
    context.vm.regs.ebx = 0x0000;
    context.vm.regs.edx = bank;
    context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
    context.vm.regs.cs = get_int_seg(0x10);
    context.vm.regs.eip = get_int_off(0x10);
    context.vm.regs.ss = context.stack_seg;
    context.vm.regs.esp = context.stack_off;
    pushw(DEFAULT_VM86_FLAGS);
    pushw(context.ret_seg);
    pushw(context.ret_off);
    run_vm86();
}

void PMAPI PM_setBankAB(int bank)
{
    if (!inited)
      PM_init();
    memset(&context.vm.regs, 0, sizeof(context.vm.regs));
    context.vm.regs.eax = 0x4F05;
    context.vm.regs.ebx = 0x0000;
    context.vm.regs.edx = bank;
    context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
    context.vm.regs.cs = get_int_seg(0x10);
    context.vm.regs.eip = get_int_off(0x10);
    context.vm.regs.ss = context.stack_seg;
    context.vm.regs.esp = context.stack_off;
    pushw(DEFAULT_VM86_FLAGS);
    pushw(context.ret_seg);
    pushw(context.ret_off);
    run_vm86();
    context.vm.regs.eax = 0x4F05;
    context.vm.regs.ebx = 0x0001;
    context.vm.regs.edx = bank;
    context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
    context.vm.regs.cs = get_int_seg(0x10);
    context.vm.regs.eip = get_int_off(0x10);
    context.vm.regs.ss = context.stack_seg;
    context.vm.regs.esp = context.stack_off;
    pushw(DEFAULT_VM86_FLAGS);
    pushw(context.ret_seg);
    pushw(context.ret_off);
    run_vm86();
}

void PMAPI PM_setCRTStart(int x,int y,int waitVRT)
{
    if (!inited)
      PM_init();
    memset(&context.vm.regs, 0, sizeof(context.vm.regs));
    context.vm.regs.eax = 0x4F07;
    context.vm.regs.ebx = waitVRT;
    context.vm.regs.ecx = x;
    context.vm.regs.edx = y;
    context.vm.regs.eflags = DEFAULT_VM86_FLAGS;
    context.vm.regs.cs = get_int_seg(0x10);
    context.vm.regs.eip = get_int_off(0x10);
    context.vm.regs.ss = context.stack_seg;
    context.vm.regs.esp = context.stack_off;
    pushw(DEFAULT_VM86_FLAGS);
    pushw(context.ret_seg);
    pushw(context.ret_off);
    run_vm86();
}

int PMAPI PM_enableWriteCombine(ulong base,ulong length,uint type)
{
#ifdef ENABLE_MTRR
    struct mtrr_sentry sentry;

    if (mtrr_fd < 0)
      return PM_MTRR_ERR_NO_OS_SUPPORT;
    sentry.base = base;
    sentry.size = length;
    sentry.type = type;
    if (ioctl(mtrr_fd, MTRRIOC_ADD_ENTRY, &sentry) == -1) {
      /* TODO: Need to decode MTRR error codes!! */
      return PM_MTRR_NOT_SUPPORTED;
      }
    return PM_MTRR_ERR_OK;
#else
    return PM_MTRR_ERR_NO_OS_SUPPORT;
#endif
}

/****************************************************************************
PARAMETERS:
callback    - Function to callback with write combine information

REMARKS:
Function to enumerate all write combine regions currently enabled for the
processor.
****************************************************************************/
int PMAPI PM_enumWriteCombine(
    PM_enumWriteCombine_t callback)
{
#ifdef ENABLE_MTRR
    struct mtrr_gentry gentry;

    if (mtrr_fd < 0)
      return PM_MTRR_ERR_NO_OS_SUPPORT;

    for (gentry.regnum = 0; ioctl (mtrr_fd, MTRRIOC_GET_ENTRY, &gentry) == 0;
       ++gentry.regnum) {
      if (gentry.size > 0) {
          /* WARNING: This code assumes that the types in pmapi.h match the ones */
          /* in the Linux kernel (mtrr.h) */
          callback(gentry.base, gentry.size, gentry.type);
      }
    }

    return PM_MTRR_ERR_OK;
#else
    return PM_MTRR_ERR_NO_OS_SUPPORT;
#endif
}

ibool PMAPI PM_doBIOSPOST(
    ushort axVal,
    ulong BIOSPhysAddr,
    void *copyOfBIOS,
    ulong BIOSLen)
{
    char        *bios_ptr = (char*)0xC0000;
    char        *old_bios;
    ulong       Current10, Current6D, *rvec = 0;
    RMREGS      regs;
    RMSREGS     sregs;

    /* The BIOS is mapped to 0xC0000 with a private memory mapping enabled
     * which means we have a copy on write scheme. Hence we simply copy
     * the secondary BIOS image over the top of the old one.
     */
    if (!inited)
      PM_init();
    if ((old_bios = PM_malloc(BIOSLen)) == NULL)
      return false;
    if (BIOSPhysAddr != 0xC0000) {
      memcpy(old_bios,bios_ptr,BIOSLen);
      memcpy(bios_ptr,copyOfBIOS,BIOSLen);
      }

    /* The interrupt vectors should already be mmap()'ed from 0-0x400 in PM_init */
    Current10 = rvec[0x10];
    Current6D = rvec[0x6D];

    /* POST the secondary BIOS */
    rvec[0x10] = rvec[0x42]; /* Restore int 10h to STD-BIOS */
    regs.x.ax = axVal;
    PM_callRealMode(0xC000,0x0003,&regs,&sregs);

    /* Restore interrupt vectors */
    rvec[0x10] = Current10;
    rvec[0x6D] = Current6D;

    /* Restore original BIOS image */
    if (BIOSPhysAddr != 0xC0000)
      memcpy(bios_ptr,old_bios,BIOSLen);
    PM_free(old_bios);
    return true;
}

int PMAPI PM_lockDataPages(void *p,uint len,PM_lockHandle *lh)
{
    p = p;  len = len;
    return 1;
}

int PMAPI PM_unlockDataPages(void *p,uint len,PM_lockHandle *lh)
{
    p = p;  len = len;
    return 1;
}

int PMAPI PM_lockCodePages(void (*p)(),uint len,PM_lockHandle *lh)
{
    p = p;  len = len;
    return 1;
}

int PMAPI PM_unlockCodePages(void (*p)(),uint len,PM_lockHandle *lh)
{
    p = p;  len = len;
    return 1;
}

PM_MODULE PMAPI PM_loadLibrary(
    const char *szDLLName)
{
    /* TODO: Implement this to load shared libraries! */
    (void)szDLLName;
    return NULL;
}

void * PMAPI PM_getProcAddress(
    PM_MODULE hModule,
    const char *szProcName)
{
    /* TODO: Implement this! */
    (void)hModule;
    (void)szProcName;
    return NULL;
}

void PMAPI PM_freeLibrary(
    PM_MODULE hModule)
{
    /* TODO: Implement this! */
    (void)hModule;
}

int PMAPI PM_setIOPL(
    int level)
{
    /* TODO: Move the IOPL switching into this function!! */
    return level;
}

void PMAPI PM_flushTLB(void)
{
    /* Do nothing on Linux. */
}

Generated by  Doxygen 1.6.0   Back to index