[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.4 and 1.33

version 1.4, 2004/01/07 14:49:10 version 1.33, 2012/01/08 19:09:40
Line 1 Line 1
 /*      $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 12 Line 10
  * 2. Redistributions in binary form must reproduce the above copyright   * 2. Redistributions in binary form must reproduce the above copyright
  *    notice, this list of conditions and the following disclaimer in the   *    notice, this list of conditions and the following disclaimer in the
  *    documentation and/or other materials provided with the distribution.   *    documentation and/or other materials provided with the distribution.
  * 3. The name of the author may not be used to endorse or promote products  
  *    derived from this software without specific prior written permission.  
  *   *
  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR   * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES   * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
Line 31 Line 27
 #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   * memory access check
  */   */
   static int MEMCALL check_limit_upstairs(descriptor_t *sdp, UINT32 offset, UINT len);
 int  static void MEMCALL cpu_memoryread_check(descriptor_t *sdp, UINT32 offset, UINT len, int e);
 init_cpumem(BYTE usemem)  static void MEMCALL cpu_memorywrite_check(descriptor_t *sdp, UINT32 offset, UINT len, int e);
 {  
         DWORD size;  static int MEMCALL
   check_limit_upstairs(descriptor_t *sdp, UINT32 offset, UINT len)
         if (usemem > 13)  {
                 usemem = 13;          UINT32 limit;
         size = usemem << 20;          UINT32 end;
   
         if (extmem_size != size - (LOWMEM - 0x100000)) {          __ASSERT(sdp != NULL);
                 if (cpumem) {          __ASSERT(len > 0);
                         free(cpumem);  
                         cpumem = 0;          len--;
           end = offset + len;
           limit = SEG_IS_32BIT(sdp) ? 0xffffffff : 0x0000ffff;
   
           if (SEG_IS_DATA(sdp) && SEG_IS_EXPANDDOWN_DATA(sdp)) {
                   /* expand-down data segment */
                   if (sdp->u.seg.limit == 0) {
                           /*
                            *   32bit       16bit
                            * +-------+   +-------+ FFFFFFFFh
                            * |       |   |       |
                            * |       |   +  [1]  + 0000FFFFh
                            * | valid |   |       |
                            * |       |   +-------+ 0000FFFFh - len -1
                            * |       |   | valid |
                            * +-------+   +-------+ 00000000h
                            */
                           if (!SEG_IS_32BIT(sdp)) {
                                   if ((len > limit)               /* len check */
                                    || (end > limit)) {            /* [1] */
                                           goto exc;
                                   }
                           } else {
                                   sdp->flag |= CPU_DESC_FLAG_WHOLEADR;
                           }
                   } else {
                           /*
                            *   32bit       16bit
                            * +-------+   +-------+ FFFFFFFFh
                            * |  [2]  |   |       |
                            * +-------+   +.......+ FFFFFFFFh - len - 1
                            * |       |   |  [2]  |
                            * |       |   +.......+ 0000FFFFh
                            * | valid |   |       |
                            * |       |   +-------+ 0000FFFFh - len - 1
                            * |       |   | valid |
                            * +-------+   +-------+ seg.limit
                            * |  [1]  |   |  [1]  |
                            * +-------+   +-------+ 00000000h
                            */
                           if ((len > limit - sdp->u.seg.limit)    /* len check */
                            || (end < offset)                      /* wrap check */
                            || (offset < sdp->u.seg.limit)         /* [1] */
                            || (end > limit)) {                    /* [2] */
                                   goto exc;
                           }
                 }                  }
                 if (size <= LOWMEM - 0x100000) {          } else {
                         extmem_size = 0;                  /* expand-up data or code segment */
                         cpumem = 0;                  if (sdp->u.seg.limit == limit) {
                           /*
                            *   32bit       16bit
                            * +-------+   +-------+ FFFFFFFFh
                            * |       |   |       |
                            * |       |   +  [1]  + 0000FFFFh
                            * | valid |   |       |
                            * |       |   +-------+ 0000FFFFh - len - 1
                            * |       |   | valid |
                            * +-------+   +-------+ 00000000h
                            */
                           if (!SEG_IS_32BIT(sdp)) {
                                   if ((len > limit)               /* len check */
                                    || (offset + len > limit)) {   /* [1] */
                                           goto exc;
                                   }
                           } else {
                                   sdp->flag |= CPU_DESC_FLAG_WHOLEADR;
                           }
                 } else {                  } else {
                         extmem_size = size - (LOWMEM - 0x100000);                          /*
                         cpumem = (BYTE *)malloc(extmem_size);                           *   32bit       16bit
                         if (cpumem == NULL) {                           * +-------+   +-------+ FFFFFFFFh
                                 protectmem_size = 0;                           * |       |   |       |
                                 return FAILURE;                           * |       |   +.......+ 0000FFFFh
                            * |  [1]  |   |  [1]  |
                            * +.......+   +.......+ seg.limit
                            * |       |   |       |
                            * +-------+   +-------+ seg.limit - len - 1
                            * | valid |   | valid |
                            * +-------+   +-------+ 00000000h
                            */
                           if ((len > sdp->u.seg.limit)            /* len check */
                            || (end < offset)                      /* wrap check */
                            || (end > sdp->u.seg.limit + 1)) {     /* [1] */
                                   goto exc;
                         }                          }
                         memset(cpumem, 0, extmem_size);  
                 }                  }
         }          }
         protectmem_size = usemem;          return 1;       /* Ok! */
         return SUCCESS;  
 }  
   
   exc:
           VERBOSE(("check_limit_upstairs: check failure: offset = 0x%08x, len = %d", offset, len + 1));
   #if defined(DEBUG)
           segdesc_dump(sdp);
   #endif
           return 0;
   }
   
 /*  static void MEMCALL
  * memory access check  cpu_memoryread_check(descriptor_t *sdp, UINT32 offset, UINT len, int e)
  */  
 void  
 cpu_memoryread_check(descriptor_t* sd, DWORD madr, DWORD length, int e)  
 {  {
   
         if (CPU_STAT_PM) {          __ASSERT(sdp != NULL);
                 /* invalid */          __ASSERT(len > 0);
                 if (!sd->valid) {  
                         EXCEPTION(GP_EXCEPTION, 0);  
                 }  
   
                 /* not present */  
                 if (!sd->p) {  
                         EXCEPTION(e, 0);  
                 }  
   
                 switch (sd->type) {          if (!SEG_IS_VALID(sdp)) {
                 case 0:  case 1:        /* ro */                  e = GP_EXCEPTION;
                 case 2:  case 3:        /* rw */                  goto exc;
                 case 10: case 11:       /* rx */          }
                 case 14: case 15:       /* rxc */          if (!SEG_IS_PRESENT(sdp)
                         if ((madr > sd->u.seg.segend - length + 1)           || SEG_IS_SYSTEM(sdp)
                             || (length - 1 > sd->u.seg.limit)) {           || (SEG_IS_CODE(sdp) && !SEG_IS_READABLE_CODE(sdp))) {
                                 EXCEPTION(e, 0);                  goto exc;
                         }          }
                         break;  
   
                 case 4:  case 5:        /* ro (expand down) */          switch (sdp->type) {
                 case 6:  case 7:        /* rw (expand down) */          case 0:  case 1:        /* ro */
                 {          case 2:  case 3:        /* rw */
                         DWORD uplimit = sd->d ? 0xffffffff : 0x0000ffff;          case 4:  case 5:        /* ro (expand down) */
                         if ((madr <= sd->u.seg.segend)          case 6:  case 7:        /* rw (expand down) */
                             || (madr > uplimit)          case 10: case 11:       /* rx */
                             || (uplimit - madr < length - 1)) {          case 14: case 15:       /* rxc */
                                 EXCEPTION(e, 0);                  if (!check_limit_upstairs(sdp, offset, len))
                         }                          goto exc;
                 }                  break;
                         break;  
   
                 default:          default:
                         EXCEPTION(e, 0);                  goto exc;
                         break;  
                 }  
         }          }
         sd->flag |= CPU_DESC_READABLE;          sdp->flag |= CPU_DESC_FLAG_READABLE;
           return;
   
   exc:
           VERBOSE(("cpu_memoryread_check: check failure: offset = 0x%08x, len = %d", offset, len));
   #if defined(DEBUG)
           segdesc_dump(sdp);
   #endif
           EXCEPTION(e, 0);
 }  }
   
 void  static void MEMCALL
 cpu_memorywrite_check(descriptor_t* sd, DWORD madr, DWORD length, int e)  cpu_memorywrite_check(descriptor_t *sdp, UINT32 offset, UINT len, int e)
 {  {
   
         if (CPU_STAT_PM) {          __ASSERT(sdp != NULL);
                 /* invalid */          __ASSERT(len > 0);
                 if (!sd->valid) {  
                         EXCEPTION(GP_EXCEPTION, 0);  
                 }  
   
                 /* not present */          if (!SEG_IS_VALID(sdp)) {
                 if (!sd->p) {                  e = GP_EXCEPTION;
                         EXCEPTION(e, 0);                  goto exc;
                 }          }
           if (!SEG_IS_PRESENT(sdp)
                 switch (sd->type) {           || SEG_IS_SYSTEM(sdp)
                 case 2: case 3: /* rw */           || SEG_IS_CODE(sdp)
                         if ((madr > sd->u.seg.segend - length + 1)           || (SEG_IS_DATA(sdp) && !SEG_IS_WRITABLE_DATA(sdp))) {
                             || (length - 1 > sd->u.seg.limit)) {                  goto exc;
                                 EXCEPTION(e, 0);          }
                         }  
                         break;  
   
                 case 6: case 7: /* rw (expand down) */          switch (sdp->type) {
                 {          case 2: case 3: /* rw */
                         DWORD uplimit = sd->d ? 0xffffffff : 0x0000ffff;          case 6: case 7: /* rw (expand down) */
                         if ((madr <= sd->u.seg.segend)                  if (!check_limit_upstairs(sdp, offset, len))
                             || (madr > uplimit)                          goto exc;
                             || (uplimit - madr < length - 1)) {                  break;
                                 EXCEPTION(e, 0);  
                         }  
                 }  
                         break;  
   
                 default:          default:
                         EXCEPTION(e, 0);                  goto exc;
                         break;  
                 }  
         }          }
         sd->flag |= CPU_DESC_WRITABLE;          sdp->flag |= CPU_DESC_FLAG_WRITABLE | CPU_DESC_FLAG_READABLE;
           return;
   
   exc:
           VERBOSE(("cpu_memorywrite_check: check failure: offset = 0x%08x, len = %d", offset, len));
   #if defined(DEBUG)
           segdesc_dump(sdp);
   #endif
           EXCEPTION(e, 0);
 }  }
   
 BOOL  void MEMCALL
 cpu_stack_push_check(descriptor_t* sdp, DWORD esp, DWORD length)  cpu_stack_push_check(UINT16 s, descriptor_t *sdp, UINT32 sp, UINT len)
 {  {
           UINT32 limit;
           UINT32 start;
   
         if (!CPU_STAT_PM)          __ASSERT(sdp != NULL);
                 return TRUE;          __ASSERT(len > 0);
   
         if (!sdp->valid || !sdp->p)          len--;
                 return FALSE;  
 #ifdef _DEBUG          if (!SEG_IS_VALID(sdp)
         if (!sdp->s || sdp->u.seg.c || !sdp->u.seg.wr)           || !SEG_IS_PRESENT(sdp)
                 return FALSE;           || SEG_IS_SYSTEM(sdp)
 #endif           || SEG_IS_CODE(sdp)
            || !SEG_IS_WRITABLE_DATA(sdp)) {
                   goto exc;
           }
   
           start = sp - len;
           limit = SEG_IS_32BIT(sdp) ? 0xffffffff : 0x0000ffff;
   
         if (!sdp->d)          if (SEG_IS_EXPANDDOWN_DATA(sdp)) {
                 esp &= 0xffff;                  /* expand-down stack */
         if (sdp->u.seg.ec) {                  if (!SEG_IS_32BIT(sdp)) {
                 DWORD limit = (sdp->d) ? 0xffffffff : 0xffff;                          if (sp > limit) {                       /* [*] */
                 if ((esp == 0)                                  goto exc;
                  || (esp < length)                          }
                  || (esp - length <= sdp->u.seg.segend)                  }
                  || (esp > limit))                  if (sdp->u.seg.limit == 0) {
                         return FALSE;                          /*
                            *   32bit       16bit
                            * +-------+   +-------+ FFFFFFFFh
                            * |       |   |  [*]  |
                            * |       |   +-------+ 0000FFFFh
                            * | valid |   |       |
                            * |       |   | valid |
                            * |       |   |       |
                            * +-------+   +-------+ 00000000h
                            */
                           if (!SEG_IS_32BIT(sdp)) {
                                   if (sp > limit) {               /* [1] */
                                           goto exc;
                                   }
                           } else {
                                   sdp->flag |= CPU_DESC_FLAG_WHOLEADR;
                           }
                   } else {
                           /*
                            *   32bit       16bit
                            * +-------+   +-------+ FFFFFFFFh
                            * |       |   |  [*]  |
                            * | valid |   +-------+ 0000FFFFh
                            * |       |   | valid |
                            * +-------+   +-------+ seg.limit + len - 1
                            * |       |   |       |
                            * +..[1]..+   +..[1]..+ seg.limit
                            * |       |   |       |
                            * +-------+   +-------+ 00000000h
                            */
                           if ((len > limit - sdp->u.seg.limit)    /* len check */
                            || (start > sp)                        /* wrap check */
                            || (start < sdp->u.seg.limit)) {       /* [1] */
                                   goto exc;
                           }
                   }
         } else {          } else {
                 /* expand-up stack */                  /* expand-up stack */
                 if (esp == 0) {                  if (sdp->u.seg.limit == limit) {
                         if ((sdp->d && (sdp->u.seg.segend != 0xffffffff))                          /*
                          || (!sdp->d && (sdp->u.seg.segend != 0xffff)))                           *   32bit       16bit
                                 return FALSE;                           * +-------+   +-------+ FFFFFFFFh
                            * |       |   |  [1]  |
                            * |       |   +-------+ 0000FFFFh
                            * | valid |   |       |
                            * |       |   | valid |
                            * |       |   |       |
                            * +-------+   +-------+ 00000000h
                            */
                           if (!SEG_IS_32BIT(sdp)) {
                                   if (sp > limit) {               /* [1] */
                                           goto exc;
                                   }
                           } else {
                                   sdp->flag |= CPU_DESC_FLAG_WHOLEADR;
                           }
                 } else {                  } else {
                         if ((esp < length)                          /*
                          || (esp - 1 > sdp->u.seg.segend))                           *   32bit       16bit
                                 return FALSE;                           * +-------+   +-------+ FFFFFFFFh
                            * |       |   |       |
                            * |  [1]  |   +  [1]  + 0000FFFFh
                            * |       |   |       |
                            * +-------+   +-------+ seg.limit
                            * | valid |   | valid |
                            * +.......+   +.......+ len - 1
                            * |  [+]  |   |  [+]  |
                            * +-------+   +-------+ 00000000h
                            *
                            * [+]: wrap check
                            */
                           if ((len > sdp->u.seg.limit)            /* len check */
                            || (start > sp)                        /* wrap check */
                            || (sp > sdp->u.seg.limit + 1)) {      /* [1] */
                                   goto exc;
                           }
                 }                  }
         }          }
         return TRUE;          return;
   
   exc:
           VERBOSE(("cpu_stack_push_check: check failure: selector = 0x%04x, sp = 0x%08x, len = %d", s, sp, len));
   #if defined(DEBUG)
           segdesc_dump(sdp);
   #endif
           EXCEPTION(SS_EXCEPTION, s & 0xfffc);
 }  }
   
 BOOL  void MEMCALL
 cpu_stack_pop_check(descriptor_t* sdp, DWORD esp, DWORD length)  cpu_stack_pop_check(UINT16 s, descriptor_t *sdp, UINT32 sp, UINT len)
 {  {
         DWORD limit;  
   
         if (!CPU_STAT_PM)          __ASSERT(sdp != NULL);
                 return TRUE;          __ASSERT(len > 0);
   
         if (!sdp->valid || !sdp->p)  
                 return FALSE;  
 #ifdef _DEBUG  
         if (!sdp->s || sdp->u.seg.c || !sdp->u.seg.wr)  
                 return FALSE;  
 #endif  
   
         if (!sdp->d) {          if (!SEG_IS_VALID(sdp)
                 esp &= 0xffff;           || !SEG_IS_PRESENT(sdp)
                 limit = 0xffff;           || SEG_IS_SYSTEM(sdp)
         } else {           || SEG_IS_CODE(sdp)
                 limit = 0xffffffff;           || !SEG_IS_WRITABLE_DATA(sdp)) {
         }                  goto exc;
         if (sdp->u.seg.ec) {  
                 if ((esp == limit)  
                  || ((limit  - esp) + 1 < length))  
                         return FALSE;  
         } else {  
                 /* expand-up stack */  
                 if ((esp == limit)  
                  || (sdp->u.seg.segend == 0)  
                  || (esp > sdp->u.seg.segend)  
                  || ((sdp->u.seg.segend - esp) + 1 < length))  
                         return FALSE;  
         }          }
         return TRUE;  
           if (!check_limit_upstairs(sdp, sp, len))
                   goto exc;
           return;
   
   exc:
           VERBOSE(("cpu_stack_pop_check: check failure: selector = 0x%04x, sp = 0x%08x, len = %d", s, sp, len));
   #if defined(DEBUG)
           segdesc_dump(sdp);
   #endif
           EXCEPTION(SS_EXCEPTION, s & 0xfffc);
 }  }
   
   
 /*  /*
  * code fetch   * code fetch
  */   */
 BYTE MEMCALL  UINT8 MEMCALL
 cpu_codefetch(DWORD madr)  cpu_codefetch(UINT32 offset)
 {  {
         descriptor_t *sd;          const int ucrw = CPU_PAGE_READ_CODE | CPU_STAT_USER_MODE;
         DWORD addr;          descriptor_t *sdp;
           UINT32 addr;
   
         sd = &CPU_STAT_SREG(CPU_CS_INDEX);          sdp = &CPU_CS_DESC;
         if (!CPU_INST_AS32)          addr = sdp->u.seg.segbase + offset;
                 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          if (!CPU_STAT_PM)
 cpu_codefetch_w(DWORD madr)                  return cpu_memoryread(addr);
 {          if (offset <= sdp->u.seg.limit)
         descriptor_t *sd;                  return cpu_lmemoryread(addr, ucrw);
         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);          EXCEPTION(GP_EXCEPTION, 0);
         return 0;       /* compiler happy */          return 0;       /* compiler happy */
 }  }
   
 DWORD MEMCALL  UINT16 MEMCALL
 cpu_codefetch_d(DWORD madr)  cpu_codefetch_w(UINT32 offset)
 {  {
         descriptor_t *sd;          const int ucrw = CPU_PAGE_READ_CODE | CPU_STAT_USER_MODE;
         DWORD addr;          descriptor_t *sdp;
           UINT32 addr;
   
           sdp = &CPU_CS_DESC;
           addr = sdp->u.seg.segbase + offset;
   
           if (!CPU_STAT_PM)
                   return cpu_memoryread_w(addr);
           if (offset <= sdp->u.seg.limit - 1)
                   return cpu_lmemoryread_w(addr, ucrw);
   
         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);          EXCEPTION(GP_EXCEPTION, 0);
         return 0;       /* compiler happy */          return 0;       /* compiler happy */
 }  }
   
   UINT32 MEMCALL
 /*  cpu_codefetch_d(UINT32 offset)
  * virtual address -> linear address  
  */  
 BYTE MEMCALL  
 cpu_vmemoryread(int idx, DWORD madr)  
 {  {
         descriptor_t *sd;          const int ucrw = CPU_PAGE_READ_CODE | CPU_STAT_USER_MODE;
         DWORD addr;          descriptor_t *sdp;
           UINT32 addr;
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);          sdp = &CPU_CS_DESC;
           addr = sdp->u.seg.segbase + offset;
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         if (!CPU_INST_AS32)          if (!CPU_STAT_PM)
                 madr &= 0xffff;                  return cpu_memoryread_d(addr);
         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          if (offset <= sdp->u.seg.limit - 3)
 cpu_vmemoryread_w(int idx, DWORD madr)                  return cpu_lmemoryread_d(addr, ucrw);
 {  
         descriptor_t *sd;  
         DWORD addr;  
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);          EXCEPTION(GP_EXCEPTION, 0);
           return 0;       /* compiler happy */
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         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  /*
 cpu_vmemoryread_d(int idx, DWORD madr)   * additional physical address memory access functions
    */
   UINT64 MEMCALL
   cpu_memoryread_q(UINT32 paddr)
 {  {
         descriptor_t *sd;          UINT64 value;
         DWORD addr;  
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);          value = cpu_memoryread_d(paddr);
           value += (UINT64)cpu_memoryread_d(paddr + 4) << 32;
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         if (!CPU_INST_AS32)          return value;
                 madr &= 0xffff;  
         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);  
         }  
         /*NOTREACHED*/  
 }  }
   
 /* vaddr memory write */  
 void MEMCALL  void MEMCALL
 cpu_vmemorywrite(int idx, DWORD madr, BYTE val)  cpu_memorywrite_q(UINT32 paddr, UINT64 value)
 {  {
         descriptor_t *sd;  
         DWORD addr;  
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);  
   
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         if (!CPU_INST_AS32)          cpu_memorywrite_d(paddr, (UINT32)value);
                 madr &= 0xffff;          cpu_memorywrite_d(paddr + 4, (UINT32)(value >> 32));
         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);  
         }  
         /*NOTREACHED*/  
 }  }
   
 void MEMCALL  REG80 MEMCALL
 cpu_vmemorywrite_w(int idx, DWORD madr, WORD val)  cpu_memoryread_f(UINT32 paddr)
 {  {
         descriptor_t *sd;          REG80 value;
         DWORD addr;          int i;
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);          for (i = 0; i < (int)sizeof(REG80); ++i) {
                   value.b[i] = cpu_memoryread(paddr + i);
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }  
   
         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*/          return value;
 }  }
   
 void MEMCALL  void MEMCALL
 cpu_vmemorywrite_d(int idx, DWORD madr, DWORD val)  cpu_memorywrite_f(UINT32 paddr, const REG80 *value)
 {  {
         descriptor_t *sd;          int i;
         DWORD addr;  
   
         __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);          for (i = 0; i < (int)sizeof(REG80); ++i) {
                   cpu_memorywrite(paddr + i, value->b[i]);
         sd = &CPU_STAT_SREG(idx);  
         if (!sd->valid) {  
                 EXCEPTION(GP_EXCEPTION, 0);  
         }          }
   
         if (!CPU_INST_AS32)  
                 madr &= 0xffff;  
         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);  
         }  
         /*NOTREACHED*/  
 }  }
   
 /*  /*
  * physical address memory function   * virtual address memory access functions
  */   */
 void MEMCALL  #define CHOOSE_EXCEPTION(sreg) \
 cpu_memorywrite_d(DWORD address, DWORD value)          (((sreg) == CPU_SS_INDEX) ? SS_EXCEPTION : GP_EXCEPTION)
 {  
         DWORD adr = address & CPU_STAT_ADRSMASK;  
   
         if (adr < LOWMEM - 3) {  #include "cpu_mem.mcr"
                 __i286_memorywrite_d(adr, value);  
         } else if (adr < LOWMEM) {  
                 cpu_memorywrite_w(adr, value & 0xffff);  
                 cpu_memorywrite_w(adr + 2, (value >> 16) & 0xffff);  
         } else {  
                 adr -= LOWMEM;  
                 if (adr < extmem_size - 3) {  
                         STOREINTELDWORD(cpumem + adr, value);  
                 } else if (adr < extmem_size) {  
                         cpu_memorywrite_w(adr, value & 0xffff);  
                         cpu_memorywrite_w(adr + 2, (value >> 16) & 0xffff);  
                 }  
         }  
 }  
   
 void MEMCALL  DECLARE_VIRTUAL_ADDRESS_MEMORY_RW_FUNCTIONS(b, UINT8, 1)
 cpu_memorywrite_w(DWORD address, WORD value)  DECLARE_VIRTUAL_ADDRESS_MEMORY_RMW_FUNCTIONS(b, UINT8, 1)
 {  DECLARE_VIRTUAL_ADDRESS_MEMORY_RW_FUNCTIONS(w, UINT16, 2)
         DWORD adr = address & CPU_STAT_ADRSMASK;  DECLARE_VIRTUAL_ADDRESS_MEMORY_RMW_FUNCTIONS(w, UINT16, 2)
   DECLARE_VIRTUAL_ADDRESS_MEMORY_RW_FUNCTIONS(d, UINT32, 4)
   DECLARE_VIRTUAL_ADDRESS_MEMORY_RMW_FUNCTIONS(d, UINT32, 4)
   DECLARE_VIRTUAL_ADDRESS_MEMORY_RW_FUNCTIONS(q, UINT64, 8)
   
   REG80 MEMCALL
   cpu_vmemoryread_f(int idx, UINT32 offset)
   {
           descriptor_t *sdp;
           UINT32 addr;
           int exc;
   
         if (adr < LOWMEM - 1) {          __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);
                 __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          sdp = &CPU_STAT_SREG(idx);
 cpu_memorywrite(DWORD address, BYTE value)          addr = sdp->u.seg.segbase + offset;
 {  
         DWORD adr = address & CPU_STAT_ADRSMASK;  
   
         if (adr < LOWMEM) {          if (!CPU_STAT_PM)
                 __i286_memorywrite(adr, value);                  return cpu_memoryread_f(addr);
         } 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) {          if (!SEG_IS_VALID(sdp)) {
                 val = __i286_memoryread_d(adr);                  exc = GP_EXCEPTION;
         } else if (adr < LOWMEM) {                  goto err;
                 val = cpu_memoryread_w(adr);          }
                 val |= (DWORD)cpu_memoryread_w(adr + 2) << 16;          if (!(sdp->flag & CPU_DESC_FLAG_READABLE)) {
         } else {                  cpu_memoryread_check(sdp, offset, 10, CHOOSE_EXCEPTION(idx));
                 adr -= LOWMEM;          } else if (!(sdp->flag & CPU_DESC_FLAG_WHOLEADR)) {
                 if (adr < extmem_size - 3) {                  if (!check_limit_upstairs(sdp, offset, 10))
                         val = LOADINTELDWORD(cpumem + adr);                          goto range_failure;
                 } else {          } 
                         val = cpu_memoryread_w(adr);          return cpu_lmemoryread_f(addr, CPU_PAGE_READ_DATA | CPU_STAT_USER_MODE);
                         val |= (DWORD)cpu_memoryread_w(adr + 2) << 16;  
                 }  range_failure:
           VERBOSE(("cpu_vmemoryread_f: type = %d, offset = %08x, limit = %08x", sdp->type, offset, sdp->u.seg.limit));
           exc = CHOOSE_EXCEPTION(idx);
   err:
           EXCEPTION(exc, 0);
           {
                   REG80 dummy;
                   memset(&dummy, 0, sizeof(dummy));
                   return dummy;   /* compiler happy */
         }          }
         return val;  
 }  }
   
 WORD MEMCALL  void MEMCALL
 cpu_memoryread_w(DWORD address)  cpu_vmemorywrite_f(int idx, UINT32 offset, const REG80 *value)
 {  {
         DWORD adr = address & CPU_STAT_ADRSMASK;          descriptor_t *sdp;
         WORD val;          UINT32 addr;
           int exc;
   
         if (adr < LOWMEM - 1) {          __ASSERT((unsigned int)idx < CPU_SEGREG_NUM);
                 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 if (adr == extmem_size - 1) {  
                         val = 0xff00 | cpumem[adr];  
                 } else {  
                         val = (WORD)-1;  
                 }  
         }  
         return val;  
 }  
   
 BYTE MEMCALL          sdp = &CPU_STAT_SREG(idx);
 cpu_memoryread(DWORD address)          addr = sdp->u.seg.segbase + offset;
 {  
         DWORD adr = address & CPU_STAT_ADRSMASK;  
         BYTE val;  
   
         if (adr < LOWMEM) {          if (!CPU_STAT_PM) {
                 val = __i286_memoryread(adr);                  cpu_memorywrite_f(addr, value);
         } else {                  return;
                 adr -= LOWMEM;          }
                 if (adr < extmem_size) {  
                         val = cpumem[adr];          if (!SEG_IS_VALID(sdp)) {
                 } else {                  exc = GP_EXCEPTION;
                         val = (BYTE)-1;                  goto err;
                 }          }
         }          if (!(sdp->flag & CPU_DESC_FLAG_WRITABLE)) {
         return val;                  cpu_memorywrite_check(sdp, offset, 10, CHOOSE_EXCEPTION(idx));
           } else if (!(sdp->flag & CPU_DESC_FLAG_WHOLEADR)) {
                   if (!check_limit_upstairs(sdp, offset, 10))
                           goto range_failure;
           }
           cpu_lmemorywrite_f(addr, value, CPU_PAGE_WRITE_DATA | CPU_STAT_USER_MODE);
           return;
   
   range_failure:
           VERBOSE(("cpu_vmemorywrite_f: type = %d, offset = %08x, limit = %08x", sdp->type, offset, sdp->u.seg.limit));
           exc = CHOOSE_EXCEPTION(idx);
   err:
           EXCEPTION(exc, 0);
 }  }
Removed from v.1.4  
changed lines
  Added in v.1.33

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