Changeset 3b05862f in mainline for arch/ia32/src

Timestamp:

2006-03-15T16:12:37Z (20 years ago)

Author:

Jakub Vana <jakub.vana@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

2f7342d

Parents:

b629483

Message:

ia32 MMX and SSEx support

Location:

arch/ia32/src

Files:

• cpu/cpu.c (modified) (1 diff)
• fpu_context.c (modified) (3 diffs)
• interrupt.c (modified) (1 diff)
• pm.c (modified) (1 diff)

arch/ia32/src/cpu/cpu.c

@@ -93 +93 @@
 void cpu_arch_init(void)
 {
+        __u32 help=0;
+        
         CPU->arch.tss = tss_p;
         CPU->fpu_owner=NULL;
+
+        cpuid_feature_info fi;
+        cpuid_extended_feature_info efi;
+
+        cpu_info_t info;
+        cpuid(1, &info);
+
+        fi.word=info.cpuid_edx;
+        efi.word=info.cpuid_ecx;
+        
+        if(fi.bits.fxsr)        fpu_fxsr();
+        else fpu_fsr(); 
+        
+        if(fi.bits.sse) asm volatile (
+                "mov %%cr4,%0;\n"
+                "or %1,%0;\n"
+                "mov %0,%%cr4;\n"
+                :"+r"(help)
+                :"i"(CR4_OSFXSR_MASK|(1<<10)) 
+        );
+        
 }
 

arch/ia32/src/fpu_context.c

@@ -32 +32 @@
 #include <cpu.h>
 
-void fpu_context_save(fpu_context_t *fctx)
+typedef void (*fpu_context_function)(fpu_context_t *fctx);
+
+static fpu_context_function fpu_save,fpu_restore;
+
+
+
+static void fpu_context_f_save(fpu_context_t *fctx)
 {
         __asm__ volatile (
@@ -40 +46 @@
 }
 
-
-void fpu_context_restore(fpu_context_t *fctx)
+static void fpu_context_f_restore(fpu_context_t *fctx)
 {
         __asm__ volatile (
@@ -49 +54 @@
 }
 
+static void fpu_context_fx_save(fpu_context_t *fctx)
+{
+        __asm__ volatile (
+                "fxsave %0"
+                : "=m"(*fctx)
+                );
+}
+
+static void fpu_context_fx_restore(fpu_context_t *fctx)
+{
+        __asm__ volatile (
+                "fxrstor %0"
+                : "=m"(*fctx)
+                );
+}
+
+/*
+        Setup using fxsr instruction
+*/
+void fpu_fxsr(void)
+{
+        fpu_save=fpu_context_fx_save;
+        fpu_restore=fpu_context_fx_restore;
+}
+/*
+        Setup using not fxsr instruction
+*/
+void fpu_fsr(void)
+{
+        fpu_save=fpu_context_f_save;
+        fpu_restore=fpu_context_f_restore;
+}
+
+
+
+void fpu_context_save(fpu_context_t *fctx)
+{
+        fpu_save(fctx);
+}
+
+void fpu_context_restore(fpu_context_t *fctx)
+{
+        fpu_restore(fctx);
+}
+
+
+
 void fpu_init()
 {
+        __u32 help0=0,help1=0;
         __asm__ volatile (
-                "fninit;"
+                "fninit;\n"
+                "stmxcsr %0\n"
+                "mov %0,%1;\n"
+                "or %2,%1;\n"
+                "mov %1,%0;\n"
+                "ldmxcsr %0;\n"
+                :"+m"(help0),"+r"(help1)
+                :"i"(0x1f80)
         );
 }

arch/ia32/src/interrupt.c

@@ -89 +89 @@
 }
 
+void simd_fp_exception(int n, istate_t *istate)
+{
+
+        PRINT_INFO_ERRCODE(istate);
+        __u32 mxcsr;
+        asm
+        (
+                "stmxcsr %0;\n"
+                :"=m"(mxcsr)
+        );
+        printf("MXCSR: %X\n",(__native)(mxcsr));
+        panic("SIMD FP exception(19)\n");
+}
+
 void nm_fault(int n, istate_t *istate)
 {

arch/ia32/src/pm.c

@@ -131 +131 @@
         exc_register( 7, "nm_fault", (iroutine) nm_fault);
         exc_register(12, "ss_fault", (iroutine) ss_fault);
+        exc_register(19, "simd_fp", (iroutine) simd_fp_exception);
 }