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

Diff for /np2/i386c/ia32/exception.c between versions 1.2 and 1.13

version 1.2, 2003/12/08 02:09:17 version 1.13, 2004/03/02 16:36:28
Line 31 Line 31
 #include "cpu.h"  #include "cpu.h"
 #include "ia32.mcr"  #include "ia32.mcr"
   
 void  const char *exception_str[EXCEPTION_NUM] = {
 memory_dump(int idx, DWORD madr)          "DE_EXCEPTION",
 {          "DB_EXCEPTION",
         DWORD addr;          "NMI_EXCEPTION",
         size_t size;          "BP_EXCEPTION",
         unsigned char buf[16];          "OF_EXCEPTION",
         size_t s, i;          "BR_EXCEPTION",
         BYTE p;          "UD_EXCEPTION",
           "NM_EXCEPTION",
         if (madr < 0x80) {          "DF_EXCEPTION",
                 size = madr + 0x80;          "CoProcesser Segment Overrun",
                 addr = 0;          "TS_EXCEPTION",
         } else {          "NP_EXCEPTION",
                 size = 0x100;          "SS_EXCEPTION",
                 addr = madr - 0x80;          "GP_EXCEPTION",
         }          "PF_EXCEPTION",
         printf("memory dump\n-- \n");          "Reserved",
         for (s = 0; s < size; s++) {          "MF_EXCEPTION",
                 if ((s % 16) == 0) {          "AC_EXCEPTION",
                         printf("%08x: ", addr + s);          "MC_EXCEPTION",
                         memset(buf, '.', sizeof(buf));          "XF_EXCEPTION",
                 }  };
   
                 p = cpu_vmemoryread(idx, addr + s);  
                 printf("%02x ", p);  
                 if (p >= 0x20 && p <= 0x7e)  
                         buf[s % 16] = p;  
   
                 if ((s % 16) == 15) {  
                         printf("| ");  
                         for (i = 0; i < sizeof(buf); i++)  
                                 printf("%c", buf[i]);  
                         printf("\n");  
                 }  
         }  
 }  
   
 static const int exctype[EXCEPTION_NUM] = {  static const int exctype[EXCEPTION_NUM] = {
         1, 0, 0, 0, 0, 0, 0, 0, 3, 0, 1, 1, 1, 1, 2, 0, 0, 0, 0, 0,          1, 0, 0, 0, 0, 0, 0, 0, 3, 0, 1, 1, 1, 1, 2, 0, 0, 0, 0, 0,
Line 84  exception(int num, int error_code) Line 70  exception(int num, int error_code)
 {  {
         int errorp = 0;          int errorp = 0;
   
         VERBOSE(("exception: num = 0x%02x, error_code = %x", num, error_code));          __ASSERT((unsigned int)num < EXCEPTION_NUM);
   
         CPU_STAT_NERROR++;          VERBOSE(("exception: -------------------------------------------------------------- start"));
         if ((CPU_STAT_NERROR >= 3)           VERBOSE(("exception: %s, error_code = %x at %04x:%08x", exception_str[num], error_code, CPU_CS, CPU_PREV_EIP));
          || (CPU_STAT_NERROR == 2 && CPU_STAT_PREV_EXCEPTION == DF_EXCEPTION)) {          VERBOSE(("%s", cpu_reg2str()));
   
           CPU_STAT_EXCEPTION_COUNTER_INC();
           if ((CPU_STAT_EXCEPTION_COUNTER >= 3) 
            || (CPU_STAT_EXCEPTION_COUNTER == 2 && CPU_STAT_PREV_EXCEPTION == DF_EXCEPTION)) {
                 /* Triple fault */                  /* Triple fault */
                 ia32_panic("exception: catch triple fault!");                  ia32_panic("exception: catch triple fault!");
         }          }
Line 112  exception(int num, int error_code) Line 102  exception(int num, int error_code)
                 error_code = 0;                  error_code = 0;
                 break;                  break;
   
   #if CPU_FAMILY >= 4
         case AC_EXCEPTION:      /* (F) アラインメントチェック (errcode: 0) */          case AC_EXCEPTION:      /* (F) アラインメントチェック (errcode: 0) */
                 error_code = 0;                  error_code = 0;
                 /*FALLTHROUGH*/                  /*FALLTHROUGH*/
   #endif
         case TS_EXCEPTION:      /* (F) 無効 TSS (errcode) */          case TS_EXCEPTION:      /* (F) 無効 TSS (errcode) */
         case NP_EXCEPTION:      /* (F) セグメント不在 (errcode) */          case NP_EXCEPTION:      /* (F) セグメント不在 (errcode) */
         case SS_EXCEPTION:      /* (F) スタックセグメントフォルト (errcode) */          case SS_EXCEPTION:      /* (F) スタックセグメントフォルト (errcode) */
Line 129  exception(int num, int error_code) Line 121  exception(int num, int error_code)
                 errorp = 0;                  errorp = 0;
                 break;                  break;
   
   #if CPU_FAMILY >= 5
         case MC_EXCEPTION:      /* (A) マシンチェック */          case MC_EXCEPTION:      /* (A) マシンチェック */
                 CPU_EIP = CPU_PREV_EIP;                  CPU_EIP = CPU_PREV_EIP;
                 errorp = 0;                  errorp = 0;
                 break;                  break;
   #endif
   
   #if CPU_FAMILY >= 6
         case XF_EXCEPTION:      /* (F) ストリーミング SIMD 拡張命令 */          case XF_EXCEPTION:      /* (F) ストリーミング SIMD 拡張命令 */
                 CPU_EIP = CPU_PREV_EIP;                  CPU_EIP = CPU_PREV_EIP;
                 errorp = 0;                  errorp = 0;
                 break;                  break;
   #endif
   
         default:          default:
                 ia32_panic("exception(): unknown exception (%d)", num);                  ia32_panic("exception: unknown exception (%d)", num);
                 break;                  break;
         }          }
   
         if (CPU_STAT_NERROR >= 2) {          if (CPU_STAT_EXCEPTION_COUNTER >= 2) {
                 if (dftable[exctype[CPU_STAT_PREV_EXCEPTION]][exctype[num]]) {                  if (dftable[exctype[CPU_STAT_PREV_EXCEPTION]][exctype[num]]) {
                         num = DF_EXCEPTION;                          num = DF_EXCEPTION;
                 }                  }
         }          }
         CPU_STAT_PREV_EXCEPTION = num;          CPU_STAT_PREV_EXCEPTION = num;
   
         INTERRUPT(num, FALSE, errorp, error_code);          VERBOSE(("exception: ---------------------------------------------------------------- end"));
         CPU_STAT_NERROR = 0;  
 #if defined(WIN32)          INTERRUPT(num, 0, errorp, error_code);
         longjmp(exec_1step_jmpbuf, 1);          CPU_STAT_EXCEPTION_COUNTER_CLEAR();
 #else  
         siglongjmp(exec_1step_jmpbuf, 1);          siglongjmp(exec_1step_jmpbuf, 1);
 #endif  
 }  }
   
 /*  /*
Line 165  exception(int num, int error_code) Line 159  exception(int num, int error_code)
  *   *
  *  31                                16 15 14 13 12       8 7   5 4       0   *  31                                16 15 14 13 12       8 7   5 4       0
  * +------------------------------------+--+-----+----------+-----+---------+   * +------------------------------------+--+-----+----------+-----+---------+
  * |         オフセット 31..16          | P| DPL | 0 1 1 0 0|0 0 0|カウント | 4   * |         オフセット 31..16          | P| DPL | 0 D 1 0 0|0 0 0|カウント | 4
  * +------------------------------------+--+-----+----------+-----+---------+   * +------------------------------------+--+-----+----------+-----+---------+
  *  31                                16 15                                0   *  31                                16 15                                0
  * +------------------------------------+-----------------------------------+   * +------------------------------------+-----------------------------------+
Line 180  exception(int num, int error_code) Line 174  exception(int num, int error_code)
  *   *
  *  31                                16 15 14 13 12       8 7             0   *  31                                16 15 14 13 12       8 7             0
  * +------------------------------------+--+-----+----------+---------------+   * +------------------------------------+--+-----+----------+---------------+
  * |              Reserved              | P| DPL | 0 D 1 0 1|   Reserved    | 4   * |              Reserved              | P| DPL | 0 0 1 0 1|   Reserved    | 4
  * +------------------------------------+--+-----+----------+---------------+   * +------------------------------------+--+-----+----------+---------------+
  *  31                                16 15                                0   *  31                                16 15                                0
  * +------------------------------------+-----------------------------------+   * +------------------------------------+-----------------------------------+
Line 216  exception(int num, int error_code) Line 210  exception(int num, int error_code)
  * D          : ゲートのサイズ．0 = 16 bit, 1 = 32 bit   * D          : ゲートのサイズ．0 = 16 bit, 1 = 32 bit
  */   */
   
   static void interrupt_task_gate(descriptor_t *gd, int softintp, int errorp, int error_code);
   static void interrupt_intr_or_trap(descriptor_t *gd, int softintp, int errorp, int error_code);
   
 void  void
 interrupt(int num, int softintp, int errorp, int error_code)  interrupt(int num, int softintp, int errorp, int error_code)
 {  {
         DWORD idt_idx;          descriptor_t gd;
           UINT idt_idx;
           UINT32 new_ip;
           UINT16 new_cs;
   
         VERBOSE(("interrupt: num = 0x%02x, softintp = %s, errorp = %s, error_code = %02x", num, softintp ? "on" : "off", errorp ? "on" : "off", error_code));          VERBOSE(("interrupt: num = 0x%02x, softintp = %s, errorp = %s, error_code = %08x", num, softintp ? "on" : "off", errorp ? "on" : "off", error_code));
   
         if (!CPU_STAT_PM) {          if (!CPU_STAT_PM) {
                 /* real mode */                  /* real mode */
                 idt_idx = num * 4;                  idt_idx = num * 4;
                 if (idt_idx + 3 > CPU_IDTR_LIMIT) {                  if (idt_idx + 3 > CPU_IDTR_LIMIT) {
                         EXCEPTION(GP_EXCEPTION, num * 4 | 2);                          VERBOSE(("interrupt: real-mode IDTR limit check failure (idx = 0x%04x, limit = 0x%08x", idt_idx, CPU_IDTR_LIMIT));
                           EXCEPTION(GP_EXCEPTION, idt_idx + 2);
                 }                  }
   
                 if (!softintp) {                  if (!softintp && CPU_STAT_HLT) {
                         BYTE op = cpu_codefetch(CPU_EIP);                          CPU_EIP++;
                         if (op == 0xf4) {       /* hlt */                          CPU_STAT_HLT = FALSE;
                                 CPU_EIP++;  
                         }  
                 }                  }
   
                 REGPUSH0(REAL_FLAGREG);                  REGPUSH0(REAL_FLAGREG);
                 REGPUSH0(CPU_CS);                  REGPUSH0(CPU_CS);
                 REGPUSH0(CPU_IP);                  REGPUSH0(CPU_IP);
   
                 if (softintp) {                  CPU_EFLAG &= ~(T_FLAG | I_FLAG | AC_FLAG | RF_FLAG);
                         CPU_EFLAG &= ~(T_FLAG | I_FLAG | AC_FLAG);                  CPU_TRAP = 0;
                         CPU_TRAP = 0;  
                 }  
   
                 CPU_EIP = cpu_memoryread_w(CPU_IDTR_BASE + num * 4);                  new_ip = cpu_memoryread_w(CPU_IDTR_BASE + idt_idx);
                 CPU_CS = cpu_memoryread_w(CPU_IDTR_BASE + num * 4 + 2);                  new_cs = cpu_memoryread_w(CPU_IDTR_BASE + idt_idx + 2);
                 CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS);                  CPU_SET_SEGREG(CPU_CS_INDEX, new_cs);
                   SET_EIP(new_ip);
                 CPU_WORKCLOCK(20);                  CPU_WORKCLOCK(20);
         } else {          } else {
                 /* protected mode */                  /* protected mode */
                 selector_t task_sel, intr_sel, ss_sel;                  VERBOSE(("interrupt: -------------------------------------------------------------- start"));
                 descriptor_t gd;  
                 int rv;                  VERBOSE(("interrupt: old EIP = %04x:%08x, ESP = %04x:%08x", CPU_CS, CPU_EIP, CPU_SS, CPU_ESP));
                 DWORD flags = REAL_EFLAGREG;  
                 DWORD mask = 0;  #if defined(DEBUG)
                 DWORD new_ip, new_sp;                  if (num == 0x80) {
                 DWORD old_ip, old_sp;                          /* Linux, FreeBSD, NetBSD, OpenBSD system call */
                 WORD new_ss;                          VERBOSE(("interrupt: syscall no = %d\n%s", CPU_EAX, cpu_reg2str()));
                 WORD old_cs, old_ss;                  }
   #endif
   
                 /* VM86 && IOPL < 3 && interrupt cause == INTn */                  /* VM86 && IOPL < 3 && interrupt cause == INTn */
                 if (CPU_STAT_VM86 && (CPU_STAT_IOPL < CPU_IOPL3) && (softintp == -1)) {                  if (CPU_STAT_VM86 && (CPU_STAT_IOPL < CPU_IOPL3) && (softintp == -1)) {
                           VERBOSE(("interrupt: VM86 && IOPL < 3 && INTn"));
                         EXCEPTION(GP_EXCEPTION, 0);                          EXCEPTION(GP_EXCEPTION, 0);
                 }                  }
   
                 idt_idx = num * 8;                  idt_idx = num * 8;
                 if (idt_idx + 7 > CPU_IDTR_LIMIT) {                  if (idt_idx + 7 > CPU_IDTR_LIMIT) {
                         EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp);                          VERBOSE(("interrupt: IDTR limit check failure (idx = 0x%04x, limit = 0x%08x", idt_idx, CPU_IDTR_LIMIT));
                           EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp);
                 }                  }
   
                 CPU_SET_GATEDESC(&gd, CPU_IDTR_BASE + idt_idx);                  memset(&gd, 0, sizeof(gd));
                   load_descriptor(&gd, CPU_IDTR_BASE + idt_idx);
                 if (!gd.valid || !gd.p) {                  if (!gd.valid || !gd.p) {
                         EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp);                          VERBOSE(("interrupt: gate descripter is invalid."));
                           EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp);
                 }                  }
   
                 switch (gd.type) {                  switch (gd.type) {
Line 286  interrupt(int num, int softintp, int err Line 289  interrupt(int num, int softintp, int err
                         break;                          break;
   
                 default:                  default:
                         EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp);                          VERBOSE(("interrupt: invalid gate type (%d)", gd.type));
                           EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp);
                         break;                          break;
                 }                  }
   
                 /* 5.10.1.1. 例外／割り込みハンドラ・プロシージャの保護 */                  /* 5.10.1.1. 例外／割り込みハンドラ・プロシージャの保護 */
                 if (softintp && (gd.dpl < CPU_STAT_CPL)) {                  if (softintp && (gd.dpl < CPU_STAT_CPL)) {
                         EXCEPTION(GP_EXCEPTION, num * 8 | 2);                          VERBOSE(("interrupt: softintp && DPL(%d) < CPL(%d)", gd.dpl, CPU_STAT_CPL));
                           EXCEPTION(GP_EXCEPTION, idt_idx + 2);
                   }
   
                   if (!softintp && CPU_STAT_HLT) {
                           CPU_EIP++;
                           CPU_STAT_HLT = FALSE;
                 }                  }
   
                 switch (gd.type) {                  switch (gd.type) {
                 case CPU_SYSDESC_TYPE_TASK:                  case CPU_SYSDESC_TYPE_TASK:
                         rv = parse_selector(&task_sel, gd.u.gate.selector);                          interrupt_task_gate(&gd, softintp, errorp, error_code);
                         if (rv < 0 || task_sel.ldt) {                          break;
                                 EXCEPTION(TS_EXCEPTION, task_sel.idx);  
                         }  
   
                         /* check gate type */                  case CPU_SYSDESC_TYPE_INTR_16:
                         switch (task_sel.desc.type) {                  case CPU_SYSDESC_TYPE_INTR_32:
                         case CPU_SYSDESC_TYPE_TSS_16:                  case CPU_SYSDESC_TYPE_TRAP_16:
                         case CPU_SYSDESC_TYPE_TSS_32:                  case CPU_SYSDESC_TYPE_TRAP_32:
                                 break;                          interrupt_intr_or_trap(&gd, softintp, errorp, error_code);
                           break;
                         case CPU_SYSDESC_TYPE_TSS_BUSY_16:  
                         case CPU_SYSDESC_TYPE_TSS_BUSY_32:  
                                 VERBOSE(("interrupt: task is busy."));  
                                 /*FALLTHROUGH*/  
                         default:  
                                 EXCEPTION(TS_EXCEPTION, task_sel.idx);  
                                 break;  
                         }  
   
                         /* not present */                  default:
                         if (selector_is_not_present(&task_sel)) {                          EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp);
                                 EXCEPTION(NP_EXCEPTION, task_sel.idx);                          break;
                         }                  }
   
                   VERBOSE(("interrupt: ---------------------------------------------------------------- end"));
           }
   }
   
                         task_switch(&task_sel, TASK_SWITCH_INTR);  static void
   interrupt_task_gate(descriptor_t *gd, int softintp, int errorp, int error_code)
   {
           selector_t task_sel;
           int rv;
   
                         if (errorp) {          VERBOSE(("interrupt: TASK-GATE"));
                                 if (task_sel.desc.type == CPU_SYSDESC_TYPE_TSS_32) {  
                                         CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), CPU_ESP, 4);          (void)softintp;
                                         PUSH0_32(error_code);  
                                 } else {          rv = parse_selector(&task_sel, gd->u.gate.selector);
                                         CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), CPU_ESP, 2);          if (rv < 0 || task_sel.ldt) {
                                         PUSH0_16(error_code);                  VERBOSE(("interrupt: parse_selector (selector = %04x, rv = %d, %cDT)", gd->u.gate.selector, rv, task_sel.ldt ? 'L' : 'G'));
                                 }                  EXCEPTION(TS_EXCEPTION, task_sel.idx);
                         }          }
   
           /* check gate type */
           switch (task_sel.desc.type) {
           case CPU_SYSDESC_TYPE_TSS_16:
           case CPU_SYSDESC_TYPE_TSS_32:
                   break;
   
           case CPU_SYSDESC_TYPE_TSS_BUSY_16:
           case CPU_SYSDESC_TYPE_TSS_BUSY_32:
                   VERBOSE(("interrupt: task is busy."));
                   /*FALLTHROUGH*/
           default:
                   VERBOSE(("interrupt: invalid gate type (%d)", task_sel.desc.type));
                   EXCEPTION(TS_EXCEPTION, task_sel.idx);
                   break;
           }
   
           /* not present */
           if (selector_is_not_present(&task_sel)) {
                   VERBOSE(("interrupt: selector is not present"));
                   EXCEPTION(NP_EXCEPTION, task_sel.idx);
           }
   
           task_switch(&task_sel, TASK_SWITCH_INTR);
   
           if (errorp) {
                   XPUSH0(error_code);
           }
   }
   
   static void
   interrupt_intr_or_trap(descriptor_t *gd, int softintp, int errorp, int error_code)
   {
           selector_t cs_sel, ss_sel;
           UINT stacksize;
           UINT32 old_flags;
           UINT32 new_flags;
           UINT32 mask;
           UINT32 sp;
           UINT32 new_ip, new_sp;
           UINT32 old_ip, old_sp;
           UINT16 old_cs, old_ss, new_ss;
           int rv; 
   
           new_ip = gd->u.gate.offset;
           old_ss = CPU_SS;
           old_cs = CPU_CS;
           old_ip = CPU_EIP;
           old_sp = CPU_ESP;
           new_flags = old_flags = REAL_EFLAGREG;
   
           switch (gd->type) {
           case CPU_SYSDESC_TYPE_INTR_16:
           case CPU_SYSDESC_TYPE_INTR_32:
                   VERBOSE(("interrupt: INTERRUPT-GATE"));
                   new_flags &= ~I_FLAG;
                   mask = I_FLAG;
                   break;
   
           case CPU_SYSDESC_TYPE_TRAP_16:
           case CPU_SYSDESC_TYPE_TRAP_32:
                   VERBOSE(("interrupt: TRAP-GATE"));
   
           default:
                   mask = 0;
                   break;
           }
           new_flags &= ~(T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG);
           mask |= T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG;
   
                         /* out of range */          rv = parse_selector(&cs_sel, gd->u.gate.selector);
                         if (CPU_EIP > CPU_STAT_CS_LIMIT) {          if (rv < 0) {
                                 EXCEPTION(GP_EXCEPTION, 0);                  VERBOSE(("interrupt: parse_selector (selector = %04x, rv = %d)", gd->u.gate.selector, rv));
                   EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp);
           }
   
           /* check segment type */
           if (!cs_sel.desc.s) {
                   VERBOSE(("interrupt: code segment is system segment"));
                   EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp);
           }
           if (!cs_sel.desc.u.seg.c) {
                   VERBOSE(("interrupt: code segment is data segment"));
                   EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp);
           }
   
           /* check privilege level */
           if (cs_sel.desc.dpl > CPU_STAT_CPL) {
                   VERBOSE(("interrupt: DPL(%d) > CPL(%d)", cs_sel.desc.dpl, CPU_STAT_CPL));
                   EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp);
           }
   
           /* not present */
           if (selector_is_not_present(&cs_sel)) {
                   VERBOSE(("interrupt: selector is not present"));
                   EXCEPTION(NP_EXCEPTION, cs_sel.idx + !softintp);
           }
   
           if (!cs_sel.desc.u.seg.ec
            && (cs_sel.desc.dpl < CPU_STAT_CPL)) {
                   if (!CPU_STAT_VM86) {
                           VERBOSE(("interrupt: INTER-PRIVILEGE-LEVEL-INTERRUPT"));
                           stacksize = errorp ? 12 : 10;
                   } else {
                           /* VM86 */
                           if (cs_sel.desc.dpl != 0) {
                                   /* 16.3.1.1 */
                                   VERBOSE(("interrupt: DPL[CS](%d) != 0", cs_sel.desc.dpl));
                                   EXCEPTION(GP_EXCEPTION, cs_sel.idx);
                         }                          }
                           VERBOSE(("interrupt: INTERRUPT-FROM-VIRTUAL-8086-MODE"));
                           stacksize = errorp ? 20 : 18;
                   }
                   switch (gd->type) {
                   case CPU_SYSDESC_TYPE_INTR_32:
                   case CPU_SYSDESC_TYPE_TRAP_32:
                           stacksize *= 2;
                         break;                          break;
                   }
   
                 case CPU_SYSDESC_TYPE_INTR_16:                  get_stack_pointer_from_tss(cs_sel.desc.dpl, &new_ss, &new_sp);
   
                   rv = parse_selector(&ss_sel, new_ss);
                   if (rv < 0) {
                           VERBOSE(("interrupt: parse_selector (selector = %04x, rv = %d)", new_ss, rv));
                           EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp);
                   }
   
                   /* check privilege level */
                   if (ss_sel.rpl != cs_sel.desc.dpl) {
                           VERBOSE(("interrupt: RPL[SS](%d) != DPL[CS](%d)", ss_sel.rpl, cs_sel.desc.dpl));
                           EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp);
                   }
                   if (ss_sel.desc.dpl != cs_sel.desc.dpl) {
                           VERBOSE(("interrupt: DPL[SS](%d) != DPL[CS](%d)", ss_sel.desc.dpl, cs_sel.desc.dpl));
                           EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp);
                   }
   
                   /* check segment type */
                   if (!ss_sel.desc.s) {
                           VERBOSE(("interrupt: stack segment is system segment"));
                           EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp);
                   }
                   if (ss_sel.desc.u.seg.c) {
                           VERBOSE(("interrupt: stack segment is code segment"));
                           EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp);
                   }
                   if (!ss_sel.desc.u.seg.wr) {
                           VERBOSE(("interrupt: stack segment is read-only data segment"));
                           EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp);
                   }
   
                   /* not present */
                   if (selector_is_not_present(&ss_sel)) {
                           VERBOSE(("interrupt: selector is not present"));
                           EXCEPTION(SS_EXCEPTION, ss_sel.idx + !softintp);
                   }
   
                   /* check stack room size */
                   CHECK_STACK_PUSH(&ss_sel.desc, new_sp, stacksize);
   
                   /* out of range */
                   if (new_ip > cs_sel.desc.u.seg.limit) {
                           VERBOSE(("interrupt: new_ip is out of range. new_ip = %08x, limit = %08x", new_ip, cs_sel.desc.u.seg.limit));
                           EXCEPTION(GP_EXCEPTION, 0);
                   }
   
                   load_ss(ss_sel.selector, &ss_sel.desc, cs_sel.desc.dpl);
                   CPU_ESP = new_sp;
   
                   load_cs(cs_sel.selector, &cs_sel.desc, cs_sel.desc.dpl);
                   SET_EIP(new_ip);
   
                   switch (gd->type) {
                 case CPU_SYSDESC_TYPE_INTR_32:                  case CPU_SYSDESC_TYPE_INTR_32:
                         flags &= I_FLAG;  
                         mask |= I_FLAG;  
                         /*FALLTHROUGH*/  
                 case CPU_SYSDESC_TYPE_TRAP_16:  
                 case CPU_SYSDESC_TYPE_TRAP_32:                  case CPU_SYSDESC_TYPE_TRAP_32:
                         flags &= ~(T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG);                          if (CPU_STAT_VM86) {
                         mask |= T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG;                                  PUSH0_32(CPU_GS);
                                   PUSH0_32(CPU_FS);
                         new_ip = intr_sel.desc.u.seg.segbase;                                  PUSH0_32(CPU_DS);
                         old_ss = CPU_SS;                                  PUSH0_32(CPU_ES);
                         old_cs = CPU_CS;  
                         old_ip = CPU_EIP;                                  CPU_SET_SEGREG(CPU_GS_INDEX, 0);
                         old_sp = CPU_ESP;                                  CPU_STAT_SREG(CPU_GS_INDEX).valid = 0;
                                   CPU_SET_SEGREG(CPU_FS_INDEX, 0);
                         VERBOSE(("TRAP-OR-INTERRUPT-GATE"));                                  CPU_STAT_SREG(CPU_FS_INDEX).valid = 0;
                                   CPU_SET_SEGREG(CPU_DS_INDEX, 0);
                         rv = parse_selector(&intr_sel, gd.u.gate.selector);                                  CPU_STAT_SREG(CPU_DS_INDEX).valid = 0;
                         if (rv < 0) {                                  CPU_SET_SEGREG(CPU_ES_INDEX, 0);
                                 EXCEPTION(GP_EXCEPTION, intr_sel.idx | !softintp);                                  CPU_STAT_SREG(CPU_ES_INDEX).valid = 0;
                         }                          }
                           PUSH0_32(old_ss);
                         if (!intr_sel.desc.s                          PUSH0_32(old_sp);
                          || !intr_sel.desc.u.seg.c                          PUSH0_32(old_flags);
                          || (intr_sel.desc.dpl > CPU_STAT_CPL)) {                          PUSH0_32(old_cs);
                                 EXCEPTION(GP_EXCEPTION, intr_sel.idx | !softintp);                          PUSH0_32(old_ip);
                           if (errorp) {
                                   PUSH0_32(error_code);
                         }                          }
                           break;
   
                         /* not present */                  case CPU_SYSDESC_TYPE_INTR_16:
                         if (selector_is_not_present(&intr_sel)) {                  case CPU_SYSDESC_TYPE_TRAP_16:
                                 EXCEPTION(NP_EXCEPTION, intr_sel.idx | !softintp);                          if (CPU_STAT_VM86) {
                                   ia32_panic("interrupt: 16bit gate && VM86");
                           }
                           PUSH0_16(old_ss);
                           PUSH0_16(old_sp);
                           PUSH0_16(old_flags);
                           PUSH0_16(old_cs);
                           PUSH0_16(old_ip);
                           if (errorp) {
                                   PUSH0_16(error_code);
                         }                          }
                           break;
                   }
   
                   set_eflags(new_flags, mask);
           } else {
                   if (CPU_STAT_VM86) {
                           VERBOSE(("interrupt: VM86"));
                           EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp);
                   }
                   if (!cs_sel.desc.u.seg.ec && (cs_sel.desc.dpl != CPU_STAT_CPL)) {
                           VERBOSE(("interrupt: NON-CONFORMING-CODE-SEGMENT(%s) and DPL[CS](%d) != CPL", cs_sel.desc.u.seg.ec ? "false" : "true", cs_sel.desc.dpl, CPU_STAT_CPL));
                           EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp);
                   }
                   VERBOSE(("interrupt: INTRA-PRIVILEGE-LEVEL-INTERRUPT"));
   
                   stacksize = errorp ? 8 : 6;
                   switch (gd->type) {
                   case CPU_SYSDESC_TYPE_INTR_32:
                   case CPU_SYSDESC_TYPE_TRAP_32:
                           stacksize *= 2;
                           break;
                   }
   
                   if (CPU_STAT_SS32) {
                           sp = CPU_ESP;
                   } else {
                           sp = CPU_SP;
                   }
                   CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), sp, stacksize);
   
                   /* out of range */
                   if (new_ip > cs_sel.desc.u.seg.limit) {
                           VERBOSE(("interrupt: new_ip is out of range. new_ip = %08x, limit = %08x", new_ip, cs_sel.desc.u.seg.limit));
                           EXCEPTION(GP_EXCEPTION, 0);
                   }
   
                         if (!intr_sel.desc.u.seg.ec && (intr_sel.desc.dpl < CPU_STAT_CPL)) {                  load_cs(cs_sel.selector, &cs_sel.desc, CPU_STAT_CPL);
                                 DWORD stacksize;                  SET_EIP(new_ip);
   
                                 if (CPU_STAT_VM86) {                  switch (gd->type) {
                                         VERBOSE(("INTER-PRIVILEGE-LEVEL-INTERRUPT"));                  case CPU_SYSDESC_TYPE_INTR_32:
                                         stacksize = errorp ? 12 : 10;                  case CPU_SYSDESC_TYPE_TRAP_32:
                                 } else {                          PUSH0_32(old_flags);
                                         if (intr_sel.desc.dpl != 0) {                          PUSH0_32(old_cs);
                                                 EXCEPTION(GP_EXCEPTION, intr_sel.idx);                          PUSH0_32(old_ip);
                                         }                          if (errorp) {
                                         VERBOSE(("INTERRUPT-FROM-VIRTUAL-8086-MODE"));                                  PUSH0_32(error_code);
                                         stacksize = errorp ? 20 : 18;  
                                 }  
   
                                 get_stack_from_tss(intr_sel.desc.dpl, &new_ss, &new_sp);  
                                 rv = parse_selector(&ss_sel, new_ss);  
                                 if (rv < 0) {  
                                         EXCEPTION(TS_EXCEPTION, ss_sel.idx | !softintp);  
                                 }  
   
                                 if ((ss_sel.rpl != intr_sel.desc.dpl)  
                                  || (ss_sel.desc.dpl != intr_sel.desc.dpl)  
                                  || !ss_sel.desc.s  
                                  || ss_sel.desc.u.seg.c  
                                  || !ss_sel.desc.u.seg.wr) {  
                                         EXCEPTION(TS_EXCEPTION, ss_sel.idx | !softintp);  
                                 }  
   
                                 /* not present */  
                                 if (selector_is_not_present(&ss_sel)) {  
                                         EXCEPTION(SS_EXCEPTION, ss_sel.idx | !softintp);  
                                 }  
   
                                 switch (gd.type) {  
                                 case CPU_SYSDESC_TYPE_INTR_32:  
                                 case CPU_SYSDESC_TYPE_TRAP_32:  
                                         CHECK_STACK_PUSH(&ss_sel.desc, new_sp, stacksize * 2);  
                                         break;  
   
                                 case CPU_SYSDESC_TYPE_INTR_16:  
                                 case CPU_SYSDESC_TYPE_TRAP_16:  
                                         CHECK_STACK_PUSH(&ss_sel.desc, new_sp, stacksize);  
                                         new_ip &= 0xffff;  
                                         break;  
                                 }  
   
                                 /* out of range */  
                                 if (new_ip > intr_sel.desc.u.seg.limit) {  
                                         EXCEPTION(GP_EXCEPTION, 0);  
                                 }  
   
                                 load_ss(new_ss, &ss_sel.desc, intr_sel.desc.dpl);  
                                 CPU_ESP = new_sp;  
   
                                 if (!CPU_STAT_VM86) {  
                                         switch (gd.type) {  
                                         case CPU_SYSDESC_TYPE_INTR_32:  
                                         case CPU_SYSDESC_TYPE_TRAP_32:  
                                                 PUSH0_32(CPU_GS);  
                                                 PUSH0_32(CPU_FS);  
                                                 PUSH0_32(CPU_DS);  
                                                 PUSH0_32(CPU_ES);  
                                                 break;  
   
                                         case CPU_SYSDESC_TYPE_INTR_16:  
                                         case CPU_SYSDESC_TYPE_TRAP_16:  
                                                 PUSH0_16(CPU_GS);  
                                                 PUSH0_16(CPU_FS);  
                                                 PUSH0_16(CPU_DS);  
                                                 PUSH0_16(CPU_ES);  
                                                 break;  
                                         }  
   
                                         CPU_SET_SEGREG(CPU_GS_INDEX, 0);  
                                         CPU_SET_SEGREG(CPU_FS_INDEX, 0);  
                                         CPU_SET_SEGREG(CPU_DS_INDEX, 0);  
                                         CPU_SET_SEGREG(CPU_ES_INDEX, 0);  
                                 }  
   
                                 switch (gd.type) {  
                                 case CPU_SYSDESC_TYPE_INTR_32:  
                                 case CPU_SYSDESC_TYPE_TRAP_32:  
                                         PUSH0_32(old_ss);  
                                         PUSH0_32(old_sp);  
                                         PUSH0_32(REAL_EFLAGREG);  
                                         PUSH0_32(old_cs);  
                                         PUSH0_32(old_ip);  
                                         if (errorp) {  
                                                 PUSH0_32(error_code);  
                                         }  
                                         break;  
   
                                 case CPU_SYSDESC_TYPE_INTR_16:  
                                 case CPU_SYSDESC_TYPE_TRAP_16:  
                                         PUSH0_16(old_ss);  
                                         PUSH0_16(old_sp);  
                                         PUSH0_16(REAL_FLAGREG);  
                                         PUSH0_16(old_cs);  
                                         PUSH0_16(old_ip);  
                                         if (errorp) {  
                                                 PUSH0_16(error_code);  
                                         }  
                                         break;  
                                 }  
   
                                 load_cs(intr_sel.selector, &intr_sel.desc, intr_sel.desc.dpl);  
                                 SET_EIP(new_ip);  
                                 set_eflags(flags, mask);  
                         } else {  
                                 if (CPU_STAT_VM86  
                                  || (!intr_sel.desc.u.seg.ec && (intr_sel.desc.dpl != CPU_STAT_CPL))) {  
                                         EXCEPTION(GP_EXCEPTION, intr_sel.idx);  
                                 }  
                                 VERBOSE(("INTRA-PRIVILEGE-LEVEL-INTERRUPT"));  
   
                                 switch (gd.type) {  
                                 case CPU_SYSDESC_TYPE_INTR_32:  
                                 case CPU_SYSDESC_TYPE_TRAP_32:  
                                         CHECK_STACK_PUSH(&ss_sel.desc, new_sp, errorp ? 16 : 12);  
                                         break;  
   
                                 case CPU_SYSDESC_TYPE_INTR_16:  
                                 case CPU_SYSDESC_TYPE_TRAP_16:  
                                         CHECK_STACK_PUSH(&ss_sel.desc, new_sp, errorp ? 8 : 6);  
                                         new_ip &= 0xffff;  
                                         break;  
                                 }  
   
                                 /* out of range */  
                                 if (new_ip > intr_sel.desc.u.seg.limit) {  
                                         EXCEPTION(GP_EXCEPTION, 0);  
                                 }  
   
                                 switch (gd.type) {  
                                 case CPU_SYSDESC_TYPE_INTR_32:  
                                 case CPU_SYSDESC_TYPE_TRAP_32:  
                                         PUSH0_32(REAL_EFLAGREG);  
                                         PUSH0_32(CPU_CS);  
                                         PUSH0_32(CPU_EIP);  
                                         if (errorp) {  
                                                 PUSH0_32(error_code);  
                                         }  
                                         break;  
   
                                 case CPU_SYSDESC_TYPE_INTR_16:  
                                 case CPU_SYSDESC_TYPE_TRAP_16:  
                                         PUSH0_16(REAL_FLAGREG);  
                                         PUSH0_16(CPU_CS);  
                                         PUSH0_16(CPU_IP);  
                                         if (errorp) {  
                                                 PUSH0_16(error_code);  
                                         }  
                                         break;  
                                 }  
   
                                 load_cs(intr_sel.selector, &intr_sel.desc, CPU_STAT_CPL);  
                                 SET_EIP(new_ip);  
                                 set_eflags(flags, mask);  
                         }                          }
                         break;                          break;
   
                 default:                  case CPU_SYSDESC_TYPE_INTR_16:
                         EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp);                  case CPU_SYSDESC_TYPE_TRAP_16:
                           PUSH0_16(old_flags);
                           PUSH0_16(old_cs);
                           PUSH0_16(old_ip);
                           if (errorp) {
                                   PUSH0_16(error_code);
                           }
                         break;                          break;
                 }                  }
   
                   set_eflags(new_flags, mask);
         }          }
   
           VERBOSE(("interrupt: new EIP = %04x:%08x, ESP = %04x:%08x", CPU_CS, CPU_EIP, CPU_SS, CPU_ESP));
 }  }
Removed from v.1.2  
changed lines
  Added in v.1.13

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