|
|
| version 1.4, 2004/01/07 14:49:10 | version 1.20, 2005/03/09 17:12:34 |
|---|---|
| Line 1 | Line 1 |
| /* $Id$ */ | /* $Id$ */ |
| /* | /* |
| * Copyright (c) 2002-2003 NONAKA Kimihiro | * Copyright (c) 2002-2004 NONAKA Kimihiro |
| * All rights reserved. | * All rights reserved. |
| * | * |
| * Redistribution and use in source and binary forms, with or without | * Redistribution and use in source and binary forms, with or without |
| Line 31 | Line 31 |
| #include "cpu.h" | #include "cpu.h" |
| #include "memory.h" | #include "memory.h" |
| // ¤¢¤È¤Ç¡Ä | |
| // extern DWORD cpumem_addrmask; // -> CPU_STAT_ADRSMASK | |
| BYTE *cpumem = 0; | |
| DWORD extmem_size = 0; | |
| BYTE protectmem_size = 0; | |
| /* | |
| * initialize 1MB-16MB memory | |
| */ | |
| int | |
| init_cpumem(BYTE usemem) | |
| { | |
| DWORD size; | |
| if (usemem > 13) | |
| usemem = 13; | |
| size = usemem << 20; | |
| if (extmem_size != size - (LOWMEM - 0x100000)) { | |
| if (cpumem) { | |
| free(cpumem); | |
| cpumem = 0; | |
| } | |
| if (size <= LOWMEM - 0x100000) { | |
| extmem_size = 0; | |
| cpumem = 0; | |
| } else { | |
| extmem_size = size - (LOWMEM - 0x100000); | |
| cpumem = (BYTE *)malloc(extmem_size); | |
| if (cpumem == NULL) { | |
| protectmem_size = 0; | |
| return FAILURE; | |
| } | |
| memset(cpumem, 0, extmem_size); | |
| } | |
| } | |
| protectmem_size = usemem; | |
| return SUCCESS; | |
| } | |
| /* | /* |
| * memory access check | * memory access check |
| */ | */ |
| void | void |
| cpu_memoryread_check(descriptor_t* sd, DWORD madr, DWORD length, int e) | cpu_memoryread_check(descriptor_t *sd, UINT32 offset, UINT length, int e) |
| { | { |
| UINT32 uplimit; | |
| if (CPU_STAT_PM) { | if (CPU_STAT_PM) { |
| /* invalid */ | /* invalid */ |
| if (!sd->valid) { | if (!sd->valid) { |
| VERBOSE(("cpu_memoryread_check: invalid")); | |
| EXCEPTION(GP_EXCEPTION, 0); | EXCEPTION(GP_EXCEPTION, 0); |
| } | } |
| /* not present */ | /* not present */ |
| if (!sd->p) { | if (!sd->p) { |
| VERBOSE(("cpu_memoryread_check: not present")); | |
| EXCEPTION(e, 0); | EXCEPTION(e, 0); |
| } | } |
| } | |
| switch (sd->type) { | switch (sd->type) { |
| case 0: case 1: /* ro */ | case 0: case 1: /* ro */ |
| case 2: case 3: /* rw */ | case 2: case 3: /* rw */ |
| case 10: case 11: /* rx */ | case 10: case 11: /* rx */ |
| case 14: case 15: /* rxc */ | case 14: case 15: /* rxc */ |
| if ((madr > sd->u.seg.segend - length + 1) | if (offset > sd->u.seg.limit - length + 1) { |
| || (length - 1 > sd->u.seg.limit)) { | VERBOSE(("cpu_memoryread_check: offset(%08x) > sd->u.seg.limit(%08x) - length(%08x) + 1", offset, sd->u.seg.limit, length)); |
| EXCEPTION(e, 0); | EXCEPTION(e, 0); |
| } | |
| break; | |
| case 4: case 5: /* ro (expand down) */ | |
| case 6: case 7: /* rw (expand down) */ | |
| { | |
| DWORD uplimit = sd->d ? 0xffffffff : 0x0000ffff; | |
| if ((madr <= sd->u.seg.segend) | |
| || (madr > uplimit) | |
| || (uplimit - madr < length - 1)) { | |
| EXCEPTION(e, 0); | |
| } | |
| } | } |
| break; | if (length - 1 > sd->u.seg.limit) { |
| VERBOSE(("cpu_memoryread_check: length(%08x) - 1 > sd->u.seg.limit(%08x)", length, sd->u.seg.limit)); | |
| EXCEPTION(e, 0); | |
| } | |
| break; | |
| default: | case 4: case 5: /* ro (expand down) */ |
| case 6: case 7: /* rw (expand down) */ | |
| uplimit = sd->d ? 0xffffffff : 0x0000ffff; | |
| if (offset <= sd->u.seg.limit) { | |
| VERBOSE(("cpu_memoryread_check: offset(%08x) <= sd->u.seg.limit(%08x)", offset, sd->u.seg.limit)); | |
| EXCEPTION(e, 0); | |
| } | |
| if (offset > uplimit) { | |
| VERBOSE(("cpu_memoryread_check: offset(%08x) > uplimit(%08x)", offset, uplimit)); | |
| EXCEPTION(e, 0); | |
| } | |
| if (uplimit - offset < length - 1) { | |
| VERBOSE(("cpu_memoryread_check: uplimit(%08x) - offset(%08x) < length(%08x) - 1", uplimit, offset, length)); | |
| EXCEPTION(e, 0); | EXCEPTION(e, 0); |
| break; | |
| } | } |
| break; | |
| default: | |
| VERBOSE(("cpu_memoryread_check: invalid type (type = %d)", sd->type)); | |
| EXCEPTION(e, 0); | |
| break; | |
| } | } |
| sd->flag |= CPU_DESC_READABLE; | sd->flag |= CPU_DESC_FLAG_READABLE; |
| } | } |
| void | void |
| cpu_memorywrite_check(descriptor_t* sd, DWORD madr, DWORD length, int e) | cpu_memorywrite_check(descriptor_t *sd, UINT32 offset, UINT length, int e) |
| { | { |
| UINT32 uplimit; | |
| if (CPU_STAT_PM) { | if (CPU_STAT_PM) { |
| /* invalid */ | /* invalid */ |
| if (!sd->valid) { | if (!sd->valid) { |
| VERBOSE(("cpu_memorywrite_check: invalid")); | |
| EXCEPTION(GP_EXCEPTION, 0); | EXCEPTION(GP_EXCEPTION, 0); |
| } | } |
| /* not present */ | /* not present */ |
| if (!sd->p) { | if (!sd->p) { |
| VERBOSE(("cpu_memorywrite_check: not present")); | |
| EXCEPTION(e, 0); | EXCEPTION(e, 0); |
| } | } |
| switch (sd->type) { | if (!sd->s) { |
| case 2: case 3: /* rw */ | VERBOSE(("cpu_memorywrite_check: system segment")); |
| if ((madr > sd->u.seg.segend - length + 1) | EXCEPTION(e, 0); |
| || (length - 1 > sd->u.seg.limit)) { | } |
| EXCEPTION(e, 0); | } |
| } | |
| break; | |
| case 6: case 7: /* rw (expand down) */ | switch (sd->type) { |
| { | case 2: case 3: /* rw */ |
| DWORD uplimit = sd->d ? 0xffffffff : 0x0000ffff; | if (offset > sd->u.seg.limit - length + 1) { |
| if ((madr <= sd->u.seg.segend) | VERBOSE(("cpu_memorywrite_check: offset(%08x) > sd->u.seg.limit(%08x) - length(%08x) + 1", offset, sd->u.seg.limit, length)); |
| || (madr > uplimit) | EXCEPTION(e, 0); |
| || (uplimit - madr < length - 1)) { | |
| EXCEPTION(e, 0); | |
| } | |
| } | } |
| break; | if (length - 1 > sd->u.seg.limit) { |
| VERBOSE(("cpu_memorywrite_check: length(%08x) - 1 > sd->u.seg.limit(%08x)", length, sd->u.seg.limit)); | |
| EXCEPTION(e, 0); | |
| } | |
| break; | |
| default: | case 6: case 7: /* rw (expand down) */ |
| uplimit = sd->d ? 0xffffffff : 0x0000ffff; | |
| if (offset <= sd->u.seg.limit) { | |
| VERBOSE(("cpu_memorywrite_check: offset(%08x) <= sd->u.seg.limit(%08x)", offset, sd->u.seg.limit)); | |
| EXCEPTION(e, 0); | EXCEPTION(e, 0); |
| break; | |
| } | } |
| if (offset > uplimit) { | |
| VERBOSE(("cpu_memorywrite_check: offset(%08x) > uplimit(%08x)", offset, uplimit)); | |
| EXCEPTION(e, 0); | |
| } | |
| if (uplimit - offset < length - 1) { | |
| VERBOSE(("cpu_memorywrite_check: uplimit(%08x) - offset(%08x) < length(%08x) - 1", uplimit, offset, length)); | |
| EXCEPTION(e, 0); | |
| } | |
| break; | |
| default: | |
| VERBOSE(("cpu_memorywrite_check: invalid type (type = %d)", sd->type)); | |
| EXCEPTION(e, 0); | |
| break; | |
| } | } |
| sd->flag |= CPU_DESC_WRITABLE; | sd->flag |= CPU_DESC_FLAG_WRITABLE; |
| } | } |
| BOOL | void |
| cpu_stack_push_check(descriptor_t* sdp, DWORD esp, DWORD length) | cpu_stack_push_check(UINT16 s, descriptor_t *sd, UINT32 esp, UINT length) |
| { | { |
| UINT32 limit; | |
| if (!CPU_STAT_PM) | if (CPU_STAT_PM) { |
| return TRUE; | if (!sd->valid || !sd->p) { |
| VERBOSE(("cpu_stack_push_check: valid = %d, present = %d", sd->valid, sd->p)); | |
| if (!sdp->valid || !sdp->p) | EXCEPTION(SS_EXCEPTION, s & 0xfffc); |
| return FALSE; | } |
| #ifdef _DEBUG | if (!sd->s || sd->u.seg.c || !sd->u.seg.wr) { |
| if (!sdp->s || sdp->u.seg.c || !sdp->u.seg.wr) | VERBOSE(("cpu_stack_push_check: s = %d, c = %d, wr", sd->s, sd->u.seg.c, sd->u.seg.wr)); |
| return FALSE; | EXCEPTION(SS_EXCEPTION, s & 0xfffc); |
| #endif | } |
| if (!sdp->d) | if (!sd->d) { |
| esp &= 0xffff; | limit = 0xffff; |
| if (sdp->u.seg.ec) { | |
| DWORD limit = (sdp->d) ? 0xffffffff : 0xffff; | |
| if ((esp == 0) | |
| || (esp < length) | |
| || (esp - length <= sdp->u.seg.segend) | |
| || (esp > limit)) | |
| return FALSE; | |
| } else { | |
| /* expand-up stack */ | |
| if (esp == 0) { | |
| if ((sdp->d && (sdp->u.seg.segend != 0xffffffff)) | |
| || (!sdp->d && (sdp->u.seg.segend != 0xffff))) | |
| return FALSE; | |
| } else { | } else { |
| if ((esp < length) | limit = 0xffffffff; |
| || (esp - 1 > sdp->u.seg.segend)) | } |
| return FALSE; | if (sd->u.seg.ec) { |
| /* expand-down stack */ | |
| if ((esp == 0) | |
| || (esp < length) | |
| || (esp - length <= sd->u.seg.limit) | |
| || (esp > limit)) { | |
| VERBOSE(("cpu_stack_push_check: expand-down, esp = %08x, length = %08x", esp, length)); | |
| VERBOSE(("cpu_stack_push_check: limit = %08x, seglimit = %08x", limit, sd->u.seg.limit)); | |
| VERBOSE(("cpu_stack_push_check: segbase = %08x, segend = %08x", sd->u.seg.segbase, sd->u.seg.segend)); | |
| EXCEPTION(SS_EXCEPTION, s & 0xfffc); | |
| } | |
| } else { | |
| /* expand-up stack */ | |
| if (esp == 0) { | |
| if ((sd->d && (sd->u.seg.segend != 0xffffffff)) | |
| || (!sd->d && (sd->u.seg.segend != 0xffff))) { | |
| VERBOSE(("cpu_stack_push_check: expand-up, esp = %08x, length = %08x", esp, length)); | |
| VERBOSE(("cpu_stack_push_check: limit = %08x, seglimit = %08x", limit, sd->u.seg.limit)); | |
| VERBOSE(("cpu_stack_push_check: segbase = %08x, segend = %08x", sd->u.seg.segbase, sd->u.seg.segend)); | |
| EXCEPTION(SS_EXCEPTION, s & 0xfffc); | |
| } | |
| } else { | |
| if ((esp < length) | |
| || (esp - 1 > sd->u.seg.limit)) { | |
| VERBOSE(("cpu_stack_push_check: expand-up, esp = %08x, length = %08x", esp, length)); | |
| VERBOSE(("cpu_stack_push_check: limit = %08x, seglimit = %08x", limit, sd->u.seg.limit)); | |
| VERBOSE(("cpu_stack_push_check: segbase = %08x, segend = %08x", sd->u.seg.segbase, sd->u.seg.segend)); | |
| EXCEPTION(SS_EXCEPTION, s & 0xfffc); | |
| } | |
| } | |
| } | } |
| } | } |
| return TRUE; | |
| } | } |
| BOOL | void |
| cpu_stack_pop_check(descriptor_t* sdp, DWORD esp, DWORD length) | cpu_stack_pop_check(UINT16 s, descriptor_t *sd, UINT32 esp, UINT length) |
| { | { |
| DWORD limit; | UINT32 limit; |
| if (!CPU_STAT_PM) | |
| return TRUE; | |
| if (!sdp->valid || !sdp->p) | if (CPU_STAT_PM) { |
| return FALSE; | if (!sd->valid || !sd->p) { |
| #ifdef _DEBUG | VERBOSE(("cpu_stack_pop_check: valid = %d, present = %d", sd->valid, sd->p)); |
| if (!sdp->s || sdp->u.seg.c || !sdp->u.seg.wr) | EXCEPTION(SS_EXCEPTION, s & 0xfffc); |
| return FALSE; | } |
| #endif | if (!sd->s || sd->u.seg.c || !sd->u.seg.wr) { |
| VERBOSE(("cpu_stack_pop_check: s = %d, c = %d, wr", sd->s, sd->u.seg.c, sd->u.seg.wr)); | |
| EXCEPTION(SS_EXCEPTION, s & 0xfffc); | |
| } | |
| if (!sdp->d) { | if (!sd->d) { |
| esp &= 0xffff; | limit = 0xffff; |
| limit = 0xffff; | } else { |
| } else { | limit = 0xffffffff; |
| limit = 0xffffffff; | } |
| if (sd->u.seg.ec) { | |
| /* expand-down stack */ | |
| if ((esp == limit) | |
| || ((limit - esp) + 1 < length)) { | |
| VERBOSE(("cpu_stack_pop_check: expand-up, esp = %08x, length = %08x", esp, length)); | |
| VERBOSE(("cpu_stack_pop_check: limit = %08x, seglimit = %08x", limit, sd->u.seg.limit)); | |
| VERBOSE(("cpu_stack_pop_check: segbase = %08x, segend = %08x", sd->u.seg.segbase, sd->u.seg.segend)); | |
| EXCEPTION(SS_EXCEPTION, s & 0xfffc); | |
| } | |
| } else { | |
| /* expand-up stack */ | |
| if ((esp == limit) | |
| || (sd->u.seg.segend == 0) | |
| || (esp > sd->u.seg.limit) | |
| || ((sd->u.seg.limit - esp) + 1 < length)) { | |
| VERBOSE(("cpu_stack_pop_check: expand-up, esp = %08x, length = %08x", esp, length)); | |
| VERBOSE(("cpu_stack_pop_check: limit = %08x, seglimit = %08x", limit, sd->u.seg.limit)); | |
| VERBOSE(("cpu_stack_pop_check: segbase = %08x, segend = %08x", sd->u.seg.segbase, sd->u.seg.segend)); | |
| EXCEPTION(SS_EXCEPTION, s & 0xfffc); | |
| } | |
| } | |
| } | } |
| if (sdp->u.seg.ec) { | } |
| if ((esp == limit) | |
| || ((limit - esp) + 1 < length)) | #if defined(IA32_SUPPORT_DEBUG_REGISTER) |
| return FALSE; | INLINE static void |
| } else { | check_memory_break_point(UINT32 address, UINT length, UINT rw) |
| /* expand-up stack */ | { |
| if ((esp == limit) | int i; |
| || (sdp->u.seg.segend == 0) | |
| || (esp > sdp->u.seg.segend) | if (CPU_STAT_BP && !(CPU_EFLAG & RF_FLAG)) { |
| || ((sdp->u.seg.segend - esp) + 1 < length)) | for (i = 0; i < CPU_DEBUG_REG_INDEX_NUM; i++) { |
| return FALSE; | if ((CPU_STAT_BP & (1 << i)) |
| && (CPU_DR7_GET_RW(i) & rw) | |
| && ((address <= CPU_DR(i) && address + length > CPU_DR(i)) | |
| || (address > CPU_DR(i) && address < CPU_DR(i) + CPU_DR7_GET_LEN(i)))) { | |
| CPU_STAT_BP_EVENT |= CPU_STAT_BP_EVENT_B(i); | |
| } | |
| } | |
| } | } |
| return TRUE; | |
| } | } |
| #else | |
| #define check_memory_break_point(address, length, rw) | |
| #endif | |
| /* | /* |
| * code fetch | * code fetch |
| */ | */ |
| BYTE MEMCALL | #define ucrw (CPU_PAGE_READ_CODE | CPU_STAT_USER_MODE) |
| cpu_codefetch(DWORD madr) | |
| UINT8 MEMCALL | |
| cpu_codefetch(UINT32 offset) | |
| { | { |
| descriptor_t *sd; | descriptor_t *sd; |
| DWORD addr; | UINT32 addr; |
| #if defined(IA32_SUPPORT_TLB) | |
| TLB_ENTRY_T *ep; | |
| #endif | |
| sd = &CPU_STAT_SREG(CPU_CS_INDEX); | sd = &CPU_STAT_SREG(CPU_CS_INDEX); |
| if (!CPU_INST_AS32) | if (offset <= sd->u.seg.limit) { |
| madr &= 0xffff; | addr = sd->u.seg.segbase + offset; |
| if (madr <= sd->u.seg.segend) { | if (!CPU_STAT_PAGING) |
| addr = CPU_STAT_SREGBASE(CPU_CS_INDEX) + madr; | |
| if (!CPU_STAT_PM) | |
| return cpu_memoryread(addr); | return cpu_memoryread(addr); |
| return cpu_lcmemoryread(addr); | #if defined(IA32_SUPPORT_TLB) |
| ep = tlb_lookup(addr, ucrw); | |
| if (ep != NULL && ep->memp != NULL) { | |
| return ep->memp[addr & 0xfff]; | |
| } | |
| #endif | |
| return cpu_linear_memory_read_b(addr, ucrw); | |
| } | } |
| EXCEPTION(GP_EXCEPTION, 0); | EXCEPTION(GP_EXCEPTION, 0); |
| return 0; /* compiler happy */ | return 0; /* compiler happy */ |
| } | } |
| WORD MEMCALL | UINT16 MEMCALL |
| cpu_codefetch_w(DWORD madr) | cpu_codefetch_w(UINT32 offset) |
| { | { |
| descriptor_t *sd; | descriptor_t *sd; |
| DWORD addr; | UINT32 addr; |
| #if defined(IA32_SUPPORT_TLB) | |
| TLB_ENTRY_T *ep; | |
| UINT16 value; | |
| #endif | |
| sd = &CPU_STAT_SREG(CPU_CS_INDEX); | sd = &CPU_STAT_SREG(CPU_CS_INDEX); |
| if (!CPU_INST_AS32) | if (offset <= sd->u.seg.limit - 1) { |
| madr &= 0xffff; | addr = sd->u.seg.segbase + offset; |
| if (madr <= sd->u.seg.segend - 1) { | if (!CPU_STAT_PAGING) |
| addr = CPU_STAT_SREGBASE(CPU_CS_INDEX) + madr; | |
| if (!CPU_STAT_PM) | |
| return cpu_memoryread_w(addr); | return cpu_memoryread_w(addr); |
| return cpu_lcmemoryread_w(addr); | #if defined(IA32_SUPPORT_TLB) |
| ep = tlb_lookup(addr, ucrw); | |
| if (ep != NULL && ep->memp != NULL) { | |
| if ((addr + 1) & 0x00000fff) { | |
| return LOADINTELWORD(ep->memp + (addr & 0xfff)); | |
| } | |
| value = ep->memp[0xfff]; | |
| ep = tlb_lookup(addr + 1, ucrw); | |
| if (ep != NULL && ep->memp != NULL) { | |
| value += (UINT16)ep->memp[0] << 8; | |
| return value; | |
| } | |
| } | |
| #endif | |
| return cpu_linear_memory_read_w(addr, ucrw); | |
| } | } |
| EXCEPTION(GP_EXCEPTION, 0); | EXCEPTION(GP_EXCEPTION, 0); |
| return 0; /* compiler happy */ | return 0; /* compiler happy */ |
| } | } |
| DWORD MEMCALL | UINT32 MEMCALL |
| cpu_codefetch_d(DWORD madr) | cpu_codefetch_d(UINT32 offset) |
| { | { |
| descriptor_t *sd; | descriptor_t *sd; |
| DWORD addr; | UINT32 addr; |
| #if defined(IA32_SUPPORT_TLB) | |
| TLB_ENTRY_T *ep[2]; | |
| UINT32 value; | |
| UINT remain; | |
| #endif | |
| sd = &CPU_STAT_SREG(CPU_CS_INDEX); | sd = &CPU_STAT_SREG(CPU_CS_INDEX); |
| if (!CPU_INST_AS32) | if (offset <= sd->u.seg.limit - 3) { |
| madr &= 0xffff; | addr = sd->u.seg.segbase + offset; |
| if (madr <= sd->u.seg.segend - 3) { | if (!CPU_STAT_PAGING) |
| addr = CPU_STAT_SREGBASE(CPU_CS_INDEX) + madr; | |
| if (!CPU_STAT_PM) | |
| return cpu_memoryread_d(addr); | return cpu_memoryread_d(addr); |
| return cpu_lcmemoryread_d(addr); | #if defined(IA32_SUPPORT_TLB) |
| ep[0] = tlb_lookup(addr, ucrw); | |
| if (ep[0] != NULL && ep[0]->memp != NULL) { | |
| remain = 0x1000 - (addr & 0xfff); | |
| if (remain >= 4) { | |
| return LOADINTELDWORD(ep[0]->memp + (addr & 0xfff)); | |
| } | |
| ep[1] = tlb_lookup(addr + remain, ucrw); | |
| if (ep[1] != NULL && ep[1]->memp != NULL) { | |
| switch (remain) { | |
| case 3: | |
| value = ep[0]->memp[0xffd]; | |
| value += (UINT32)LOADINTELWORD(ep[0]->memp + 0xffe) << 8; | |
| value += (UINT32)ep[1]->memp[0] << 24; | |
| break; | |
| case 2: | |
| value = LOADINTELWORD(ep[0]->memp + 0xffe); | |
| value += (UINT32)LOADINTELWORD(ep[1]->memp + 0) << 16; | |
| break; | |
| case 1: | |
| value = ep[0]->memp[0xfff]; | |
| value += (UINT32)LOADINTELWORD(ep[1]->memp + 0) << 8; | |
| value += (UINT32)ep[1]->memp[2] << 24; | |
| break; | |
| default: | |
| ia32_panic("cpu_codefetch_d(): out of range. (remain = %d)\n", remain); | |
| return (UINT32)-1; | |
| } | |
| return value; | |
| } | |
| } | |
| #endif | |
| return cpu_linear_memory_read_d(addr, ucrw); | |
| } | } |
| EXCEPTION(GP_EXCEPTION, 0); | EXCEPTION(GP_EXCEPTION, 0); |
| return 0; /* compiler happy */ | return 0; /* compiler happy */ |
| } | } |
| /* | /* |
| * virtual address -> linear address | * additional physical address memory access functions |
| */ | */ |
| BYTE MEMCALL | UINT64 MEMCALL |
| cpu_vmemoryread(int idx, DWORD madr) | cpu_memoryread_q(UINT32 address) |
| { | { |
| descriptor_t *sd; | UINT64 value; |
| DWORD addr; | |
| __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | value = cpu_memoryread_d(address); |
| value += (UINT64)cpu_memoryread_d(address + 4) << 32; | |
| sd = &CPU_STAT_SREG(idx); | return value; |
| if (!sd->valid) { | } |
| EXCEPTION(GP_EXCEPTION, 0); | |
| } | |
| if (!CPU_INST_AS32) | REG80 MEMCALL |
| madr &= 0xffff; | cpu_memoryread_f(UINT32 address) |
| for (;;) { | { |
| if ((sd->flag & CPU_DESC_READABLE) | REG80 value; |
| || (madr <= sd->u.seg.segend)) { | UINT i; |
| addr = CPU_STAT_SREGBASE(idx) + madr; | |
| if (!CPU_STAT_PM) | for (i = 0; i < sizeof(REG80); ++i) { |
| return cpu_memoryread(addr); | value.b[i] = cpu_memoryread(address + i); |
| return cpu_lmemoryread(addr); | |
| } | |
| cpu_memoryread_check(sd, madr, 1, | |
| (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); | |
| } | } |
| /*NOTREACHED*/ | return value; |
| } | } |
| WORD MEMCALL | void MEMCALL |
| cpu_vmemoryread_w(int idx, DWORD madr) | cpu_memorywrite_q(UINT32 address, UINT64 value) |
| { | { |
| descriptor_t *sd; | |
| DWORD addr; | |
| __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | cpu_memorywrite_d(address, (UINT32)value); |
| cpu_memorywrite_d(address + 4, (UINT32)(value >> 32)); | |
| } | |
| sd = &CPU_STAT_SREG(idx); | void MEMCALL |
| if (!sd->valid) { | cpu_memorywrite_f(UINT32 address, const REG80 *value) |
| EXCEPTION(GP_EXCEPTION, 0); | { |
| } | UINT i; |
| if (!CPU_INST_AS32) | for (i = 0; i < sizeof(REG80); ++i) { |
| madr &= 0xffff; | cpu_memorywrite(address + i, value->b[i]); |
| for (;;) { | |
| if ((sd->flag & CPU_DESC_READABLE) | |
| || (madr <= sd->u.seg.segend - 1)) { | |
| addr = CPU_STAT_SREGBASE(idx) + madr; | |
| if (!CPU_STAT_PM) | |
| return cpu_memoryread_w(addr); | |
| return cpu_lmemoryread_w(addr); | |
| } | |
| cpu_memoryread_check(sd, madr, 2, | |
| (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); | |
| } | } |
| /*NOTREACHED*/ | |
| } | } |
| DWORD MEMCALL | /* |
| cpu_vmemoryread_d(int idx, DWORD madr) | * virtual address memory access functions |
| */ | |
| #include "cpu_mem.mcr" | |
| VIRTUAL_ADDRESS_MEMORY_ACCESS_FUNCTION(b, UINT8, 1) | |
| VIRTUAL_ADDRESS_MEMORY_ACCESS_FUNCTION(w, UINT16, 2) | |
| VIRTUAL_ADDRESS_MEMORY_ACCESS_FUNCTION(d, UINT32, 4) | |
| UINT64 MEMCALL | |
| cpu_vmemoryread_q(int idx, UINT32 offset) | |
| { | { |
| descriptor_t *sd; | descriptor_t *sd; |
| DWORD addr; | UINT32 addr; |
| int exc; | |
| __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); |
| sd = &CPU_STAT_SREG(idx); | sd = &CPU_STAT_SREG(idx); |
| if (!sd->valid) { | if (!sd->valid) { |
| EXCEPTION(GP_EXCEPTION, 0); | exc = GP_EXCEPTION; |
| goto err; | |
| } | } |
| if (!CPU_INST_AS32) | if (!(sd->flag & CPU_DESC_FLAG_READABLE)) { |
| madr &= 0xffff; | cpu_memoryread_check(sd, offset, 8, |
| for (;;) { | |
| if ((sd->flag & CPU_DESC_READABLE) | |
| || (madr <= sd->u.seg.segend - 3)) { | |
| addr = CPU_STAT_SREGBASE(idx) + madr; | |
| if (!CPU_STAT_PM) | |
| return cpu_memoryread_d(addr); | |
| return cpu_lmemoryread_d(addr); | |
| } | |
| cpu_memoryread_check(sd, madr, 4, | |
| (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); | (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); |
| } else { | |
| switch (sd->type) { | |
| case 4: case 5: case 6: case 7: | |
| if (offset - (8 - 1) <= sd->u.seg.limit) | |
| goto range_failure; | |
| break; | |
| default: | |
| if (offset > sd->u.seg.limit - (8 - 1)) | |
| goto range_failure; | |
| break; | |
| } | |
| } | |
| addr = sd->u.seg.segbase + offset; | |
| check_memory_break_point(addr, 8, CPU_DR7_RW_RO); | |
| if (!CPU_STAT_PAGING) | |
| return cpu_memoryread_q(addr); | |
| return cpu_linear_memory_read_q(addr, CPU_PAGE_READ_DATA | CPU_STAT_USER_MODE); | |
| range_failure: | |
| if (idx == CPU_SS_INDEX) { | |
| exc = SS_EXCEPTION; | |
| } else { | |
| exc = GP_EXCEPTION; | |
| } | } |
| /*NOTREACHED*/ | VERBOSE(("cpu_vmemoryread_q: type = %d, offset = %08x, limit = %08x", sd->type, offset, sd->u.seg.limit)); |
| err: | |
| EXCEPTION(exc, 0); | |
| return 0; /* compiler happy */ | |
| } | } |
| /* vaddr memory write */ | |
| void MEMCALL | void MEMCALL |
| cpu_vmemorywrite(int idx, DWORD madr, BYTE val) | cpu_vmemorywrite_q(int idx, UINT32 offset, UINT64 value) |
| { | { |
| descriptor_t *sd; | descriptor_t *sd; |
| DWORD addr; | UINT32 addr; |
| int exc; | |
| __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); |
| sd = &CPU_STAT_SREG(idx); | sd = &CPU_STAT_SREG(idx); |
| if (!sd->valid) { | if (!sd->valid) { |
| EXCEPTION(GP_EXCEPTION, 0); | exc = GP_EXCEPTION; |
| goto err; | |
| } | } |
| if (!CPU_INST_AS32) | if (!(sd->flag & CPU_DESC_FLAG_WRITABLE)) { |
| madr &= 0xffff; | cpu_memorywrite_check(sd, offset, 8, |
| for (;;) { | |
| if ((sd->flag & CPU_DESC_WRITABLE) | |
| || (madr <= sd->u.seg.segend)) { | |
| addr = CPU_STAT_SREGBASE(idx) + madr; | |
| if (!CPU_STAT_PM) { | |
| /* real mode */ | |
| cpu_memorywrite(addr, val); | |
| } else { | |
| /* protected mode */ | |
| cpu_lmemorywrite(addr, val); | |
| } | |
| return; | |
| } | |
| cpu_memorywrite_check(sd, madr, 1, | |
| (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); | (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); |
| } else { | |
| switch (sd->type) { | |
| case 6: case 7: | |
| if (offset - (8 - 1) <= sd->u.seg.limit) | |
| goto range_failure; | |
| break; | |
| default: | |
| if (offset > sd->u.seg.limit - (8 - 1)) | |
| goto range_failure; | |
| break; | |
| } | |
| } | |
| addr = sd->u.seg.segbase + offset; | |
| check_memory_break_point(addr, 8, CPU_DR7_RW_RW); | |
| if (!CPU_STAT_PAGING) { | |
| cpu_memorywrite_q(addr, value); | |
| } else { | |
| cpu_linear_memory_write_q(addr, value, CPU_PAGE_WRITE_DATA | CPU_STAT_USER_MODE); | |
| } | |
| return; | |
| range_failure: | |
| if (idx == CPU_SS_INDEX) { | |
| exc = SS_EXCEPTION; | |
| } else { | |
| exc = GP_EXCEPTION; | |
| } | } |
| /*NOTREACHED*/ | VERBOSE(("cpu_vmemorywrite_q: type = %d, offset = %08x, limit = %08x", sd->type, offset, sd->u.seg.limit)); |
| err: | |
| EXCEPTION(exc, 0); | |
| } | } |
| void MEMCALL | REG80 MEMCALL |
| cpu_vmemorywrite_w(int idx, DWORD madr, WORD val) | cpu_vmemoryread_f(int idx, UINT32 offset) |
| { | { |
| descriptor_t *sd; | descriptor_t *sd; |
| DWORD addr; | UINT32 addr; |
| int exc; | |
| __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); |
| sd = &CPU_STAT_SREG(idx); | sd = &CPU_STAT_SREG(idx); |
| if (!sd->valid) { | if (!sd->valid) { |
| EXCEPTION(GP_EXCEPTION, 0); | exc = GP_EXCEPTION; |
| goto err; | |
| } | } |
| if (!CPU_INST_AS32) | if (!(sd->flag & CPU_DESC_FLAG_READABLE)) { |
| madr &= 0xffff; | cpu_memoryread_check(sd, offset, 10, |
| for (;;) { | |
| if ((sd->flag & CPU_DESC_WRITABLE) | |
| || (madr <= sd->u.seg.segend - 1)) { | |
| addr = CPU_STAT_SREGBASE(idx) + madr; | |
| if (!CPU_STAT_PM) { | |
| /* real mode */ | |
| cpu_memorywrite_w(addr, val); | |
| } else { | |
| /* protected mode */ | |
| cpu_lmemorywrite_w(addr, val); | |
| } | |
| return; | |
| } | |
| cpu_memorywrite_check(sd, madr, 2, | |
| (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); | (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); |
| } else { | |
| switch (sd->type) { | |
| case 4: case 5: case 6: case 7: | |
| if (offset - (10 - 1) <= sd->u.seg.limit) | |
| goto range_failure; | |
| break; | |
| default: | |
| if (offset > sd->u.seg.limit - (10 - 1)) | |
| goto range_failure; | |
| break; | |
| } | |
| } | |
| addr = sd->u.seg.segbase + offset; | |
| check_memory_break_point(addr, 10, CPU_DR7_RW_RO); | |
| if (!CPU_STAT_PAGING) | |
| return cpu_memoryread_f(addr); | |
| return cpu_linear_memory_read_f(addr, CPU_PAGE_READ_DATA | CPU_STAT_USER_MODE); | |
| range_failure: | |
| if (idx == CPU_SS_INDEX) { | |
| exc = SS_EXCEPTION; | |
| } else { | |
| exc = GP_EXCEPTION; | |
| } | |
| VERBOSE(("cpu_vmemoryread_f: type = %d, offset = %08x, limit = %08x", sd->type, offset, sd->u.seg.limit)); | |
| err: | |
| EXCEPTION(exc, 0); | |
| { | |
| REG80 dummy; | |
| memset(&dummy, 0, sizeof(dummy)); | |
| return dummy; /* compiler happy */ | |
| } | } |
| /*NOTREACHED*/ | |
| } | } |
| void MEMCALL | void MEMCALL |
| cpu_vmemorywrite_d(int idx, DWORD madr, DWORD val) | cpu_vmemorywrite_f(int idx, UINT32 offset, const REG80 *value) |
| { | { |
| descriptor_t *sd; | descriptor_t *sd; |
| DWORD addr; | UINT32 addr; |
| int exc; | |
| __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); |
| sd = &CPU_STAT_SREG(idx); | sd = &CPU_STAT_SREG(idx); |
| if (!sd->valid) { | if (!sd->valid) { |
| EXCEPTION(GP_EXCEPTION, 0); | exc = GP_EXCEPTION; |
| goto err; | |
| } | } |
| if (!CPU_INST_AS32) | if (!(sd->flag & CPU_DESC_FLAG_WRITABLE)) { |
| madr &= 0xffff; | cpu_memorywrite_check(sd, offset, 10, |
| for (;;) { | |
| if ((sd->flag & CPU_DESC_WRITABLE) | |
| || (madr <= sd->u.seg.segend - 3)) { | |
| addr = CPU_STAT_SREGBASE(idx) + madr; | |
| if (!CPU_STAT_PM) { | |
| /* real mode */ | |
| cpu_memorywrite_d(addr, val); | |
| } else { | |
| /* protected mode */ | |
| cpu_lmemorywrite_d(addr, val); | |
| } | |
| return; | |
| } | |
| cpu_memorywrite_check(sd, madr, 4, | |
| (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); | (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION); |
| } | |
| /*NOTREACHED*/ | |
| } | |
| /* | |
| * physical address memory function | |
| */ | |
| void MEMCALL | |
| cpu_memorywrite_d(DWORD address, DWORD value) | |
| { | |
| DWORD adr = address & CPU_STAT_ADRSMASK; | |
| if (adr < LOWMEM - 3) { | |
| __i286_memorywrite_d(adr, value); | |
| } else if (adr < LOWMEM) { | |
| cpu_memorywrite_w(adr, value & 0xffff); | |
| cpu_memorywrite_w(adr + 2, (value >> 16) & 0xffff); | |
| } else { | } else { |
| adr -= LOWMEM; | switch (sd->type) { |
| if (adr < extmem_size - 3) { | case 6: case 7: |
| STOREINTELDWORD(cpumem + adr, value); | if (offset - (10 - 1) <= sd->u.seg.limit) |
| } else if (adr < extmem_size) { | goto range_failure; |
| cpu_memorywrite_w(adr, value & 0xffff); | break; |
| cpu_memorywrite_w(adr + 2, (value >> 16) & 0xffff); | |
| } | |
| } | |
| } | |
| void MEMCALL | |
| cpu_memorywrite_w(DWORD address, WORD value) | |
| { | |
| DWORD adr = address & CPU_STAT_ADRSMASK; | |
| if (adr < LOWMEM - 1) { | |
| __i286_memorywrite_w(adr, value); | |
| } else if (adr < LOWMEM) { | |
| __i286_memorywrite(adr, value & 0xff); | |
| cpumem[adr - (LOWMEM - 1)] = (value >> 8) & 0xff; | |
| } else { | |
| adr -= LOWMEM; | |
| if (adr < extmem_size - 1) { | |
| STOREINTELWORD(cpumem + adr, value); | |
| } else if (adr == extmem_size - 1) { | |
| cpumem[adr] = value & 0xff; | |
| } | |
| } | |
| } | |
| void MEMCALL | |
| cpu_memorywrite(DWORD address, BYTE value) | |
| { | |
| DWORD adr = address & CPU_STAT_ADRSMASK; | |
| if (adr < LOWMEM) { | |
| __i286_memorywrite(adr, value); | |
| } else { | |
| adr -= LOWMEM; | |
| if (adr < extmem_size) { | |
| cpumem[adr] = value; | |
| } | |
| } | |
| } | |
| DWORD MEMCALL | |
| cpu_memoryread_d(DWORD address) | |
| { | |
| DWORD adr = address & CPU_STAT_ADRSMASK; | |
| DWORD val; | |
| if (adr < LOWMEM - 3) { | default: |
| val = __i286_memoryread_d(adr); | if (offset > sd->u.seg.limit - (10 - 1)) |
| } else if (adr < LOWMEM) { | goto range_failure; |
| val = cpu_memoryread_w(adr); | break; |
| val |= (DWORD)cpu_memoryread_w(adr + 2) << 16; | |
| } else { | |
| adr -= LOWMEM; | |
| if (adr < extmem_size - 3) { | |
| val = LOADINTELDWORD(cpumem + adr); | |
| } else { | |
| val = cpu_memoryread_w(adr); | |
| val |= (DWORD)cpu_memoryread_w(adr + 2) << 16; | |
| } | } |
| } | } |
| return val; | addr = sd->u.seg.segbase + offset; |
| } | check_memory_break_point(addr, 10, CPU_DR7_RW_RW); |
| if (!CPU_STAT_PAGING) { | |
| WORD MEMCALL | cpu_memorywrite_f(addr, value); |
| cpu_memoryread_w(DWORD address) | |
| { | |
| DWORD adr = address & CPU_STAT_ADRSMASK; | |
| WORD val; | |
| if (adr < LOWMEM - 1) { | |
| val = __i286_memoryread_w(adr); | |
| } else if (adr < LOWMEM) { | |
| val = cpu_memoryread(adr); | |
| val |= (WORD)cpumem[adr - (LOWMEM - 1)] << 8; | |
| } else { | } else { |
| adr -= LOWMEM; | cpu_linear_memory_write_f(addr, value, CPU_PAGE_WRITE_DATA | CPU_STAT_USER_MODE); |
| if (adr < extmem_size - 1) { | |
| val = LOADINTELWORD(cpumem + adr); | |
| } else if (adr == extmem_size - 1) { | |
| val = 0xff00 | cpumem[adr]; | |
| } else { | |
| val = (WORD)-1; | |
| } | |
| } | } |
| return val; | return; |
| } | |
| BYTE MEMCALL | |
| cpu_memoryread(DWORD address) | |
| { | |
| DWORD adr = address & CPU_STAT_ADRSMASK; | |
| BYTE val; | |
| if (adr < LOWMEM) { | range_failure: |
| val = __i286_memoryread(adr); | if (idx == CPU_SS_INDEX) { |
| exc = SS_EXCEPTION; | |
| } else { | } else { |
| adr -= LOWMEM; | exc = GP_EXCEPTION; |
| if (adr < extmem_size) { | |
| val = cpumem[adr]; | |
| } else { | |
| val = (BYTE)-1; | |
| } | |
| } | } |
| return val; | VERBOSE(("cpu_vmemorywrite_f: type = %d, offset = %08x, limit = %08x", sd->type, offset, sd->u.seg.limit)); |
| err: | |
| EXCEPTION(exc, 0); | |
| } | } |