diff options
Diffstat (limited to 'arch/mips/kernel/r4k_fpu.S')
-rw-r--r-- | arch/mips/kernel/r4k_fpu.S | 74 |
1 files changed, 70 insertions, 4 deletions
diff --git a/arch/mips/kernel/r4k_fpu.S b/arch/mips/kernel/r4k_fpu.S index 55ffe149dae9..253b2fb52026 100644 --- a/arch/mips/kernel/r4k_fpu.S +++ b/arch/mips/kernel/r4k_fpu.S | |||
@@ -35,7 +35,15 @@ | |||
35 | LEAF(_save_fp_context) | 35 | LEAF(_save_fp_context) |
36 | cfc1 t1, fcr31 | 36 | cfc1 t1, fcr31 |
37 | 37 | ||
38 | #ifdef CONFIG_64BIT | 38 | #if defined(CONFIG_64BIT) || defined(CONFIG_MIPS32_R2) |
39 | .set push | ||
40 | #ifdef CONFIG_MIPS32_R2 | ||
41 | .set mips64r2 | ||
42 | mfc0 t0, CP0_STATUS | ||
43 | sll t0, t0, 5 | ||
44 | bgez t0, 1f # skip storing odd if FR=0 | ||
45 | nop | ||
46 | #endif | ||
39 | /* Store the 16 odd double precision registers */ | 47 | /* Store the 16 odd double precision registers */ |
40 | EX sdc1 $f1, SC_FPREGS+8(a0) | 48 | EX sdc1 $f1, SC_FPREGS+8(a0) |
41 | EX sdc1 $f3, SC_FPREGS+24(a0) | 49 | EX sdc1 $f3, SC_FPREGS+24(a0) |
@@ -53,6 +61,7 @@ LEAF(_save_fp_context) | |||
53 | EX sdc1 $f27, SC_FPREGS+216(a0) | 61 | EX sdc1 $f27, SC_FPREGS+216(a0) |
54 | EX sdc1 $f29, SC_FPREGS+232(a0) | 62 | EX sdc1 $f29, SC_FPREGS+232(a0) |
55 | EX sdc1 $f31, SC_FPREGS+248(a0) | 63 | EX sdc1 $f31, SC_FPREGS+248(a0) |
64 | 1: .set pop | ||
56 | #endif | 65 | #endif |
57 | 66 | ||
58 | /* Store the 16 even double precision registers */ | 67 | /* Store the 16 even double precision registers */ |
@@ -82,7 +91,31 @@ LEAF(_save_fp_context) | |||
82 | LEAF(_save_fp_context32) | 91 | LEAF(_save_fp_context32) |
83 | cfc1 t1, fcr31 | 92 | cfc1 t1, fcr31 |
84 | 93 | ||
85 | EX sdc1 $f0, SC32_FPREGS+0(a0) | 94 | mfc0 t0, CP0_STATUS |
95 | sll t0, t0, 5 | ||
96 | bgez t0, 1f # skip storing odd if FR=0 | ||
97 | nop | ||
98 | |||
99 | /* Store the 16 odd double precision registers */ | ||
100 | EX sdc1 $f1, SC32_FPREGS+8(a0) | ||
101 | EX sdc1 $f3, SC32_FPREGS+24(a0) | ||
102 | EX sdc1 $f5, SC32_FPREGS+40(a0) | ||
103 | EX sdc1 $f7, SC32_FPREGS+56(a0) | ||
104 | EX sdc1 $f9, SC32_FPREGS+72(a0) | ||
105 | EX sdc1 $f11, SC32_FPREGS+88(a0) | ||
106 | EX sdc1 $f13, SC32_FPREGS+104(a0) | ||
107 | EX sdc1 $f15, SC32_FPREGS+120(a0) | ||
108 | EX sdc1 $f17, SC32_FPREGS+136(a0) | ||
109 | EX sdc1 $f19, SC32_FPREGS+152(a0) | ||
110 | EX sdc1 $f21, SC32_FPREGS+168(a0) | ||
111 | EX sdc1 $f23, SC32_FPREGS+184(a0) | ||
112 | EX sdc1 $f25, SC32_FPREGS+200(a0) | ||
113 | EX sdc1 $f27, SC32_FPREGS+216(a0) | ||
114 | EX sdc1 $f29, SC32_FPREGS+232(a0) | ||
115 | EX sdc1 $f31, SC32_FPREGS+248(a0) | ||
116 | |||
117 | /* Store the 16 even double precision registers */ | ||
118 | 1: EX sdc1 $f0, SC32_FPREGS+0(a0) | ||
86 | EX sdc1 $f2, SC32_FPREGS+16(a0) | 119 | EX sdc1 $f2, SC32_FPREGS+16(a0) |
87 | EX sdc1 $f4, SC32_FPREGS+32(a0) | 120 | EX sdc1 $f4, SC32_FPREGS+32(a0) |
88 | EX sdc1 $f6, SC32_FPREGS+48(a0) | 121 | EX sdc1 $f6, SC32_FPREGS+48(a0) |
@@ -114,7 +147,16 @@ LEAF(_save_fp_context32) | |||
114 | */ | 147 | */ |
115 | LEAF(_restore_fp_context) | 148 | LEAF(_restore_fp_context) |
116 | EX lw t0, SC_FPC_CSR(a0) | 149 | EX lw t0, SC_FPC_CSR(a0) |
117 | #ifdef CONFIG_64BIT | 150 | |
151 | #if defined(CONFIG_64BIT) || defined(CONFIG_MIPS32_R2) | ||
152 | .set push | ||
153 | #ifdef CONFIG_MIPS32_R2 | ||
154 | .set mips64r2 | ||
155 | mfc0 t0, CP0_STATUS | ||
156 | sll t0, t0, 5 | ||
157 | bgez t0, 1f # skip loading odd if FR=0 | ||
158 | nop | ||
159 | #endif | ||
118 | EX ldc1 $f1, SC_FPREGS+8(a0) | 160 | EX ldc1 $f1, SC_FPREGS+8(a0) |
119 | EX ldc1 $f3, SC_FPREGS+24(a0) | 161 | EX ldc1 $f3, SC_FPREGS+24(a0) |
120 | EX ldc1 $f5, SC_FPREGS+40(a0) | 162 | EX ldc1 $f5, SC_FPREGS+40(a0) |
@@ -131,6 +173,7 @@ LEAF(_restore_fp_context) | |||
131 | EX ldc1 $f27, SC_FPREGS+216(a0) | 173 | EX ldc1 $f27, SC_FPREGS+216(a0) |
132 | EX ldc1 $f29, SC_FPREGS+232(a0) | 174 | EX ldc1 $f29, SC_FPREGS+232(a0) |
133 | EX ldc1 $f31, SC_FPREGS+248(a0) | 175 | EX ldc1 $f31, SC_FPREGS+248(a0) |
176 | 1: .set pop | ||
134 | #endif | 177 | #endif |
135 | EX ldc1 $f0, SC_FPREGS+0(a0) | 178 | EX ldc1 $f0, SC_FPREGS+0(a0) |
136 | EX ldc1 $f2, SC_FPREGS+16(a0) | 179 | EX ldc1 $f2, SC_FPREGS+16(a0) |
@@ -157,7 +200,30 @@ LEAF(_restore_fp_context) | |||
157 | LEAF(_restore_fp_context32) | 200 | LEAF(_restore_fp_context32) |
158 | /* Restore an o32 sigcontext. */ | 201 | /* Restore an o32 sigcontext. */ |
159 | EX lw t0, SC32_FPC_CSR(a0) | 202 | EX lw t0, SC32_FPC_CSR(a0) |
160 | EX ldc1 $f0, SC32_FPREGS+0(a0) | 203 | |
204 | mfc0 t0, CP0_STATUS | ||
205 | sll t0, t0, 5 | ||
206 | bgez t0, 1f # skip loading odd if FR=0 | ||
207 | nop | ||
208 | |||
209 | EX ldc1 $f1, SC32_FPREGS+8(a0) | ||
210 | EX ldc1 $f3, SC32_FPREGS+24(a0) | ||
211 | EX ldc1 $f5, SC32_FPREGS+40(a0) | ||
212 | EX ldc1 $f7, SC32_FPREGS+56(a0) | ||
213 | EX ldc1 $f9, SC32_FPREGS+72(a0) | ||
214 | EX ldc1 $f11, SC32_FPREGS+88(a0) | ||
215 | EX ldc1 $f13, SC32_FPREGS+104(a0) | ||
216 | EX ldc1 $f15, SC32_FPREGS+120(a0) | ||
217 | EX ldc1 $f17, SC32_FPREGS+136(a0) | ||
218 | EX ldc1 $f19, SC32_FPREGS+152(a0) | ||
219 | EX ldc1 $f21, SC32_FPREGS+168(a0) | ||
220 | EX ldc1 $f23, SC32_FPREGS+184(a0) | ||
221 | EX ldc1 $f25, SC32_FPREGS+200(a0) | ||
222 | EX ldc1 $f27, SC32_FPREGS+216(a0) | ||
223 | EX ldc1 $f29, SC32_FPREGS+232(a0) | ||
224 | EX ldc1 $f31, SC32_FPREGS+248(a0) | ||
225 | |||
226 | 1: EX ldc1 $f0, SC32_FPREGS+0(a0) | ||
161 | EX ldc1 $f2, SC32_FPREGS+16(a0) | 227 | EX ldc1 $f2, SC32_FPREGS+16(a0) |
162 | EX ldc1 $f4, SC32_FPREGS+32(a0) | 228 | EX ldc1 $f4, SC32_FPREGS+32(a0) |
163 | EX ldc1 $f6, SC32_FPREGS+48(a0) | 229 | EX ldc1 $f6, SC32_FPREGS+48(a0) |