12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148 |
- /****************************************************************************
- *
- * Realmode X86 Emulator Library
- *
- * Copyright (C) 1991-2004 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
- * instruction decoding and accessess of immediate data via IP. etc.
- *
- ****************************************************************************/
- #include "x86emu/x86emui.h"
- /*----------------------------- Implementation ----------------------------*/
- /****************************************************************************
- REMARKS:
- Handles any pending asychronous interrupts.
- ****************************************************************************/
- static void x86emu_intr_handle(void)
- {
- u8 intno;
- if (M.x86.intr & INTR_SYNCH) {
- intno = M.x86.intno;
- if (_X86EMU_intrTab[intno]) {
- (*_X86EMU_intrTab[intno])(intno);
- } else {
- 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(intno * 4 + 2);
- push_word(M.x86.R_IP);
- M.x86.R_IP = mem_access_word(intno * 4);
- M.x86.intr = 0;
- }
- }
- }
- /****************************************************************************
- PARAMETERS:
- intrnum - Interrupt number to raise
- REMARKS:
- Raise the specified interrupt to be handled before the execution of the
- next instruction.
- ****************************************************************************/
- void x86emu_intr_raise(
- u8 intrnum)
- {
- M.x86.intno = intrnum;
- M.x86.intr |= INTR_SYNCH;
- }
- /****************************************************************************
- REMARKS:
- Main execution loop for the emulator. We return from here when the system
- halts, which is normally caused by a stack fault when we return from the
- original real mode call.
- ****************************************************************************/
- void X86EMU_exec(void)
- {
- u8 op1;
- M.x86.intr = 0;
- DB(x86emu_end_instr();)
- for (;;) {
- DB( if (CHECK_IP_FETCH())
- x86emu_check_ip_access();)
- /* If debugging, save the IP and CS values. */
- SAVE_IP_CS(M.x86.R_CS, M.x86.R_IP);
- INC_DECODED_INST_LEN(1);
- if (M.x86.intr) {
- if (M.x86.intr & INTR_HALTED) {
- DB( if (M.x86.R_SP != 0) {
- printk("halted\n");
- X86EMU_trace_regs();
- }
- else {
- if (M.x86.debug)
- printk("Service completed successfully\n");
- })
- return;
- }
- if (((M.x86.intr & INTR_SYNCH) && (M.x86.intno == 0 || M.x86.intno == 2)) ||
- !ACCESS_FLAG(F_IF)) {
- x86emu_intr_handle();
- }
- }
- op1 = (*sys_rdb)(((u32)M.x86.R_CS << 4) + (M.x86.R_IP++));
- (*x86emu_optab[op1])(op1);
- if (M.x86.debug & DEBUG_EXIT) {
- M.x86.debug &= ~DEBUG_EXIT;
- return;
- }
- }
- }
- /****************************************************************************
- REMARKS:
- Halts the system by setting the halted system flag.
- ****************************************************************************/
- void X86EMU_halt_sys(void)
- {
- M.x86.intr |= INTR_HALTED;
- }
- /****************************************************************************
- PARAMETERS:
- mod - Mod value from decoded byte
- regh - Reg h value from decoded byte
- regl - Reg l value from decoded byte
- REMARKS:
- Raise the specified interrupt to be handled before the execution of the
- next instruction.
- NOTE: Do not inline this function, as (*sys_rdb) is already inline!
- ****************************************************************************/
- void fetch_decode_modrm(
- int *mod,
- int *regh,
- int *regl)
- {
- int fetched;
- DB( if (CHECK_IP_FETCH())
- x86emu_check_ip_access();)
- fetched = (*sys_rdb)(((u32)M.x86.R_CS << 4) + (M.x86.R_IP++));
- INC_DECODED_INST_LEN(1);
- *mod = (fetched >> 6) & 0x03;
- *regh = (fetched >> 3) & 0x07;
- *regl = (fetched >> 0) & 0x07;
- }
- /****************************************************************************
- RETURNS:
- Immediate byte value read from instruction queue
- REMARKS:
- This function returns the immediate byte from the instruction queue, and
- moves the instruction pointer to the next value.
- NOTE: Do not inline this function, as (*sys_rdb) is already inline!
- ****************************************************************************/
- u8 fetch_byte_imm(void)
- {
- u8 fetched;
- DB( if (CHECK_IP_FETCH())
- x86emu_check_ip_access();)
- fetched = (*sys_rdb)(((u32)M.x86.R_CS << 4) + (M.x86.R_IP++));
- INC_DECODED_INST_LEN(1);
- return fetched;
- }
- /****************************************************************************
- RETURNS:
- Immediate word value read from instruction queue
- REMARKS:
- This function returns the immediate byte from the instruction queue, and
- moves the instruction pointer to the next value.
- NOTE: Do not inline this function, as (*sys_rdw) is already inline!
- ****************************************************************************/
- u16 fetch_word_imm(void)
- {
- u16 fetched;
- DB( if (CHECK_IP_FETCH())
- x86emu_check_ip_access();)
- fetched = (*sys_rdw)(((u32)M.x86.R_CS << 4) + (M.x86.R_IP));
- M.x86.R_IP += 2;
- INC_DECODED_INST_LEN(2);
- return fetched;
- }
- /****************************************************************************
- RETURNS:
- Immediate lone value read from instruction queue
- REMARKS:
- This function returns the immediate byte from the instruction queue, and
- moves the instruction pointer to the next value.
- NOTE: Do not inline this function, as (*sys_rdw) is already inline!
- ****************************************************************************/
- u32 fetch_long_imm(void)
- {
- u32 fetched;
- DB( if (CHECK_IP_FETCH())
- x86emu_check_ip_access();)
- fetched = (*sys_rdl)(((u32)M.x86.R_CS << 4) + (M.x86.R_IP));
- M.x86.R_IP += 4;
- INC_DECODED_INST_LEN(4);
- return fetched;
- }
- /****************************************************************************
- RETURNS:
- Value of the default data segment
- REMARKS:
- Inline function that returns the default data segment for the current
- instruction.
- On the x86 processor, the default segment is not always DS if there is
- no segment override. Address modes such as -3[BP] or 10[BP+SI] all refer to
- addresses relative to SS (ie: on the stack). So, at the minimum, all
- decodings of addressing modes would have to set/clear a bit describing
- whether the access is relative to DS or SS. That is the function of the
- cpu-state-varible M.x86.mode. There are several potential states:
- repe prefix seen (handled elsewhere)
- repne prefix seen (ditto)
- cs segment override
- ds segment override
- es segment override
- fs segment override
- gs segment override
- ss segment override
- ds/ss select (in absense of override)
- Each of the above 7 items are handled with a bit in the mode field.
- ****************************************************************************/
- _INLINE u32 get_data_segment(void)
- {
- #define GET_SEGMENT(segment)
- switch (M.x86.mode & SYSMODE_SEGMASK) {
- case 0: /* default case: use ds register */
- case SYSMODE_SEGOVR_DS:
- case SYSMODE_SEGOVR_DS | SYSMODE_SEG_DS_SS:
- return M.x86.R_DS;
- case SYSMODE_SEG_DS_SS: /* non-overridden, use ss register */
- return M.x86.R_SS;
- case SYSMODE_SEGOVR_CS:
- case SYSMODE_SEGOVR_CS | SYSMODE_SEG_DS_SS:
- return M.x86.R_CS;
- case SYSMODE_SEGOVR_ES:
- case SYSMODE_SEGOVR_ES | SYSMODE_SEG_DS_SS:
- return M.x86.R_ES;
- case SYSMODE_SEGOVR_FS:
- case SYSMODE_SEGOVR_FS | SYSMODE_SEG_DS_SS:
- return M.x86.R_FS;
- case SYSMODE_SEGOVR_GS:
- case SYSMODE_SEGOVR_GS | SYSMODE_SEG_DS_SS:
- return M.x86.R_GS;
- case SYSMODE_SEGOVR_SS:
- case SYSMODE_SEGOVR_SS | SYSMODE_SEG_DS_SS:
- return M.x86.R_SS;
- default:
- #ifdef DEBUG
- printk("error: should not happen: multiple overrides.\n");
- #endif
- HALT_SYS();
- return 0;
- }
- }
- /****************************************************************************
- PARAMETERS:
- offset - Offset to load data from
- RETURNS:
- Byte value read from the absolute memory location.
- NOTE: Do not inline this function as (*sys_rdX) is already inline!
- ****************************************************************************/
- u8 fetch_data_byte(
- uint offset)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access((u16)get_data_segment(), offset);
- #endif
- return (*sys_rdb)((get_data_segment() << 4) + offset);
- }
- /****************************************************************************
- PARAMETERS:
- offset - Offset to load data from
- RETURNS:
- Word value read from the absolute memory location.
- NOTE: Do not inline this function as (*sys_rdX) is already inline!
- ****************************************************************************/
- u16 fetch_data_word(
- uint offset)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access((u16)get_data_segment(), offset);
- #endif
- return (*sys_rdw)((get_data_segment() << 4) + offset);
- }
- /****************************************************************************
- PARAMETERS:
- offset - Offset to load data from
- RETURNS:
- Long value read from the absolute memory location.
- NOTE: Do not inline this function as (*sys_rdX) is already inline!
- ****************************************************************************/
- u32 fetch_data_long(
- uint offset)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access((u16)get_data_segment(), offset);
- #endif
- return (*sys_rdl)((get_data_segment() << 4) + offset);
- }
- /****************************************************************************
- PARAMETERS:
- segment - Segment to load data from
- offset - Offset to load data from
- RETURNS:
- Byte value read from the absolute memory location.
- NOTE: Do not inline this function as (*sys_rdX) is already inline!
- ****************************************************************************/
- u8 fetch_data_byte_abs(
- uint segment,
- uint offset)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access(segment, offset);
- #endif
- return (*sys_rdb)(((u32)segment << 4) + offset);
- }
- /****************************************************************************
- PARAMETERS:
- segment - Segment to load data from
- offset - Offset to load data from
- RETURNS:
- Word value read from the absolute memory location.
- NOTE: Do not inline this function as (*sys_rdX) is already inline!
- ****************************************************************************/
- u16 fetch_data_word_abs(
- uint segment,
- uint offset)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access(segment, offset);
- #endif
- return (*sys_rdw)(((u32)segment << 4) + offset);
- }
- /****************************************************************************
- PARAMETERS:
- segment - Segment to load data from
- offset - Offset to load data from
- RETURNS:
- Long value read from the absolute memory location.
- NOTE: Do not inline this function as (*sys_rdX) is already inline!
- ****************************************************************************/
- u32 fetch_data_long_abs(
- uint segment,
- uint offset)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access(segment, offset);
- #endif
- return (*sys_rdl)(((u32)segment << 4) + offset);
- }
- /****************************************************************************
- PARAMETERS:
- offset - Offset to store data at
- val - Value to store
- REMARKS:
- Writes a word value to an segmented memory location. The segment used is
- the current 'default' segment, which may have been overridden.
- NOTE: Do not inline this function as (*sys_wrX) is already inline!
- ****************************************************************************/
- void store_data_byte(
- uint offset,
- u8 val)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access((u16)get_data_segment(), offset);
- #endif
- (*sys_wrb)((get_data_segment() << 4) + offset, val);
- }
- /****************************************************************************
- PARAMETERS:
- offset - Offset to store data at
- val - Value to store
- REMARKS:
- Writes a word value to an segmented memory location. The segment used is
- the current 'default' segment, which may have been overridden.
- NOTE: Do not inline this function as (*sys_wrX) is already inline!
- ****************************************************************************/
- void store_data_word(
- uint offset,
- u16 val)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access((u16)get_data_segment(), offset);
- #endif
- (*sys_wrw)((get_data_segment() << 4) + offset, val);
- }
- /****************************************************************************
- PARAMETERS:
- offset - Offset to store data at
- val - Value to store
- REMARKS:
- Writes a long value to an segmented memory location. The segment used is
- the current 'default' segment, which may have been overridden.
- NOTE: Do not inline this function as (*sys_wrX) is already inline!
- ****************************************************************************/
- void store_data_long(
- uint offset,
- u32 val)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access((u16)get_data_segment(), offset);
- #endif
- (*sys_wrl)((get_data_segment() << 4) + offset, val);
- }
- /****************************************************************************
- PARAMETERS:
- segment - Segment to store data at
- offset - Offset to store data at
- val - Value to store
- REMARKS:
- Writes a byte value to an absolute memory location.
- NOTE: Do not inline this function as (*sys_wrX) is already inline!
- ****************************************************************************/
- void store_data_byte_abs(
- uint segment,
- uint offset,
- u8 val)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access(segment, offset);
- #endif
- (*sys_wrb)(((u32)segment << 4) + offset, val);
- }
- /****************************************************************************
- PARAMETERS:
- segment - Segment to store data at
- offset - Offset to store data at
- val - Value to store
- REMARKS:
- Writes a word value to an absolute memory location.
- NOTE: Do not inline this function as (*sys_wrX) is already inline!
- ****************************************************************************/
- void store_data_word_abs(
- uint segment,
- uint offset,
- u16 val)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access(segment, offset);
- #endif
- (*sys_wrw)(((u32)segment << 4) + offset, val);
- }
- /****************************************************************************
- PARAMETERS:
- segment - Segment to store data at
- offset - Offset to store data at
- val - Value to store
- REMARKS:
- Writes a long value to an absolute memory location.
- NOTE: Do not inline this function as (*sys_wrX) is already inline!
- ****************************************************************************/
- void store_data_long_abs(
- uint segment,
- uint offset,
- u32 val)
- {
- #ifdef DEBUG
- if (CHECK_DATA_ACCESS())
- x86emu_check_data_access(segment, offset);
- #endif
- (*sys_wrl)(((u32)segment << 4) + offset, val);
- }
- /****************************************************************************
- PARAMETERS:
- reg - Register to decode
- RETURNS:
- Pointer to the appropriate register
- REMARKS:
- Return a pointer to the register given by the R/RM field of the
- modrm byte, for byte operands. Also enables the decoding of instructions.
- ****************************************************************************/
- u8* decode_rm_byte_register(
- int reg)
- {
- switch (reg) {
- case 0:
- DECODE_PRINTF("AL");
- return &M.x86.R_AL;
- case 1:
- DECODE_PRINTF("CL");
- return &M.x86.R_CL;
- case 2:
- DECODE_PRINTF("DL");
- return &M.x86.R_DL;
- case 3:
- DECODE_PRINTF("BL");
- return &M.x86.R_BL;
- case 4:
- DECODE_PRINTF("AH");
- return &M.x86.R_AH;
- case 5:
- DECODE_PRINTF("CH");
- return &M.x86.R_CH;
- case 6:
- DECODE_PRINTF("DH");
- return &M.x86.R_DH;
- case 7:
- DECODE_PRINTF("BH");
- return &M.x86.R_BH;
- }
- HALT_SYS();
- return NULL; /* NOT REACHED OR REACHED ON ERROR */
- }
- /****************************************************************************
- PARAMETERS:
- reg - Register to decode
- RETURNS:
- Pointer to the appropriate register
- REMARKS:
- Return a pointer to the register given by the R/RM field of the
- modrm byte, for word operands. Also enables the decoding of instructions.
- ****************************************************************************/
- u16* decode_rm_word_register(
- int reg)
- {
- switch (reg) {
- case 0:
- DECODE_PRINTF("AX");
- return &M.x86.R_AX;
- case 1:
- DECODE_PRINTF("CX");
- return &M.x86.R_CX;
- case 2:
- DECODE_PRINTF("DX");
- return &M.x86.R_DX;
- case 3:
- DECODE_PRINTF("BX");
- return &M.x86.R_BX;
- case 4:
- DECODE_PRINTF("SP");
- return &M.x86.R_SP;
- case 5:
- DECODE_PRINTF("BP");
- return &M.x86.R_BP;
- case 6:
- DECODE_PRINTF("SI");
- return &M.x86.R_SI;
- case 7:
- DECODE_PRINTF("DI");
- return &M.x86.R_DI;
- }
- HALT_SYS();
- return NULL; /* NOTREACHED OR REACHED ON ERROR */
- }
- /****************************************************************************
- PARAMETERS:
- reg - Register to decode
- RETURNS:
- Pointer to the appropriate register
- REMARKS:
- Return a pointer to the register given by the R/RM field of the
- modrm byte, for dword operands. Also enables the decoding of instructions.
- ****************************************************************************/
- u32* decode_rm_long_register(
- int reg)
- {
- switch (reg) {
- case 0:
- DECODE_PRINTF("EAX");
- return &M.x86.R_EAX;
- case 1:
- DECODE_PRINTF("ECX");
- return &M.x86.R_ECX;
- case 2:
- DECODE_PRINTF("EDX");
- return &M.x86.R_EDX;
- case 3:
- DECODE_PRINTF("EBX");
- return &M.x86.R_EBX;
- case 4:
- DECODE_PRINTF("ESP");
- return &M.x86.R_ESP;
- case 5:
- DECODE_PRINTF("EBP");
- return &M.x86.R_EBP;
- case 6:
- DECODE_PRINTF("ESI");
- return &M.x86.R_ESI;
- case 7:
- DECODE_PRINTF("EDI");
- return &M.x86.R_EDI;
- }
- HALT_SYS();
- return NULL; /* NOTREACHED OR REACHED ON ERROR */
- }
- /****************************************************************************
- PARAMETERS:
- reg - Register to decode
- RETURNS:
- Pointer to the appropriate register
- REMARKS:
- Return a pointer to the register given by the R/RM field of the
- modrm byte, for word operands, modified from above for the weirdo
- special case of segreg operands. Also enables the decoding of instructions.
- ****************************************************************************/
- u16* decode_rm_seg_register(
- int reg)
- {
- switch (reg) {
- case 0:
- DECODE_PRINTF("ES");
- return &M.x86.R_ES;
- case 1:
- DECODE_PRINTF("CS");
- return &M.x86.R_CS;
- case 2:
- DECODE_PRINTF("SS");
- return &M.x86.R_SS;
- case 3:
- DECODE_PRINTF("DS");
- return &M.x86.R_DS;
- case 4:
- DECODE_PRINTF("FS");
- return &M.x86.R_FS;
- case 5:
- DECODE_PRINTF("GS");
- return &M.x86.R_GS;
- case 6:
- case 7:
- DECODE_PRINTF("ILLEGAL SEGREG");
- break;
- }
- HALT_SYS();
- return NULL; /* NOT REACHED OR REACHED ON ERROR */
- }
- /****************************************************************************
- PARAMETERS:
- scale - scale value of SIB byte
- index - index value of SIB byte
- RETURNS:
- Value of scale * index
- REMARKS:
- Decodes scale/index of SIB byte and returns relevant offset part of
- effective address.
- ****************************************************************************/
- unsigned decode_sib_si(
- int scale,
- int index)
- {
- scale = 1 << scale;
- if (scale > 1) {
- DECODE_PRINTF2("[%d*", scale);
- } else {
- DECODE_PRINTF("[");
- }
- switch (index) {
- case 0:
- DECODE_PRINTF("EAX]");
- return M.x86.R_EAX * index;
- case 1:
- DECODE_PRINTF("ECX]");
- return M.x86.R_ECX * index;
- case 2:
- DECODE_PRINTF("EDX]");
- return M.x86.R_EDX * index;
- case 3:
- DECODE_PRINTF("EBX]");
- return M.x86.R_EBX * index;
- case 4:
- DECODE_PRINTF("0]");
- return 0;
- case 5:
- DECODE_PRINTF("EBP]");
- return M.x86.R_EBP * index;
- case 6:
- DECODE_PRINTF("ESI]");
- return M.x86.R_ESI * index;
- case 7:
- DECODE_PRINTF("EDI]");
- return M.x86.R_EDI * index;
- }
- HALT_SYS();
- return 0; /* NOT REACHED OR REACHED ON ERROR */
- }
- /****************************************************************************
- PARAMETERS:
- mod - MOD value of preceding ModR/M byte
- RETURNS:
- Offset in memory for the address decoding
- REMARKS:
- Decodes SIB addressing byte and returns calculated effective address.
- ****************************************************************************/
- unsigned decode_sib_address(
- int mod)
- {
- int sib = fetch_byte_imm();
- int ss = (sib >> 6) & 0x03;
- int index = (sib >> 3) & 0x07;
- int base = sib & 0x07;
- int offset = 0;
- int displacement;
- switch (base) {
- case 0:
- DECODE_PRINTF("[EAX]");
- offset = M.x86.R_EAX;
- break;
- case 1:
- DECODE_PRINTF("[ECX]");
- offset = M.x86.R_ECX;
- break;
- case 2:
- DECODE_PRINTF("[EDX]");
- offset = M.x86.R_EDX;
- break;
- case 3:
- DECODE_PRINTF("[EBX]");
- offset = M.x86.R_EBX;
- break;
- case 4:
- DECODE_PRINTF("[ESP]");
- offset = M.x86.R_ESP;
- break;
- case 5:
- switch (mod) {
- case 0:
- displacement = (s32)fetch_long_imm();
- DECODE_PRINTF2("[%d]", displacement);
- offset = displacement;
- break;
- case 1:
- displacement = (s8)fetch_byte_imm();
- DECODE_PRINTF2("[%d][EBP]", displacement);
- offset = M.x86.R_EBP + displacement;
- break;
- case 2:
- displacement = (s32)fetch_long_imm();
- DECODE_PRINTF2("[%d][EBP]", displacement);
- offset = M.x86.R_EBP + displacement;
- break;
- default:
- HALT_SYS();
- }
- DECODE_PRINTF("[EAX]");
- offset = M.x86.R_EAX;
- break;
- case 6:
- DECODE_PRINTF("[ESI]");
- offset = M.x86.R_ESI;
- break;
- case 7:
- DECODE_PRINTF("[EDI]");
- offset = M.x86.R_EDI;
- break;
- default:
- HALT_SYS();
- }
- offset += decode_sib_si(ss, index);
- return offset;
- }
- /****************************************************************************
- PARAMETERS:
- rm - RM value to decode
- RETURNS:
- Offset in memory for the address decoding
- REMARKS:
- Return the offset given by mod=00 addressing. Also enables the
- decoding of instructions.
- NOTE: The code which specifies the corresponding segment (ds vs ss)
- below in the case of [BP+..]. The assumption here is that at the
- point that this subroutine is called, the bit corresponding to
- SYSMODE_SEG_DS_SS will be zero. After every instruction
- except the segment override instructions, this bit (as well
- as any bits indicating segment overrides) will be clear. So
- if a SS access is needed, set this bit. Otherwise, DS access
- occurs (unless any of the segment override bits are set).
- ****************************************************************************/
- unsigned decode_rm00_address(
- int rm)
- {
- unsigned offset;
- if (M.x86.mode & SYSMODE_PREFIX_ADDR) {
- /* 32-bit addressing */
- switch (rm) {
- case 0:
- DECODE_PRINTF("[EAX]");
- return M.x86.R_EAX;
- case 1:
- DECODE_PRINTF("[ECX]");
- return M.x86.R_ECX;
- case 2:
- DECODE_PRINTF("[EDX]");
- return M.x86.R_EDX;
- case 3:
- DECODE_PRINTF("[EBX]");
- return M.x86.R_EBX;
- case 4:
- return decode_sib_address(0);
- case 5:
- offset = fetch_long_imm();
- DECODE_PRINTF2("[%08x]", offset);
- return offset;
- case 6:
- DECODE_PRINTF("[ESI]");
- return M.x86.R_ESI;
- case 7:
- DECODE_PRINTF("[EDI]");
- return M.x86.R_EDI;
- }
- } else {
- /* 16-bit addressing */
- switch (rm) {
- case 0:
- DECODE_PRINTF("[BX+SI]");
- return (M.x86.R_BX + M.x86.R_SI) & 0xffff;
- case 1:
- DECODE_PRINTF("[BX+DI]");
- return (M.x86.R_BX + M.x86.R_DI) & 0xffff;
- case 2:
- DECODE_PRINTF("[BP+SI]");
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + M.x86.R_SI) & 0xffff;
- case 3:
- DECODE_PRINTF("[BP+DI]");
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + M.x86.R_DI) & 0xffff;
- case 4:
- DECODE_PRINTF("[SI]");
- return M.x86.R_SI;
- case 5:
- DECODE_PRINTF("[DI]");
- return M.x86.R_DI;
- case 6:
- offset = fetch_word_imm();
- DECODE_PRINTF2("[%04x]", offset);
- return offset;
- case 7:
- DECODE_PRINTF("[BX]");
- return M.x86.R_BX;
- }
- }
- HALT_SYS();
- return 0;
- }
- /****************************************************************************
- PARAMETERS:
- rm - RM value to decode
- RETURNS:
- Offset in memory for the address decoding
- REMARKS:
- Return the offset given by mod=01 addressing. Also enables the
- decoding of instructions.
- ****************************************************************************/
- unsigned decode_rm01_address(
- int rm)
- {
- int displacement;
- if (M.x86.mode & SYSMODE_PREFIX_ADDR) {
- /* 32-bit addressing */
- if (rm != 4)
- displacement = (s8)fetch_byte_imm();
- else
- displacement = 0;
- switch (rm) {
- case 0:
- DECODE_PRINTF2("%d[EAX]", displacement);
- return M.x86.R_EAX + displacement;
- case 1:
- DECODE_PRINTF2("%d[ECX]", displacement);
- return M.x86.R_ECX + displacement;
- case 2:
- DECODE_PRINTF2("%d[EDX]", displacement);
- return M.x86.R_EDX + displacement;
- case 3:
- DECODE_PRINTF2("%d[EBX]", displacement);
- return M.x86.R_EBX + displacement;
- case 4: {
- int offset = decode_sib_address(1);
- displacement = (s8)fetch_byte_imm();
- DECODE_PRINTF2("[%d]", displacement);
- return offset + displacement;
- }
- case 5:
- DECODE_PRINTF2("%d[EBP]", displacement);
- return M.x86.R_EBP + displacement;
- case 6:
- DECODE_PRINTF2("%d[ESI]", displacement);
- return M.x86.R_ESI + displacement;
- case 7:
- DECODE_PRINTF2("%d[EDI]", displacement);
- return M.x86.R_EDI + displacement;
- }
- } else {
- /* 16-bit addressing */
- displacement = (s8)fetch_byte_imm();
- switch (rm) {
- case 0:
- DECODE_PRINTF2("%d[BX+SI]", displacement);
- return (M.x86.R_BX + M.x86.R_SI + displacement) & 0xffff;
- case 1:
- DECODE_PRINTF2("%d[BX+DI]", displacement);
- return (M.x86.R_BX + M.x86.R_DI + displacement) & 0xffff;
- case 2:
- DECODE_PRINTF2("%d[BP+SI]", displacement);
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + M.x86.R_SI + displacement) & 0xffff;
- case 3:
- DECODE_PRINTF2("%d[BP+DI]", displacement);
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + M.x86.R_DI + displacement) & 0xffff;
- case 4:
- DECODE_PRINTF2("%d[SI]", displacement);
- return (M.x86.R_SI + displacement) & 0xffff;
- case 5:
- DECODE_PRINTF2("%d[DI]", displacement);
- return (M.x86.R_DI + displacement) & 0xffff;
- case 6:
- DECODE_PRINTF2("%d[BP]", displacement);
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + displacement) & 0xffff;
- case 7:
- DECODE_PRINTF2("%d[BX]", displacement);
- return (M.x86.R_BX + displacement) & 0xffff;
- }
- }
- HALT_SYS();
- return 0; /* SHOULD NOT HAPPEN */
- }
- /****************************************************************************
- PARAMETERS:
- rm - RM value to decode
- RETURNS:
- Offset in memory for the address decoding
- REMARKS:
- Return the offset given by mod=10 addressing. Also enables the
- decoding of instructions.
- ****************************************************************************/
- unsigned decode_rm10_address(
- int rm)
- {
- if (M.x86.mode & SYSMODE_PREFIX_ADDR) {
- int displacement;
- /* 32-bit addressing */
- if (rm != 4)
- displacement = (s32)fetch_long_imm();
- else
- displacement = 0;
- switch (rm) {
- case 0:
- DECODE_PRINTF2("%d[EAX]", displacement);
- return M.x86.R_EAX + displacement;
- case 1:
- DECODE_PRINTF2("%d[ECX]", displacement);
- return M.x86.R_ECX + displacement;
- case 2:
- DECODE_PRINTF2("%d[EDX]", displacement);
- return M.x86.R_EDX + displacement;
- case 3:
- DECODE_PRINTF2("%d[EBX]", displacement);
- return M.x86.R_EBX + displacement;
- case 4: {
- int offset = decode_sib_address(2);
- displacement = (s32)fetch_long_imm();
- DECODE_PRINTF2("[%d]", displacement);
- return offset + displacement;
- }
- case 5:
- DECODE_PRINTF2("%d[EBP]", displacement);
- return M.x86.R_EBP + displacement;
- case 6:
- DECODE_PRINTF2("%d[ESI]", displacement);
- return M.x86.R_ESI + displacement;
- case 7:
- DECODE_PRINTF2("%d[EDI]", displacement);
- return M.x86.R_EDI + displacement;
- }
- } else {
- int displacement = (s16)fetch_word_imm();
- /* 16-bit addressing */
- switch (rm) {
- case 0:
- DECODE_PRINTF2("%d[BX+SI]", displacement);
- return (M.x86.R_BX + M.x86.R_SI + displacement) & 0xffff;
- case 1:
- DECODE_PRINTF2("%d[BX+DI]", displacement);
- return (M.x86.R_BX + M.x86.R_DI + displacement) & 0xffff;
- case 2:
- DECODE_PRINTF2("%d[BP+SI]", displacement);
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + M.x86.R_SI + displacement) & 0xffff;
- case 3:
- DECODE_PRINTF2("%d[BP+DI]", displacement);
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + M.x86.R_DI + displacement) & 0xffff;
- case 4:
- DECODE_PRINTF2("%d[SI]", displacement);
- return (M.x86.R_SI + displacement) & 0xffff;
- case 5:
- DECODE_PRINTF2("%d[DI]", displacement);
- return (M.x86.R_DI + displacement) & 0xffff;
- case 6:
- DECODE_PRINTF2("%d[BP]", displacement);
- M.x86.mode |= SYSMODE_SEG_DS_SS;
- return (M.x86.R_BP + displacement) & 0xffff;
- case 7:
- DECODE_PRINTF2("%d[BX]", displacement);
- return (M.x86.R_BX + displacement) & 0xffff;
- }
- }
- HALT_SYS();
- return 0; /* SHOULD NOT HAPPEN */
- }
- /****************************************************************************
- PARAMETERS:
- mod - modifier
- rm - RM value to decode
- RETURNS:
- Offset in memory for the address decoding, multiplexing calls to
- the decode_rmXX_address functions
- REMARKS:
- Return the offset given by "mod" addressing.
- ****************************************************************************/
- unsigned decode_rmXX_address(int mod, int rm)
- {
- if(mod == 0)
- return decode_rm00_address(rm);
- if(mod == 1)
- return decode_rm01_address(rm);
- return decode_rm10_address(rm);
- }
|