[BACK]Return to cpu_mem.c CVS log [TXT] [DIR] Up to [RetroPC.NET] / np2 / i386c / ia32

Diff for /np2/i386c/ia32/cpu_mem.c between versions 1.2 and 1.16

version 1.2, 2003/12/11 15:03:16 version 1.16, 2004/03/24 14:34:23
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;  
   
 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);                  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;                  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);
                   }
                   if (offset > uplimit) {
                           VERBOSE(("cpu_memorywrite_check: offset(%08x) > uplimit(%08x)", offset, uplimit));
                         EXCEPTION(e, 0);                          EXCEPTION(e, 0);
                         break;  
                 }                  }
                   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) {
         if (sdp->u.seg.ec) {                          /* expand-down stack */
                 if ((esp == limit)                          if ((esp == limit)
                  || ((limit  - esp) + 1 < length))                           || ((limit - esp) + 1 < length)) {
                         return FALSE;                                  VERBOSE(("cpu_stack_pop_check: expand-up, esp = %08x, length = %08x", esp, length));
         } else {                                  VERBOSE(("cpu_stack_pop_check: limit = %08x, seglimit = %08x", limit, sd->u.seg.limit));
                 /* expand-up stack */                                  VERBOSE(("cpu_stack_pop_check: segbase = %08x, segend = %08x", sd->u.seg.segbase, sd->u.seg.segend));
                 if ((esp == limit)                                  EXCEPTION(SS_EXCEPTION, s & 0xfffc);
                  || (sdp->u.seg.segend == 0)                          }
                  || (esp > sdp->u.seg.segend)                  } else {
                  || ((sdp->u.seg.segend - esp) + 1 < length))                          /* expand-up stack */
                         return FALSE;                          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);
                           }
                   }
         }          }
         return TRUE;  
 }  }
   
   
   #if defined(IA32_SUPPORT_PREFETCH_QUEUE)
 /*  /*
  * code fetch   * code prefetch
  */   */
 BYTE MEMCALL  #define CPU_PREFETCHQ_MASK      (CPU_PREFETCH_QUEUE_LENGTH - 1)
 cpu_codefetch(DWORD madr)  
 {  
         descriptor_t *sd;  
         DWORD addr;  
   
         sd = &CPU_STAT_SREG(CPU_CS_INDEX);  
         if (!CPU_INST_AS32)  
                 madr &= 0xffff;  
         if (madr <= sd->u.seg.segend) {  
                 addr = CPU_STAT_SREGBASE(CPU_CS_INDEX) + madr;  
                 if (!CPU_STAT_PM)  
                         return cpu_memoryread(addr);  
                 return cpu_lcmemoryread(addr);  
         }  
         EXCEPTION(GP_EXCEPTION, 0);  
         return 0;       /* compiler happy */  
 }  
   
 WORD MEMCALL  
 cpu_codefetch_w(DWORD madr)  
 {  
         descriptor_t *sd;  
         DWORD addr;  
   
         sd = &CPU_STAT_SREG(CPU_CS_INDEX);  
         if (!CPU_INST_AS32)  
                 madr &= 0xffff;  
         if (madr <= sd->u.seg.segend - 1) {  
                 addr = CPU_STAT_SREGBASE(CPU_CS_INDEX) + madr;  
                 if (!CPU_STAT_PM)  
                         return cpu_memoryread_w(addr);  
                 return cpu_lcmemoryread_w(addr);  
         }  
         EXCEPTION(GP_EXCEPTION, 0);  
         return 0;       /* compiler happy */  
 }  
   
 DWORD MEMCALL  
 cpu_codefetch_d(DWORD madr)  
 {  
         descriptor_t *sd;  
         DWORD addr;  
   
         sd = &CPU_STAT_SREG(CPU_CS_INDEX);  
         if (!CPU_INST_AS32)  
                 madr &= 0xffff;  
         if (madr <= sd->u.seg.segend - 3) {  
                 addr = CPU_STAT_SREGBASE(CPU_CS_INDEX) + madr;  
                 if (!CPU_STAT_PM)  
                         return cpu_memoryread_d(addr);  
                 return cpu_lcmemoryread_d(addr);  
         }  
         EXCEPTION(GP_EXCEPTION, 0);  
         return 0;       /* compiler happy */  
 }  
   
   
 /*  INLINE static MEMCALL void
  * virtual address -> linear address  cpu_prefetch(UINT32 address)
  */  
 BYTE MEMCALL  
 cpu_vmemoryread(int idx, DWORD madr)  
 {  {
         descriptor_t *sd;          UINT offset = address & CPU_PREFETCHQ_MASK;
         DWORD addr;          UINT length = CPU_PREFETCH_QUEUE_LENGTH - offset;
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);  
   
         sd = &CPU_STAT_SREG(idx);          cpu_memory_access_la_region(address, length, CPU_PAGE_READ_CODE|CPU_STAT_USER_MODE, CPU_PREFETCHQ + offset);
         if (!sd->valid) {          CPU_PREFETCHQ_REMAIN = (SINT8)length;
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         if (!CPU_INST_AS32)  
                 madr &= 0xffff;  
         for (;;) {  
                 if ((sd->flag & CPU_DESC_READABLE)  
                     || (madr <= sd->u.seg.segend)) {  
                         addr = CPU_STAT_SREGBASE(idx) + madr;  
                         if (!CPU_STAT_PM)  
                                 return cpu_memoryread(addr);  
                         return cpu_lmemoryread(addr);  
                 }  
                 cpu_memoryread_check(sd, madr, 1,  
                     (idx == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION);  
         }  
         /*NOTREACHED*/  
 }  }
   
 WORD MEMCALL  INLINE static MEMCALL UINT8
 cpu_vmemoryread_w(int idx, DWORD madr)  cpu_prefetchq(UINT32 address)
 {  {
         descriptor_t *sd;          UINT8 v;
         DWORD addr;  
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);  
   
         sd = &CPU_STAT_SREG(idx);          CPU_PREFETCHQ_REMAIN--;
         if (!sd->valid) {          v = CPU_PREFETCHQ[address & CPU_PREFETCHQ_MASK];
                 EXCEPTION(GP_EXCEPTION, 0);          return v;
         }  
   
         if (!CPU_INST_AS32)  
                 madr &= 0xffff;  
         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  INLINE static MEMCALL UINT16
 cpu_vmemoryread_d(int idx, DWORD madr)  cpu_prefetchq_w(UINT32 address)
 {  {
         descriptor_t *sd;          BYTE *p;
         DWORD addr;          UINT16 v;
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);  
   
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         if (!CPU_INST_AS32)          CPU_PREFETCHQ_REMAIN -= 2;
                 madr &= 0xffff;          p = CPU_PREFETCHQ + (address & CPU_PREFETCHQ_MASK);
         for (;;) {          v = LOADINTELWORD(p);
                 if ((sd->flag & CPU_DESC_READABLE)          return v;
                     || (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);  
         }  
         /*NOTREACHED*/  
 }  }
   
 /* vaddr memory write */  INLINE static MEMCALL UINT32
 void MEMCALL  cpu_prefetchq_3(UINT32 address)
 cpu_vmemorywrite(int idx, DWORD madr, BYTE val)  
 {  {
         descriptor_t *sd;          BYTE *p;
         DWORD addr;          UINT32 v;
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);  
   
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         if (!CPU_INST_AS32)          CPU_PREFETCHQ_REMAIN -= 3;
                 madr &= 0xffff;          p = CPU_PREFETCHQ + (address & CPU_PREFETCHQ_MASK);
         for (;;) {          v = LOADINTELWORD(p);
                 if ((sd->flag & CPU_DESC_WRITABLE)          v += ((UINT32)p[2]) << 16;
                     || (madr <= sd->u.seg.segend)) {          return v;
                         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);  
         }  
         /*NOTREACHED*/  
 }  }
   
 void MEMCALL  INLINE static MEMCALL UINT32
 cpu_vmemorywrite_w(int idx, DWORD madr, WORD val)  cpu_prefetchq_d(UINT32 address)
 {  {
         descriptor_t *sd;          BYTE *p;
         DWORD addr;          UINT32 v;
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);  
   
         sd = &CPU_STAT_SREG(idx);          CPU_PREFETCHQ_REMAIN -= 4;
         if (!sd->valid) {          p = CPU_PREFETCHQ + (address & CPU_PREFETCHQ_MASK);
                 EXCEPTION(GP_EXCEPTION, 0);          v = LOADINTELDWORD(p);
         }          return v;
   
         if (!CPU_INST_AS32)  
                 madr &= 0xffff;  
         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);  
         }  
         /*NOTREACHED*/  
 }  }
   #endif  /* IA32_SUPPORT_PREFETCH_QUEUE */
   
 void MEMCALL  #if defined(IA32_SUPPORT_DEBUG_REGISTER)
 cpu_vmemorywrite_d(int idx, DWORD madr, DWORD val)  INLINE static void
   check_memory_break_point(UINT32 address, UINT length, UINT rw)
 {  {
         descriptor_t *sd;          int i;
         DWORD addr;  
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);  
   
         sd = &CPU_STAT_SREG(idx);          if (CPU_STAT_BP && !(CPU_EFLAG & RF_FLAG)) {
         if (!sd->valid) {                  for (i = 0; i < CPU_DEBUG_REG_INDEX_NUM; i++) {
                 EXCEPTION(GP_EXCEPTION, 0);                          if ((CPU_STAT_BP & (1 << i))
         }                           && (CPU_DR7_GET_RW(i) & rw)
   
         if (!CPU_INST_AS32)                           && ((address <= CPU_DR(i) && address + length > CPU_DR(i))
                 madr &= 0xffff;                            || (address > CPU_DR(i) && address < CPU_DR(i) + CPU_DR7_GET_LEN(i)))) {
         for (;;) {                                  CPU_STAT_BP_EVENT |= CPU_STAT_BP_EVENT_B(i);
                 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);  
         }          }
         /*NOTREACHED*/  
 }  }
   #else
   #define check_memory_break_point(address, length, rw)
   #endif
   
 /*  /*
  * physical address memory function   * code fetch
  */   */
 void MEMCALL  UINT8 MEMCALL
 cpu_memorywrite_d(DWORD address, DWORD value)  cpu_codefetch(UINT32 offset)
 {  {
         DWORD adr = address & cpumem_addrmask;          descriptor_t *sd;
           UINT32 addr;
   
         if (adr < LOWMEM - 3) {          sd = &CPU_STAT_SREG(CPU_CS_INDEX);
                 __i286_memorywrite_d(adr, value);          if (offset <= sd->u.seg.limit) {
         } else if (adr < LOWMEM) {                  addr = sd->u.seg.segbase + offset;
                 cpu_memorywrite_w(adr, value & 0xffff);  #if defined(IA32_SUPPORT_PREFETCH_QUEUE)
                 cpu_memorywrite_w(adr + 2, (value >> 16) & 0xffff);                  if (CPU_PREFETCHQ_REMAIN <= 0) {
         } else {                          cpu_prefetch(addr);
                 adr -= LOWMEM;                  }
                 if (adr < extmem_size - 3) {                  return cpu_prefetchq(addr);
                         STOREINTELDWORD(cpumem + adr, value);  #else   /* !IA32_SUPPORT_PREFETCH_QUEUE */
                 } else {                  if (!CPU_STAT_PAGING)
                         ia32_panic("cpu_memorywrite_d: out of universe.");                          return cpu_memoryread(addr);
                 }                  return cpu_lcmemoryread(addr);
   #endif  /* IA32_SUPPORT_PREFETCH_QUEUE */
         }          }
           EXCEPTION(GP_EXCEPTION, 0);
           return 0;       /* compiler happy */
 }  }
   
 void MEMCALL  UINT16 MEMCALL
 cpu_memorywrite_w(DWORD address, WORD value)  cpu_codefetch_w(UINT32 offset)
 {  {
         DWORD adr = address & cpumem_addrmask;          descriptor_t *sd;
           UINT32 addr;
   #if defined(IA32_SUPPORT_PREFETCH_QUEUE)
           UINT16 v;
   #endif
   
         if (adr < LOWMEM - 1) {          sd = &CPU_STAT_SREG(CPU_CS_INDEX);
                 __i286_memorywrite_w(adr, value);          if (offset <= sd->u.seg.limit - 1) {
         } else if (adr < LOWMEM) {                  addr = sd->u.seg.segbase + offset;
                 __i286_memorywrite(adr, value & 0xff);  #if defined(IA32_SUPPORT_PREFETCH_QUEUE)
                 cpumem[adr - (LOWMEM - 1)] = (value >> 8) & 0xff;                  if (CPU_PREFETCHQ_REMAIN <= 0) {
         } else {                          cpu_prefetch(addr);
                 adr -= LOWMEM;                  }
                 if (adr < extmem_size - 1) {                  if (CPU_PREFETCHQ_REMAIN >= 2) {
                         STOREINTELWORD(cpumem + adr, value);                          return cpu_prefetchq_w(addr);
                 } else {                  }
                         ia32_panic("cpu_memorywrite_w: out of universe.");  
                 }                  v = cpu_prefetchq(addr);
                   addr++;
                   cpu_prefetch(addr);
                   v += (UINT16)cpu_prefetchq(addr) << 8;
                   return v;
   #else   /* !IA32_SUPPORT_PREFETCH_QUEUE */
                   if (!CPU_STAT_PAGING)
                           return cpu_memoryread_w(addr);
                   return cpu_lcmemoryread_w(addr);
   #endif  /* IA32_SUPPORT_PREFETCH_QUEUE */
         }          }
           EXCEPTION(GP_EXCEPTION, 0);
           return 0;       /* compiler happy */
 }  }
   
 void MEMCALL  UINT32 MEMCALL
 cpu_memorywrite(DWORD address, BYTE value)  cpu_codefetch_d(UINT32 offset)
 {  {
         DWORD adr = address & cpumem_addrmask;          descriptor_t *sd;
           UINT32 addr;
   #if defined(IA32_SUPPORT_PREFETCH_QUEUE)
           UINT32 v;
   #endif
   
         if (adr < LOWMEM) {          sd = &CPU_STAT_SREG(CPU_CS_INDEX);
                 __i286_memorywrite(adr, value);          if (offset <= sd->u.seg.limit - 3) {
         } else {                  addr = sd->u.seg.segbase + offset;
                 adr -= LOWMEM;  #if defined(IA32_SUPPORT_PREFETCH_QUEUE)
                 if (adr < extmem_size) {                  if (CPU_PREFETCHQ_REMAIN <= 0) {
                         cpumem[adr] = value;                          cpu_prefetch(addr);
                 } else {  
                         ia32_panic("cpu_memorywrite: out of universe.");  
                 }                  }
         }                  if (CPU_PREFETCHQ_REMAIN >= 4) {
 }                          return cpu_prefetchq_d(addr);
   
 DWORD MEMCALL  
 cpu_memoryread_d(DWORD address)  
 {  
         DWORD adr = address & cpumem_addrmask;  
         DWORD val;  
   
         if (adr < LOWMEM - 3) {  
                 val = __i286_memoryread_d(adr);  
         } else if (adr < LOWMEM) {  
                 val = cpu_memoryread_w(adr);  
                 val |= (DWORD)cpu_memoryread_w(adr + 2) << 16;  
         } else {  
                 adr -= LOWMEM;  
                 if (adr < extmem_size - 3) {  
                         val = LOADINTELDWORD(cpumem + adr);  
                 } else {                  } else {
                         ia32_panic("cpu_memoryread_d: out of universe.");                          switch (CPU_PREFETCHQ_REMAIN) {
                         val = (DWORD)-1;                          case 1:
                                   v = cpu_prefetchq(addr);
                                   addr++;
                                   cpu_prefetch(addr);
                                   v += (UINT32)cpu_prefetchq_3(addr) << 8;
                                   break;
   
                           case 2:
                                   v = cpu_prefetchq_w(addr);
                                   addr += 2;
                                   cpu_prefetch(addr);
                                   v += (UINT32)cpu_prefetchq_w(addr) << 16;
                                   break;
   
                           case 3:
                                   v = cpu_prefetchq_3(addr);
                                   addr += 3;
                                   cpu_prefetch(addr);
                                   v += (UINT32)cpu_prefetchq(addr) << 24;
                                   break;
                           }
                           return v;
                 }                  }
   #else   /* !IA32_SUPPORT_PREFETCH_QUEUE */
                   if (!CPU_STAT_PAGING)
                           return cpu_memoryread_d(addr);
                   return cpu_lcmemoryread_d(addr);
   #endif  /* IA32_SUPPORT_PREFETCH_QUEUE */
         }          }
         return val;          EXCEPTION(GP_EXCEPTION, 0);
           return 0;       /* compiler happy */
 }  }
   
 WORD MEMCALL  
 cpu_memoryread_w(DWORD address)  
 {  
         DWORD adr = address & cpumem_addrmask;  
         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 {  
                 adr -= LOWMEM;  
                 if (adr < extmem_size - 1) {  
                         val = LOADINTELWORD(cpumem + adr);  
                 } else {  
                         ia32_panic("cpu_memoryread_w: out of universe.");  
                         val = (WORD)-1;  
                 }  
         }  
         return val;  
 }  
   
 BYTE MEMCALL  /*
 cpu_memoryread(DWORD address)   * virtual address memory access functions
 {   */
         DWORD adr = address & cpumem_addrmask;  #include "cpu_mem.mcr"
         BYTE val;  
   
         if (adr < LOWMEM) {  VIRTUAL_ADDRESS_MEMORY_ACCESS_FUNCTION(b, UINT8, 1)
                 val = __i286_memoryread(adr);  VIRTUAL_ADDRESS_MEMORY_ACCESS_FUNCTION(w, UINT16, 2)
         } else {  VIRTUAL_ADDRESS_MEMORY_ACCESS_FUNCTION(d, UINT32, 4)
                 adr -= LOWMEM;  
                 if (adr < extmem_size) {  
                         val = cpumem[adr];  
                 } else {  
                         ia32_panic("cpu_memoryread: out of universe.");  
                         val = (BYTE)-1;  
                 }  
         }  
         return val;  
 }  
Removed from v.1.2  
changed lines
  Added in v.1.16

RetroPC.NET-CVS <cvs@retropc.net>