--- linux/kernel/traps.c	2018/04/24 18:00:41	1.1
+++ linux/kernel/traps.c	2018/04/24 18:04:23	1.1.1.4
@@ -1,4 +1,10 @@
 /*
+ *  linux/kernel/traps.c
+ *
+ *  (C) 1991  Linus Torvalds
+ */
+
+/*
  * 'Traps.c' handles hardware traps and faults after we have saved some
  * state in 'asm.s'. Currently mostly a debugging-aid, will be extended
  * to mainly kill the offending process (probably by giving it a signal,
@@ -11,6 +17,9 @@
 #include <linux/kernel.h>
 #include <asm/system.h>
 #include <asm/segment.h>
+#include <asm/io.h>
+#include <errno.h>
+
 
 #define get_seg_byte(seg,addr) ({ \
 register char __res; \
@@ -29,8 +38,6 @@ register unsigned short __res; \
 __asm__("mov %%fs,%%ax":"=a" (__res):); \
 __res;})
 
-int do_exit(long code);
-
 void page_exception(void);
 
 void divide_error(void);
@@ -50,6 +57,10 @@ void general_protection(void);
 void page_fault(void);
 void coprocessor_error(void);
 void reserved(void);
+void parallel_interrupt(void);
+void irq13(void);
+void alignment_check(void);
+int send_sig(long, struct task_struct *, int);
 
 static void die(char * str,long esp_ptr,long nr)
 {
@@ -57,11 +68,12 @@ static void die(char * str,long esp_ptr,
 	int i;
 
 	printk("%s: %04x\n\r",str,nr&0xffff);
-	printk("EIP:\t%04x:%p\nEFLAGS:\t%p\nESP:\t%04x:%p\n",
-		esp[1],esp[0],esp[2],esp[4],esp[3]);
+	printk("EIP:    %04x:%p\nEFLAGS: %p\n", 0xffff & esp[1],esp[0],esp[2]);
+	if ((0xffff & esp[1]) == 0xf)
+		printk("ESP:    %04x:%p\n",0xffff & esp[4],esp[3]);
 	printk("fs: %04x\n",_fs());
 	printk("base: %p, limit: %p\n",get_base(current->ldt[1]),get_limit(0x17));
-	if (esp[4] == 0x17) {
+	if ((0xffff & esp[1]) == 0xf) {
 		printk("Stack: ");
 		for (i=0;i<4;i++)
 			printk("%p ",get_seg_long(0x17,i+(long *)esp[3]));
@@ -85,26 +97,19 @@ void do_general_protection(long esp, lon
 	die("general protection",esp,error_code);
 }
 
+void do_alignment_check(long esp, long error_code)
+{
+    die("alignment check",esp,error_code);
+}
+
 void do_divide_error(long esp, long error_code)
 {
 	die("divide error",esp,error_code);
 }
 
-void do_int3(long * esp, long error_code,
-		long fs,long es,long ds,
-		long ebp,long esi,long edi,
-		long edx,long ecx,long ebx,long eax)
-{
-	int tr;
-
-	__asm__("str %%ax":"=a" (tr):"0" (0));
-	printk("eax\t\tebx\t\tecx\t\tedx\n\r%8x\t%8x\t%8x\t%8x\n\r",
-		eax,ebx,ecx,edx);
-	printk("esi\t\tedi\t\tebp\t\tesp\n\r%8x\t%8x\t%8x\t%8x\n\r",
-		esi,edi,ebp,(long) esp);
-	printk("\n\rds\tes\tfs\ttr\n\r%4x\t%4x\t%4x\t%4x\n\r",
-		ds,es,fs,tr);
-	printk("EIP: %8x   CS: %4x  EFLAGS: %8x\n\r",esp[0],esp[1],esp[2]);
+void do_int3(long esp, long error_code)
+{
+	send_sig(SIGTRAP, current, 0);
 }
 
 void do_nmi(long esp, long error_code)
@@ -114,7 +119,7 @@ void do_nmi(long esp, long error_code)
 
 void do_debug(long esp, long error_code)
 {
-	die("debug",esp,error_code);
+  send_sig(SIGTRAP, current, 0);
 }
 
 void do_overflow(long esp, long error_code)
@@ -159,12 +164,14 @@ void do_stack_segment(long esp,long erro
 
 void do_coprocessor_error(long esp, long error_code)
 {
+	if (last_task_used_math != current)
+		return;
 	die("coprocessor error",esp,error_code);
 }
 
 void do_reserved(long esp, long error_code)
 {
-	die("reserved (15,17-31) error",esp,error_code);
+	die("reserved (15,17-47) error",esp,error_code);
 }
 
 void trap_init(void)
@@ -188,12 +195,11 @@ void trap_init(void)
 	set_trap_gate(14,&page_fault);
 	set_trap_gate(15,&reserved);
 	set_trap_gate(16,&coprocessor_error);
-	for (i=17;i<32;i++)
+	set_trap_gate(17,&alignment_check);
+	for (i=18;i<48;i++)
 		set_trap_gate(i,&reserved);
-/*	__asm__("movl $0x3ff000,%%eax\n\t"
-		"movl %%eax,%%db0\n\t"
-		"movl $0x000d0303,%%eax\n\t"
-		"movl %%eax,%%db7"
-		:::"ax");*/
+	set_trap_gate(45,&irq13);
+	outb_p(inb_p(0x21)&0xfb,0x21);
+	outb(inb_p(0xA1)&0xdf,0xA1);
+	set_trap_gate(39,&parallel_interrupt);
 }
-