root / target-sh4 / op_helper.c @ 0e326109
History | View | Annotate | Download (16.8 kB)
1 | fdf9b3e8 | bellard | /*
|
---|---|---|---|
2 | fdf9b3e8 | bellard | * SH4 emulation
|
3 | 5fafdf24 | ths | *
|
4 | fdf9b3e8 | bellard | * Copyright (c) 2005 Samuel Tardieu
|
5 | fdf9b3e8 | bellard | *
|
6 | fdf9b3e8 | bellard | * This library is free software; you can redistribute it and/or
|
7 | fdf9b3e8 | bellard | * modify it under the terms of the GNU Lesser General Public
|
8 | fdf9b3e8 | bellard | * License as published by the Free Software Foundation; either
|
9 | fdf9b3e8 | bellard | * version 2 of the License, or (at your option) any later version.
|
10 | fdf9b3e8 | bellard | *
|
11 | fdf9b3e8 | bellard | * This library is distributed in the hope that it will be useful,
|
12 | fdf9b3e8 | bellard | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 | fdf9b3e8 | bellard | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
14 | fdf9b3e8 | bellard | * Lesser General Public License for more details.
|
15 | fdf9b3e8 | bellard | *
|
16 | fdf9b3e8 | bellard | * You should have received a copy of the GNU Lesser General Public
|
17 | 8167ee88 | Blue Swirl | * License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
18 | fdf9b3e8 | bellard | */
|
19 | fdf9b3e8 | bellard | #include <assert.h> |
20 | 852d481f | edgar_igl | #include <stdlib.h> |
21 | fdf9b3e8 | bellard | #include "exec.h" |
22 | a7812ae4 | pbrook | #include "helper.h" |
23 | fdf9b3e8 | bellard | |
24 | 21829e9b | Aurelien Jarno | static void cpu_restore_state_from_retaddr(void *retaddr) |
25 | 21829e9b | Aurelien Jarno | { |
26 | 21829e9b | Aurelien Jarno | TranslationBlock *tb; |
27 | 21829e9b | Aurelien Jarno | unsigned long pc; |
28 | 21829e9b | Aurelien Jarno | |
29 | 21829e9b | Aurelien Jarno | if (retaddr) {
|
30 | 21829e9b | Aurelien Jarno | pc = (unsigned long) retaddr; |
31 | 21829e9b | Aurelien Jarno | tb = tb_find_pc(pc); |
32 | 21829e9b | Aurelien Jarno | if (tb) {
|
33 | 21829e9b | Aurelien Jarno | /* the PC is inside the translated code. It means that we have
|
34 | 21829e9b | Aurelien Jarno | a virtual CPU fault */
|
35 | 21829e9b | Aurelien Jarno | cpu_restore_state(tb, env, pc, NULL);
|
36 | 21829e9b | Aurelien Jarno | } |
37 | 21829e9b | Aurelien Jarno | } |
38 | 21829e9b | Aurelien Jarno | } |
39 | 21829e9b | Aurelien Jarno | |
40 | fdf9b3e8 | bellard | #ifndef CONFIG_USER_ONLY
|
41 | fdf9b3e8 | bellard | |
42 | fdf9b3e8 | bellard | #define MMUSUFFIX _mmu
|
43 | fdf9b3e8 | bellard | |
44 | fdf9b3e8 | bellard | #define SHIFT 0 |
45 | fdf9b3e8 | bellard | #include "softmmu_template.h" |
46 | fdf9b3e8 | bellard | |
47 | fdf9b3e8 | bellard | #define SHIFT 1 |
48 | fdf9b3e8 | bellard | #include "softmmu_template.h" |
49 | fdf9b3e8 | bellard | |
50 | fdf9b3e8 | bellard | #define SHIFT 2 |
51 | fdf9b3e8 | bellard | #include "softmmu_template.h" |
52 | fdf9b3e8 | bellard | |
53 | fdf9b3e8 | bellard | #define SHIFT 3 |
54 | fdf9b3e8 | bellard | #include "softmmu_template.h" |
55 | fdf9b3e8 | bellard | |
56 | 6ebbf390 | j_mayer | void tlb_fill(target_ulong addr, int is_write, int mmu_idx, void *retaddr) |
57 | fdf9b3e8 | bellard | { |
58 | fdf9b3e8 | bellard | CPUState *saved_env; |
59 | fdf9b3e8 | bellard | int ret;
|
60 | fdf9b3e8 | bellard | |
61 | fdf9b3e8 | bellard | /* XXX: hack to restore env in all cases, even if not called from
|
62 | fdf9b3e8 | bellard | generated code */
|
63 | fdf9b3e8 | bellard | saved_env = env; |
64 | fdf9b3e8 | bellard | env = cpu_single_env; |
65 | 6ebbf390 | j_mayer | ret = cpu_sh4_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
|
66 | fdf9b3e8 | bellard | if (ret) {
|
67 | 21829e9b | Aurelien Jarno | /* now we have a real cpu fault */
|
68 | 21829e9b | Aurelien Jarno | cpu_restore_state_from_retaddr(retaddr); |
69 | e6afc2f4 | aurel32 | cpu_loop_exit(); |
70 | fdf9b3e8 | bellard | } |
71 | fdf9b3e8 | bellard | env = saved_env; |
72 | fdf9b3e8 | bellard | } |
73 | fdf9b3e8 | bellard | |
74 | fdf9b3e8 | bellard | #endif
|
75 | fdf9b3e8 | bellard | |
76 | ea2b542a | aurel32 | void helper_ldtlb(void) |
77 | ea2b542a | aurel32 | { |
78 | ea2b542a | aurel32 | #ifdef CONFIG_USER_ONLY
|
79 | ea2b542a | aurel32 | /* XXXXX */
|
80 | 43dc2a64 | Blue Swirl | cpu_abort(env, "Unhandled ldtlb");
|
81 | ea2b542a | aurel32 | #else
|
82 | ea2b542a | aurel32 | cpu_load_tlb(env); |
83 | ea2b542a | aurel32 | #endif
|
84 | ea2b542a | aurel32 | } |
85 | ea2b542a | aurel32 | |
86 | fd4bab10 | Aurelien Jarno | static inline void raise_exception(int index, void *retaddr) |
87 | e6afc2f4 | aurel32 | { |
88 | fd4bab10 | Aurelien Jarno | env->exception_index = index; |
89 | fd4bab10 | Aurelien Jarno | cpu_restore_state_from_retaddr(retaddr); |
90 | e6afc2f4 | aurel32 | cpu_loop_exit(); |
91 | e6afc2f4 | aurel32 | } |
92 | e6afc2f4 | aurel32 | |
93 | fd4bab10 | Aurelien Jarno | void helper_raise_illegal_instruction(void) |
94 | fd4bab10 | Aurelien Jarno | { |
95 | fd4bab10 | Aurelien Jarno | raise_exception(0x180, GETPC());
|
96 | fd4bab10 | Aurelien Jarno | } |
97 | fd4bab10 | Aurelien Jarno | |
98 | e6afc2f4 | aurel32 | void helper_raise_slot_illegal_instruction(void) |
99 | e6afc2f4 | aurel32 | { |
100 | fd4bab10 | Aurelien Jarno | raise_exception(0x1a0, GETPC());
|
101 | e6afc2f4 | aurel32 | } |
102 | e6afc2f4 | aurel32 | |
103 | d8299bcc | aurel32 | void helper_raise_fpu_disable(void) |
104 | d8299bcc | aurel32 | { |
105 | fd4bab10 | Aurelien Jarno | raise_exception(0x800, GETPC());
|
106 | d8299bcc | aurel32 | } |
107 | d8299bcc | aurel32 | |
108 | d8299bcc | aurel32 | void helper_raise_slot_fpu_disable(void) |
109 | d8299bcc | aurel32 | { |
110 | fd4bab10 | Aurelien Jarno | raise_exception(0x820, GETPC());
|
111 | d8299bcc | aurel32 | } |
112 | d8299bcc | aurel32 | |
113 | e6afc2f4 | aurel32 | void helper_debug(void) |
114 | e6afc2f4 | aurel32 | { |
115 | e6afc2f4 | aurel32 | env->exception_index = EXCP_DEBUG; |
116 | e6afc2f4 | aurel32 | cpu_loop_exit(); |
117 | e6afc2f4 | aurel32 | } |
118 | e6afc2f4 | aurel32 | |
119 | f24f381b | aurel32 | void helper_sleep(uint32_t next_pc)
|
120 | e6afc2f4 | aurel32 | { |
121 | e6afc2f4 | aurel32 | env->halted = 1;
|
122 | efac4154 | Aurelien Jarno | env->in_sleep = 1;
|
123 | e6afc2f4 | aurel32 | env->exception_index = EXCP_HLT; |
124 | f24f381b | aurel32 | env->pc = next_pc; |
125 | e6afc2f4 | aurel32 | cpu_loop_exit(); |
126 | e6afc2f4 | aurel32 | } |
127 | e6afc2f4 | aurel32 | |
128 | e6afc2f4 | aurel32 | void helper_trapa(uint32_t tra)
|
129 | e6afc2f4 | aurel32 | { |
130 | e6afc2f4 | aurel32 | env->tra = tra << 2;
|
131 | fd4bab10 | Aurelien Jarno | raise_exception(0x160, GETPC());
|
132 | e6afc2f4 | aurel32 | } |
133 | e6afc2f4 | aurel32 | |
134 | 852d481f | edgar_igl | void helper_movcal(uint32_t address, uint32_t value)
|
135 | 852d481f | edgar_igl | { |
136 | 852d481f | edgar_igl | if (cpu_sh4_is_cached (env, address))
|
137 | 852d481f | edgar_igl | { |
138 | 852d481f | edgar_igl | memory_content *r = malloc (sizeof(memory_content));
|
139 | 852d481f | edgar_igl | r->address = address; |
140 | 852d481f | edgar_igl | r->value = value; |
141 | 852d481f | edgar_igl | r->next = NULL;
|
142 | 852d481f | edgar_igl | |
143 | 852d481f | edgar_igl | *(env->movcal_backup_tail) = r; |
144 | 852d481f | edgar_igl | env->movcal_backup_tail = &(r->next); |
145 | 852d481f | edgar_igl | } |
146 | 852d481f | edgar_igl | } |
147 | 852d481f | edgar_igl | |
148 | 852d481f | edgar_igl | void helper_discard_movcal_backup(void) |
149 | 852d481f | edgar_igl | { |
150 | 852d481f | edgar_igl | memory_content *current = env->movcal_backup; |
151 | 852d481f | edgar_igl | |
152 | 852d481f | edgar_igl | while(current)
|
153 | 852d481f | edgar_igl | { |
154 | 852d481f | edgar_igl | memory_content *next = current->next; |
155 | 852d481f | edgar_igl | free (current); |
156 | 852d481f | edgar_igl | env->movcal_backup = current = next; |
157 | b9d38e95 | Blue Swirl | if (current == NULL) |
158 | 852d481f | edgar_igl | env->movcal_backup_tail = &(env->movcal_backup); |
159 | 852d481f | edgar_igl | } |
160 | 852d481f | edgar_igl | } |
161 | 852d481f | edgar_igl | |
162 | 852d481f | edgar_igl | void helper_ocbi(uint32_t address)
|
163 | 852d481f | edgar_igl | { |
164 | 852d481f | edgar_igl | memory_content **current = &(env->movcal_backup); |
165 | 852d481f | edgar_igl | while (*current)
|
166 | 852d481f | edgar_igl | { |
167 | 852d481f | edgar_igl | uint32_t a = (*current)->address; |
168 | 852d481f | edgar_igl | if ((a & ~0x1F) == (address & ~0x1F)) |
169 | 852d481f | edgar_igl | { |
170 | 852d481f | edgar_igl | memory_content *next = (*current)->next; |
171 | 852d481f | edgar_igl | stl(a, (*current)->value); |
172 | 852d481f | edgar_igl | |
173 | b9d38e95 | Blue Swirl | if (next == NULL) |
174 | 852d481f | edgar_igl | { |
175 | 852d481f | edgar_igl | env->movcal_backup_tail = current; |
176 | 852d481f | edgar_igl | } |
177 | 852d481f | edgar_igl | |
178 | 852d481f | edgar_igl | free (*current); |
179 | 852d481f | edgar_igl | *current = next; |
180 | 852d481f | edgar_igl | break;
|
181 | 852d481f | edgar_igl | } |
182 | 852d481f | edgar_igl | } |
183 | 852d481f | edgar_igl | } |
184 | 852d481f | edgar_igl | |
185 | 6f06939b | aurel32 | uint32_t helper_addc(uint32_t arg0, uint32_t arg1) |
186 | fdf9b3e8 | bellard | { |
187 | fdf9b3e8 | bellard | uint32_t tmp0, tmp1; |
188 | fdf9b3e8 | bellard | |
189 | 6f06939b | aurel32 | tmp1 = arg0 + arg1; |
190 | 6f06939b | aurel32 | tmp0 = arg1; |
191 | 6f06939b | aurel32 | arg1 = tmp1 + (env->sr & 1);
|
192 | fdf9b3e8 | bellard | if (tmp0 > tmp1)
|
193 | fdf9b3e8 | bellard | env->sr |= SR_T; |
194 | fdf9b3e8 | bellard | else
|
195 | fdf9b3e8 | bellard | env->sr &= ~SR_T; |
196 | 6f06939b | aurel32 | if (tmp1 > arg1)
|
197 | fdf9b3e8 | bellard | env->sr |= SR_T; |
198 | 6f06939b | aurel32 | return arg1;
|
199 | fdf9b3e8 | bellard | } |
200 | fdf9b3e8 | bellard | |
201 | 6f06939b | aurel32 | uint32_t helper_addv(uint32_t arg0, uint32_t arg1) |
202 | fdf9b3e8 | bellard | { |
203 | fdf9b3e8 | bellard | uint32_t dest, src, ans; |
204 | fdf9b3e8 | bellard | |
205 | 6f06939b | aurel32 | if ((int32_t) arg1 >= 0) |
206 | fdf9b3e8 | bellard | dest = 0;
|
207 | fdf9b3e8 | bellard | else
|
208 | fdf9b3e8 | bellard | dest = 1;
|
209 | 6f06939b | aurel32 | if ((int32_t) arg0 >= 0) |
210 | fdf9b3e8 | bellard | src = 0;
|
211 | fdf9b3e8 | bellard | else
|
212 | fdf9b3e8 | bellard | src = 1;
|
213 | fdf9b3e8 | bellard | src += dest; |
214 | 6f06939b | aurel32 | arg1 += arg0; |
215 | 6f06939b | aurel32 | if ((int32_t) arg1 >= 0) |
216 | fdf9b3e8 | bellard | ans = 0;
|
217 | fdf9b3e8 | bellard | else
|
218 | fdf9b3e8 | bellard | ans = 1;
|
219 | fdf9b3e8 | bellard | ans += dest; |
220 | fdf9b3e8 | bellard | if (src == 0 || src == 2) { |
221 | fdf9b3e8 | bellard | if (ans == 1) |
222 | fdf9b3e8 | bellard | env->sr |= SR_T; |
223 | fdf9b3e8 | bellard | else
|
224 | fdf9b3e8 | bellard | env->sr &= ~SR_T; |
225 | fdf9b3e8 | bellard | } else
|
226 | fdf9b3e8 | bellard | env->sr &= ~SR_T; |
227 | 6f06939b | aurel32 | return arg1;
|
228 | fdf9b3e8 | bellard | } |
229 | fdf9b3e8 | bellard | |
230 | fdf9b3e8 | bellard | #define T (env->sr & SR_T)
|
231 | fdf9b3e8 | bellard | #define Q (env->sr & SR_Q ? 1 : 0) |
232 | fdf9b3e8 | bellard | #define M (env->sr & SR_M ? 1 : 0) |
233 | fdf9b3e8 | bellard | #define SETT env->sr |= SR_T
|
234 | fdf9b3e8 | bellard | #define CLRT env->sr &= ~SR_T
|
235 | fdf9b3e8 | bellard | #define SETQ env->sr |= SR_Q
|
236 | fdf9b3e8 | bellard | #define CLRQ env->sr &= ~SR_Q
|
237 | fdf9b3e8 | bellard | #define SETM env->sr |= SR_M
|
238 | fdf9b3e8 | bellard | #define CLRM env->sr &= ~SR_M
|
239 | fdf9b3e8 | bellard | |
240 | 69d6275b | aurel32 | uint32_t helper_div1(uint32_t arg0, uint32_t arg1) |
241 | fdf9b3e8 | bellard | { |
242 | fdf9b3e8 | bellard | uint32_t tmp0, tmp2; |
243 | fdf9b3e8 | bellard | uint8_t old_q, tmp1 = 0xff;
|
244 | fdf9b3e8 | bellard | |
245 | 69d6275b | aurel32 | //printf("div1 arg0=0x%08x arg1=0x%08x M=%d Q=%d T=%d\n", arg0, arg1, M, Q, T);
|
246 | fdf9b3e8 | bellard | old_q = Q; |
247 | 69d6275b | aurel32 | if ((0x80000000 & arg1) != 0) |
248 | fdf9b3e8 | bellard | SETQ; |
249 | fdf9b3e8 | bellard | else
|
250 | fdf9b3e8 | bellard | CLRQ; |
251 | 69d6275b | aurel32 | tmp2 = arg0; |
252 | 69d6275b | aurel32 | arg1 <<= 1;
|
253 | 69d6275b | aurel32 | arg1 |= T; |
254 | fdf9b3e8 | bellard | switch (old_q) {
|
255 | fdf9b3e8 | bellard | case 0: |
256 | fdf9b3e8 | bellard | switch (M) {
|
257 | fdf9b3e8 | bellard | case 0: |
258 | 69d6275b | aurel32 | tmp0 = arg1; |
259 | 69d6275b | aurel32 | arg1 -= tmp2; |
260 | 69d6275b | aurel32 | tmp1 = arg1 > tmp0; |
261 | fdf9b3e8 | bellard | switch (Q) {
|
262 | fdf9b3e8 | bellard | case 0: |
263 | fdf9b3e8 | bellard | if (tmp1)
|
264 | fdf9b3e8 | bellard | SETQ; |
265 | fdf9b3e8 | bellard | else
|
266 | fdf9b3e8 | bellard | CLRQ; |
267 | fdf9b3e8 | bellard | break;
|
268 | fdf9b3e8 | bellard | case 1: |
269 | fdf9b3e8 | bellard | if (tmp1 == 0) |
270 | fdf9b3e8 | bellard | SETQ; |
271 | fdf9b3e8 | bellard | else
|
272 | fdf9b3e8 | bellard | CLRQ; |
273 | fdf9b3e8 | bellard | break;
|
274 | fdf9b3e8 | bellard | } |
275 | fdf9b3e8 | bellard | break;
|
276 | fdf9b3e8 | bellard | case 1: |
277 | 69d6275b | aurel32 | tmp0 = arg1; |
278 | 69d6275b | aurel32 | arg1 += tmp2; |
279 | 69d6275b | aurel32 | tmp1 = arg1 < tmp0; |
280 | fdf9b3e8 | bellard | switch (Q) {
|
281 | fdf9b3e8 | bellard | case 0: |
282 | fdf9b3e8 | bellard | if (tmp1 == 0) |
283 | fdf9b3e8 | bellard | SETQ; |
284 | fdf9b3e8 | bellard | else
|
285 | fdf9b3e8 | bellard | CLRQ; |
286 | fdf9b3e8 | bellard | break;
|
287 | fdf9b3e8 | bellard | case 1: |
288 | fdf9b3e8 | bellard | if (tmp1)
|
289 | fdf9b3e8 | bellard | SETQ; |
290 | fdf9b3e8 | bellard | else
|
291 | fdf9b3e8 | bellard | CLRQ; |
292 | fdf9b3e8 | bellard | break;
|
293 | fdf9b3e8 | bellard | } |
294 | fdf9b3e8 | bellard | break;
|
295 | fdf9b3e8 | bellard | } |
296 | fdf9b3e8 | bellard | break;
|
297 | fdf9b3e8 | bellard | case 1: |
298 | fdf9b3e8 | bellard | switch (M) {
|
299 | fdf9b3e8 | bellard | case 0: |
300 | 69d6275b | aurel32 | tmp0 = arg1; |
301 | 69d6275b | aurel32 | arg1 += tmp2; |
302 | 69d6275b | aurel32 | tmp1 = arg1 < tmp0; |
303 | fdf9b3e8 | bellard | switch (Q) {
|
304 | fdf9b3e8 | bellard | case 0: |
305 | fdf9b3e8 | bellard | if (tmp1)
|
306 | fdf9b3e8 | bellard | SETQ; |
307 | fdf9b3e8 | bellard | else
|
308 | fdf9b3e8 | bellard | CLRQ; |
309 | fdf9b3e8 | bellard | break;
|
310 | fdf9b3e8 | bellard | case 1: |
311 | fdf9b3e8 | bellard | if (tmp1 == 0) |
312 | fdf9b3e8 | bellard | SETQ; |
313 | fdf9b3e8 | bellard | else
|
314 | fdf9b3e8 | bellard | CLRQ; |
315 | fdf9b3e8 | bellard | break;
|
316 | fdf9b3e8 | bellard | } |
317 | fdf9b3e8 | bellard | break;
|
318 | fdf9b3e8 | bellard | case 1: |
319 | 69d6275b | aurel32 | tmp0 = arg1; |
320 | 69d6275b | aurel32 | arg1 -= tmp2; |
321 | 69d6275b | aurel32 | tmp1 = arg1 > tmp0; |
322 | fdf9b3e8 | bellard | switch (Q) {
|
323 | fdf9b3e8 | bellard | case 0: |
324 | fdf9b3e8 | bellard | if (tmp1 == 0) |
325 | fdf9b3e8 | bellard | SETQ; |
326 | fdf9b3e8 | bellard | else
|
327 | fdf9b3e8 | bellard | CLRQ; |
328 | fdf9b3e8 | bellard | break;
|
329 | fdf9b3e8 | bellard | case 1: |
330 | fdf9b3e8 | bellard | if (tmp1)
|
331 | fdf9b3e8 | bellard | SETQ; |
332 | fdf9b3e8 | bellard | else
|
333 | fdf9b3e8 | bellard | CLRQ; |
334 | fdf9b3e8 | bellard | break;
|
335 | fdf9b3e8 | bellard | } |
336 | fdf9b3e8 | bellard | break;
|
337 | fdf9b3e8 | bellard | } |
338 | fdf9b3e8 | bellard | break;
|
339 | fdf9b3e8 | bellard | } |
340 | fdf9b3e8 | bellard | if (Q == M)
|
341 | fdf9b3e8 | bellard | SETT; |
342 | fdf9b3e8 | bellard | else
|
343 | fdf9b3e8 | bellard | CLRT; |
344 | 69d6275b | aurel32 | //printf("Output: arg1=0x%08x M=%d Q=%d T=%d\n", arg1, M, Q, T);
|
345 | 69d6275b | aurel32 | return arg1;
|
346 | fdf9b3e8 | bellard | } |
347 | fdf9b3e8 | bellard | |
348 | 6f06939b | aurel32 | void helper_macl(uint32_t arg0, uint32_t arg1)
|
349 | fdf9b3e8 | bellard | { |
350 | fdf9b3e8 | bellard | int64_t res; |
351 | fdf9b3e8 | bellard | |
352 | fdf9b3e8 | bellard | res = ((uint64_t) env->mach << 32) | env->macl;
|
353 | 6f06939b | aurel32 | res += (int64_t) (int32_t) arg0 *(int64_t) (int32_t) arg1; |
354 | fdf9b3e8 | bellard | env->mach = (res >> 32) & 0xffffffff; |
355 | fdf9b3e8 | bellard | env->macl = res & 0xffffffff;
|
356 | fdf9b3e8 | bellard | if (env->sr & SR_S) {
|
357 | fdf9b3e8 | bellard | if (res < 0) |
358 | fdf9b3e8 | bellard | env->mach |= 0xffff0000;
|
359 | fdf9b3e8 | bellard | else
|
360 | fdf9b3e8 | bellard | env->mach &= 0x00007fff;
|
361 | fdf9b3e8 | bellard | } |
362 | fdf9b3e8 | bellard | } |
363 | fdf9b3e8 | bellard | |
364 | 6f06939b | aurel32 | void helper_macw(uint32_t arg0, uint32_t arg1)
|
365 | fdf9b3e8 | bellard | { |
366 | fdf9b3e8 | bellard | int64_t res; |
367 | fdf9b3e8 | bellard | |
368 | fdf9b3e8 | bellard | res = ((uint64_t) env->mach << 32) | env->macl;
|
369 | 6f06939b | aurel32 | res += (int64_t) (int16_t) arg0 *(int64_t) (int16_t) arg1; |
370 | fdf9b3e8 | bellard | env->mach = (res >> 32) & 0xffffffff; |
371 | fdf9b3e8 | bellard | env->macl = res & 0xffffffff;
|
372 | fdf9b3e8 | bellard | if (env->sr & SR_S) {
|
373 | fdf9b3e8 | bellard | if (res < -0x80000000) { |
374 | fdf9b3e8 | bellard | env->mach = 1;
|
375 | fdf9b3e8 | bellard | env->macl = 0x80000000;
|
376 | fdf9b3e8 | bellard | } else if (res > 0x000000007fffffff) { |
377 | fdf9b3e8 | bellard | env->mach = 1;
|
378 | fdf9b3e8 | bellard | env->macl = 0x7fffffff;
|
379 | fdf9b3e8 | bellard | } |
380 | fdf9b3e8 | bellard | } |
381 | fdf9b3e8 | bellard | } |
382 | fdf9b3e8 | bellard | |
383 | 6f06939b | aurel32 | uint32_t helper_subc(uint32_t arg0, uint32_t arg1) |
384 | fdf9b3e8 | bellard | { |
385 | fdf9b3e8 | bellard | uint32_t tmp0, tmp1; |
386 | fdf9b3e8 | bellard | |
387 | 6f06939b | aurel32 | tmp1 = arg1 - arg0; |
388 | 6f06939b | aurel32 | tmp0 = arg1; |
389 | 6f06939b | aurel32 | arg1 = tmp1 - (env->sr & SR_T); |
390 | fdf9b3e8 | bellard | if (tmp0 < tmp1)
|
391 | fdf9b3e8 | bellard | env->sr |= SR_T; |
392 | fdf9b3e8 | bellard | else
|
393 | fdf9b3e8 | bellard | env->sr &= ~SR_T; |
394 | 6f06939b | aurel32 | if (tmp1 < arg1)
|
395 | fdf9b3e8 | bellard | env->sr |= SR_T; |
396 | 6f06939b | aurel32 | return arg1;
|
397 | fdf9b3e8 | bellard | } |
398 | fdf9b3e8 | bellard | |
399 | 6f06939b | aurel32 | uint32_t helper_subv(uint32_t arg0, uint32_t arg1) |
400 | fdf9b3e8 | bellard | { |
401 | fdf9b3e8 | bellard | int32_t dest, src, ans; |
402 | fdf9b3e8 | bellard | |
403 | 6f06939b | aurel32 | if ((int32_t) arg1 >= 0) |
404 | fdf9b3e8 | bellard | dest = 0;
|
405 | fdf9b3e8 | bellard | else
|
406 | fdf9b3e8 | bellard | dest = 1;
|
407 | 6f06939b | aurel32 | if ((int32_t) arg0 >= 0) |
408 | fdf9b3e8 | bellard | src = 0;
|
409 | fdf9b3e8 | bellard | else
|
410 | fdf9b3e8 | bellard | src = 1;
|
411 | fdf9b3e8 | bellard | src += dest; |
412 | 6f06939b | aurel32 | arg1 -= arg0; |
413 | 6f06939b | aurel32 | if ((int32_t) arg1 >= 0) |
414 | fdf9b3e8 | bellard | ans = 0;
|
415 | fdf9b3e8 | bellard | else
|
416 | fdf9b3e8 | bellard | ans = 1;
|
417 | fdf9b3e8 | bellard | ans += dest; |
418 | fdf9b3e8 | bellard | if (src == 1) { |
419 | fdf9b3e8 | bellard | if (ans == 1) |
420 | fdf9b3e8 | bellard | env->sr |= SR_T; |
421 | fdf9b3e8 | bellard | else
|
422 | fdf9b3e8 | bellard | env->sr &= ~SR_T; |
423 | fdf9b3e8 | bellard | } else
|
424 | fdf9b3e8 | bellard | env->sr &= ~SR_T; |
425 | 6f06939b | aurel32 | return arg1;
|
426 | fdf9b3e8 | bellard | } |
427 | fdf9b3e8 | bellard | |
428 | cc4ba6a9 | aurel32 | static inline void set_t(void) |
429 | cc4ba6a9 | aurel32 | { |
430 | cc4ba6a9 | aurel32 | env->sr |= SR_T; |
431 | cc4ba6a9 | aurel32 | } |
432 | cc4ba6a9 | aurel32 | |
433 | cc4ba6a9 | aurel32 | static inline void clr_t(void) |
434 | cc4ba6a9 | aurel32 | { |
435 | cc4ba6a9 | aurel32 | env->sr &= ~SR_T; |
436 | cc4ba6a9 | aurel32 | } |
437 | cc4ba6a9 | aurel32 | |
438 | 390af821 | aurel32 | void helper_ld_fpscr(uint32_t val)
|
439 | 390af821 | aurel32 | { |
440 | 26ac1ea5 | Aurelien Jarno | env->fpscr = val & FPSCR_MASK; |
441 | 26ac1ea5 | Aurelien Jarno | if ((val & FPSCR_RM_MASK) == FPSCR_RM_ZERO) {
|
442 | 390af821 | aurel32 | set_float_rounding_mode(float_round_to_zero, &env->fp_status); |
443 | 26ac1ea5 | Aurelien Jarno | } else {
|
444 | 390af821 | aurel32 | set_float_rounding_mode(float_round_nearest_even, &env->fp_status); |
445 | 26ac1ea5 | Aurelien Jarno | } |
446 | a0d4ac33 | Aurelien Jarno | set_flush_to_zero((val & FPSCR_DN) != 0, &env->fp_status);
|
447 | 390af821 | aurel32 | } |
448 | cc4ba6a9 | aurel32 | |
449 | 21829e9b | Aurelien Jarno | static void update_fpscr(void *retaddr) |
450 | 21829e9b | Aurelien Jarno | { |
451 | 21829e9b | Aurelien Jarno | int xcpt, cause, enable;
|
452 | 21829e9b | Aurelien Jarno | |
453 | 21829e9b | Aurelien Jarno | xcpt = get_float_exception_flags(&env->fp_status); |
454 | 21829e9b | Aurelien Jarno | |
455 | 21829e9b | Aurelien Jarno | /* Clear the flag entries */
|
456 | 21829e9b | Aurelien Jarno | env->fpscr &= ~FPSCR_FLAG_MASK; |
457 | 21829e9b | Aurelien Jarno | |
458 | 21829e9b | Aurelien Jarno | if (unlikely(xcpt)) {
|
459 | 21829e9b | Aurelien Jarno | if (xcpt & float_flag_invalid) {
|
460 | 21829e9b | Aurelien Jarno | env->fpscr |= FPSCR_FLAG_V; |
461 | 21829e9b | Aurelien Jarno | } |
462 | 21829e9b | Aurelien Jarno | if (xcpt & float_flag_divbyzero) {
|
463 | 21829e9b | Aurelien Jarno | env->fpscr |= FPSCR_FLAG_Z; |
464 | 21829e9b | Aurelien Jarno | } |
465 | 21829e9b | Aurelien Jarno | if (xcpt & float_flag_overflow) {
|
466 | 21829e9b | Aurelien Jarno | env->fpscr |= FPSCR_FLAG_O; |
467 | 21829e9b | Aurelien Jarno | } |
468 | 21829e9b | Aurelien Jarno | if (xcpt & float_flag_underflow) {
|
469 | 21829e9b | Aurelien Jarno | env->fpscr |= FPSCR_FLAG_U; |
470 | 21829e9b | Aurelien Jarno | } |
471 | 21829e9b | Aurelien Jarno | if (xcpt & float_flag_inexact) {
|
472 | 21829e9b | Aurelien Jarno | env->fpscr |= FPSCR_FLAG_I; |
473 | 21829e9b | Aurelien Jarno | } |
474 | 21829e9b | Aurelien Jarno | |
475 | 21829e9b | Aurelien Jarno | /* Accumulate in cause entries */
|
476 | 21829e9b | Aurelien Jarno | env->fpscr |= (env->fpscr & FPSCR_FLAG_MASK) |
477 | 21829e9b | Aurelien Jarno | << (FPSCR_CAUSE_SHIFT - FPSCR_FLAG_SHIFT); |
478 | 21829e9b | Aurelien Jarno | |
479 | 21829e9b | Aurelien Jarno | /* Generate an exception if enabled */
|
480 | 21829e9b | Aurelien Jarno | cause = (env->fpscr & FPSCR_CAUSE_MASK) >> FPSCR_CAUSE_SHIFT; |
481 | 21829e9b | Aurelien Jarno | enable = (env->fpscr & FPSCR_ENABLE_MASK) >> FPSCR_ENABLE_SHIFT; |
482 | 21829e9b | Aurelien Jarno | if (cause & enable) {
|
483 | 21829e9b | Aurelien Jarno | cpu_restore_state_from_retaddr(retaddr); |
484 | 21829e9b | Aurelien Jarno | env->exception_index = 0x120;
|
485 | 21829e9b | Aurelien Jarno | cpu_loop_exit(); |
486 | 21829e9b | Aurelien Jarno | } |
487 | 21829e9b | Aurelien Jarno | } |
488 | 21829e9b | Aurelien Jarno | } |
489 | 21829e9b | Aurelien Jarno | |
490 | cc4ba6a9 | aurel32 | uint32_t helper_fabs_FT(uint32_t t0) |
491 | cc4ba6a9 | aurel32 | { |
492 | 9850d1e8 | aurel32 | CPU_FloatU f; |
493 | 9850d1e8 | aurel32 | f.l = t0; |
494 | 9850d1e8 | aurel32 | f.f = float32_abs(f.f); |
495 | 9850d1e8 | aurel32 | return f.l;
|
496 | cc4ba6a9 | aurel32 | } |
497 | cc4ba6a9 | aurel32 | |
498 | cc4ba6a9 | aurel32 | uint64_t helper_fabs_DT(uint64_t t0) |
499 | cc4ba6a9 | aurel32 | { |
500 | 9850d1e8 | aurel32 | CPU_DoubleU d; |
501 | 9850d1e8 | aurel32 | d.ll = t0; |
502 | 9850d1e8 | aurel32 | d.d = float64_abs(d.d); |
503 | 9850d1e8 | aurel32 | return d.ll;
|
504 | cc4ba6a9 | aurel32 | } |
505 | cc4ba6a9 | aurel32 | |
506 | cc4ba6a9 | aurel32 | uint32_t helper_fadd_FT(uint32_t t0, uint32_t t1) |
507 | cc4ba6a9 | aurel32 | { |
508 | 9850d1e8 | aurel32 | CPU_FloatU f0, f1; |
509 | 9850d1e8 | aurel32 | f0.l = t0; |
510 | 9850d1e8 | aurel32 | f1.l = t1; |
511 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
512 | 9850d1e8 | aurel32 | f0.f = float32_add(f0.f, f1.f, &env->fp_status); |
513 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
514 | 9850d1e8 | aurel32 | return f0.l;
|
515 | cc4ba6a9 | aurel32 | } |
516 | cc4ba6a9 | aurel32 | |
517 | cc4ba6a9 | aurel32 | uint64_t helper_fadd_DT(uint64_t t0, uint64_t t1) |
518 | cc4ba6a9 | aurel32 | { |
519 | 9850d1e8 | aurel32 | CPU_DoubleU d0, d1; |
520 | 9850d1e8 | aurel32 | d0.ll = t0; |
521 | 9850d1e8 | aurel32 | d1.ll = t1; |
522 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
523 | 9850d1e8 | aurel32 | d0.d = float64_add(d0.d, d1.d, &env->fp_status); |
524 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
525 | 9850d1e8 | aurel32 | return d0.ll;
|
526 | cc4ba6a9 | aurel32 | } |
527 | cc4ba6a9 | aurel32 | |
528 | cc4ba6a9 | aurel32 | void helper_fcmp_eq_FT(uint32_t t0, uint32_t t1)
|
529 | cc4ba6a9 | aurel32 | { |
530 | 9850d1e8 | aurel32 | CPU_FloatU f0, f1; |
531 | 21829e9b | Aurelien Jarno | int relation;
|
532 | 9850d1e8 | aurel32 | f0.l = t0; |
533 | 9850d1e8 | aurel32 | f1.l = t1; |
534 | 9850d1e8 | aurel32 | |
535 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
536 | 21829e9b | Aurelien Jarno | relation = float32_compare(f0.f, f1.f, &env->fp_status); |
537 | 21829e9b | Aurelien Jarno | if (unlikely(relation == float_relation_unordered)) {
|
538 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
539 | 21829e9b | Aurelien Jarno | } else if (relation == float_relation_equal) { |
540 | cc4ba6a9 | aurel32 | set_t(); |
541 | 21829e9b | Aurelien Jarno | } else {
|
542 | cc4ba6a9 | aurel32 | clr_t(); |
543 | 21829e9b | Aurelien Jarno | } |
544 | cc4ba6a9 | aurel32 | } |
545 | cc4ba6a9 | aurel32 | |
546 | cc4ba6a9 | aurel32 | void helper_fcmp_eq_DT(uint64_t t0, uint64_t t1)
|
547 | cc4ba6a9 | aurel32 | { |
548 | 9850d1e8 | aurel32 | CPU_DoubleU d0, d1; |
549 | 21829e9b | Aurelien Jarno | int relation;
|
550 | 9850d1e8 | aurel32 | d0.ll = t0; |
551 | 9850d1e8 | aurel32 | d1.ll = t1; |
552 | 9850d1e8 | aurel32 | |
553 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
554 | 21829e9b | Aurelien Jarno | relation = float64_compare(d0.d, d1.d, &env->fp_status); |
555 | 21829e9b | Aurelien Jarno | if (unlikely(relation == float_relation_unordered)) {
|
556 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
557 | 21829e9b | Aurelien Jarno | } else if (relation == float_relation_equal) { |
558 | cc4ba6a9 | aurel32 | set_t(); |
559 | 21829e9b | Aurelien Jarno | } else {
|
560 | cc4ba6a9 | aurel32 | clr_t(); |
561 | 21829e9b | Aurelien Jarno | } |
562 | cc4ba6a9 | aurel32 | } |
563 | cc4ba6a9 | aurel32 | |
564 | cc4ba6a9 | aurel32 | void helper_fcmp_gt_FT(uint32_t t0, uint32_t t1)
|
565 | cc4ba6a9 | aurel32 | { |
566 | 9850d1e8 | aurel32 | CPU_FloatU f0, f1; |
567 | 21829e9b | Aurelien Jarno | int relation;
|
568 | 9850d1e8 | aurel32 | f0.l = t0; |
569 | 9850d1e8 | aurel32 | f1.l = t1; |
570 | 9850d1e8 | aurel32 | |
571 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
572 | 21829e9b | Aurelien Jarno | relation = float32_compare(f0.f, f1.f, &env->fp_status); |
573 | 21829e9b | Aurelien Jarno | if (unlikely(relation == float_relation_unordered)) {
|
574 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
575 | 21829e9b | Aurelien Jarno | } else if (relation == float_relation_greater) { |
576 | cc4ba6a9 | aurel32 | set_t(); |
577 | 21829e9b | Aurelien Jarno | } else {
|
578 | cc4ba6a9 | aurel32 | clr_t(); |
579 | 21829e9b | Aurelien Jarno | } |
580 | cc4ba6a9 | aurel32 | } |
581 | cc4ba6a9 | aurel32 | |
582 | cc4ba6a9 | aurel32 | void helper_fcmp_gt_DT(uint64_t t0, uint64_t t1)
|
583 | cc4ba6a9 | aurel32 | { |
584 | 9850d1e8 | aurel32 | CPU_DoubleU d0, d1; |
585 | 21829e9b | Aurelien Jarno | int relation;
|
586 | 9850d1e8 | aurel32 | d0.ll = t0; |
587 | 9850d1e8 | aurel32 | d1.ll = t1; |
588 | 9850d1e8 | aurel32 | |
589 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
590 | 21829e9b | Aurelien Jarno | relation = float64_compare(d0.d, d1.d, &env->fp_status); |
591 | 21829e9b | Aurelien Jarno | if (unlikely(relation == float_relation_unordered)) {
|
592 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
593 | 21829e9b | Aurelien Jarno | } else if (relation == float_relation_greater) { |
594 | cc4ba6a9 | aurel32 | set_t(); |
595 | 21829e9b | Aurelien Jarno | } else {
|
596 | cc4ba6a9 | aurel32 | clr_t(); |
597 | 21829e9b | Aurelien Jarno | } |
598 | cc4ba6a9 | aurel32 | } |
599 | cc4ba6a9 | aurel32 | |
600 | cc4ba6a9 | aurel32 | uint64_t helper_fcnvsd_FT_DT(uint32_t t0) |
601 | cc4ba6a9 | aurel32 | { |
602 | 9850d1e8 | aurel32 | CPU_DoubleU d; |
603 | 9850d1e8 | aurel32 | CPU_FloatU f; |
604 | 9850d1e8 | aurel32 | f.l = t0; |
605 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
606 | 9850d1e8 | aurel32 | d.d = float32_to_float64(f.f, &env->fp_status); |
607 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
608 | 9850d1e8 | aurel32 | return d.ll;
|
609 | cc4ba6a9 | aurel32 | } |
610 | cc4ba6a9 | aurel32 | |
611 | cc4ba6a9 | aurel32 | uint32_t helper_fcnvds_DT_FT(uint64_t t0) |
612 | cc4ba6a9 | aurel32 | { |
613 | 9850d1e8 | aurel32 | CPU_DoubleU d; |
614 | 9850d1e8 | aurel32 | CPU_FloatU f; |
615 | 9850d1e8 | aurel32 | d.ll = t0; |
616 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
617 | 9850d1e8 | aurel32 | f.f = float64_to_float32(d.d, &env->fp_status); |
618 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
619 | 9850d1e8 | aurel32 | return f.l;
|
620 | cc4ba6a9 | aurel32 | } |
621 | cc4ba6a9 | aurel32 | |
622 | cc4ba6a9 | aurel32 | uint32_t helper_fdiv_FT(uint32_t t0, uint32_t t1) |
623 | cc4ba6a9 | aurel32 | { |
624 | 9850d1e8 | aurel32 | CPU_FloatU f0, f1; |
625 | 9850d1e8 | aurel32 | f0.l = t0; |
626 | 9850d1e8 | aurel32 | f1.l = t1; |
627 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
628 | 9850d1e8 | aurel32 | f0.f = float32_div(f0.f, f1.f, &env->fp_status); |
629 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
630 | 9850d1e8 | aurel32 | return f0.l;
|
631 | cc4ba6a9 | aurel32 | } |
632 | cc4ba6a9 | aurel32 | |
633 | cc4ba6a9 | aurel32 | uint64_t helper_fdiv_DT(uint64_t t0, uint64_t t1) |
634 | cc4ba6a9 | aurel32 | { |
635 | 9850d1e8 | aurel32 | CPU_DoubleU d0, d1; |
636 | 9850d1e8 | aurel32 | d0.ll = t0; |
637 | 9850d1e8 | aurel32 | d1.ll = t1; |
638 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
639 | 9850d1e8 | aurel32 | d0.d = float64_div(d0.d, d1.d, &env->fp_status); |
640 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
641 | 9850d1e8 | aurel32 | return d0.ll;
|
642 | cc4ba6a9 | aurel32 | } |
643 | cc4ba6a9 | aurel32 | |
644 | cc4ba6a9 | aurel32 | uint32_t helper_float_FT(uint32_t t0) |
645 | cc4ba6a9 | aurel32 | { |
646 | 9850d1e8 | aurel32 | CPU_FloatU f; |
647 | 21829e9b | Aurelien Jarno | |
648 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
649 | 9850d1e8 | aurel32 | f.f = int32_to_float32(t0, &env->fp_status); |
650 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
651 | 21829e9b | Aurelien Jarno | |
652 | 9850d1e8 | aurel32 | return f.l;
|
653 | cc4ba6a9 | aurel32 | } |
654 | cc4ba6a9 | aurel32 | |
655 | cc4ba6a9 | aurel32 | uint64_t helper_float_DT(uint32_t t0) |
656 | cc4ba6a9 | aurel32 | { |
657 | 9850d1e8 | aurel32 | CPU_DoubleU d; |
658 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
659 | 9850d1e8 | aurel32 | d.d = int32_to_float64(t0, &env->fp_status); |
660 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
661 | 9850d1e8 | aurel32 | return d.ll;
|
662 | cc4ba6a9 | aurel32 | } |
663 | cc4ba6a9 | aurel32 | |
664 | 5b7141a1 | aurel32 | uint32_t helper_fmac_FT(uint32_t t0, uint32_t t1, uint32_t t2) |
665 | 5b7141a1 | aurel32 | { |
666 | 5b7141a1 | aurel32 | CPU_FloatU f0, f1, f2; |
667 | 5b7141a1 | aurel32 | f0.l = t0; |
668 | 5b7141a1 | aurel32 | f1.l = t1; |
669 | 5b7141a1 | aurel32 | f2.l = t2; |
670 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
671 | 5b7141a1 | aurel32 | f0.f = float32_mul(f0.f, f1.f, &env->fp_status); |
672 | 5b7141a1 | aurel32 | f0.f = float32_add(f0.f, f2.f, &env->fp_status); |
673 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
674 | 21829e9b | Aurelien Jarno | |
675 | 5b7141a1 | aurel32 | return f0.l;
|
676 | 5b7141a1 | aurel32 | } |
677 | 5b7141a1 | aurel32 | |
678 | cc4ba6a9 | aurel32 | uint32_t helper_fmul_FT(uint32_t t0, uint32_t t1) |
679 | cc4ba6a9 | aurel32 | { |
680 | 9850d1e8 | aurel32 | CPU_FloatU f0, f1; |
681 | 9850d1e8 | aurel32 | f0.l = t0; |
682 | 9850d1e8 | aurel32 | f1.l = t1; |
683 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
684 | 9850d1e8 | aurel32 | f0.f = float32_mul(f0.f, f1.f, &env->fp_status); |
685 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
686 | 9850d1e8 | aurel32 | return f0.l;
|
687 | cc4ba6a9 | aurel32 | } |
688 | cc4ba6a9 | aurel32 | |
689 | cc4ba6a9 | aurel32 | uint64_t helper_fmul_DT(uint64_t t0, uint64_t t1) |
690 | cc4ba6a9 | aurel32 | { |
691 | 9850d1e8 | aurel32 | CPU_DoubleU d0, d1; |
692 | 9850d1e8 | aurel32 | d0.ll = t0; |
693 | 9850d1e8 | aurel32 | d1.ll = t1; |
694 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
695 | 9850d1e8 | aurel32 | d0.d = float64_mul(d0.d, d1.d, &env->fp_status); |
696 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
697 | 21829e9b | Aurelien Jarno | |
698 | 9850d1e8 | aurel32 | return d0.ll;
|
699 | cc4ba6a9 | aurel32 | } |
700 | cc4ba6a9 | aurel32 | |
701 | 7fdf924f | aurel32 | uint32_t helper_fneg_T(uint32_t t0) |
702 | 7fdf924f | aurel32 | { |
703 | 9850d1e8 | aurel32 | CPU_FloatU f; |
704 | 9850d1e8 | aurel32 | f.l = t0; |
705 | 9850d1e8 | aurel32 | f.f = float32_chs(f.f); |
706 | 9850d1e8 | aurel32 | return f.l;
|
707 | 7fdf924f | aurel32 | } |
708 | 7fdf924f | aurel32 | |
709 | cc4ba6a9 | aurel32 | uint32_t helper_fsqrt_FT(uint32_t t0) |
710 | cc4ba6a9 | aurel32 | { |
711 | 9850d1e8 | aurel32 | CPU_FloatU f; |
712 | 9850d1e8 | aurel32 | f.l = t0; |
713 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
714 | 9850d1e8 | aurel32 | f.f = float32_sqrt(f.f, &env->fp_status); |
715 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
716 | 9850d1e8 | aurel32 | return f.l;
|
717 | cc4ba6a9 | aurel32 | } |
718 | cc4ba6a9 | aurel32 | |
719 | cc4ba6a9 | aurel32 | uint64_t helper_fsqrt_DT(uint64_t t0) |
720 | cc4ba6a9 | aurel32 | { |
721 | 9850d1e8 | aurel32 | CPU_DoubleU d; |
722 | 9850d1e8 | aurel32 | d.ll = t0; |
723 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
724 | 9850d1e8 | aurel32 | d.d = float64_sqrt(d.d, &env->fp_status); |
725 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
726 | 9850d1e8 | aurel32 | return d.ll;
|
727 | cc4ba6a9 | aurel32 | } |
728 | cc4ba6a9 | aurel32 | |
729 | cc4ba6a9 | aurel32 | uint32_t helper_fsub_FT(uint32_t t0, uint32_t t1) |
730 | cc4ba6a9 | aurel32 | { |
731 | 9850d1e8 | aurel32 | CPU_FloatU f0, f1; |
732 | 9850d1e8 | aurel32 | f0.l = t0; |
733 | 9850d1e8 | aurel32 | f1.l = t1; |
734 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
735 | 9850d1e8 | aurel32 | f0.f = float32_sub(f0.f, f1.f, &env->fp_status); |
736 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
737 | 9850d1e8 | aurel32 | return f0.l;
|
738 | cc4ba6a9 | aurel32 | } |
739 | cc4ba6a9 | aurel32 | |
740 | cc4ba6a9 | aurel32 | uint64_t helper_fsub_DT(uint64_t t0, uint64_t t1) |
741 | cc4ba6a9 | aurel32 | { |
742 | 9850d1e8 | aurel32 | CPU_DoubleU d0, d1; |
743 | 21829e9b | Aurelien Jarno | |
744 | 9850d1e8 | aurel32 | d0.ll = t0; |
745 | 9850d1e8 | aurel32 | d1.ll = t1; |
746 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
747 | 9850d1e8 | aurel32 | d0.d = float64_sub(d0.d, d1.d, &env->fp_status); |
748 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
749 | 9850d1e8 | aurel32 | return d0.ll;
|
750 | cc4ba6a9 | aurel32 | } |
751 | cc4ba6a9 | aurel32 | |
752 | cc4ba6a9 | aurel32 | uint32_t helper_ftrc_FT(uint32_t t0) |
753 | cc4ba6a9 | aurel32 | { |
754 | 9850d1e8 | aurel32 | CPU_FloatU f; |
755 | 21829e9b | Aurelien Jarno | uint32_t ret; |
756 | 9850d1e8 | aurel32 | f.l = t0; |
757 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
758 | 21829e9b | Aurelien Jarno | ret = float32_to_int32_round_to_zero(f.f, &env->fp_status); |
759 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
760 | 21829e9b | Aurelien Jarno | return ret;
|
761 | cc4ba6a9 | aurel32 | } |
762 | cc4ba6a9 | aurel32 | |
763 | cc4ba6a9 | aurel32 | uint32_t helper_ftrc_DT(uint64_t t0) |
764 | cc4ba6a9 | aurel32 | { |
765 | 9850d1e8 | aurel32 | CPU_DoubleU d; |
766 | 21829e9b | Aurelien Jarno | uint32_t ret; |
767 | 9850d1e8 | aurel32 | d.ll = t0; |
768 | 21829e9b | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
769 | 21829e9b | Aurelien Jarno | ret = float64_to_int32_round_to_zero(d.d, &env->fp_status); |
770 | 21829e9b | Aurelien Jarno | update_fpscr(GETPC()); |
771 | 21829e9b | Aurelien Jarno | return ret;
|
772 | cc4ba6a9 | aurel32 | } |
773 | af8c2bde | Aurelien Jarno | |
774 | af8c2bde | Aurelien Jarno | void helper_fipr(uint32_t m, uint32_t n)
|
775 | af8c2bde | Aurelien Jarno | { |
776 | af8c2bde | Aurelien Jarno | int bank, i;
|
777 | af8c2bde | Aurelien Jarno | float32 r, p; |
778 | af8c2bde | Aurelien Jarno | |
779 | af8c2bde | Aurelien Jarno | bank = (env->sr & FPSCR_FR) ? 16 : 0; |
780 | af8c2bde | Aurelien Jarno | r = float32_zero; |
781 | af8c2bde | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
782 | af8c2bde | Aurelien Jarno | |
783 | af8c2bde | Aurelien Jarno | for (i = 0 ; i < 4 ; i++) { |
784 | af8c2bde | Aurelien Jarno | p = float32_mul(env->fregs[bank + m + i], |
785 | af8c2bde | Aurelien Jarno | env->fregs[bank + n + i], |
786 | af8c2bde | Aurelien Jarno | &env->fp_status); |
787 | af8c2bde | Aurelien Jarno | r = float32_add(r, p, &env->fp_status); |
788 | af8c2bde | Aurelien Jarno | } |
789 | af8c2bde | Aurelien Jarno | update_fpscr(GETPC()); |
790 | af8c2bde | Aurelien Jarno | |
791 | af8c2bde | Aurelien Jarno | env->fregs[bank + n + 3] = r;
|
792 | af8c2bde | Aurelien Jarno | } |
793 | 17075f10 | Aurelien Jarno | |
794 | 17075f10 | Aurelien Jarno | void helper_ftrv(uint32_t n)
|
795 | 17075f10 | Aurelien Jarno | { |
796 | 17075f10 | Aurelien Jarno | int bank_matrix, bank_vector;
|
797 | 17075f10 | Aurelien Jarno | int i, j;
|
798 | 17075f10 | Aurelien Jarno | float32 r[4];
|
799 | 17075f10 | Aurelien Jarno | float32 p; |
800 | 17075f10 | Aurelien Jarno | |
801 | 17075f10 | Aurelien Jarno | bank_matrix = (env->sr & FPSCR_FR) ? 0 : 16; |
802 | 17075f10 | Aurelien Jarno | bank_vector = (env->sr & FPSCR_FR) ? 16 : 0; |
803 | 17075f10 | Aurelien Jarno | set_float_exception_flags(0, &env->fp_status);
|
804 | 17075f10 | Aurelien Jarno | for (i = 0 ; i < 4 ; i++) { |
805 | 17075f10 | Aurelien Jarno | r[i] = float32_zero; |
806 | 17075f10 | Aurelien Jarno | for (j = 0 ; j < 4 ; j++) { |
807 | 17075f10 | Aurelien Jarno | p = float32_mul(env->fregs[bank_matrix + 4 * j + i],
|
808 | 17075f10 | Aurelien Jarno | env->fregs[bank_vector + j], |
809 | 17075f10 | Aurelien Jarno | &env->fp_status); |
810 | 17075f10 | Aurelien Jarno | r[i] = float32_add(r[i], p, &env->fp_status); |
811 | 17075f10 | Aurelien Jarno | } |
812 | 17075f10 | Aurelien Jarno | } |
813 | 17075f10 | Aurelien Jarno | update_fpscr(GETPC()); |
814 | 17075f10 | Aurelien Jarno | |
815 | 17075f10 | Aurelien Jarno | for (i = 0 ; i < 4 ; i++) { |
816 | 17075f10 | Aurelien Jarno | env->fregs[bank_vector + i] = r[i]; |
817 | 17075f10 | Aurelien Jarno | } |
818 | 17075f10 | Aurelien Jarno | } |