kernel/traps.c

   1 #include <asm/system.h>
   2 #include <asm/io.h>
   3 #include <thunix.h>
   4
   5 unsigned long long *idt = (unsigned long long  *)0x80000;
   6
   7 #define get_seg_byte(seg,addr) ({                                       \
   8                         register char __res;                            \
   9                         __asm__("push %%fs;mov %%ax,%%fs;movb %%fs:%2,%%al;pop %%fs" \
  10                                 :"=a" (__res):"0" (seg),"m" (*(addr))); \
  11                         __res;})
  12
  13 #define get_seg_long(seg,addr) ({                                       \
  14                         register unsigned long __res;                   \
  15                         __asm__("push %%fs;mov %%ax,%%fs;movl %%fs:%2,%%eax;pop %%fs" \
  16                                 :"=a" (__res):"0" (seg),"m" (*(addr))); \
  17                         __res;})
  18
  19 #define _fs() ({                                                \
  20                         register unsigned short __res;          \
  21                         __asm__("mov %%fs,%%ax":"=a" (__res):); \
  22                         __res;})
  23
  24 #define _ds() ({                                                \
  25                         register unsigned short __res;          \
  26                         __asm__("mov %%ds,%%ax":"=a" (__res):); \
  27                         __res;})
  28
  29 #define _es() ({                                                \
  30                         register unsigned short __res;          \
  31                         __asm__("mov %%es,%%ax":"=a" (__res):); \
  32                         __res;})
  33
  34
  35 /*int do_exit(long code);   *** Not finished *** */
  36
  37 void ipc_install(void);
  38
  39 void page_exception(void);
  40 void divide_error(void);
  41 void debug(void);
  42 void nmi(void);
  43 void int3(void);
  44 void overflow(void);
  45 void bounds(void);
  46 void invalid_op(void);
  47 void device_not_available(void);
  48 void double_fault(void);
  49 void coprocessor_segment_overrun(void);
  50 void invalid_TSS(void);
  51 void segment_not_present(void);
  52 void stack_segment(void);
  53 void general_protection(void);
  54 void page_fault(void);
  55 void coprocessor_error(void);
  56 void reserved(void);
  57
  58 static void die(char * str,long esp_ptr,long nr)
  59 {
  60         long * esp = (long *) esp_ptr;
  61         int i;
  62         //unsigned long eip = esp[0];
  63
  64         printk("\n");
  65
  66         printk("%s: %04x\n\r",str,nr&0xffff);
  67         printk("EIP:\t%04x:%p\nEFLAGS:\t%p\nESP:\t%04x:%p\n",
  68                esp[1],esp[0],esp[2],esp[4],esp[3]);
  69         printk("fs: %04x\n",_fs());
  70         printk("ds: %04x\n",_ds());
  71         printk("es: %04x\n",_es());
  72
  73         if (esp[4] == 0x17) {
  74                 printk("Stack: ");
  75                 for (i=0;i<4;i++)
  76                         printk("%p ",get_seg_long(0x17,i+(long *)esp[3]));
  77                 printk("\n");
  78         }
  79
  80         /*
  81           if (strcmp(str, "divide error" == 0)) {
  82                   esp[0] += 0x03;
  83                   return;
  84           }
  85         */
  86         while(1)
  87                 ;
  88 }
  89
  90 void do_double_fault(long esp, long error_code)
  91 {
  92         die("double fault",esp,error_code);
  93 }
  94
  95 void do_general_protection(long esp, long error_code)
  96 {
  97         die("general protection",esp,error_code);
  98 }
  99
 100 void do_divide_error(long esp, long error_code)
 101 {
 102         die("divide error",esp,error_code);
 103 }
 104
 105 void do_int3(long * esp, long error_code,
 106              long fs,long es,long ds,
 107              long ebp,long esi,long edi,
 108              long edx,long ecx,long ebx,long eax)
 109 {
 110
 111         /*      __asm__("str %%ax":"=a" (tr):"0" (0));*/
 112         printk("eax\t\tebx\t\tecx\t\tedx\n\r%8x\t%8x\t%8x\t%8x\n\r",
 113                eax,ebx,ecx,edx);
 114         printk("esi\t\tedi\t\tebp\t\tesp\n\r%8x\t%8x\t%8x\t%8x\n\r",
 115                esi,edi,ebp,(long) esp);
 116         printk("\n\rds\tes\tfs\ttr\n\r%4x\t%4x\t%4x\t\n\r",
 117                ds,es,fs/*,tr*/);
 118         printk("EIP: %8x   CS: %4x  EFLAGS: %8x\n\r",esp[0],esp[1],esp[2]);
 119
 120         for (;;)
 121                 ;
 122 }
 123
 124 void do_nmi(long esp, long error_code)
 125 {
 126         die("nmi",esp,error_code);
 127 }
 128
 129 void do_debug(long esp, long error_code)
 130 {
 131         die("debug",esp,error_code);
 132 }
 133
 134 void do_overflow(long esp, long error_code)
 135 {
 136         die("overflow",esp,error_code);
 137 }
 138
 139 void do_bounds(long esp, long error_code)
 140 {
 141         die("bounds",esp,error_code);
 142 }
 143
 144 void do_invalid_op(long esp, long error_code)
 145 {
 146         die("invalid operand",esp,error_code);
 147 }
 148
 149 void do_device_not_available(long esp, long error_code)
 150 {
 151         die("device not available",esp,error_code);
 152 }
 153
 154 void do_coprocessor_segment_overrun(long esp, long error_code)
 155 {
 156         die("coprocessor segment overrun",esp,error_code);
 157 }
 158
 159 void do_invalid_TSS(long esp,long error_code)
 160 {
 161         die("invalid TSS",esp,error_code);
 162 }
 163
 164 void do_segment_not_present(long esp,long error_code)
 165 {
 166         die("segment not present",esp,error_code);
 167 }
 168
 169 void do_stack_segment(long esp,long error_code)
 170 {
 171         die("stack segment",esp,error_code);
 172 }
 173
 174 void do_coprocessor_error(long esp, long error_code)
 175 {
 176         die("coprocessor error",esp,error_code);
 177 }
 178
 179 void do_reserved(long esp, long error_code)
 180 {
 181         die("reserved (15,17-31) error",esp,error_code);
 182 }
 183
 184
 185
 186 void ipc_install(void)
 187 {
 188         outb_p(0x11, 0x20);
 189         outb_p(0x11, 0xa0);
 190
 191         outb_p(0x20, 0x21);
 192         outb_p(0x28, 0xa1);
 193
 194         outb_p(0x04, 0x21);
 195         outb_p(0x02, 0xa1);
 196
 197         outb_p(0x01, 0x21);
 198         outb_p(0x01, 0xa1);
 199
 200         outb_p(0x11, 0x21);
 201         outb_p(0x11, 0xa1);
 202 }
 203
 204
 205 void trap_init(void)
 206 {
 207         extern void keyboard_interrupt();
 208         int i;
 209         struct DESCR {
 210                 unsigned short length;
 211                 unsigned long long  *address;
 212         } __attribute__((packed)) idt_descr = {256*8-1, idt};
 213
 214         ipc_install();
 215
 216         set_trap_gate(0,&divide_error);
 217         set_trap_gate(1,&debug);
 218         set_trap_gate(2,&nmi);
 219         set_system_gate(3,&int3);  /*int3*/
 220         set_system_gate(4,&overflow);
 221         set_system_gate(5,&bounds);
 222         set_trap_gate(6,&invalid_op);
 223         set_trap_gate(7,&reserved);/*device_not_available*/
 224         set_trap_gate(8,&double_fault);
 225         set_trap_gate(9,&coprocessor_segment_overrun);
 226         set_trap_gate(10,&invalid_TSS);
 227         set_trap_gate(11,&segment_not_present);
 228         set_trap_gate(12,&stack_segment);
 229         set_trap_gate(13,&general_protection);
 230         set_trap_gate(14,&reserved);/*page_fault*/
 231         set_trap_gate(15,&reserved);
 232         set_trap_gate(16,&reserved); /*coprocessor_error*/
 233
 234         for (i=17;i < 48;i++)
 235                 set_trap_gate(i,&reserved);
 236
 237
 238
 239         __asm__ ("lidt %0\n\t"::"m"(idt_descr));
 240
 241
 242
 243         /*set_trap_gate(45,&irq13);*/
 244
 245         outb_p(inb_p(0x21)&0xfb, 0x21);
 246         outb_p(inb_p(0xa1)&0xdf, 0xa1);
 247
 248         /* set_trap_gate(39,&parallel_interrupt);*/
 249
 250 }