fpu.c

uboot在arm处理器s3c2410的移植代码

/****************************************************************************
*
*						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 contains the code to implement the decoding and
*               emulation of the FPU instructions.
*
****************************************************************************/

#include "x86emu/x86emui.h"

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

/* opcode=0xd8 */
void x86emuOp_esc_coprocess_d8(u8 X86EMU_UNUSED(op1))
{
    START_OF_INSTR();
    DECODE_PRINTF("ESC D8\n");
    DECODE_CLEAR_SEGOVR();
    END_OF_INSTR_NO_TRACE();
}

#ifdef DEBUG

static char *x86emu_fpu_op_d9_tab[] = {
    "FLD\tDWORD PTR ", "ESC_D9\t", "FST\tDWORD PTR ", "FSTP\tDWORD PTR ",
    "FLDENV\t", "FLDCW\t", "FSTENV\t", "FSTCW\t",

    "FLD\tDWORD PTR ", "ESC_D9\t", "FST\tDWORD PTR ", "FSTP\tDWORD PTR ",
    "FLDENV\t", "FLDCW\t", "FSTENV\t", "FSTCW\t",

    "FLD\tDWORD PTR ", "ESC_D9\t", "FST\tDWORD PTR ", "FSTP\tDWORD PTR ",
    "FLDENV\t", "FLDCW\t", "FSTENV\t", "FSTCW\t",
};

static char *x86emu_fpu_op_d9_tab1[] = {
    "FLD\t", "FLD\t", "FLD\t", "FLD\t",
    "FLD\t", "FLD\t", "FLD\t", "FLD\t",

    "FXCH\t", "FXCH\t", "FXCH\t", "FXCH\t",
    "FXCH\t", "FXCH\t", "FXCH\t", "FXCH\t",

    "FNOP", "ESC_D9", "ESC_D9", "ESC_D9",
    "ESC_D9", "ESC_D9", "ESC_D9", "ESC_D9",

    "FSTP\t", "FSTP\t", "FSTP\t", "FSTP\t",
    "FSTP\t", "FSTP\t", "FSTP\t", "FSTP\t",

    "FCHS", "FABS", "ESC_D9", "ESC_D9",
    "FTST", "FXAM", "ESC_D9", "ESC_D9",

    "FLD1", "FLDL2T", "FLDL2E", "FLDPI",
    "FLDLG2", "FLDLN2", "FLDZ", "ESC_D9",

    "F2XM1", "FYL2X", "FPTAN", "FPATAN",
    "FXTRACT", "ESC_D9", "FDECSTP", "FINCSTP",

    "FPREM", "FYL2XP1", "FSQRT", "ESC_D9",
    "FRNDINT", "FSCALE", "ESC_D9", "ESC_D9",
};

#endif /* DEBUG */

/* opcode=0xd9 */
void x86emuOp_esc_coprocess_d9(u8 X86EMU_UNUSED(op1))
{
    int mod, rl, rh;
	uint destoffset;
    u8 stkelem;

    START_OF_INSTR();
    FETCH_DECODE_MODRM(mod, rh, rl);
#ifdef DEBUG
    if (mod != 3) {
	DECODE_PRINTINSTR32(x86emu_fpu_op_d9_tab, mod, rh, rl);
    } else {
	DECODE_PRINTF(x86emu_fpu_op_d9_tab1[(rh << 3) + rl]);
    }
#endif
    switch (mod) {
      case 0:
	destoffset = decode_rm00_address(rl);
	DECODE_PRINTF("\n");
	break;
      case 1:
	destoffset = decode_rm01_address(rl);
	DECODE_PRINTF("\n");
	break;
      case 2:
	destoffset = decode_rm10_address(rl);
	DECODE_PRINTF("\n");
	break;
      case 3:                   /* register to register */
		stkelem = (u8)rl;
		if (rh < 4) {
				DECODE_PRINTF2("ST(%d)\n", stkelem);
		} else {
				DECODE_PRINTF("\n");
		}
	break;
    }
#ifdef X86EMU_FPU_PRESENT
    /* execute */
    switch (mod) {
      case 3:
	switch (rh) {
	  case 0:
	    x86emu_fpu_R_fld(X86EMU_FPU_STKTOP, stkelem);
	    break;
	  case 1:
	    x86emu_fpu_R_fxch(X86EMU_FPU_STKTOP, stkelem);
	    break;
	  case 2:
	    switch (rl) {
	      case 0:
		x86emu_fpu_R_nop();
		break;
	      default:
		x86emu_fpu_illegal();
		break;
	    }
	  case 3:
	    x86emu_fpu_R_fstp(X86EMU_FPU_STKTOP, stkelem);
	    break;
	  case 4:
	    switch (rl) {
	    case 0:
		x86emu_fpu_R_fchs(X86EMU_FPU_STKTOP);
		break;
	    case 1:
		x86emu_fpu_R_fabs(X86EMU_FPU_STKTOP);
		break;
	    case 4:
		x86emu_fpu_R_ftst(X86EMU_FPU_STKTOP);
		break;
	    case 5:
		x86emu_fpu_R_fxam(X86EMU_FPU_STKTOP);
		break;
	    default:
		/* 2,3,6,7 */
		x86emu_fpu_illegal();
		break;
	    }
	    break;

	  case 5:
	    switch (rl) {
	      case 0:
		x86emu_fpu_R_fld1(X86EMU_FPU_STKTOP);
		break;
	      case 1:
		x86emu_fpu_R_fldl2t(X86EMU_FPU_STKTOP);
		break;
	      case 2:
		x86emu_fpu_R_fldl2e(X86EMU_FPU_STKTOP);
		break;
	      case 3:
		x86emu_fpu_R_fldpi(X86EMU_FPU_STKTOP);
		break;
	      case 4:
		x86emu_fpu_R_fldlg2(X86EMU_FPU_STKTOP);
		break;
	      case 5:
		x86emu_fpu_R_fldln2(X86EMU_FPU_STKTOP);
		break;
	      case 6:
		x86emu_fpu_R_fldz(X86EMU_FPU_STKTOP);
		break;
	      default:
		/* 7 */
		x86emu_fpu_illegal();
		break;
	    }
	    break;

	  case 6:
	    switch (rl) {
	      case 0:
		x86emu_fpu_R_f2xm1(X86EMU_FPU_STKTOP);
		break;
	      case 1:
		x86emu_fpu_R_fyl2x(X86EMU_FPU_STKTOP);
		break;
	      case 2:
		x86emu_fpu_R_fptan(X86EMU_FPU_STKTOP);
		break;
	      case 3:
		x86emu_fpu_R_fpatan(X86EMU_FPU_STKTOP);
		break;
	      case 4:
		x86emu_fpu_R_fxtract(X86EMU_FPU_STKTOP);
		break;
	      case 5:
		x86emu_fpu_illegal();
		break;
	      case 6:
		x86emu_fpu_R_decstp();
		break;
	      case 7:
		x86emu_fpu_R_incstp();
		break;
	    }
	    break;

	  case 7:
	    switch (rl) {
	      case 0:
		x86emu_fpu_R_fprem(X86EMU_FPU_STKTOP);
		break;
	      case 1:
		x86emu_fpu_R_fyl2xp1(X86EMU_FPU_STKTOP);
		break;
	      case 2:
		x86emu_fpu_R_fsqrt(X86EMU_FPU_STKTOP);
		break;
	      case 3:
		x86emu_fpu_illegal();
		break;
	      case 4:
		x86emu_fpu_R_frndint(X86EMU_FPU_STKTOP);
		break;
	      case 5:
		x86emu_fpu_R_fscale(X86EMU_FPU_STKTOP);
		break;
	      case 6:
	      case 7:
	      default:
		x86emu_fpu_illegal();
		break;
	    }
	    break;

	  default:
	    switch (rh) {
	      case 0:
		x86emu_fpu_M_fld(X86EMU_FPU_FLOAT, destoffset);
		break;
	      case 1:
		x86emu_fpu_illegal();
		break;
	      case 2:
		x86emu_fpu_M_fst(X86EMU_FPU_FLOAT, destoffset);
		break;
	      case 3:
		x86emu_fpu_M_fstp(X86EMU_FPU_FLOAT, destoffset);
		break;
	      case 4:
		x86emu_fpu_M_fldenv(X86EMU_FPU_WORD, destoffset);
		break;
	      case 5:
		x86emu_fpu_M_fldcw(X86EMU_FPU_WORD, destoffset);
		break;
	      case 6:
		x86emu_fpu_M_fstenv(X86EMU_FPU_WORD, destoffset);
		break;
	      case 7:
		x86emu_fpu_M_fstcw(X86EMU_FPU_WORD, destoffset);
		break;
	    }
	}
    }
#endif /* X86EMU_FPU_PRESENT */
    DECODE_CLEAR_SEGOVR();
    END_OF_INSTR_NO_TRACE();
}

#ifdef DEBUG

char *x86emu_fpu_op_da_tab[] = {
    "FIADD\tDWORD PTR ", "FIMUL\tDWORD PTR ", "FICOM\tDWORD PTR ",
    "FICOMP\tDWORD PTR ",
    "FISUB\tDWORD PTR ", "FISUBR\tDWORD PTR ", "FIDIV\tDWORD PTR ",
    "FIDIVR\tDWORD PTR ",

    "FIADD\tDWORD PTR ", "FIMUL\tDWORD PTR ", "FICOM\tDWORD PTR ",
    "FICOMP\tDWORD PTR ",
    "FISUB\tDWORD PTR ", "FISUBR\tDWORD PTR ", "FIDIV\tDWORD PTR ",
    "FIDIVR\tDWORD PTR ",

    "FIADD\tDWORD PTR ", "FIMUL\tDWORD PTR ", "FICOM\tDWORD PTR ",
    "FICOMP\tDWORD PTR ",
    "FISUB\tDWORD PTR ", "FISUBR\tDWORD PTR ", "FIDIV\tDWORD PTR ",
    "FIDIVR\tDWORD PTR ",

    "ESC_DA ", "ESC_DA ", "ESC_DA ", "ESC_DA ",
    "ESC_DA     ", "ESC_DA ", "ESC_DA   ", "ESC_DA ",
};

#endif /* DEBUG */

/* opcode=0xda */
void x86emuOp_esc_coprocess_da(u8 X86EMU_UNUSED(op1))
{
    int mod, rl, rh;
	uint destoffset;
    u8 stkelem;

    START_OF_INSTR();
    FETCH_DECODE_MODRM(mod, rh, rl);
    DECODE_PRINTINSTR32(x86emu_fpu_op_da_tab, mod, rh, rl);
    switch (mod) {
      case 0:
	destoffset = decode_rm00_address(rl);
	DECODE_PRINTF("\n");
	break;
      case 1:
	destoffset = decode_rm01_address(rl);
	DECODE_PRINTF("\n");
	break;
      case 2:
	destoffset = decode_rm10_address(rl);
	DECODE_PRINTF("\n");
	break;
      case 3:           /* register to register */
		stkelem = (u8)rl;
	DECODE_PRINTF2("\tST(%d),ST\n", stkelem);
	break;
    }
#ifdef X86EMU_FPU_PRESENT
    switch (mod) {
      case 3:
	x86emu_fpu_illegal();
	break;
      default:
	switch (rh) {
	  case 0:
	    x86emu_fpu_M_iadd(X86EMU_FPU_SHORT, destoffset);
	    break;
	  case 1:
	    x86emu_fpu_M_imul(X86EMU_FPU_SHORT, destoffset);
	    break;
	  case 2:
	    x86emu_fpu_M_icom(X86EMU_FPU_SHORT, destoffset);
	    break;
	  case 3:
	    x86emu_fpu_M_icomp(X86EMU_FPU_SHORT, destoffset);
	    break;
	  case 4:
	    x86emu_fpu_M_isub(X86EMU_FPU_SHORT, destoffset);
	    break;
	  case 5:
	    x86emu_fpu_M_isubr(X86EMU_FPU_SHORT, destoffset);
	    break;
	  case 6:
	    x86emu_fpu_M_idiv(X86EMU_FPU_SHORT, destoffset);
	    break;
	  case 7:
	    x86emu_fpu_M_idivr(X86EMU_FPU_SHORT, destoffset);
	    break;
	}
    }
#endif
    DECODE_CLEAR_SEGOVR();
    END_OF_INSTR_NO_TRACE();
}

#ifdef DEBUG

char *x86emu_fpu_op_db_tab[] = {
    "FILD\tDWORD PTR ", "ESC_DB\t19", "FIST\tDWORD PTR ", "FISTP\tDWORD PTR ",
    "ESC_DB\t1C", "FLD\tTBYTE PTR ", "ESC_DB\t1E", "FSTP\tTBYTE PTR ",

    "FILD\tDWORD PTR ", "ESC_DB\t19", "FIST\tDWORD PTR ", "FISTP\tDWORD PTR ",
    "ESC_DB\t1C", "FLD\tTBYTE PTR ", "ESC_DB\t1E", "FSTP\tTBYTE PTR ",

    "FILD\tDWORD PTR ", "ESC_DB\t19", "FIST\tDWORD PTR ", "FISTP\tDWORD PTR ",
    "ESC_DB\t1C", "FLD\tTBYTE PTR ", "ESC_DB\t1E", "FSTP\tTBYTE PTR ",
};

#endif /* DEBUG */

/* opcode=0xdb */
void x86emuOp_esc_coprocess_db(u8 X86EMU_UNUSED(op1))
{
    int mod, rl, rh;
	uint destoffset;

    START_OF_INSTR();
    FETCH_DECODE_MODRM(mod, rh, rl);
#ifdef DEBUG
    if (mod != 3) {
	DECODE_PRINTINSTR32(x86emu_fpu_op_db_tab, mod, rh, rl);
    } else if (rh == 4) {       /* === 11 10 0 nnn */
	switch (rl) {
	  case 0:
	    DECODE_PRINTF("FENI\n");
	    break;
	  case 1:
	    DECODE_PRINTF("FDISI\n");
	    break;
	  case 2:
	    DECODE_PRINTF("FCLEX\n");
	    break;
	  case 3:
	    DECODE_PRINTF("FINIT\n");
	    break;
	}
    } else {
	DECODE_PRINTF2("ESC_DB %0x\n", (mod << 6) + (rh << 3) + (rl));
    }
#endif /* DEBUG */
    switch (mod) {
      case 0:
	destoffset = decode_rm00_address(rl);
	break;
      case 1:
	destoffset = decode_rm01_address(rl);
	break;
      case 2:
	destoffset = decode_rm10_address(rl);
	break;
      case 3:                   /* register to register */
	break;
    }
#ifdef X86EMU_FPU_PRESENT
    /* execute */
    switch (mod) {
      case 3:
	switch (rh) {
	  case 4:
	    switch (rl) {
	      case 0:
		x86emu_fpu_R_feni();
		break;
	      case 1:
		x86emu_fpu_R_fdisi();
		break;
	      case 2:
		x86emu_fpu_R_fclex();
		break;
	      case 3:
		x86emu_fpu_R_finit();
		break;
	      default:
		x86emu_fpu_illegal();
		break;
	    }
	    break;
	  default:
	    x86emu_fpu_illegal();
	    break;
	}
	break;