873 lines
27 KiB
C++
873 lines
27 KiB
C++
/////////////////////////////////////////////////////////////////////////
|
|
// $Id: init.cc,v 1.100 2006-04-25 14:42:57 sshwarts Exp $
|
|
/////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// Copyright (C) 2001 MandrakeSoft S.A.
|
|
//
|
|
// MandrakeSoft S.A.
|
|
// 43, rue d'Aboukir
|
|
// 75002 Paris - France
|
|
// http://www.linux-mandrake.com/
|
|
// http://www.mandrakesoft.com/
|
|
//
|
|
// This library is free software; you can redistribute it and/or
|
|
// modify it under the terms of the GNU Lesser General Public
|
|
// License as published by the Free Software Foundation; either
|
|
// version 2 of the License, or (at your option) any later version.
|
|
//
|
|
// This library is distributed in the hope that it will be useful,
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
// Lesser General Public License for more details.
|
|
//
|
|
// You should have received a copy of the GNU Lesser General Public
|
|
// License along with this library; if not, write to the Free Software
|
|
// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
|
|
#define NEED_CPU_REG_SHORTCUTS 1
|
|
#include "bochs.h"
|
|
#include "cpu.h"
|
|
#define LOG_THIS BX_CPU_THIS_PTR
|
|
|
|
|
|
BX_CPU_C::BX_CPU_C(unsigned id): bx_cpuid(id)
|
|
#if BX_SUPPORT_APIC
|
|
,local_apic (this)
|
|
#endif
|
|
{
|
|
// in case of SMF, you cannot reference any member data
|
|
// in the constructor because the only access to it is via
|
|
// global variables which aren't initialized quite yet.
|
|
put("CPU");
|
|
settype (CPU0LOG);
|
|
}
|
|
|
|
#if BX_WITH_WX
|
|
|
|
#define IF_SEG_REG_GET(x) \
|
|
if (!strcmp(param->get_name(), #x)) { \
|
|
return BX_CPU(cpu)->sregs[BX_SEG_REG_##x].selector.value; \
|
|
}
|
|
#define IF_SEG_REG_SET(reg, val) \
|
|
if (!strcmp(param->get_name(), #reg)) { \
|
|
BX_CPU(cpu)->load_seg_reg(&BX_CPU(cpu)->sregs[BX_SEG_REG_##reg],val); \
|
|
}
|
|
#define IF_LAZY_EFLAG_GET(flag) \
|
|
if (!strcmp(param->get_name(), #flag)) { \
|
|
return BX_CPU(cpu)->get_##flag(); \
|
|
}
|
|
#define IF_LAZY_EFLAG_SET(flag, val) \
|
|
if (!strcmp(param->get_name(), #flag)) { \
|
|
BX_CPU(cpu)->set_##flag(val); \
|
|
}
|
|
#define IF_EFLAG_GET(flag) \
|
|
if (!strcmp(param->get_name(), #flag)) { \
|
|
return BX_CPU(cpu)->get_##flag(); \
|
|
}
|
|
#define IF_EFLAG_SET(flag, val) \
|
|
if (!strcmp(param->get_name(), #flag)) { \
|
|
BX_CPU(cpu)->set_##flag(val); \
|
|
}
|
|
|
|
|
|
// implement get/set handler for parameters that need unusual set/get
|
|
static Bit64s cpu_param_handler(bx_param_c *param, int set, Bit64s val)
|
|
{
|
|
#if BX_SUPPORT_SMP
|
|
int cpu = atoi(param->get_parent()->get_name());
|
|
#endif
|
|
if (set) {
|
|
if (!strcmp(param->get_name(), "LDTR")) {
|
|
BX_CPU(cpu)->panic("setting LDTR not implemented");
|
|
}
|
|
if (!strcmp(param->get_name(), "TR")) {
|
|
BX_CPU(cpu)->panic("setting LDTR not implemented");
|
|
}
|
|
IF_SEG_REG_SET(CS, val);
|
|
IF_SEG_REG_SET(DS, val);
|
|
IF_SEG_REG_SET(SS, val);
|
|
IF_SEG_REG_SET(ES, val);
|
|
IF_SEG_REG_SET(FS, val);
|
|
IF_SEG_REG_SET(GS, val);
|
|
IF_LAZY_EFLAG_SET(OF, val);
|
|
IF_LAZY_EFLAG_SET(SF, val);
|
|
IF_LAZY_EFLAG_SET(ZF, val);
|
|
IF_LAZY_EFLAG_SET(AF, val);
|
|
IF_LAZY_EFLAG_SET(PF, val);
|
|
IF_LAZY_EFLAG_SET(CF, val);
|
|
IF_EFLAG_SET(ID, val);
|
|
IF_EFLAG_SET(VIP, val);
|
|
IF_EFLAG_SET(VIF, val);
|
|
IF_EFLAG_SET(AC, val);
|
|
IF_EFLAG_SET(VM, val);
|
|
IF_EFLAG_SET(RF, val);
|
|
IF_EFLAG_SET(NT, val);
|
|
IF_EFLAG_SET(IOPL, val);
|
|
IF_EFLAG_SET(DF, val);
|
|
IF_EFLAG_SET(IF, val);
|
|
IF_EFLAG_SET(TF, val);
|
|
} else {
|
|
if (!strcmp(param->get_name(), "LDTR")) {
|
|
return BX_CPU(cpu)->ldtr.selector.value;
|
|
}
|
|
if (!strcmp(param->get_name(), "TR")) {
|
|
return BX_CPU(cpu)->tr.selector.value;
|
|
}
|
|
IF_SEG_REG_GET (CS);
|
|
IF_SEG_REG_GET (DS);
|
|
IF_SEG_REG_GET (SS);
|
|
IF_SEG_REG_GET (ES);
|
|
IF_SEG_REG_GET (FS);
|
|
IF_SEG_REG_GET (GS);
|
|
IF_LAZY_EFLAG_GET(OF);
|
|
IF_LAZY_EFLAG_GET(SF);
|
|
IF_LAZY_EFLAG_GET(ZF);
|
|
IF_LAZY_EFLAG_GET(AF);
|
|
IF_LAZY_EFLAG_GET(PF);
|
|
IF_LAZY_EFLAG_GET(CF);
|
|
IF_EFLAG_GET(ID);
|
|
IF_EFLAG_GET(VIP);
|
|
IF_EFLAG_GET(VIF);
|
|
IF_EFLAG_GET(AC);
|
|
IF_EFLAG_GET(VM);
|
|
IF_EFLAG_GET(RF);
|
|
IF_EFLAG_GET(NT);
|
|
IF_EFLAG_GET(IOPL);
|
|
IF_EFLAG_GET(DF);
|
|
IF_EFLAG_GET(IF);
|
|
IF_EFLAG_GET(TF);
|
|
}
|
|
return val;
|
|
}
|
|
#undef IF_SEG_REG_GET
|
|
#undef IF_SEG_REG_SET
|
|
|
|
#endif
|
|
|
|
void BX_CPU_C::initialize(BX_MEM_C *addrspace)
|
|
{
|
|
// BX_CPU_C constructor
|
|
BX_CPU_THIS_PTR set_INTR (0);
|
|
|
|
#if BX_SUPPORT_APIC
|
|
BX_CPU_THIS_PTR local_apic.set_id(BX_CPU_ID);
|
|
BX_CPU_THIS_PTR local_apic.init();
|
|
#endif
|
|
|
|
// in SMP mode, the prefix of the CPU will be changed to [CPUn] in
|
|
// bx_local_apic_c::set_id as soon as the apic ID is assigned.
|
|
|
|
/* hack for the following fields. Its easier to decode mod-rm bytes if
|
|
you can assume there's always a base & index register used. For
|
|
modes which don't really use them, point to an empty (zeroed) register.
|
|
*/
|
|
empty_register = 0;
|
|
|
|
// 16bit address mode base register, used for mod-rm decoding
|
|
|
|
_16bit_base_reg[0] = &gen_reg[BX_16BIT_REG_BX].word.rx;
|
|
_16bit_base_reg[1] = &gen_reg[BX_16BIT_REG_BX].word.rx;
|
|
_16bit_base_reg[2] = &gen_reg[BX_16BIT_REG_BP].word.rx;
|
|
_16bit_base_reg[3] = &gen_reg[BX_16BIT_REG_BP].word.rx;
|
|
_16bit_base_reg[4] = (Bit16u*) &empty_register;
|
|
_16bit_base_reg[5] = (Bit16u*) &empty_register;
|
|
_16bit_base_reg[6] = &gen_reg[BX_16BIT_REG_BP].word.rx;
|
|
_16bit_base_reg[7] = &gen_reg[BX_16BIT_REG_BX].word.rx;
|
|
|
|
// 16bit address mode index register, used for mod-rm decoding
|
|
_16bit_index_reg[0] = &gen_reg[BX_16BIT_REG_SI].word.rx;
|
|
_16bit_index_reg[1] = &gen_reg[BX_16BIT_REG_DI].word.rx;
|
|
_16bit_index_reg[2] = &gen_reg[BX_16BIT_REG_SI].word.rx;
|
|
_16bit_index_reg[3] = &gen_reg[BX_16BIT_REG_DI].word.rx;
|
|
_16bit_index_reg[4] = &gen_reg[BX_16BIT_REG_SI].word.rx;
|
|
_16bit_index_reg[5] = &gen_reg[BX_16BIT_REG_DI].word.rx;
|
|
_16bit_index_reg[6] = (Bit16u*) &empty_register;
|
|
_16bit_index_reg[7] = (Bit16u*) &empty_register;
|
|
|
|
// <TAG-INIT-CPU-START>
|
|
// for decoding instructions: access to seg reg's via index number
|
|
sreg_mod00_rm16[0] = BX_SEG_REG_DS;
|
|
sreg_mod00_rm16[1] = BX_SEG_REG_DS;
|
|
sreg_mod00_rm16[2] = BX_SEG_REG_SS;
|
|
sreg_mod00_rm16[3] = BX_SEG_REG_SS;
|
|
sreg_mod00_rm16[4] = BX_SEG_REG_DS;
|
|
sreg_mod00_rm16[5] = BX_SEG_REG_DS;
|
|
sreg_mod00_rm16[6] = BX_SEG_REG_DS;
|
|
sreg_mod00_rm16[7] = BX_SEG_REG_DS;
|
|
|
|
sreg_mod01or10_rm16[0] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm16[1] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm16[2] = BX_SEG_REG_SS;
|
|
sreg_mod01or10_rm16[3] = BX_SEG_REG_SS;
|
|
sreg_mod01or10_rm16[4] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm16[5] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm16[6] = BX_SEG_REG_SS;
|
|
sreg_mod01or10_rm16[7] = BX_SEG_REG_DS;
|
|
|
|
// the default segment to use for a one-byte modrm with
|
|
// mod==01b or mod==10b and rm == i
|
|
sreg_mod01or10_rm32[0] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[1] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[2] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[3] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[4] = BX_SEG_REG_NULL;
|
|
// this entry should never be accessed
|
|
// (escape to 2-byte)
|
|
sreg_mod01or10_rm32[5] = BX_SEG_REG_SS;
|
|
sreg_mod01or10_rm32[6] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[7] = BX_SEG_REG_DS;
|
|
#if BX_SUPPORT_X86_64
|
|
sreg_mod01or10_rm32[8] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[9] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[10] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[11] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[12] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[13] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[14] = BX_SEG_REG_DS;
|
|
sreg_mod01or10_rm32[15] = BX_SEG_REG_DS;
|
|
#endif
|
|
|
|
// the default segment to use for a two-byte modrm with
|
|
// mod==00b and base == i
|
|
sreg_mod0_base32[0] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[1] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[2] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[3] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[4] = BX_SEG_REG_SS;
|
|
sreg_mod0_base32[5] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[6] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[7] = BX_SEG_REG_DS;
|
|
#if BX_SUPPORT_X86_64
|
|
sreg_mod0_base32[8] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[9] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[10] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[11] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[12] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[13] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[14] = BX_SEG_REG_DS;
|
|
sreg_mod0_base32[15] = BX_SEG_REG_DS;
|
|
#endif
|
|
|
|
// the default segment to use for a two-byte modrm with
|
|
// mod==01b or mod==10b and base == i
|
|
sreg_mod1or2_base32[0] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[1] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[2] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[3] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[4] = BX_SEG_REG_SS;
|
|
sreg_mod1or2_base32[5] = BX_SEG_REG_SS;
|
|
sreg_mod1or2_base32[6] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[7] = BX_SEG_REG_DS;
|
|
#if BX_SUPPORT_X86_64
|
|
sreg_mod1or2_base32[8] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[9] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[10] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[11] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[12] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[13] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[14] = BX_SEG_REG_DS;
|
|
sreg_mod1or2_base32[15] = BX_SEG_REG_DS;
|
|
#endif
|
|
// <TAG-INIT-CPU-END>
|
|
|
|
mem = addrspace;
|
|
sprintf(name, "CPU %d", BX_CPU_ID);
|
|
|
|
#if BX_WITH_WX
|
|
static bx_bool counter = 0;
|
|
if (counter < BX_MAX_SMP_THREADS_SUPPORTED) {
|
|
// Register some of the CPUs variables as shadow parameters so that
|
|
// they can be visible in the config interface.
|
|
// (Experimental, obviously not a complete list)
|
|
bx_param_num_c *param;
|
|
char cpu_name[10], cpu_title[10];
|
|
const char *fmt16 = "%04X";
|
|
const char *fmt32 = "%08X";
|
|
Bit32u oldbase = bx_param_num_c::set_default_base(16);
|
|
const char *oldfmt = bx_param_num_c::set_default_format(fmt32);
|
|
sprintf(cpu_name, "%d", BX_CPU_ID);
|
|
sprintf(cpu_title, "CPU %d", BX_CPU_ID);
|
|
bx_list_c *list = new bx_list_c(SIM->get_param(BXPN_WX_CPU_STATE), strdup(cpu_name),
|
|
cpu_title, 60);
|
|
#define DEFPARAM_NORMAL(name,field) \
|
|
new bx_shadow_num_c(list, #name, #name, &(field))
|
|
|
|
DEFPARAM_NORMAL(EAX, EAX);
|
|
DEFPARAM_NORMAL(EBX, EBX);
|
|
DEFPARAM_NORMAL(ECX, ECX);
|
|
DEFPARAM_NORMAL(EDX, EDX);
|
|
DEFPARAM_NORMAL(ESP, ESP);
|
|
DEFPARAM_NORMAL(EBP, EBP);
|
|
DEFPARAM_NORMAL(ESI, ESI);
|
|
DEFPARAM_NORMAL(EDI, EDI);
|
|
DEFPARAM_NORMAL(EIP, EIP);
|
|
DEFPARAM_NORMAL(DR0, dr0);
|
|
DEFPARAM_NORMAL(DR1, dr1);
|
|
DEFPARAM_NORMAL(DR2, dr2);
|
|
DEFPARAM_NORMAL(DR3, dr3);
|
|
DEFPARAM_NORMAL(DR6, dr6);
|
|
DEFPARAM_NORMAL(DR7, dr7);
|
|
#if BX_SUPPORT_X86_64==0
|
|
#if BX_CPU_LEVEL >= 2
|
|
DEFPARAM_NORMAL(CR0, cr0.val32);
|
|
DEFPARAM_NORMAL(CR1, cr1);
|
|
DEFPARAM_NORMAL(CR2, cr2);
|
|
DEFPARAM_NORMAL(CR3, cr3);
|
|
#endif
|
|
#if BX_CPU_LEVEL >= 4
|
|
DEFPARAM_NORMAL(CR4, cr4.registerValue);
|
|
#endif
|
|
#endif // #if BX_SUPPORT_X86_64==0
|
|
|
|
// segment registers require a handler function because they have
|
|
// special get/set requirements.
|
|
#define DEFPARAM_SEG_REG(x) \
|
|
param = new bx_param_num_c(list, \
|
|
#x, #x, "", 0, 0xffff, 0); \
|
|
param->set_handler(cpu_param_handler); \
|
|
param->set_format(fmt16);
|
|
#define DEFPARAM_GLOBAL_SEG_REG(name,field) \
|
|
param = new bx_shadow_num_c(list, \
|
|
#name"_base", #name" base", \
|
|
& BX_CPU_THIS_PTR field.base); \
|
|
param = new bx_shadow_num_c(list, \
|
|
#name"_limit", #name" limit", \
|
|
& BX_CPU_THIS_PTR field.limit);
|
|
|
|
DEFPARAM_SEG_REG(CS);
|
|
DEFPARAM_SEG_REG(DS);
|
|
DEFPARAM_SEG_REG(SS);
|
|
DEFPARAM_SEG_REG(ES);
|
|
DEFPARAM_SEG_REG(FS);
|
|
DEFPARAM_SEG_REG(GS);
|
|
DEFPARAM_SEG_REG(LDTR);
|
|
DEFPARAM_SEG_REG(TR);
|
|
DEFPARAM_GLOBAL_SEG_REG(GDTR, gdtr);
|
|
DEFPARAM_GLOBAL_SEG_REG(IDTR, idtr);
|
|
#undef DEFPARAM_SEG_REG
|
|
#undef DEFPARAM_GLOBAL_SEG_REG
|
|
|
|
#if BX_SUPPORT_X86_64==0
|
|
param = new bx_shadow_num_c(list, "EFLAGS", "EFLAGS",
|
|
&BX_CPU_THIS_PTR eflags.val32);
|
|
#endif
|
|
|
|
// flags implemented in lazy_flags.cc must be done with a handler
|
|
// that calls their get function, to force them to be computed.
|
|
#define DEFPARAM_EFLAG(name) \
|
|
param = new bx_param_bool_c(list, \
|
|
#name, #name, "", get_##name()); \
|
|
param->set_handler(cpu_param_handler);
|
|
#define DEFPARAM_LAZY_EFLAG(name) \
|
|
param = new bx_param_bool_c(list, \
|
|
#name, #name, "", get_##name()); \
|
|
param->set_handler(cpu_param_handler);
|
|
|
|
#if BX_CPU_LEVEL >= 4
|
|
DEFPARAM_EFLAG(ID);
|
|
DEFPARAM_EFLAG(VIP);
|
|
DEFPARAM_EFLAG(VIF);
|
|
DEFPARAM_EFLAG(AC);
|
|
#endif
|
|
#if BX_CPU_LEVEL >= 3
|
|
DEFPARAM_EFLAG(VM);
|
|
DEFPARAM_EFLAG(RF);
|
|
#endif
|
|
#if BX_CPU_LEVEL >= 2
|
|
DEFPARAM_EFLAG(NT);
|
|
// IOPL is a special case because it is 2 bits wide.
|
|
param = new bx_shadow_num_c(
|
|
list,
|
|
"IOPL", "IOPL",
|
|
&eflags.val32, 10,
|
|
12, 13);
|
|
param->set_range(0, 3);
|
|
#if BX_SUPPORT_X86_64==0
|
|
param->set_format("%d");
|
|
#endif
|
|
#endif
|
|
DEFPARAM_LAZY_EFLAG(OF);
|
|
DEFPARAM_EFLAG(DF);
|
|
DEFPARAM_EFLAG(IF);
|
|
DEFPARAM_EFLAG(TF);
|
|
DEFPARAM_LAZY_EFLAG(SF);
|
|
DEFPARAM_LAZY_EFLAG(ZF);
|
|
DEFPARAM_LAZY_EFLAG(AF);
|
|
DEFPARAM_LAZY_EFLAG(PF);
|
|
DEFPARAM_LAZY_EFLAG(CF);
|
|
|
|
// restore defaults
|
|
bx_param_num_c::set_default_base(oldbase);
|
|
bx_param_num_c::set_default_format(oldfmt);
|
|
|
|
counter++;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
BX_CPU_C::~BX_CPU_C(void)
|
|
{
|
|
BX_INSTR_SHUTDOWN(BX_CPU_ID);
|
|
BX_DEBUG(( "Exit."));
|
|
}
|
|
|
|
void BX_CPU_C::reset(unsigned source)
|
|
{
|
|
UNUSED(source); // either BX_RESET_HARDWARE or BX_RESET_SOFTWARE
|
|
|
|
#if BX_SUPPORT_X86_64
|
|
RAX = 0; // processor passed test :-)
|
|
RBX = 0;
|
|
RCX = 0;
|
|
RDX = get_cpu_version_information();
|
|
RBP = 0;
|
|
RSI = 0;
|
|
RDI = 0;
|
|
RSP = 0;
|
|
R8 = 0;
|
|
R9 = 0;
|
|
R10 = 0;
|
|
R11 = 0;
|
|
R12 = 0;
|
|
R13 = 0;
|
|
R14 = 0;
|
|
R15 = 0;
|
|
#else
|
|
// general registers
|
|
EAX = 0; // processor passed test :-)
|
|
EBX = 0;
|
|
ECX = 0;
|
|
EDX = get_cpu_version_information();
|
|
EBP = 0;
|
|
ESI = 0;
|
|
EDI = 0;
|
|
ESP = 0;
|
|
#endif
|
|
|
|
// all status flags at known values, use BX_CPU_THIS_PTR eflags structure
|
|
BX_CPU_THIS_PTR lf_flags_status = 0x000000;
|
|
|
|
// status and control flags register set
|
|
BX_CPU_THIS_PTR setEFlags(0x2); // Bit1 is always set
|
|
BX_CPU_THIS_PTR clear_IF ();
|
|
#if BX_CPU_LEVEL >= 3
|
|
BX_CPU_THIS_PTR clear_RF ();
|
|
BX_CPU_THIS_PTR clear_VM ();
|
|
#endif
|
|
#if BX_CPU_LEVEL >= 4
|
|
BX_CPU_THIS_PTR clear_AC ();
|
|
#endif
|
|
|
|
BX_CPU_THIS_PTR inhibit_mask = 0;
|
|
BX_CPU_THIS_PTR debug_trap = 0;
|
|
|
|
/* instruction pointer */
|
|
#if BX_CPU_LEVEL < 2
|
|
BX_CPU_THIS_PTR prev_eip = EIP = 0x00000000;
|
|
#else /* from 286 up */
|
|
BX_CPU_THIS_PTR prev_eip =
|
|
#if BX_SUPPORT_X86_64
|
|
RIP = 0x0000FFF0;
|
|
#else
|
|
EIP = 0x0000FFF0;
|
|
#endif
|
|
#endif
|
|
|
|
/* CS (Code Segment) and descriptor cache */
|
|
/* Note: on a real cpu, CS initially points to upper memory. After
|
|
* the 1st jump, the descriptor base is zero'd out. Since I'm just
|
|
* going to jump to my BIOS, I don't need to do this.
|
|
* For future reference:
|
|
* processor cs.selector cs.base cs.limit EIP
|
|
* 8086 FFFF FFFF0 FFFF 0000
|
|
* 286 F000 FF0000 FFFF FFF0
|
|
* 386+ F000 FFFF0000 FFFF FFF0
|
|
*/
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].selector.value = 0xF000;
|
|
#if BX_CPU_LEVEL >= 2
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].selector.index = 0;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].selector.ti = 0;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].selector.rpl = 0;
|
|
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.valid = 1;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.p = 1;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.dpl = 0;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.segment = 1; /* data/code segment */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.type = 11; /* executable/readable/access code segment */
|
|
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.executable = 1; /* data/stack segment */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.c_ed = 0; /* normal expand up */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.r_w = 1; /* writeable */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.a = 1; /* accessed */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.base = 0xFFFF0000;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.limit = 0xFFFF;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.limit_scaled = 0xFFFF;
|
|
#endif
|
|
#if BX_CPU_LEVEL >= 3
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.g = 0; /* byte granular */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.d_b = 0; /* 16bit default size */
|
|
#if BX_SUPPORT_X86_64
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.l = 0; /* 16bit default size */
|
|
#endif
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.avl = 0;
|
|
#endif
|
|
|
|
#if BX_SUPPORT_ICACHE
|
|
BX_CPU_THIS_PTR updateFetchModeMask();
|
|
#endif
|
|
|
|
/* DS (Data Segment) and descriptor cache */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].selector.value = 0x0000;
|
|
#if BX_CPU_LEVEL >= 2
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].selector.index = 0;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].selector.ti = 0;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].selector.rpl = 0;
|
|
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.valid = 1;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.p = 1;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.dpl = 0;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.segment = 1; /* data/code segment */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.type = 3; /* read/write/access */
|
|
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.executable = 0; /* data/stack segment */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.c_ed = 0; /* normal expand up */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.r_w = 1; /* writeable */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.a = 1; /* accessed */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.base = 0x00000000;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.limit = 0xFFFF;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.limit_scaled = 0xFFFF;
|
|
#endif
|
|
#if BX_CPU_LEVEL >= 3
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.avl = 0;
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.g = 0; /* byte granular */
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.d_b = 0; /* 16bit default size */
|
|
#if BX_SUPPORT_X86_64
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS].cache.u.segment.l = 0; /* 16bit default size */
|
|
#endif
|
|
#endif
|
|
|
|
// use DS segment as template for the others
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_SS] = BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS];
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_ES] = BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS];
|
|
#if BX_CPU_LEVEL >= 3
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_FS] = BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS];
|
|
BX_CPU_THIS_PTR sregs[BX_SEG_REG_GS] = BX_CPU_THIS_PTR sregs[BX_SEG_REG_DS];
|
|
#endif
|
|
|
|
#if BX_CPU_LEVEL >= 2
|
|
/* GDTR (Global Descriptor Table Register) */
|
|
BX_CPU_THIS_PTR gdtr.base = 0x00000000;
|
|
BX_CPU_THIS_PTR gdtr.limit = 0xFFFF;
|
|
|
|
/* IDTR (Interrupt Descriptor Table Register) */
|
|
BX_CPU_THIS_PTR idtr.base = 0x00000000;
|
|
BX_CPU_THIS_PTR idtr.limit = 0xFFFF; /* always byte granular */
|
|
|
|
/* LDTR (Local Descriptor Table Register) */
|
|
BX_CPU_THIS_PTR ldtr.selector.value = 0x0000;
|
|
BX_CPU_THIS_PTR ldtr.selector.index = 0x0000;
|
|
BX_CPU_THIS_PTR ldtr.selector.ti = 0;
|
|
BX_CPU_THIS_PTR ldtr.selector.rpl = 0;
|
|
|
|
BX_CPU_THIS_PTR ldtr.cache.valid = 1; /* valid */
|
|
BX_CPU_THIS_PTR ldtr.cache.p = 1; /* present */
|
|
BX_CPU_THIS_PTR ldtr.cache.dpl = 0; /* field not used */
|
|
BX_CPU_THIS_PTR ldtr.cache.segment = 0; /* system segment */
|
|
BX_CPU_THIS_PTR ldtr.cache.type = 2; /* LDT descriptor */
|
|
|
|
BX_CPU_THIS_PTR ldtr.cache.u.ldt.base = 0x00000000;
|
|
BX_CPU_THIS_PTR ldtr.cache.u.ldt.limit = 0xFFFF;
|
|
|
|
/* TR (Task Register) */
|
|
BX_CPU_THIS_PTR tr.selector.value = 0x0000;
|
|
BX_CPU_THIS_PTR tr.selector.index = 0x0000; /* undefined */
|
|
BX_CPU_THIS_PTR tr.selector.ti = 0;
|
|
BX_CPU_THIS_PTR tr.selector.rpl = 0;
|
|
|
|
BX_CPU_THIS_PTR tr.cache.valid = 1; /* valid */
|
|
BX_CPU_THIS_PTR tr.cache.p = 1; /* present */
|
|
BX_CPU_THIS_PTR tr.cache.dpl = 0; /* field not used */
|
|
BX_CPU_THIS_PTR tr.cache.segment = 0; /* system segment */
|
|
BX_CPU_THIS_PTR tr.cache.type = 3; /* busy 16-bit TSS */
|
|
BX_CPU_THIS_PTR tr.cache.u.tss286.base = 0x00000000;
|
|
BX_CPU_THIS_PTR tr.cache.u.tss286.limit = 0xFFFF;
|
|
#endif
|
|
|
|
// DR0 - DR7 (Debug Registers)
|
|
#if BX_CPU_LEVEL >= 3
|
|
BX_CPU_THIS_PTR dr0 = 0; /* undefined */
|
|
BX_CPU_THIS_PTR dr1 = 0; /* undefined */
|
|
BX_CPU_THIS_PTR dr2 = 0; /* undefined */
|
|
BX_CPU_THIS_PTR dr3 = 0; /* undefined */
|
|
#endif
|
|
|
|
BX_CPU_THIS_PTR dr7 = 0x00000400;
|
|
#if BX_CPU_LEVEL == 3
|
|
BX_CPU_THIS_PTR dr6 = 0xFFFF1FF0;
|
|
#elif BX_CPU_LEVEL == 4
|
|
BX_CPU_THIS_PTR dr6 = 0xFFFF1FF0;
|
|
#elif BX_CPU_LEVEL == 5
|
|
BX_CPU_THIS_PTR dr6 = 0xFFFF0FF0;
|
|
#elif BX_CPU_LEVEL == 6
|
|
BX_CPU_THIS_PTR dr6 = 0xFFFF0FF0;
|
|
#else
|
|
# error "DR6: CPU > 6"
|
|
#endif
|
|
|
|
BX_CPU_THIS_PTR cpu_mode = BX_MODE_IA32_REAL;
|
|
|
|
BX_CPU_THIS_PTR smi_pending = 0;
|
|
BX_CPU_THIS_PTR nmi_pending = 0;
|
|
BX_CPU_THIS_PTR in_smm = 0;
|
|
BX_CPU_THIS_PTR nmi_disable = 0;
|
|
|
|
BX_CPU_THIS_PTR smbase = 0x30000;
|
|
|
|
#if BX_CPU_LEVEL >= 2
|
|
// MSW (Machine Status Word), so called on 286
|
|
// CR0 (Control Register 0), so called on 386+
|
|
BX_CPU_THIS_PTR cr0.ts = 0; // no task switch
|
|
BX_CPU_THIS_PTR cr0.em = 0; // emulate math coprocessor
|
|
BX_CPU_THIS_PTR cr0.mp = 0; // wait instructions not trapped
|
|
BX_CPU_THIS_PTR cr0.pe = 0; // real mode
|
|
BX_CPU_THIS_PTR cr0.val32 = 0;
|
|
|
|
#if BX_CPU_LEVEL >= 3
|
|
BX_CPU_THIS_PTR cr0.pg = 0; // paging disabled
|
|
// no change to cr0.val32
|
|
#endif
|
|
|
|
#if BX_CPU_LEVEL >= 4
|
|
BX_CPU_THIS_PTR cr0.cd = 0;
|
|
BX_CPU_THIS_PTR cr0.nw = 0;
|
|
BX_CPU_THIS_PTR cr0.am = 0; // disable alignment check
|
|
BX_CPU_THIS_PTR cr0.wp = 0; // disable write-protect
|
|
BX_CPU_THIS_PTR cr0.ne = 0; // np exceptions through int 13H, DOS compat
|
|
BX_CPU_THIS_PTR cr0.val32 |= 0x00000000;
|
|
#endif
|
|
|
|
// handle reserved bits
|
|
#if BX_CPU_LEVEL == 3
|
|
// reserved bits all set to 1 on 386
|
|
BX_CPU_THIS_PTR cr0.val32 |= 0x7ffffff0;
|
|
#elif BX_CPU_LEVEL >= 4
|
|
// bit 4 is hardwired to 1 on all x86
|
|
BX_CPU_THIS_PTR cr0.val32 |= 0x00000010;
|
|
#endif
|
|
#endif // CPU >= 2
|
|
|
|
// CR0 paging might be modified
|
|
TLB_flush(1);
|
|
|
|
#if BX_CPU_LEVEL >= 3
|
|
BX_CPU_THIS_PTR cr2 = 0;
|
|
BX_CPU_THIS_PTR cr3 = 0;
|
|
BX_CPU_THIS_PTR cr3_masked = 0;
|
|
#endif
|
|
#if BX_CPU_LEVEL >= 4
|
|
BX_CPU_THIS_PTR cr4.setRegister(0);
|
|
#endif
|
|
|
|
/* initialise MSR registers to defaults */
|
|
#if BX_CPU_LEVEL >= 5
|
|
#if BX_SUPPORT_APIC
|
|
/* APIC Address, APIC enabled and BSP is default, we'll fill in the rest later */
|
|
BX_CPU_THIS_PTR msr.apicbase = BX_LAPIC_BASE_ADDR;
|
|
BX_CPU_THIS_PTR local_apic.init();
|
|
BX_CPU_THIS_PTR msr.apicbase |= 0x900;
|
|
#endif
|
|
#if BX_SUPPORT_X86_64
|
|
BX_CPU_THIS_PTR msr.lme = BX_CPU_THIS_PTR msr.lma = 0;
|
|
#endif
|
|
BX_CPU_THIS_PTR set_TSC(0);
|
|
#endif
|
|
|
|
BX_CPU_THIS_PTR EXT = 0;
|
|
|
|
#if BX_SUPPORT_PAGING
|
|
#if BX_USE_TLB
|
|
TLB_init();
|
|
#endif // BX_USE_TLB
|
|
#endif // BX_SUPPORT_PAGING
|
|
|
|
// invalidate the prefetch queue
|
|
BX_CPU_THIS_PTR eipPageBias = 0;
|
|
BX_CPU_THIS_PTR eipPageWindowSize = 0;
|
|
BX_CPU_THIS_PTR eipFetchPtr = NULL;
|
|
|
|
#if BX_DEBUGGER
|
|
#if BX_MAGIC_BREAKPOINT
|
|
BX_CPU_THIS_PTR magic_break = 0;
|
|
#endif
|
|
BX_CPU_THIS_PTR stop_reason = STOP_NO_REASON;
|
|
BX_CPU_THIS_PTR trace_reg = 0;
|
|
BX_CPU_THIS_PTR dbg_cpu_mode = BX_CPU_THIS_PTR cpu_mode;
|
|
#endif
|
|
|
|
BX_CPU_THIS_PTR trace = 0;
|
|
|
|
// Reset the Floating Point Unit
|
|
#if BX_SUPPORT_FPU
|
|
BX_CPU_THIS_PTR the_i387.reset(); // unchanged on #INIT
|
|
#endif
|
|
|
|
// Reset XMM state
|
|
#if BX_SUPPORT_SSE >= 1 // unchanged on #INIT
|
|
for(unsigned index=0; index < BX_XMM_REGISTERS; index++)
|
|
{
|
|
BX_CPU_THIS_PTR xmm[index].xmm64u(0) = 0;
|
|
BX_CPU_THIS_PTR xmm[index].xmm64u(1) = 0;
|
|
}
|
|
|
|
BX_CPU_THIS_PTR mxcsr.mxcsr = MXCSR_RESET;
|
|
#endif
|
|
|
|
#if BX_SUPPORT_SMP
|
|
// notice if I'm the bootstrap processor. If not, do the equivalent of
|
|
// a HALT instruction.
|
|
int apic_id = local_apic.get_id();
|
|
if (BX_BOOTSTRAP_PROCESSOR == apic_id) {
|
|
// boot normally
|
|
BX_CPU_THIS_PTR msr.apicbase |= 0x0100; /* set bit 8 BSP */
|
|
BX_INFO(("CPU[%d] is the bootstrap processor", apic_id));
|
|
} else {
|
|
// it's an application processor, halt until IPI is heard.
|
|
BX_CPU_THIS_PTR msr.apicbase &= ~0x0100; /* clear bit 8 BSP */
|
|
BX_INFO(("CPU[%d] is an application processor. Halting until IPI.", apic_id));
|
|
debug_trap |= BX_DEBUG_TRAP_HALT_STATE;
|
|
async_event = 1;
|
|
}
|
|
#endif
|
|
|
|
BX_INSTR_RESET(BX_CPU_ID);
|
|
}
|
|
|
|
void BX_CPU_C::sanity_checks(void)
|
|
{
|
|
Bit8u al, cl, dl, bl, ah, ch, dh, bh;
|
|
Bit16u ax, cx, dx, bx, sp, bp, si, di;
|
|
Bit32u eax, ecx, edx, ebx, esp, ebp, esi, edi;
|
|
|
|
EAX = 0xFFEEDDCC;
|
|
ECX = 0xBBAA9988;
|
|
EDX = 0x77665544;
|
|
EBX = 0x332211FF;
|
|
ESP = 0xEEDDCCBB;
|
|
EBP = 0xAA998877;
|
|
ESI = 0x66554433;
|
|
EDI = 0x2211FFEE;
|
|
|
|
al = AL;
|
|
cl = CL;
|
|
dl = DL;
|
|
bl = BL;
|
|
ah = AH;
|
|
ch = CH;
|
|
dh = DH;
|
|
bh = BH;
|
|
|
|
if ( al != (EAX & 0xFF) ||
|
|
cl != (ECX & 0xFF) ||
|
|
dl != (EDX & 0xFF) ||
|
|
bl != (EBX & 0xFF) ||
|
|
ah != ((EAX >> 8) & 0xFF) ||
|
|
ch != ((ECX >> 8) & 0xFF) ||
|
|
dh != ((EDX >> 8) & 0xFF) ||
|
|
bh != ((EBX >> 8) & 0xFF) )
|
|
{
|
|
BX_PANIC(("problems using BX_READ_8BIT_REGx()!"));
|
|
}
|
|
|
|
ax = AX;
|
|
cx = CX;
|
|
dx = DX;
|
|
bx = BX;
|
|
sp = SP;
|
|
bp = BP;
|
|
si = SI;
|
|
di = DI;
|
|
|
|
if ( ax != (EAX & 0xFFFF) ||
|
|
cx != (ECX & 0xFFFF) ||
|
|
dx != (EDX & 0xFFFF) ||
|
|
bx != (EBX & 0xFFFF) ||
|
|
sp != (ESP & 0xFFFF) ||
|
|
bp != (EBP & 0xFFFF) ||
|
|
si != (ESI & 0xFFFF) ||
|
|
di != (EDI & 0xFFFF) )
|
|
{
|
|
BX_PANIC(("problems using BX_READ_16BIT_REG()!"));
|
|
}
|
|
|
|
eax = EAX;
|
|
ecx = ECX;
|
|
edx = EDX;
|
|
ebx = EBX;
|
|
esp = ESP;
|
|
ebp = EBP;
|
|
esi = ESI;
|
|
edi = EDI;
|
|
|
|
if (sizeof(Bit8u) != 1 || sizeof(Bit8s) != 1)
|
|
BX_PANIC(("data type Bit8u or Bit8s is not of length 1 byte!"));
|
|
if (sizeof(Bit16u) != 2 || sizeof(Bit16s) != 2)
|
|
BX_PANIC(("data type Bit16u or Bit16s is not of length 2 bytes!"));
|
|
if (sizeof(Bit32u) != 4 || sizeof(Bit32s) != 4)
|
|
BX_PANIC(("data type Bit32u or Bit32s is not of length 4 bytes!"));
|
|
if (sizeof(Bit64u) != 8 || sizeof(Bit64s) != 8)
|
|
BX_PANIC(("data type Bit64u or Bit64u is not of length 8 bytes!"));
|
|
|
|
BX_DEBUG(("#(%u)all sanity checks passed!", BX_CPU_ID));
|
|
}
|
|
|
|
void BX_CPU_C::assert_checks(void)
|
|
{
|
|
// check CPU mode consistency
|
|
#if BX_SUPPORT_X86_64
|
|
if (BX_CPU_THIS_PTR msr.lma) {
|
|
if (! BX_CPU_THIS_PTR cr0.pe) {
|
|
BX_PANIC(("assert_checks: EFER.LMA is set when CR0.PE=0 !"));
|
|
}
|
|
if (BX_CPU_THIS_PTR sregs[BX_SEG_REG_CS].cache.u.segment.l) {
|
|
if (BX_CPU_THIS_PTR cpu_mode != BX_MODE_LONG_64)
|
|
BX_PANIC(("assert_checks: unconsistent cpu_mode BX_MODE_LONG_64 !"));
|
|
}
|
|
else {
|
|
if (BX_CPU_THIS_PTR cpu_mode != BX_MODE_LONG_COMPAT)
|
|
BX_PANIC(("assert_checks: unconsistent cpu_mode BX_MODE_LONG_COMPAT !"));
|
|
}
|
|
}
|
|
else
|
|
#endif
|
|
{
|
|
if (BX_CPU_THIS_PTR cr0.pe) {
|
|
if (BX_CPU_THIS_PTR get_VM()) {
|
|
if (BX_CPU_THIS_PTR cpu_mode != BX_MODE_IA32_V8086)
|
|
BX_PANIC(("assert_checks: unconsistent cpu_mode BX_MODE_IA32_V8086 !"));
|
|
}
|
|
else {
|
|
if (BX_CPU_THIS_PTR cpu_mode != BX_MODE_IA32_PROTECTED)
|
|
BX_PANIC(("assert_checks: unconsistent cpu_mode BX_MODE_IA32_PROTECTED !"));
|
|
}
|
|
}
|
|
else {
|
|
if (BX_CPU_THIS_PTR cpu_mode != BX_MODE_IA32_REAL)
|
|
BX_PANIC(("assert_checks: unconsistent cpu_mode BX_MODE_IA32_REAL !"));
|
|
}
|
|
}
|
|
|
|
// VM should be OFF in long mode
|
|
#if BX_SUPPORT_X86_64
|
|
if (IsLongMode()) {
|
|
if (BX_CPU_THIS_PTR get_VM()) BX_PANIC(("assert_checks: VM is set in long mode !"));
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void BX_CPU_C::set_INTR(bx_bool value)
|
|
{
|
|
BX_CPU_THIS_PTR INTR = value;
|
|
BX_CPU_THIS_PTR async_event = 1;
|
|
}
|