| /**************************************************************************** |
| * |
| * Realmode X86 Emulator Library |
| * |
| * Copyright (C) 1996-1999 SciTech Software, Inc. |
| * Copyright (C) David Mosberger-Tang |
| * Copyright (C) 1999 Egbert Eich |
| * |
| * ======================================================================== |
| * |
| * Permission to use, copy, modify, distribute, and sell this software and |
| * its documentation for any purpose is hereby granted without fee, |
| * provided that the above copyright notice appear in all copies and that |
| * both that copyright notice and this permission notice appear in |
| * supporting documentation, and that the name of the authors not be used |
| * in advertising or publicity pertaining to distribution of the software |
| * without specific, written prior permission. The authors makes no |
| * representations about the suitability of this software for any purpose. |
| * It is provided "as is" without express or implied warranty. |
| * |
| * THE AUTHORS DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, |
| * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO |
| * EVENT SHALL THE AUTHORS BE LIABLE FOR ANY SPECIAL, INDIRECT OR |
| * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF |
| * USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR |
| * OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR |
| * PERFORMANCE OF THIS SOFTWARE. |
| * |
| * ======================================================================== |
| * |
| * Language: ANSI C |
| * Environment: Any |
| * Developer: Kendall Bennett |
| * |
| * Description: This file includes subroutines which are related to |
| * programmed I/O and memory access. Included in this module |
| * are default functions with limited usefulness. For real |
| * uses these functions will most likely be overriden by the |
| * user library. |
| * |
| ****************************************************************************/ |
| |
| #include "x86emu.h" |
| #include "x86emu/regs.h" |
| #include "x86emu/debug.h" |
| #include "x86emu/prim_ops.h" |
| #include <string.h> |
| |
| /*------------------------- Global Variables ------------------------------*/ |
| |
| X86EMU_sysEnv _X86EMU_env; /* Global emulator machine state */ |
| X86EMU_intrFuncs _X86EMU_intrTab[256]; |
| |
| /*----------------------------- Implementation ----------------------------*/ |
| #ifdef __alpha__ |
| /* to cope with broken egcs-1.1.2 :-(((( */ |
| |
| /* |
| * inline functions to do unaligned accesses |
| * from linux/include/asm-alpha/unaligned.h |
| */ |
| |
| /* |
| * EGCS 1.1 knows about arbitrary unaligned loads. Define some |
| * packed structures to talk about such things with. |
| */ |
| |
| #if __GNUC__ > 2 || __GNUC_MINOR__ >= 91 |
| struct __una_u64 { unsigned long x __attribute__((packed)); }; |
| struct __una_u32 { unsigned int x __attribute__((packed)); }; |
| struct __una_u16 { unsigned short x __attribute__((packed)); }; |
| #endif |
| |
| static __inline__ unsigned long ldq_u(unsigned long * r11) |
| { |
| #if __GNUC__ > 2 || __GNUC_MINOR__ >= 91 |
| const struct __una_u64 *ptr = (const struct __una_u64 *) r11; |
| return ptr->x; |
| #else |
| unsigned long r1,r2; |
| __asm__("ldq_u %0,%3\n\t" |
| "ldq_u %1,%4\n\t" |
| "extql %0,%2,%0\n\t" |
| "extqh %1,%2,%1" |
| :"=&r" (r1), "=&r" (r2) |
| :"r" (r11), |
| "m" (*r11), |
| "m" (*(const unsigned long *)(7+(char *) r11))); |
| return r1 | r2; |
| #endif |
| } |
| |
| static __inline__ unsigned long ldl_u(unsigned int * r11) |
| { |
| #if __GNUC__ > 2 || __GNUC_MINOR__ >= 91 |
| const struct __una_u32 *ptr = (const struct __una_u32 *) r11; |
| return ptr->x; |
| #else |
| unsigned long r1,r2; |
| __asm__("ldq_u %0,%3\n\t" |
| "ldq_u %1,%4\n\t" |
| "extll %0,%2,%0\n\t" |
| "extlh %1,%2,%1" |
| :"=&r" (r1), "=&r" (r2) |
| :"r" (r11), |
| "m" (*r11), |
| "m" (*(const unsigned long *)(3+(char *) r11))); |
| return r1 | r2; |
| #endif |
| } |
| |
| static __inline__ unsigned long ldw_u(unsigned short * r11) |
| { |
| #if __GNUC__ > 2 || __GNUC_MINOR__ >= 91 |
| const struct __una_u16 *ptr = (const struct __una_u16 *) r11; |
| return ptr->x; |
| #else |
| unsigned long r1,r2; |
| __asm__("ldq_u %0,%3\n\t" |
| "ldq_u %1,%4\n\t" |
| "extwl %0,%2,%0\n\t" |
| "extwh %1,%2,%1" |
| :"=&r" (r1), "=&r" (r2) |
| :"r" (r11), |
| "m" (*r11), |
| "m" (*(const unsigned long *)(1+(char *) r11))); |
| return r1 | r2; |
| #endif |
| } |
| |
| /* |
| * Elemental unaligned stores |
| */ |
| |
| static __inline__ void stq_u(unsigned long r5, unsigned long * r11) |
| { |
| #if __GNUC__ > 2 || __GNUC_MINOR__ >= 91 |
| struct __una_u64 *ptr = (struct __una_u64 *) r11; |
| ptr->x = r5; |
| #else |
| unsigned long r1,r2,r3,r4; |
| |
| __asm__("ldq_u %3,%1\n\t" |
| "ldq_u %2,%0\n\t" |
| "insqh %6,%7,%5\n\t" |
| "insql %6,%7,%4\n\t" |
| "mskqh %3,%7,%3\n\t" |
| "mskql %2,%7,%2\n\t" |
| "bis %3,%5,%3\n\t" |
| "bis %2,%4,%2\n\t" |
| "stq_u %3,%1\n\t" |
| "stq_u %2,%0" |
| :"=m" (*r11), |
| "=m" (*(unsigned long *)(7+(char *) r11)), |
| "=&r" (r1), "=&r" (r2), "=&r" (r3), "=&r" (r4) |
| :"r" (r5), "r" (r11)); |
| #endif |
| } |
| |
| static __inline__ void stl_u(unsigned long r5, unsigned int * r11) |
| { |
| #if __GNUC__ > 2 || __GNUC_MINOR__ >= 91 |
| struct __una_u32 *ptr = (struct __una_u32 *) r11; |
| ptr->x = r5; |
| #else |
| unsigned long r1,r2,r3,r4; |
| |
| __asm__("ldq_u %3,%1\n\t" |
| "ldq_u %2,%0\n\t" |
| "inslh %6,%7,%5\n\t" |
| "insll %6,%7,%4\n\t" |
| "msklh %3,%7,%3\n\t" |
| "mskll %2,%7,%2\n\t" |
| "bis %3,%5,%3\n\t" |
| "bis %2,%4,%2\n\t" |
| "stq_u %3,%1\n\t" |
| "stq_u %2,%0" |
| :"=m" (*r11), |
| "=m" (*(unsigned long *)(3+(char *) r11)), |
| "=&r" (r1), "=&r" (r2), "=&r" (r3), "=&r" (r4) |
| :"r" (r5), "r" (r11)); |
| #endif |
| } |
| |
| static __inline__ void stw_u(unsigned long r5, unsigned short * r11) |
| { |
| #if __GNUC__ > 2 || __GNUC_MINOR__ >= 91 |
| struct __una_u16 *ptr = (struct __una_u16 *) r11; |
| ptr->x = r5; |
| #else |
| unsigned long r1,r2,r3,r4; |
| |
| __asm__("ldq_u %3,%1\n\t" |
| "ldq_u %2,%0\n\t" |
| "inswh %6,%7,%5\n\t" |
| "inswl %6,%7,%4\n\t" |
| "mskwh %3,%7,%3\n\t" |
| "mskwl %2,%7,%2\n\t" |
| "bis %3,%5,%3\n\t" |
| "bis %2,%4,%2\n\t" |
| "stq_u %3,%1\n\t" |
| "stq_u %2,%0" |
| :"=m" (*r11), |
| "=m" (*(unsigned long *)(1+(char *) r11)), |
| "=&r" (r1), "=&r" (r2), "=&r" (r3), "=&r" (r4) |
| :"r" (r5), "r" (r11)); |
| #endif |
| } |
| |
| #elif defined (__ia64__) |
| /* |
| * EGCS 1.1 knows about arbitrary unaligned loads. Define some |
| * packed structures to talk about such things with. |
| */ |
| struct __una_u64 { unsigned long x __attribute__((packed)); }; |
| struct __una_u32 { unsigned int x __attribute__((packed)); }; |
| struct __una_u16 { unsigned short x __attribute__((packed)); }; |
| |
| static __inline__ unsigned long |
| __uldq (const unsigned long * r11) |
| { |
| const struct __una_u64 *ptr = (const struct __una_u64 *) r11; |
| return ptr->x; |
| } |
| |
| static __inline__ unsigned long |
| uldl (const unsigned int * r11) |
| { |
| const struct __una_u32 *ptr = (const struct __una_u32 *) r11; |
| return ptr->x; |
| } |
| |
| static __inline__ unsigned long |
| uldw (const unsigned short * r11) |
| { |
| const struct __una_u16 *ptr = (const struct __una_u16 *) r11; |
| return ptr->x; |
| } |
| |
| static __inline__ void |
| ustq (unsigned long r5, unsigned long * r11) |
| { |
| struct __una_u64 *ptr = (struct __una_u64 *) r11; |
| ptr->x = r5; |
| } |
| |
| static __inline__ void |
| ustl (unsigned long r5, unsigned int * r11) |
| { |
| struct __una_u32 *ptr = (struct __una_u32 *) r11; |
| ptr->x = r5; |
| } |
| |
| static __inline__ void |
| ustw (unsigned long r5, unsigned short * r11) |
| { |
| struct __una_u16 *ptr = (struct __una_u16 *) r11; |
| ptr->x = r5; |
| } |
| |
| #endif |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - Emulator memory address to read |
| |
| RETURNS: |
| Byte value read from emulator memory. |
| |
| REMARKS: |
| Reads a byte value from the emulator memory. |
| ****************************************************************************/ |
| u8 X86API rdb( |
| u32 addr) |
| { |
| u8 val; |
| |
| if (addr > M.mem_size - 1) { |
| DB(printk("mem_read: address %#lx out of range!\n", addr);) |
| HALT_SYS(); |
| } |
| val = *(u8*)(M.mem_base + addr); |
| DB( if (DEBUG_MEM_TRACE()) |
| printk("%#08x 1 -> %#x\n", addr, val);) |
| return val; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - Emulator memory address to read |
| |
| RETURNS: |
| Word value read from emulator memory. |
| |
| REMARKS: |
| Reads a word value from the emulator memory. |
| ****************************************************************************/ |
| u16 X86API rdw( |
| u32 addr) |
| { |
| u16 val = 0; |
| |
| if (addr > M.mem_size - 2) { |
| DB(printk("mem_read: address %#lx out of range!\n", addr);) |
| HALT_SYS(); |
| } |
| #ifdef __BIG_ENDIAN__ |
| if (addr & 0x1) { |
| val = (*(u8*)(M.mem_base + addr) | |
| (*(u8*)(M.mem_base + addr + 1) << 8)); |
| } |
| else |
| #endif |
| #ifdef __alpha__ |
| val = ldw_u((u16*)(M.mem_base + addr)); |
| #elif defined (__ia64__) |
| val = uldw((u16*)(M.mem_base + addr)); |
| #else |
| val = *(u16*)(M.mem_base + addr); |
| #endif |
| DB( if (DEBUG_MEM_TRACE()) |
| printk("%#08x 2 -> %#x\n", addr, val);) |
| return val; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - Emulator memory address to read |
| |
| RETURNS: |
| Long value read from emulator memory. |
| REMARKS: |
| Reads a long value from the emulator memory. |
| ****************************************************************************/ |
| u32 X86API rdl( |
| u32 addr) |
| { |
| u32 val = 0; |
| |
| if (addr > M.mem_size - 4) { |
| DB(printk("mem_read: address %#lx out of range!\n", addr);) |
| HALT_SYS(); |
| } |
| #ifdef __BIG_ENDIAN__ |
| if (addr & 0x3) { |
| val = (*(u8*)(M.mem_base + addr + 0) | |
| (*(u8*)(M.mem_base + addr + 1) << 8) | |
| (*(u8*)(M.mem_base + addr + 2) << 16) | |
| (*(u8*)(M.mem_base + addr + 3) << 24)); |
| } |
| else |
| #endif |
| #ifdef __alpha__ |
| val = ldl_u((u32*)(M.mem_base + addr)); |
| #elif defined (__ia64__) |
| val = uldl((u32*)(M.mem_base + addr)); |
| #else |
| val = *(u32*)(M.mem_base + addr); |
| #endif |
| DB( if (DEBUG_MEM_TRACE()) |
| printk("%#08x 4 -> %#x\n", addr, val);) |
| return val; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - Emulator memory address to read |
| val - Value to store |
| |
| REMARKS: |
| Writes a byte value to emulator memory. |
| ****************************************************************************/ |
| void X86API wrb( |
| u32 addr, |
| u8 val) |
| { |
| DB( if (DEBUG_MEM_TRACE()) |
| printk("%#08x 1 <- %#x\n", addr, val);) |
| if (addr > M.mem_size - 1) { |
| DB(printk("mem_write: address %#lx out of range!\n", addr);) |
| HALT_SYS(); |
| } |
| *(u8*)(M.mem_base + addr) = val; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - Emulator memory address to read |
| val - Value to store |
| |
| REMARKS: |
| Writes a word value to emulator memory. |
| ****************************************************************************/ |
| void X86API wrw( |
| u32 addr, |
| u16 val) |
| { |
| DB( if (DEBUG_MEM_TRACE()) |
| printk("%#08x 2 <- %#x\n", addr, val);) |
| if (addr > M.mem_size - 2) { |
| DB(printk("mem_write: address %#lx out of range!\n", addr);) |
| HALT_SYS(); |
| } |
| #ifdef __BIG_ENDIAN__ |
| if (addr & 0x1) { |
| *(u8*)(M.mem_base + addr + 0) = (val >> 0) & 0xff; |
| *(u8*)(M.mem_base + addr + 1) = (val >> 8) & 0xff; |
| } |
| else |
| #endif |
| #ifdef __alpha__ |
| stw_u(val,(u16*)(M.mem_base + addr)); |
| #elif defined (__ia64__) |
| ustw(val,(u16*)(M.mem_base + addr)); |
| #else |
| *(u16*)(M.mem_base + addr) = val; |
| #endif |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - Emulator memory address to read |
| val - Value to store |
| |
| REMARKS: |
| Writes a long value to emulator memory. |
| ****************************************************************************/ |
| void X86API wrl( |
| u32 addr, |
| u32 val) |
| { |
| DB( if (DEBUG_MEM_TRACE()) |
| printk("%#08x 4 <- %#x\n", addr, val);) |
| if (addr > M.mem_size - 4) { |
| DB(printk("mem_write: address %#lx out of range!\n", addr);) |
| HALT_SYS(); |
| } |
| #ifdef __BIG_ENDIAN__ |
| if (addr & 0x1) { |
| *(u8*)(M.mem_base + addr + 0) = (val >> 0) & 0xff; |
| *(u8*)(M.mem_base + addr + 1) = (val >> 8) & 0xff; |
| *(u8*)(M.mem_base + addr + 2) = (val >> 16) & 0xff; |
| *(u8*)(M.mem_base + addr + 3) = (val >> 24) & 0xff; |
| } |
| else |
| #endif |
| #ifdef __alpha__ |
| stl_u(val,(u32*)(M.mem_base + addr)); |
| #elif defined (__ia64__) |
| ustl(val,(u32*)(M.mem_base + addr)); |
| #else |
| *(u32*)(M.mem_base + addr) = val; |
| #endif |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - PIO address to read |
| RETURN: |
| 0 |
| REMARKS: |
| Default PIO byte read function. Doesn't perform real inb. |
| ****************************************************************************/ |
| static u8 X86API p_inb( |
| X86EMU_pioAddr addr) |
| { |
| DB( if (DEBUG_IO_TRACE()) |
| printk("inb %#04x \n", addr);) |
| return 0; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - PIO address to read |
| RETURN: |
| 0 |
| REMARKS: |
| Default PIO word read function. Doesn't perform real inw. |
| ****************************************************************************/ |
| static u16 X86API p_inw( |
| X86EMU_pioAddr addr) |
| { |
| DB( if (DEBUG_IO_TRACE()) |
| printk("inw %#04x \n", addr);) |
| return 0; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - PIO address to read |
| RETURN: |
| 0 |
| REMARKS: |
| Default PIO long read function. Doesn't perform real inl. |
| ****************************************************************************/ |
| static u32 X86API p_inl( |
| X86EMU_pioAddr addr) |
| { |
| DB( if (DEBUG_IO_TRACE()) |
| printk("inl %#04x \n", addr);) |
| return 0; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - PIO address to write |
| val - Value to store |
| REMARKS: |
| Default PIO byte write function. Doesn't perform real outb. |
| ****************************************************************************/ |
| static void X86API p_outb( |
| X86EMU_pioAddr addr, |
| u8 val) |
| { |
| DB( if (DEBUG_IO_TRACE()) |
| printk("outb %#02x -> %#04x \n", val, addr);) |
| return; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - PIO address to write |
| val - Value to store |
| REMARKS: |
| Default PIO word write function. Doesn't perform real outw. |
| ****************************************************************************/ |
| static void X86API p_outw( |
| X86EMU_pioAddr addr, |
| u16 val) |
| { |
| DB( if (DEBUG_IO_TRACE()) |
| printk("outw %#04x -> %#04x \n", val, addr);) |
| return; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| addr - PIO address to write |
| val - Value to store |
| REMARKS: |
| Default PIO ;ong write function. Doesn't perform real outl. |
| ****************************************************************************/ |
| static void X86API p_outl( |
| X86EMU_pioAddr addr, |
| u32 val) |
| { |
| DB( if (DEBUG_IO_TRACE()) |
| printk("outl %#08x -> %#04x \n", val, addr);) |
| return; |
| } |
| |
| /*------------------------- Global Variables ------------------------------*/ |
| |
| u8 (X86APIP sys_rdb)(u32 addr) = rdb; |
| u16 (X86APIP sys_rdw)(u32 addr) = rdw; |
| u32 (X86APIP sys_rdl)(u32 addr) = rdl; |
| void (X86APIP sys_wrb)(u32 addr,u8 val) = wrb; |
| void (X86APIP sys_wrw)(u32 addr,u16 val) = wrw; |
| void (X86APIP sys_wrl)(u32 addr,u32 val) = wrl; |
| u8 (X86APIP sys_inb)(X86EMU_pioAddr addr) = p_inb; |
| u16 (X86APIP sys_inw)(X86EMU_pioAddr addr) = p_inw; |
| u32 (X86APIP sys_inl)(X86EMU_pioAddr addr) = p_inl; |
| void (X86APIP sys_outb)(X86EMU_pioAddr addr, u8 val) = p_outb; |
| void (X86APIP sys_outw)(X86EMU_pioAddr addr, u16 val) = p_outw; |
| void (X86APIP sys_outl)(X86EMU_pioAddr addr, u32 val) = p_outl; |
| |
| /*----------------------------- Setup -------------------------------------*/ |
| |
| /**************************************************************************** |
| PARAMETERS: |
| funcs - New memory function pointers to make active |
| |
| REMARKS: |
| This function is used to set the pointers to functions which access |
| memory space, allowing the user application to override these functions |
| and hook them out as necessary for their application. |
| ****************************************************************************/ |
| void X86EMU_setupMemFuncs( |
| X86EMU_memFuncs *funcs) |
| { |
| sys_rdb = funcs->rdb; |
| sys_rdw = funcs->rdw; |
| sys_rdl = funcs->rdl; |
| sys_wrb = funcs->wrb; |
| sys_wrw = funcs->wrw; |
| sys_wrl = funcs->wrl; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| funcs - New programmed I/O function pointers to make active |
| |
| REMARKS: |
| This function is used to set the pointers to functions which access |
| I/O space, allowing the user application to override these functions |
| and hook them out as necessary for their application. |
| ****************************************************************************/ |
| void X86EMU_setupPioFuncs( |
| X86EMU_pioFuncs *funcs) |
| { |
| sys_inb = funcs->inb; |
| sys_inw = funcs->inw; |
| sys_inl = funcs->inl; |
| sys_outb = funcs->outb; |
| sys_outw = funcs->outw; |
| sys_outl = funcs->outl; |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| funcs - New interrupt vector table to make active |
| |
| REMARKS: |
| This function is used to set the pointers to functions which handle |
| interrupt processing in the emulator, allowing the user application to |
| hook interrupts as necessary for their application. Any interrupts that |
| are not hooked by the user application, and reflected and handled internally |
| in the emulator via the interrupt vector table. This allows the application |
| to get control when the code being emulated executes specific software |
| interrupts. |
| ****************************************************************************/ |
| void X86EMU_setupIntrFuncs( |
| X86EMU_intrFuncs funcs[]) |
| { |
| int i; |
| |
| for (i=0; i < 256; i++) |
| _X86EMU_intrTab[i] = NULL; |
| if (funcs) { |
| for (i = 0; i < 256; i++) |
| _X86EMU_intrTab[i] = funcs[i]; |
| } |
| } |
| |
| /**************************************************************************** |
| PARAMETERS: |
| int - New software interrupt to prepare for |
| |
| REMARKS: |
| This function is used to set up the emulator state to exceute a software |
| interrupt. This can be used by the user application code to allow an |
| interrupt to be hooked, examined and then reflected back to the emulator |
| so that the code in the emulator will continue processing the software |
| interrupt as per normal. This essentially allows system code to actively |
| hook and handle certain software interrupts as necessary. |
| ****************************************************************************/ |
| void X86EMU_prepareForInt( |
| int num) |
| { |
| push_word((u16)M.x86.R_FLG); |
| CLEAR_FLAG(F_IF); |
| CLEAR_FLAG(F_TF); |
| push_word(M.x86.R_CS); |
| M.x86.R_CS = mem_access_word(num * 4 + 2); |
| push_word(M.x86.R_IP); |
| M.x86.R_IP = mem_access_word(num * 4); |
| M.x86.intr = 0; |
| } |