root / target-alpha / op_helper.c @ 94909d9f
History | View | Annotate | Download (24.9 kB)
1 | 4c9649a9 | j_mayer | /*
|
---|---|---|---|
2 | 4c9649a9 | j_mayer | * Alpha emulation cpu micro-operations helpers for qemu.
|
3 | 5fafdf24 | ths | *
|
4 | 4c9649a9 | j_mayer | * Copyright (c) 2007 Jocelyn Mayer
|
5 | 4c9649a9 | j_mayer | *
|
6 | 4c9649a9 | j_mayer | * This library is free software; you can redistribute it and/or
|
7 | 4c9649a9 | j_mayer | * modify it under the terms of the GNU Lesser General Public
|
8 | 4c9649a9 | j_mayer | * License as published by the Free Software Foundation; either
|
9 | 4c9649a9 | j_mayer | * version 2 of the License, or (at your option) any later version.
|
10 | 4c9649a9 | j_mayer | *
|
11 | 4c9649a9 | j_mayer | * This library is distributed in the hope that it will be useful,
|
12 | 4c9649a9 | j_mayer | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 | 4c9649a9 | j_mayer | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
14 | 4c9649a9 | j_mayer | * Lesser General Public License for more details.
|
15 | 4c9649a9 | j_mayer | *
|
16 | 4c9649a9 | j_mayer | * You should have received a copy of the GNU Lesser General Public
|
17 | 4c9649a9 | j_mayer | * License along with this library; if not, write to the Free Software
|
18 | fad6cb1a | aurel32 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
|
19 | 4c9649a9 | j_mayer | */
|
20 | 4c9649a9 | j_mayer | |
21 | 4c9649a9 | j_mayer | #include "exec.h" |
22 | 603fccce | j_mayer | #include "host-utils.h" |
23 | 4c9649a9 | j_mayer | #include "softfloat.h" |
24 | a7812ae4 | pbrook | #include "helper.h" |
25 | 4c9649a9 | j_mayer | |
26 | 4c9649a9 | j_mayer | void helper_tb_flush (void) |
27 | 4c9649a9 | j_mayer | { |
28 | 75fc9c0c | aurel32 | tb_flush(env); |
29 | 4c9649a9 | j_mayer | } |
30 | 4c9649a9 | j_mayer | |
31 | 4c9649a9 | j_mayer | /*****************************************************************************/
|
32 | 4c9649a9 | j_mayer | /* Exceptions processing helpers */
|
33 | 6ad02592 | aurel32 | void helper_excp (int excp, int error) |
34 | 4c9649a9 | j_mayer | { |
35 | 4c9649a9 | j_mayer | env->exception_index = excp; |
36 | 4c9649a9 | j_mayer | env->error_code = error; |
37 | 4c9649a9 | j_mayer | cpu_loop_exit(); |
38 | 4c9649a9 | j_mayer | } |
39 | 4c9649a9 | j_mayer | |
40 | 6ad02592 | aurel32 | uint64_t helper_load_pcc (void)
|
41 | 4c9649a9 | j_mayer | { |
42 | 4c9649a9 | j_mayer | /* XXX: TODO */
|
43 | 6ad02592 | aurel32 | return 0; |
44 | 4c9649a9 | j_mayer | } |
45 | 4c9649a9 | j_mayer | |
46 | f18cd223 | aurel32 | uint64_t helper_load_fpcr (void)
|
47 | 4c9649a9 | j_mayer | { |
48 | f18cd223 | aurel32 | uint64_t ret = 0;
|
49 | 4c9649a9 | j_mayer | #ifdef CONFIG_SOFTFLOAT
|
50 | f18cd223 | aurel32 | ret |= env->fp_status.float_exception_flags << 52;
|
51 | 4c9649a9 | j_mayer | if (env->fp_status.float_exception_flags)
|
52 | f18cd223 | aurel32 | ret |= 1ULL << 63; |
53 | 4c9649a9 | j_mayer | env->ipr[IPR_EXC_SUM] &= ~0x3E:
|
54 | 4c9649a9 | j_mayer | env->ipr[IPR_EXC_SUM] |= env->fp_status.float_exception_flags << 1;
|
55 | 4c9649a9 | j_mayer | #endif
|
56 | 4c9649a9 | j_mayer | switch (env->fp_status.float_rounding_mode) {
|
57 | 4c9649a9 | j_mayer | case float_round_nearest_even:
|
58 | f18cd223 | aurel32 | ret |= 2ULL << 58; |
59 | 4c9649a9 | j_mayer | break;
|
60 | 4c9649a9 | j_mayer | case float_round_down:
|
61 | f18cd223 | aurel32 | ret |= 1ULL << 58; |
62 | 4c9649a9 | j_mayer | break;
|
63 | 4c9649a9 | j_mayer | case float_round_up:
|
64 | f18cd223 | aurel32 | ret |= 3ULL << 58; |
65 | 4c9649a9 | j_mayer | break;
|
66 | 4c9649a9 | j_mayer | case float_round_to_zero:
|
67 | 4c9649a9 | j_mayer | break;
|
68 | 4c9649a9 | j_mayer | } |
69 | f18cd223 | aurel32 | return ret;
|
70 | 4c9649a9 | j_mayer | } |
71 | 4c9649a9 | j_mayer | |
72 | f18cd223 | aurel32 | void helper_store_fpcr (uint64_t val)
|
73 | 4c9649a9 | j_mayer | { |
74 | 4c9649a9 | j_mayer | #ifdef CONFIG_SOFTFLOAT
|
75 | f18cd223 | aurel32 | set_float_exception_flags((val >> 52) & 0x3F, &FP_STATUS); |
76 | 4c9649a9 | j_mayer | #endif
|
77 | f18cd223 | aurel32 | switch ((val >> 58) & 3) { |
78 | 4c9649a9 | j_mayer | case 0: |
79 | 4c9649a9 | j_mayer | set_float_rounding_mode(float_round_to_zero, &FP_STATUS); |
80 | 4c9649a9 | j_mayer | break;
|
81 | 4c9649a9 | j_mayer | case 1: |
82 | 4c9649a9 | j_mayer | set_float_rounding_mode(float_round_down, &FP_STATUS); |
83 | 4c9649a9 | j_mayer | break;
|
84 | 4c9649a9 | j_mayer | case 2: |
85 | 4c9649a9 | j_mayer | set_float_rounding_mode(float_round_nearest_even, &FP_STATUS); |
86 | 4c9649a9 | j_mayer | break;
|
87 | 4c9649a9 | j_mayer | case 3: |
88 | 4c9649a9 | j_mayer | set_float_rounding_mode(float_round_up, &FP_STATUS); |
89 | 4c9649a9 | j_mayer | break;
|
90 | 4c9649a9 | j_mayer | } |
91 | 4c9649a9 | j_mayer | } |
92 | 4c9649a9 | j_mayer | |
93 | 6ad02592 | aurel32 | spinlock_t intr_cpu_lock = SPIN_LOCK_UNLOCKED; |
94 | 4c9649a9 | j_mayer | |
95 | 6ad02592 | aurel32 | uint64_t helper_rs(void)
|
96 | 4c9649a9 | j_mayer | { |
97 | 6ad02592 | aurel32 | uint64_t tmp; |
98 | 6ad02592 | aurel32 | |
99 | 6ad02592 | aurel32 | spin_lock(&intr_cpu_lock); |
100 | 6ad02592 | aurel32 | tmp = env->intr_flag; |
101 | 6ad02592 | aurel32 | env->intr_flag = 1;
|
102 | 6ad02592 | aurel32 | spin_unlock(&intr_cpu_lock); |
103 | 6ad02592 | aurel32 | |
104 | 6ad02592 | aurel32 | return tmp;
|
105 | 4c9649a9 | j_mayer | } |
106 | 4c9649a9 | j_mayer | |
107 | 6ad02592 | aurel32 | uint64_t helper_rc(void)
|
108 | 4c9649a9 | j_mayer | { |
109 | 6ad02592 | aurel32 | uint64_t tmp; |
110 | 6ad02592 | aurel32 | |
111 | 6ad02592 | aurel32 | spin_lock(&intr_cpu_lock); |
112 | 6ad02592 | aurel32 | tmp = env->intr_flag; |
113 | 6ad02592 | aurel32 | env->intr_flag = 0;
|
114 | 6ad02592 | aurel32 | spin_unlock(&intr_cpu_lock); |
115 | 6ad02592 | aurel32 | |
116 | 6ad02592 | aurel32 | return tmp;
|
117 | 4c9649a9 | j_mayer | } |
118 | 4c9649a9 | j_mayer | |
119 | 04acd307 | aurel32 | uint64_t helper_addqv (uint64_t op1, uint64_t op2) |
120 | 4c9649a9 | j_mayer | { |
121 | 04acd307 | aurel32 | uint64_t tmp = op1; |
122 | 04acd307 | aurel32 | op1 += op2; |
123 | 04acd307 | aurel32 | if (unlikely((tmp ^ op2 ^ (-1ULL)) & (tmp ^ op1) & (1ULL << 63))) { |
124 | 4c9649a9 | j_mayer | helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW); |
125 | 4c9649a9 | j_mayer | } |
126 | 04acd307 | aurel32 | return op1;
|
127 | 4c9649a9 | j_mayer | } |
128 | 4c9649a9 | j_mayer | |
129 | 04acd307 | aurel32 | uint64_t helper_addlv (uint64_t op1, uint64_t op2) |
130 | 4c9649a9 | j_mayer | { |
131 | 04acd307 | aurel32 | uint64_t tmp = op1; |
132 | 04acd307 | aurel32 | op1 = (uint32_t)(op1 + op2); |
133 | 04acd307 | aurel32 | if (unlikely((tmp ^ op2 ^ (-1UL)) & (tmp ^ op1) & (1UL << 31))) { |
134 | 4c9649a9 | j_mayer | helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW); |
135 | 4c9649a9 | j_mayer | } |
136 | 04acd307 | aurel32 | return op1;
|
137 | 4c9649a9 | j_mayer | } |
138 | 4c9649a9 | j_mayer | |
139 | 04acd307 | aurel32 | uint64_t helper_subqv (uint64_t op1, uint64_t op2) |
140 | 4c9649a9 | j_mayer | { |
141 | ecbb5ea1 | aurel32 | uint64_t res; |
142 | ecbb5ea1 | aurel32 | res = op1 - op2; |
143 | ecbb5ea1 | aurel32 | if (unlikely((op1 ^ op2) & (res ^ op1) & (1ULL << 63))) { |
144 | 4c9649a9 | j_mayer | helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW); |
145 | 4c9649a9 | j_mayer | } |
146 | ecbb5ea1 | aurel32 | return res;
|
147 | 4c9649a9 | j_mayer | } |
148 | 4c9649a9 | j_mayer | |
149 | 04acd307 | aurel32 | uint64_t helper_sublv (uint64_t op1, uint64_t op2) |
150 | 4c9649a9 | j_mayer | { |
151 | ecbb5ea1 | aurel32 | uint32_t res; |
152 | ecbb5ea1 | aurel32 | res = op1 - op2; |
153 | ecbb5ea1 | aurel32 | if (unlikely((op1 ^ op2) & (res ^ op1) & (1UL << 31))) { |
154 | 4c9649a9 | j_mayer | helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW); |
155 | 4c9649a9 | j_mayer | } |
156 | ecbb5ea1 | aurel32 | return res;
|
157 | 4c9649a9 | j_mayer | } |
158 | 4c9649a9 | j_mayer | |
159 | 04acd307 | aurel32 | uint64_t helper_mullv (uint64_t op1, uint64_t op2) |
160 | 4c9649a9 | j_mayer | { |
161 | 04acd307 | aurel32 | int64_t res = (int64_t)op1 * (int64_t)op2; |
162 | 4c9649a9 | j_mayer | |
163 | 4c9649a9 | j_mayer | if (unlikely((int32_t)res != res)) {
|
164 | 4c9649a9 | j_mayer | helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW); |
165 | 4c9649a9 | j_mayer | } |
166 | 04acd307 | aurel32 | return (int64_t)((int32_t)res);
|
167 | 4c9649a9 | j_mayer | } |
168 | 4c9649a9 | j_mayer | |
169 | 04acd307 | aurel32 | uint64_t helper_mulqv (uint64_t op1, uint64_t op2) |
170 | 4c9649a9 | j_mayer | { |
171 | e14fe0a9 | j_mayer | uint64_t tl, th; |
172 | e14fe0a9 | j_mayer | |
173 | 04acd307 | aurel32 | muls64(&tl, &th, op1, op2); |
174 | e14fe0a9 | j_mayer | /* If th != 0 && th != -1, then we had an overflow */
|
175 | e14fe0a9 | j_mayer | if (unlikely((th + 1) > 1)) { |
176 | 4c9649a9 | j_mayer | helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW); |
177 | 4c9649a9 | j_mayer | } |
178 | 04acd307 | aurel32 | return tl;
|
179 | 04acd307 | aurel32 | } |
180 | 04acd307 | aurel32 | |
181 | 04acd307 | aurel32 | uint64_t helper_umulh (uint64_t op1, uint64_t op2) |
182 | 04acd307 | aurel32 | { |
183 | 04acd307 | aurel32 | uint64_t tl, th; |
184 | 04acd307 | aurel32 | |
185 | 04acd307 | aurel32 | mulu64(&tl, &th, op1, op2); |
186 | 04acd307 | aurel32 | return th;
|
187 | 4c9649a9 | j_mayer | } |
188 | 4c9649a9 | j_mayer | |
189 | ae8ecd42 | aurel32 | uint64_t helper_ctpop (uint64_t arg) |
190 | 4c9649a9 | j_mayer | { |
191 | ae8ecd42 | aurel32 | return ctpop64(arg);
|
192 | 4c9649a9 | j_mayer | } |
193 | 4c9649a9 | j_mayer | |
194 | ae8ecd42 | aurel32 | uint64_t helper_ctlz (uint64_t arg) |
195 | 4c9649a9 | j_mayer | { |
196 | ae8ecd42 | aurel32 | return clz64(arg);
|
197 | 4c9649a9 | j_mayer | } |
198 | 4c9649a9 | j_mayer | |
199 | ae8ecd42 | aurel32 | uint64_t helper_cttz (uint64_t arg) |
200 | 4c9649a9 | j_mayer | { |
201 | ae8ecd42 | aurel32 | return ctz64(arg);
|
202 | 4c9649a9 | j_mayer | } |
203 | 4c9649a9 | j_mayer | |
204 | f071b4d3 | j_mayer | static always_inline uint64_t byte_zap (uint64_t op, uint8_t mskb)
|
205 | 4c9649a9 | j_mayer | { |
206 | 4c9649a9 | j_mayer | uint64_t mask; |
207 | 4c9649a9 | j_mayer | |
208 | 4c9649a9 | j_mayer | mask = 0;
|
209 | 4c9649a9 | j_mayer | mask |= ((mskb >> 0) & 1) * 0x00000000000000FFULL; |
210 | 4c9649a9 | j_mayer | mask |= ((mskb >> 1) & 1) * 0x000000000000FF00ULL; |
211 | 4c9649a9 | j_mayer | mask |= ((mskb >> 2) & 1) * 0x0000000000FF0000ULL; |
212 | 4c9649a9 | j_mayer | mask |= ((mskb >> 3) & 1) * 0x00000000FF000000ULL; |
213 | 4c9649a9 | j_mayer | mask |= ((mskb >> 4) & 1) * 0x000000FF00000000ULL; |
214 | 4c9649a9 | j_mayer | mask |= ((mskb >> 5) & 1) * 0x0000FF0000000000ULL; |
215 | 4c9649a9 | j_mayer | mask |= ((mskb >> 6) & 1) * 0x00FF000000000000ULL; |
216 | 4c9649a9 | j_mayer | mask |= ((mskb >> 7) & 1) * 0xFF00000000000000ULL; |
217 | 4c9649a9 | j_mayer | |
218 | 4c9649a9 | j_mayer | return op & ~mask;
|
219 | 4c9649a9 | j_mayer | } |
220 | 4c9649a9 | j_mayer | |
221 | b3249f63 | aurel32 | uint64_t helper_mskbl(uint64_t val, uint64_t mask) |
222 | 4c9649a9 | j_mayer | { |
223 | b3249f63 | aurel32 | return byte_zap(val, 0x01 << (mask & 7)); |
224 | 4c9649a9 | j_mayer | } |
225 | 4c9649a9 | j_mayer | |
226 | b3249f63 | aurel32 | uint64_t helper_insbl(uint64_t val, uint64_t mask) |
227 | 4c9649a9 | j_mayer | { |
228 | b3249f63 | aurel32 | val <<= (mask & 7) * 8; |
229 | b3249f63 | aurel32 | return byte_zap(val, ~(0x01 << (mask & 7))); |
230 | 4c9649a9 | j_mayer | } |
231 | 4c9649a9 | j_mayer | |
232 | b3249f63 | aurel32 | uint64_t helper_mskwl(uint64_t val, uint64_t mask) |
233 | 4c9649a9 | j_mayer | { |
234 | b3249f63 | aurel32 | return byte_zap(val, 0x03 << (mask & 7)); |
235 | 4c9649a9 | j_mayer | } |
236 | 4c9649a9 | j_mayer | |
237 | b3249f63 | aurel32 | uint64_t helper_inswl(uint64_t val, uint64_t mask) |
238 | 4c9649a9 | j_mayer | { |
239 | b3249f63 | aurel32 | val <<= (mask & 7) * 8; |
240 | b3249f63 | aurel32 | return byte_zap(val, ~(0x03 << (mask & 7))); |
241 | 4c9649a9 | j_mayer | } |
242 | 4c9649a9 | j_mayer | |
243 | b3249f63 | aurel32 | uint64_t helper_mskll(uint64_t val, uint64_t mask) |
244 | 4c9649a9 | j_mayer | { |
245 | b3249f63 | aurel32 | return byte_zap(val, 0x0F << (mask & 7)); |
246 | 4c9649a9 | j_mayer | } |
247 | 4c9649a9 | j_mayer | |
248 | b3249f63 | aurel32 | uint64_t helper_insll(uint64_t val, uint64_t mask) |
249 | 4c9649a9 | j_mayer | { |
250 | b3249f63 | aurel32 | val <<= (mask & 7) * 8; |
251 | b3249f63 | aurel32 | return byte_zap(val, ~(0x0F << (mask & 7))); |
252 | 4c9649a9 | j_mayer | } |
253 | 4c9649a9 | j_mayer | |
254 | b3249f63 | aurel32 | uint64_t helper_zap(uint64_t val, uint64_t mask) |
255 | 4c9649a9 | j_mayer | { |
256 | b3249f63 | aurel32 | return byte_zap(val, mask);
|
257 | 4c9649a9 | j_mayer | } |
258 | 4c9649a9 | j_mayer | |
259 | b3249f63 | aurel32 | uint64_t helper_zapnot(uint64_t val, uint64_t mask) |
260 | 4c9649a9 | j_mayer | { |
261 | b3249f63 | aurel32 | return byte_zap(val, ~mask);
|
262 | 4c9649a9 | j_mayer | } |
263 | 4c9649a9 | j_mayer | |
264 | b3249f63 | aurel32 | uint64_t helper_mskql(uint64_t val, uint64_t mask) |
265 | 4c9649a9 | j_mayer | { |
266 | b3249f63 | aurel32 | return byte_zap(val, 0xFF << (mask & 7)); |
267 | 4c9649a9 | j_mayer | } |
268 | 4c9649a9 | j_mayer | |
269 | b3249f63 | aurel32 | uint64_t helper_insql(uint64_t val, uint64_t mask) |
270 | 4c9649a9 | j_mayer | { |
271 | b3249f63 | aurel32 | val <<= (mask & 7) * 8; |
272 | b3249f63 | aurel32 | return byte_zap(val, ~(0xFF << (mask & 7))); |
273 | 4c9649a9 | j_mayer | } |
274 | 4c9649a9 | j_mayer | |
275 | b3249f63 | aurel32 | uint64_t helper_mskwh(uint64_t val, uint64_t mask) |
276 | 4c9649a9 | j_mayer | { |
277 | b3249f63 | aurel32 | return byte_zap(val, (0x03 << (mask & 7)) >> 8); |
278 | 4c9649a9 | j_mayer | } |
279 | 4c9649a9 | j_mayer | |
280 | b3249f63 | aurel32 | uint64_t helper_inswh(uint64_t val, uint64_t mask) |
281 | 4c9649a9 | j_mayer | { |
282 | b3249f63 | aurel32 | val >>= 64 - ((mask & 7) * 8); |
283 | b3249f63 | aurel32 | return byte_zap(val, ~((0x03 << (mask & 7)) >> 8)); |
284 | 4c9649a9 | j_mayer | } |
285 | 4c9649a9 | j_mayer | |
286 | b3249f63 | aurel32 | uint64_t helper_msklh(uint64_t val, uint64_t mask) |
287 | 4c9649a9 | j_mayer | { |
288 | b3249f63 | aurel32 | return byte_zap(val, (0x0F << (mask & 7)) >> 8); |
289 | 4c9649a9 | j_mayer | } |
290 | 4c9649a9 | j_mayer | |
291 | b3249f63 | aurel32 | uint64_t helper_inslh(uint64_t val, uint64_t mask) |
292 | 4c9649a9 | j_mayer | { |
293 | b3249f63 | aurel32 | val >>= 64 - ((mask & 7) * 8); |
294 | b3249f63 | aurel32 | return byte_zap(val, ~((0x0F << (mask & 7)) >> 8)); |
295 | 4c9649a9 | j_mayer | } |
296 | 4c9649a9 | j_mayer | |
297 | b3249f63 | aurel32 | uint64_t helper_mskqh(uint64_t val, uint64_t mask) |
298 | 4c9649a9 | j_mayer | { |
299 | b3249f63 | aurel32 | return byte_zap(val, (0xFF << (mask & 7)) >> 8); |
300 | 4c9649a9 | j_mayer | } |
301 | 4c9649a9 | j_mayer | |
302 | b3249f63 | aurel32 | uint64_t helper_insqh(uint64_t val, uint64_t mask) |
303 | 4c9649a9 | j_mayer | { |
304 | b3249f63 | aurel32 | val >>= 64 - ((mask & 7) * 8); |
305 | b3249f63 | aurel32 | return byte_zap(val, ~((0xFF << (mask & 7)) >> 8)); |
306 | 4c9649a9 | j_mayer | } |
307 | 4c9649a9 | j_mayer | |
308 | 04acd307 | aurel32 | uint64_t helper_cmpbge (uint64_t op1, uint64_t op2) |
309 | 4c9649a9 | j_mayer | { |
310 | 4c9649a9 | j_mayer | uint8_t opa, opb, res; |
311 | 4c9649a9 | j_mayer | int i;
|
312 | 4c9649a9 | j_mayer | |
313 | 4c9649a9 | j_mayer | res = 0;
|
314 | 970d622e | aurel32 | for (i = 0; i < 8; i++) { |
315 | 04acd307 | aurel32 | opa = op1 >> (i * 8);
|
316 | 04acd307 | aurel32 | opb = op2 >> (i * 8);
|
317 | 4c9649a9 | j_mayer | if (opa >= opb)
|
318 | 4c9649a9 | j_mayer | res |= 1 << i;
|
319 | 4c9649a9 | j_mayer | } |
320 | 04acd307 | aurel32 | return res;
|
321 | 4c9649a9 | j_mayer | } |
322 | 4c9649a9 | j_mayer | |
323 | f18cd223 | aurel32 | /* Floating point helpers */
|
324 | f18cd223 | aurel32 | |
325 | f18cd223 | aurel32 | /* F floating (VAX) */
|
326 | f18cd223 | aurel32 | static always_inline uint64_t float32_to_f (float32 fa)
|
327 | 4c9649a9 | j_mayer | { |
328 | f18cd223 | aurel32 | uint64_t r, exp, mant, sig; |
329 | e2eb2798 | aurel32 | CPU_FloatU a; |
330 | f18cd223 | aurel32 | |
331 | e2eb2798 | aurel32 | a.f = fa; |
332 | e2eb2798 | aurel32 | sig = ((uint64_t)a.l & 0x80000000) << 32; |
333 | e2eb2798 | aurel32 | exp = (a.l >> 23) & 0xff; |
334 | e2eb2798 | aurel32 | mant = ((uint64_t)a.l & 0x007fffff) << 29; |
335 | f18cd223 | aurel32 | |
336 | f18cd223 | aurel32 | if (exp == 255) { |
337 | f18cd223 | aurel32 | /* NaN or infinity */
|
338 | f18cd223 | aurel32 | r = 1; /* VAX dirty zero */ |
339 | f18cd223 | aurel32 | } else if (exp == 0) { |
340 | f18cd223 | aurel32 | if (mant == 0) { |
341 | f18cd223 | aurel32 | /* Zero */
|
342 | f18cd223 | aurel32 | r = 0;
|
343 | f18cd223 | aurel32 | } else {
|
344 | f18cd223 | aurel32 | /* Denormalized */
|
345 | f18cd223 | aurel32 | r = sig | ((exp + 1) << 52) | mant; |
346 | f18cd223 | aurel32 | } |
347 | f18cd223 | aurel32 | } else {
|
348 | f18cd223 | aurel32 | if (exp >= 253) { |
349 | f18cd223 | aurel32 | /* Overflow */
|
350 | f18cd223 | aurel32 | r = 1; /* VAX dirty zero */ |
351 | f18cd223 | aurel32 | } else {
|
352 | f18cd223 | aurel32 | r = sig | ((exp + 2) << 52); |
353 | f18cd223 | aurel32 | } |
354 | f18cd223 | aurel32 | } |
355 | f18cd223 | aurel32 | |
356 | f18cd223 | aurel32 | return r;
|
357 | 4c9649a9 | j_mayer | } |
358 | 4c9649a9 | j_mayer | |
359 | f18cd223 | aurel32 | static always_inline float32 f_to_float32 (uint64_t a)
|
360 | 4c9649a9 | j_mayer | { |
361 | e2eb2798 | aurel32 | uint32_t exp, mant_sig; |
362 | e2eb2798 | aurel32 | CPU_FloatU r; |
363 | f18cd223 | aurel32 | |
364 | f18cd223 | aurel32 | exp = ((a >> 55) & 0x80) | ((a >> 52) & 0x7f); |
365 | f18cd223 | aurel32 | mant_sig = ((a >> 32) & 0x80000000) | ((a >> 29) & 0x007fffff); |
366 | f18cd223 | aurel32 | |
367 | f18cd223 | aurel32 | if (unlikely(!exp && mant_sig)) {
|
368 | f18cd223 | aurel32 | /* Reserved operands / Dirty zero */
|
369 | f18cd223 | aurel32 | helper_excp(EXCP_OPCDEC, 0);
|
370 | f18cd223 | aurel32 | } |
371 | f18cd223 | aurel32 | |
372 | f18cd223 | aurel32 | if (exp < 3) { |
373 | f18cd223 | aurel32 | /* Underflow */
|
374 | e2eb2798 | aurel32 | r.l = 0;
|
375 | f18cd223 | aurel32 | } else {
|
376 | e2eb2798 | aurel32 | r.l = ((exp - 2) << 23) | mant_sig; |
377 | f18cd223 | aurel32 | } |
378 | f18cd223 | aurel32 | |
379 | e2eb2798 | aurel32 | return r.f;
|
380 | 4c9649a9 | j_mayer | } |
381 | 4c9649a9 | j_mayer | |
382 | f18cd223 | aurel32 | uint32_t helper_f_to_memory (uint64_t a) |
383 | 4c9649a9 | j_mayer | { |
384 | f18cd223 | aurel32 | uint32_t r; |
385 | f18cd223 | aurel32 | r = (a & 0x00001fffe0000000ull) >> 13; |
386 | f18cd223 | aurel32 | r |= (a & 0x07ffe00000000000ull) >> 45; |
387 | f18cd223 | aurel32 | r |= (a & 0xc000000000000000ull) >> 48; |
388 | f18cd223 | aurel32 | return r;
|
389 | f18cd223 | aurel32 | } |
390 | 4c9649a9 | j_mayer | |
391 | f18cd223 | aurel32 | uint64_t helper_memory_to_f (uint32_t a) |
392 | f18cd223 | aurel32 | { |
393 | f18cd223 | aurel32 | uint64_t r; |
394 | f18cd223 | aurel32 | r = ((uint64_t)(a & 0x0000c000)) << 48; |
395 | f18cd223 | aurel32 | r |= ((uint64_t)(a & 0x003fffff)) << 45; |
396 | f18cd223 | aurel32 | r |= ((uint64_t)(a & 0xffff0000)) << 13; |
397 | f18cd223 | aurel32 | if (!(a & 0x00004000)) |
398 | f18cd223 | aurel32 | r |= 0x7ll << 59; |
399 | f18cd223 | aurel32 | return r;
|
400 | 4c9649a9 | j_mayer | } |
401 | 4c9649a9 | j_mayer | |
402 | f18cd223 | aurel32 | uint64_t helper_addf (uint64_t a, uint64_t b) |
403 | 4c9649a9 | j_mayer | { |
404 | f18cd223 | aurel32 | float32 fa, fb, fr; |
405 | 4c9649a9 | j_mayer | |
406 | f18cd223 | aurel32 | fa = f_to_float32(a); |
407 | f18cd223 | aurel32 | fb = f_to_float32(b); |
408 | f18cd223 | aurel32 | fr = float32_add(fa, fb, &FP_STATUS); |
409 | f18cd223 | aurel32 | return float32_to_f(fr);
|
410 | 4c9649a9 | j_mayer | } |
411 | 4c9649a9 | j_mayer | |
412 | f18cd223 | aurel32 | uint64_t helper_subf (uint64_t a, uint64_t b) |
413 | 4c9649a9 | j_mayer | { |
414 | f18cd223 | aurel32 | float32 fa, fb, fr; |
415 | 4c9649a9 | j_mayer | |
416 | f18cd223 | aurel32 | fa = f_to_float32(a); |
417 | f18cd223 | aurel32 | fb = f_to_float32(b); |
418 | f18cd223 | aurel32 | fr = float32_sub(fa, fb, &FP_STATUS); |
419 | f18cd223 | aurel32 | return float32_to_f(fr);
|
420 | 4c9649a9 | j_mayer | } |
421 | 4c9649a9 | j_mayer | |
422 | f18cd223 | aurel32 | uint64_t helper_mulf (uint64_t a, uint64_t b) |
423 | 4c9649a9 | j_mayer | { |
424 | f18cd223 | aurel32 | float32 fa, fb, fr; |
425 | 4c9649a9 | j_mayer | |
426 | f18cd223 | aurel32 | fa = f_to_float32(a); |
427 | f18cd223 | aurel32 | fb = f_to_float32(b); |
428 | f18cd223 | aurel32 | fr = float32_mul(fa, fb, &FP_STATUS); |
429 | f18cd223 | aurel32 | return float32_to_f(fr);
|
430 | 4c9649a9 | j_mayer | } |
431 | 4c9649a9 | j_mayer | |
432 | f18cd223 | aurel32 | uint64_t helper_divf (uint64_t a, uint64_t b) |
433 | 4c9649a9 | j_mayer | { |
434 | f18cd223 | aurel32 | float32 fa, fb, fr; |
435 | 4c9649a9 | j_mayer | |
436 | f18cd223 | aurel32 | fa = f_to_float32(a); |
437 | f18cd223 | aurel32 | fb = f_to_float32(b); |
438 | f18cd223 | aurel32 | fr = float32_div(fa, fb, &FP_STATUS); |
439 | f18cd223 | aurel32 | return float32_to_f(fr);
|
440 | 4c9649a9 | j_mayer | } |
441 | 4c9649a9 | j_mayer | |
442 | f18cd223 | aurel32 | uint64_t helper_sqrtf (uint64_t t) |
443 | 4c9649a9 | j_mayer | { |
444 | f18cd223 | aurel32 | float32 ft, fr; |
445 | f18cd223 | aurel32 | |
446 | f18cd223 | aurel32 | ft = f_to_float32(t); |
447 | f18cd223 | aurel32 | fr = float32_sqrt(ft, &FP_STATUS); |
448 | f18cd223 | aurel32 | return float32_to_f(fr);
|
449 | 4c9649a9 | j_mayer | } |
450 | 4c9649a9 | j_mayer | |
451 | f18cd223 | aurel32 | |
452 | f18cd223 | aurel32 | /* G floating (VAX) */
|
453 | f18cd223 | aurel32 | static always_inline uint64_t float64_to_g (float64 fa)
|
454 | 4c9649a9 | j_mayer | { |
455 | e2eb2798 | aurel32 | uint64_t r, exp, mant, sig; |
456 | e2eb2798 | aurel32 | CPU_DoubleU a; |
457 | 4c9649a9 | j_mayer | |
458 | e2eb2798 | aurel32 | a.d = fa; |
459 | e2eb2798 | aurel32 | sig = a.ll & 0x8000000000000000ull;
|
460 | e2eb2798 | aurel32 | exp = (a.ll >> 52) & 0x7ff; |
461 | e2eb2798 | aurel32 | mant = a.ll & 0x000fffffffffffffull;
|
462 | f18cd223 | aurel32 | |
463 | f18cd223 | aurel32 | if (exp == 2047) { |
464 | f18cd223 | aurel32 | /* NaN or infinity */
|
465 | f18cd223 | aurel32 | r = 1; /* VAX dirty zero */ |
466 | f18cd223 | aurel32 | } else if (exp == 0) { |
467 | f18cd223 | aurel32 | if (mant == 0) { |
468 | f18cd223 | aurel32 | /* Zero */
|
469 | f18cd223 | aurel32 | r = 0;
|
470 | f18cd223 | aurel32 | } else {
|
471 | f18cd223 | aurel32 | /* Denormalized */
|
472 | f18cd223 | aurel32 | r = sig | ((exp + 1) << 52) | mant; |
473 | f18cd223 | aurel32 | } |
474 | f18cd223 | aurel32 | } else {
|
475 | f18cd223 | aurel32 | if (exp >= 2045) { |
476 | f18cd223 | aurel32 | /* Overflow */
|
477 | f18cd223 | aurel32 | r = 1; /* VAX dirty zero */ |
478 | f18cd223 | aurel32 | } else {
|
479 | f18cd223 | aurel32 | r = sig | ((exp + 2) << 52); |
480 | f18cd223 | aurel32 | } |
481 | f18cd223 | aurel32 | } |
482 | f18cd223 | aurel32 | |
483 | f18cd223 | aurel32 | return r;
|
484 | 4c9649a9 | j_mayer | } |
485 | 4c9649a9 | j_mayer | |
486 | f18cd223 | aurel32 | static always_inline float64 g_to_float64 (uint64_t a)
|
487 | 4c9649a9 | j_mayer | { |
488 | e2eb2798 | aurel32 | uint64_t exp, mant_sig; |
489 | e2eb2798 | aurel32 | CPU_DoubleU r; |
490 | f18cd223 | aurel32 | |
491 | f18cd223 | aurel32 | exp = (a >> 52) & 0x7ff; |
492 | f18cd223 | aurel32 | mant_sig = a & 0x800fffffffffffffull;
|
493 | f18cd223 | aurel32 | |
494 | f18cd223 | aurel32 | if (!exp && mant_sig) {
|
495 | f18cd223 | aurel32 | /* Reserved operands / Dirty zero */
|
496 | f18cd223 | aurel32 | helper_excp(EXCP_OPCDEC, 0);
|
497 | f18cd223 | aurel32 | } |
498 | 4c9649a9 | j_mayer | |
499 | f18cd223 | aurel32 | if (exp < 3) { |
500 | f18cd223 | aurel32 | /* Underflow */
|
501 | e2eb2798 | aurel32 | r.ll = 0;
|
502 | f18cd223 | aurel32 | } else {
|
503 | e2eb2798 | aurel32 | r.ll = ((exp - 2) << 52) | mant_sig; |
504 | f18cd223 | aurel32 | } |
505 | f18cd223 | aurel32 | |
506 | e2eb2798 | aurel32 | return r.d;
|
507 | 4c9649a9 | j_mayer | } |
508 | 4c9649a9 | j_mayer | |
509 | f18cd223 | aurel32 | uint64_t helper_g_to_memory (uint64_t a) |
510 | 4c9649a9 | j_mayer | { |
511 | f18cd223 | aurel32 | uint64_t r; |
512 | f18cd223 | aurel32 | r = (a & 0x000000000000ffffull) << 48; |
513 | f18cd223 | aurel32 | r |= (a & 0x00000000ffff0000ull) << 16; |
514 | f18cd223 | aurel32 | r |= (a & 0x0000ffff00000000ull) >> 16; |
515 | f18cd223 | aurel32 | r |= (a & 0xffff000000000000ull) >> 48; |
516 | f18cd223 | aurel32 | return r;
|
517 | f18cd223 | aurel32 | } |
518 | 4c9649a9 | j_mayer | |
519 | f18cd223 | aurel32 | uint64_t helper_memory_to_g (uint64_t a) |
520 | f18cd223 | aurel32 | { |
521 | f18cd223 | aurel32 | uint64_t r; |
522 | f18cd223 | aurel32 | r = (a & 0x000000000000ffffull) << 48; |
523 | f18cd223 | aurel32 | r |= (a & 0x00000000ffff0000ull) << 16; |
524 | f18cd223 | aurel32 | r |= (a & 0x0000ffff00000000ull) >> 16; |
525 | f18cd223 | aurel32 | r |= (a & 0xffff000000000000ull) >> 48; |
526 | f18cd223 | aurel32 | return r;
|
527 | 4c9649a9 | j_mayer | } |
528 | 4c9649a9 | j_mayer | |
529 | f18cd223 | aurel32 | uint64_t helper_addg (uint64_t a, uint64_t b) |
530 | 4c9649a9 | j_mayer | { |
531 | f18cd223 | aurel32 | float64 fa, fb, fr; |
532 | 4c9649a9 | j_mayer | |
533 | f18cd223 | aurel32 | fa = g_to_float64(a); |
534 | f18cd223 | aurel32 | fb = g_to_float64(b); |
535 | f18cd223 | aurel32 | fr = float64_add(fa, fb, &FP_STATUS); |
536 | f18cd223 | aurel32 | return float64_to_g(fr);
|
537 | 4c9649a9 | j_mayer | } |
538 | 4c9649a9 | j_mayer | |
539 | f18cd223 | aurel32 | uint64_t helper_subg (uint64_t a, uint64_t b) |
540 | 4c9649a9 | j_mayer | { |
541 | f18cd223 | aurel32 | float64 fa, fb, fr; |
542 | 4c9649a9 | j_mayer | |
543 | f18cd223 | aurel32 | fa = g_to_float64(a); |
544 | f18cd223 | aurel32 | fb = g_to_float64(b); |
545 | f18cd223 | aurel32 | fr = float64_sub(fa, fb, &FP_STATUS); |
546 | f18cd223 | aurel32 | return float64_to_g(fr);
|
547 | 4c9649a9 | j_mayer | } |
548 | 4c9649a9 | j_mayer | |
549 | f18cd223 | aurel32 | uint64_t helper_mulg (uint64_t a, uint64_t b) |
550 | 4c9649a9 | j_mayer | { |
551 | f18cd223 | aurel32 | float64 fa, fb, fr; |
552 | 4c9649a9 | j_mayer | |
553 | f18cd223 | aurel32 | fa = g_to_float64(a); |
554 | f18cd223 | aurel32 | fb = g_to_float64(b); |
555 | f18cd223 | aurel32 | fr = float64_mul(fa, fb, &FP_STATUS); |
556 | f18cd223 | aurel32 | return float64_to_g(fr);
|
557 | 4c9649a9 | j_mayer | } |
558 | 4c9649a9 | j_mayer | |
559 | f18cd223 | aurel32 | uint64_t helper_divg (uint64_t a, uint64_t b) |
560 | 4c9649a9 | j_mayer | { |
561 | f18cd223 | aurel32 | float64 fa, fb, fr; |
562 | 4c9649a9 | j_mayer | |
563 | f18cd223 | aurel32 | fa = g_to_float64(a); |
564 | f18cd223 | aurel32 | fb = g_to_float64(b); |
565 | f18cd223 | aurel32 | fr = float64_div(fa, fb, &FP_STATUS); |
566 | f18cd223 | aurel32 | return float64_to_g(fr);
|
567 | f18cd223 | aurel32 | } |
568 | f18cd223 | aurel32 | |
569 | f18cd223 | aurel32 | uint64_t helper_sqrtg (uint64_t a) |
570 | f18cd223 | aurel32 | { |
571 | f18cd223 | aurel32 | float64 fa, fr; |
572 | 4c9649a9 | j_mayer | |
573 | f18cd223 | aurel32 | fa = g_to_float64(a); |
574 | f18cd223 | aurel32 | fr = float64_sqrt(fa, &FP_STATUS); |
575 | f18cd223 | aurel32 | return float64_to_g(fr);
|
576 | 4c9649a9 | j_mayer | } |
577 | 4c9649a9 | j_mayer | |
578 | f18cd223 | aurel32 | |
579 | f18cd223 | aurel32 | /* S floating (single) */
|
580 | f18cd223 | aurel32 | static always_inline uint64_t float32_to_s (float32 fa)
|
581 | 4c9649a9 | j_mayer | { |
582 | e2eb2798 | aurel32 | CPU_FloatU a; |
583 | f18cd223 | aurel32 | uint64_t r; |
584 | 4c9649a9 | j_mayer | |
585 | e2eb2798 | aurel32 | a.f = fa; |
586 | 4c9649a9 | j_mayer | |
587 | e2eb2798 | aurel32 | r = (((uint64_t)(a.l & 0xc0000000)) << 32) | (((uint64_t)(a.l & 0x3fffffff)) << 29); |
588 | e2eb2798 | aurel32 | if (((a.l & 0x7f800000) != 0x7f800000) && (!(a.l & 0x40000000))) |
589 | f18cd223 | aurel32 | r |= 0x7ll << 59; |
590 | f18cd223 | aurel32 | return r;
|
591 | 4c9649a9 | j_mayer | } |
592 | 4c9649a9 | j_mayer | |
593 | f18cd223 | aurel32 | static always_inline float32 s_to_float32 (uint64_t a)
|
594 | 4c9649a9 | j_mayer | { |
595 | e2eb2798 | aurel32 | CPU_FloatU r; |
596 | e2eb2798 | aurel32 | r.l = ((a >> 32) & 0xc0000000) | ((a >> 29) & 0x3fffffff); |
597 | e2eb2798 | aurel32 | return r.f;
|
598 | f18cd223 | aurel32 | } |
599 | 4c9649a9 | j_mayer | |
600 | f18cd223 | aurel32 | uint32_t helper_s_to_memory (uint64_t a) |
601 | f18cd223 | aurel32 | { |
602 | f18cd223 | aurel32 | /* Memory format is the same as float32 */
|
603 | f18cd223 | aurel32 | float32 fa = s_to_float32(a); |
604 | f18cd223 | aurel32 | return *(uint32_t*)(&fa);
|
605 | f18cd223 | aurel32 | } |
606 | 4c9649a9 | j_mayer | |
607 | f18cd223 | aurel32 | uint64_t helper_memory_to_s (uint32_t a) |
608 | f18cd223 | aurel32 | { |
609 | f18cd223 | aurel32 | /* Memory format is the same as float32 */
|
610 | f18cd223 | aurel32 | return float32_to_s(*(float32*)(&a));
|
611 | 4c9649a9 | j_mayer | } |
612 | 4c9649a9 | j_mayer | |
613 | f18cd223 | aurel32 | uint64_t helper_adds (uint64_t a, uint64_t b) |
614 | 4c9649a9 | j_mayer | { |
615 | f18cd223 | aurel32 | float32 fa, fb, fr; |
616 | 4c9649a9 | j_mayer | |
617 | f18cd223 | aurel32 | fa = s_to_float32(a); |
618 | f18cd223 | aurel32 | fb = s_to_float32(b); |
619 | f18cd223 | aurel32 | fr = float32_add(fa, fb, &FP_STATUS); |
620 | f18cd223 | aurel32 | return float32_to_s(fr);
|
621 | 4c9649a9 | j_mayer | } |
622 | 4c9649a9 | j_mayer | |
623 | f18cd223 | aurel32 | uint64_t helper_subs (uint64_t a, uint64_t b) |
624 | 4c9649a9 | j_mayer | { |
625 | f18cd223 | aurel32 | float32 fa, fb, fr; |
626 | 4c9649a9 | j_mayer | |
627 | f18cd223 | aurel32 | fa = s_to_float32(a); |
628 | f18cd223 | aurel32 | fb = s_to_float32(b); |
629 | f18cd223 | aurel32 | fr = float32_sub(fa, fb, &FP_STATUS); |
630 | f18cd223 | aurel32 | return float32_to_s(fr);
|
631 | 4c9649a9 | j_mayer | } |
632 | 4c9649a9 | j_mayer | |
633 | f18cd223 | aurel32 | uint64_t helper_muls (uint64_t a, uint64_t b) |
634 | 4c9649a9 | j_mayer | { |
635 | f18cd223 | aurel32 | float32 fa, fb, fr; |
636 | 4c9649a9 | j_mayer | |
637 | f18cd223 | aurel32 | fa = s_to_float32(a); |
638 | f18cd223 | aurel32 | fb = s_to_float32(b); |
639 | f18cd223 | aurel32 | fr = float32_mul(fa, fb, &FP_STATUS); |
640 | f18cd223 | aurel32 | return float32_to_s(fr);
|
641 | 4c9649a9 | j_mayer | } |
642 | 4c9649a9 | j_mayer | |
643 | f18cd223 | aurel32 | uint64_t helper_divs (uint64_t a, uint64_t b) |
644 | 4c9649a9 | j_mayer | { |
645 | f18cd223 | aurel32 | float32 fa, fb, fr; |
646 | 4c9649a9 | j_mayer | |
647 | f18cd223 | aurel32 | fa = s_to_float32(a); |
648 | f18cd223 | aurel32 | fb = s_to_float32(b); |
649 | f18cd223 | aurel32 | fr = float32_div(fa, fb, &FP_STATUS); |
650 | f18cd223 | aurel32 | return float32_to_s(fr);
|
651 | 4c9649a9 | j_mayer | } |
652 | 4c9649a9 | j_mayer | |
653 | f18cd223 | aurel32 | uint64_t helper_sqrts (uint64_t a) |
654 | 4c9649a9 | j_mayer | { |
655 | f18cd223 | aurel32 | float32 fa, fr; |
656 | 4c9649a9 | j_mayer | |
657 | f18cd223 | aurel32 | fa = s_to_float32(a); |
658 | f18cd223 | aurel32 | fr = float32_sqrt(fa, &FP_STATUS); |
659 | f18cd223 | aurel32 | return float32_to_s(fr);
|
660 | 4c9649a9 | j_mayer | } |
661 | 4c9649a9 | j_mayer | |
662 | f18cd223 | aurel32 | |
663 | f18cd223 | aurel32 | /* T floating (double) */
|
664 | f18cd223 | aurel32 | static always_inline float64 t_to_float64 (uint64_t a)
|
665 | 4c9649a9 | j_mayer | { |
666 | f18cd223 | aurel32 | /* Memory format is the same as float64 */
|
667 | e2eb2798 | aurel32 | CPU_DoubleU r; |
668 | e2eb2798 | aurel32 | r.ll = a; |
669 | e2eb2798 | aurel32 | return r.d;
|
670 | 4c9649a9 | j_mayer | } |
671 | 4c9649a9 | j_mayer | |
672 | f18cd223 | aurel32 | static always_inline uint64_t float64_to_t (float64 fa)
|
673 | 4c9649a9 | j_mayer | { |
674 | f18cd223 | aurel32 | /* Memory format is the same as float64 */
|
675 | e2eb2798 | aurel32 | CPU_DoubleU r; |
676 | e2eb2798 | aurel32 | r.d = fa; |
677 | e2eb2798 | aurel32 | return r.ll;
|
678 | f18cd223 | aurel32 | } |
679 | 4c9649a9 | j_mayer | |
680 | f18cd223 | aurel32 | uint64_t helper_addt (uint64_t a, uint64_t b) |
681 | f18cd223 | aurel32 | { |
682 | f18cd223 | aurel32 | float64 fa, fb, fr; |
683 | 4c9649a9 | j_mayer | |
684 | f18cd223 | aurel32 | fa = t_to_float64(a); |
685 | f18cd223 | aurel32 | fb = t_to_float64(b); |
686 | f18cd223 | aurel32 | fr = float64_add(fa, fb, &FP_STATUS); |
687 | f18cd223 | aurel32 | return float64_to_t(fr);
|
688 | 4c9649a9 | j_mayer | } |
689 | 4c9649a9 | j_mayer | |
690 | f18cd223 | aurel32 | uint64_t helper_subt (uint64_t a, uint64_t b) |
691 | 4c9649a9 | j_mayer | { |
692 | f18cd223 | aurel32 | float64 fa, fb, fr; |
693 | 4c9649a9 | j_mayer | |
694 | f18cd223 | aurel32 | fa = t_to_float64(a); |
695 | f18cd223 | aurel32 | fb = t_to_float64(b); |
696 | f18cd223 | aurel32 | fr = float64_sub(fa, fb, &FP_STATUS); |
697 | f18cd223 | aurel32 | return float64_to_t(fr);
|
698 | 4c9649a9 | j_mayer | } |
699 | 4c9649a9 | j_mayer | |
700 | f18cd223 | aurel32 | uint64_t helper_mult (uint64_t a, uint64_t b) |
701 | 4c9649a9 | j_mayer | { |
702 | f18cd223 | aurel32 | float64 fa, fb, fr; |
703 | 4c9649a9 | j_mayer | |
704 | f18cd223 | aurel32 | fa = t_to_float64(a); |
705 | f18cd223 | aurel32 | fb = t_to_float64(b); |
706 | f18cd223 | aurel32 | fr = float64_mul(fa, fb, &FP_STATUS); |
707 | f18cd223 | aurel32 | return float64_to_t(fr);
|
708 | 4c9649a9 | j_mayer | } |
709 | 4c9649a9 | j_mayer | |
710 | f18cd223 | aurel32 | uint64_t helper_divt (uint64_t a, uint64_t b) |
711 | 4c9649a9 | j_mayer | { |
712 | f18cd223 | aurel32 | float64 fa, fb, fr; |
713 | 4c9649a9 | j_mayer | |
714 | f18cd223 | aurel32 | fa = t_to_float64(a); |
715 | f18cd223 | aurel32 | fb = t_to_float64(b); |
716 | f18cd223 | aurel32 | fr = float64_div(fa, fb, &FP_STATUS); |
717 | f18cd223 | aurel32 | return float64_to_t(fr);
|
718 | 4c9649a9 | j_mayer | } |
719 | 4c9649a9 | j_mayer | |
720 | f18cd223 | aurel32 | uint64_t helper_sqrtt (uint64_t a) |
721 | 4c9649a9 | j_mayer | { |
722 | f18cd223 | aurel32 | float64 fa, fr; |
723 | 4c9649a9 | j_mayer | |
724 | f18cd223 | aurel32 | fa = t_to_float64(a); |
725 | f18cd223 | aurel32 | fr = float64_sqrt(fa, &FP_STATUS); |
726 | f18cd223 | aurel32 | return float64_to_t(fr);
|
727 | 4c9649a9 | j_mayer | } |
728 | 4c9649a9 | j_mayer | |
729 | 4c9649a9 | j_mayer | |
730 | f18cd223 | aurel32 | /* Sign copy */
|
731 | f18cd223 | aurel32 | uint64_t helper_cpys(uint64_t a, uint64_t b) |
732 | f18cd223 | aurel32 | { |
733 | f18cd223 | aurel32 | return (a & 0x8000000000000000ULL) | (b & ~0x8000000000000000ULL); |
734 | 4c9649a9 | j_mayer | } |
735 | 4c9649a9 | j_mayer | |
736 | f18cd223 | aurel32 | uint64_t helper_cpysn(uint64_t a, uint64_t b) |
737 | 4c9649a9 | j_mayer | { |
738 | f18cd223 | aurel32 | return ((~a) & 0x8000000000000000ULL) | (b & ~0x8000000000000000ULL); |
739 | f18cd223 | aurel32 | } |
740 | 4c9649a9 | j_mayer | |
741 | f18cd223 | aurel32 | uint64_t helper_cpyse(uint64_t a, uint64_t b) |
742 | f18cd223 | aurel32 | { |
743 | f18cd223 | aurel32 | return (a & 0xFFF0000000000000ULL) | (b & ~0xFFF0000000000000ULL); |
744 | 4c9649a9 | j_mayer | } |
745 | 4c9649a9 | j_mayer | |
746 | f18cd223 | aurel32 | |
747 | f18cd223 | aurel32 | /* Comparisons */
|
748 | f18cd223 | aurel32 | uint64_t helper_cmptun (uint64_t a, uint64_t b) |
749 | 4c9649a9 | j_mayer | { |
750 | f18cd223 | aurel32 | float64 fa, fb; |
751 | 4c9649a9 | j_mayer | |
752 | f18cd223 | aurel32 | fa = t_to_float64(a); |
753 | f18cd223 | aurel32 | fb = t_to_float64(b); |
754 | f18cd223 | aurel32 | |
755 | f18cd223 | aurel32 | if (float64_is_nan(fa) || float64_is_nan(fb))
|
756 | f18cd223 | aurel32 | return 0x4000000000000000ULL; |
757 | f18cd223 | aurel32 | else
|
758 | f18cd223 | aurel32 | return 0; |
759 | 4c9649a9 | j_mayer | } |
760 | 4c9649a9 | j_mayer | |
761 | f18cd223 | aurel32 | uint64_t helper_cmpteq(uint64_t a, uint64_t b) |
762 | 4c9649a9 | j_mayer | { |
763 | f18cd223 | aurel32 | float64 fa, fb; |
764 | 4c9649a9 | j_mayer | |
765 | f18cd223 | aurel32 | fa = t_to_float64(a); |
766 | f18cd223 | aurel32 | fb = t_to_float64(b); |
767 | f18cd223 | aurel32 | |
768 | f18cd223 | aurel32 | if (float64_eq(fa, fb, &FP_STATUS))
|
769 | f18cd223 | aurel32 | return 0x4000000000000000ULL; |
770 | f18cd223 | aurel32 | else
|
771 | f18cd223 | aurel32 | return 0; |
772 | 4c9649a9 | j_mayer | } |
773 | 4c9649a9 | j_mayer | |
774 | f18cd223 | aurel32 | uint64_t helper_cmptle(uint64_t a, uint64_t b) |
775 | 4c9649a9 | j_mayer | { |
776 | f18cd223 | aurel32 | float64 fa, fb; |
777 | 4c9649a9 | j_mayer | |
778 | f18cd223 | aurel32 | fa = t_to_float64(a); |
779 | f18cd223 | aurel32 | fb = t_to_float64(b); |
780 | f18cd223 | aurel32 | |
781 | f18cd223 | aurel32 | if (float64_le(fa, fb, &FP_STATUS))
|
782 | f18cd223 | aurel32 | return 0x4000000000000000ULL; |
783 | f18cd223 | aurel32 | else
|
784 | f18cd223 | aurel32 | return 0; |
785 | 4c9649a9 | j_mayer | } |
786 | 4c9649a9 | j_mayer | |
787 | f18cd223 | aurel32 | uint64_t helper_cmptlt(uint64_t a, uint64_t b) |
788 | 4c9649a9 | j_mayer | { |
789 | f18cd223 | aurel32 | float64 fa, fb; |
790 | 4c9649a9 | j_mayer | |
791 | f18cd223 | aurel32 | fa = t_to_float64(a); |
792 | f18cd223 | aurel32 | fb = t_to_float64(b); |
793 | f18cd223 | aurel32 | |
794 | f18cd223 | aurel32 | if (float64_lt(fa, fb, &FP_STATUS))
|
795 | f18cd223 | aurel32 | return 0x4000000000000000ULL; |
796 | f18cd223 | aurel32 | else
|
797 | f18cd223 | aurel32 | return 0; |
798 | 4c9649a9 | j_mayer | } |
799 | 4c9649a9 | j_mayer | |
800 | f18cd223 | aurel32 | uint64_t helper_cmpgeq(uint64_t a, uint64_t b) |
801 | 4c9649a9 | j_mayer | { |
802 | f18cd223 | aurel32 | float64 fa, fb; |
803 | 4c9649a9 | j_mayer | |
804 | f18cd223 | aurel32 | fa = g_to_float64(a); |
805 | f18cd223 | aurel32 | fb = g_to_float64(b); |
806 | f18cd223 | aurel32 | |
807 | f18cd223 | aurel32 | if (float64_eq(fa, fb, &FP_STATUS))
|
808 | f18cd223 | aurel32 | return 0x4000000000000000ULL; |
809 | f18cd223 | aurel32 | else
|
810 | f18cd223 | aurel32 | return 0; |
811 | 4c9649a9 | j_mayer | } |
812 | 4c9649a9 | j_mayer | |
813 | f18cd223 | aurel32 | uint64_t helper_cmpgle(uint64_t a, uint64_t b) |
814 | 4c9649a9 | j_mayer | { |
815 | f18cd223 | aurel32 | float64 fa, fb; |
816 | f18cd223 | aurel32 | |
817 | f18cd223 | aurel32 | fa = g_to_float64(a); |
818 | f18cd223 | aurel32 | fb = g_to_float64(b); |
819 | 4c9649a9 | j_mayer | |
820 | f18cd223 | aurel32 | if (float64_le(fa, fb, &FP_STATUS))
|
821 | f18cd223 | aurel32 | return 0x4000000000000000ULL; |
822 | f18cd223 | aurel32 | else
|
823 | f18cd223 | aurel32 | return 0; |
824 | 4c9649a9 | j_mayer | } |
825 | 4c9649a9 | j_mayer | |
826 | f18cd223 | aurel32 | uint64_t helper_cmpglt(uint64_t a, uint64_t b) |
827 | 4c9649a9 | j_mayer | { |
828 | f18cd223 | aurel32 | float64 fa, fb; |
829 | f18cd223 | aurel32 | |
830 | f18cd223 | aurel32 | fa = g_to_float64(a); |
831 | f18cd223 | aurel32 | fb = g_to_float64(b); |
832 | 4c9649a9 | j_mayer | |
833 | f18cd223 | aurel32 | if (float64_lt(fa, fb, &FP_STATUS))
|
834 | f18cd223 | aurel32 | return 0x4000000000000000ULL; |
835 | f18cd223 | aurel32 | else
|
836 | f18cd223 | aurel32 | return 0; |
837 | 4c9649a9 | j_mayer | } |
838 | 4c9649a9 | j_mayer | |
839 | f18cd223 | aurel32 | uint64_t helper_cmpfeq (uint64_t a) |
840 | 4c9649a9 | j_mayer | { |
841 | f18cd223 | aurel32 | return !(a & 0x7FFFFFFFFFFFFFFFULL); |
842 | 4c9649a9 | j_mayer | } |
843 | 4c9649a9 | j_mayer | |
844 | f18cd223 | aurel32 | uint64_t helper_cmpfne (uint64_t a) |
845 | 4c9649a9 | j_mayer | { |
846 | f18cd223 | aurel32 | return (a & 0x7FFFFFFFFFFFFFFFULL); |
847 | f18cd223 | aurel32 | } |
848 | 4c9649a9 | j_mayer | |
849 | f18cd223 | aurel32 | uint64_t helper_cmpflt (uint64_t a) |
850 | f18cd223 | aurel32 | { |
851 | f18cd223 | aurel32 | return (a & 0x8000000000000000ULL) && (a & 0x7FFFFFFFFFFFFFFFULL); |
852 | 4c9649a9 | j_mayer | } |
853 | 4c9649a9 | j_mayer | |
854 | f18cd223 | aurel32 | uint64_t helper_cmpfle (uint64_t a) |
855 | 4c9649a9 | j_mayer | { |
856 | f18cd223 | aurel32 | return (a & 0x8000000000000000ULL) || !(a & 0x7FFFFFFFFFFFFFFFULL); |
857 | 4c9649a9 | j_mayer | } |
858 | 4c9649a9 | j_mayer | |
859 | f18cd223 | aurel32 | uint64_t helper_cmpfgt (uint64_t a) |
860 | 4c9649a9 | j_mayer | { |
861 | f18cd223 | aurel32 | return !(a & 0x8000000000000000ULL) && (a & 0x7FFFFFFFFFFFFFFFULL); |
862 | f18cd223 | aurel32 | } |
863 | 4c9649a9 | j_mayer | |
864 | f18cd223 | aurel32 | uint64_t helper_cmpfge (uint64_t a) |
865 | f18cd223 | aurel32 | { |
866 | f18cd223 | aurel32 | return !(a & 0x8000000000000000ULL) || !(a & 0x7FFFFFFFFFFFFFFFULL); |
867 | 4c9649a9 | j_mayer | } |
868 | 4c9649a9 | j_mayer | |
869 | f18cd223 | aurel32 | |
870 | f18cd223 | aurel32 | /* Floating point format conversion */
|
871 | f18cd223 | aurel32 | uint64_t helper_cvtts (uint64_t a) |
872 | 4c9649a9 | j_mayer | { |
873 | f18cd223 | aurel32 | float64 fa; |
874 | f18cd223 | aurel32 | float32 fr; |
875 | 4c9649a9 | j_mayer | |
876 | f18cd223 | aurel32 | fa = t_to_float64(a); |
877 | f18cd223 | aurel32 | fr = float64_to_float32(fa, &FP_STATUS); |
878 | f18cd223 | aurel32 | return float32_to_s(fr);
|
879 | 4c9649a9 | j_mayer | } |
880 | 4c9649a9 | j_mayer | |
881 | f18cd223 | aurel32 | uint64_t helper_cvtst (uint64_t a) |
882 | 4c9649a9 | j_mayer | { |
883 | f18cd223 | aurel32 | float32 fa; |
884 | f18cd223 | aurel32 | float64 fr; |
885 | f18cd223 | aurel32 | |
886 | f18cd223 | aurel32 | fa = s_to_float32(a); |
887 | f18cd223 | aurel32 | fr = float32_to_float64(fa, &FP_STATUS); |
888 | f18cd223 | aurel32 | return float64_to_t(fr);
|
889 | 4c9649a9 | j_mayer | } |
890 | 4c9649a9 | j_mayer | |
891 | f18cd223 | aurel32 | uint64_t helper_cvtqs (uint64_t a) |
892 | 4c9649a9 | j_mayer | { |
893 | f18cd223 | aurel32 | float32 fr = int64_to_float32(a, &FP_STATUS); |
894 | f18cd223 | aurel32 | return float32_to_s(fr);
|
895 | 4c9649a9 | j_mayer | } |
896 | 4c9649a9 | j_mayer | |
897 | f18cd223 | aurel32 | uint64_t helper_cvttq (uint64_t a) |
898 | 4c9649a9 | j_mayer | { |
899 | f18cd223 | aurel32 | float64 fa = t_to_float64(a); |
900 | f18cd223 | aurel32 | return float64_to_int64_round_to_zero(fa, &FP_STATUS);
|
901 | f18cd223 | aurel32 | } |
902 | 4c9649a9 | j_mayer | |
903 | f18cd223 | aurel32 | uint64_t helper_cvtqt (uint64_t a) |
904 | f18cd223 | aurel32 | { |
905 | f18cd223 | aurel32 | float64 fr = int64_to_float64(a, &FP_STATUS); |
906 | f18cd223 | aurel32 | return float64_to_t(fr);
|
907 | 4c9649a9 | j_mayer | } |
908 | 4c9649a9 | j_mayer | |
909 | f18cd223 | aurel32 | uint64_t helper_cvtqf (uint64_t a) |
910 | 4c9649a9 | j_mayer | { |
911 | f18cd223 | aurel32 | float32 fr = int64_to_float32(a, &FP_STATUS); |
912 | f18cd223 | aurel32 | return float32_to_f(fr);
|
913 | 4c9649a9 | j_mayer | } |
914 | 4c9649a9 | j_mayer | |
915 | f18cd223 | aurel32 | uint64_t helper_cvtgf (uint64_t a) |
916 | 4c9649a9 | j_mayer | { |
917 | f18cd223 | aurel32 | float64 fa; |
918 | f18cd223 | aurel32 | float32 fr; |
919 | f18cd223 | aurel32 | |
920 | f18cd223 | aurel32 | fa = g_to_float64(a); |
921 | f18cd223 | aurel32 | fr = float64_to_float32(fa, &FP_STATUS); |
922 | f18cd223 | aurel32 | return float32_to_f(fr);
|
923 | 4c9649a9 | j_mayer | } |
924 | 4c9649a9 | j_mayer | |
925 | f18cd223 | aurel32 | uint64_t helper_cvtgq (uint64_t a) |
926 | 4c9649a9 | j_mayer | { |
927 | f18cd223 | aurel32 | float64 fa = g_to_float64(a); |
928 | f18cd223 | aurel32 | return float64_to_int64_round_to_zero(fa, &FP_STATUS);
|
929 | 4c9649a9 | j_mayer | } |
930 | 4c9649a9 | j_mayer | |
931 | f18cd223 | aurel32 | uint64_t helper_cvtqg (uint64_t a) |
932 | 4c9649a9 | j_mayer | { |
933 | f18cd223 | aurel32 | float64 fr; |
934 | f18cd223 | aurel32 | fr = int64_to_float64(a, &FP_STATUS); |
935 | f18cd223 | aurel32 | return float64_to_g(fr);
|
936 | 4c9649a9 | j_mayer | } |
937 | 4c9649a9 | j_mayer | |
938 | f18cd223 | aurel32 | uint64_t helper_cvtlq (uint64_t a) |
939 | 4c9649a9 | j_mayer | { |
940 | f18cd223 | aurel32 | return (int64_t)((int32_t)((a >> 32) | ((a >> 29) & 0x3FFFFFFF))); |
941 | 4c9649a9 | j_mayer | } |
942 | 4c9649a9 | j_mayer | |
943 | f18cd223 | aurel32 | static always_inline uint64_t __helper_cvtql (uint64_t a, int s, int v) |
944 | 4c9649a9 | j_mayer | { |
945 | f18cd223 | aurel32 | uint64_t r; |
946 | f18cd223 | aurel32 | |
947 | f18cd223 | aurel32 | r = ((uint64_t)(a & 0xC0000000)) << 32; |
948 | f18cd223 | aurel32 | r |= ((uint64_t)(a & 0x7FFFFFFF)) << 29; |
949 | f18cd223 | aurel32 | |
950 | f18cd223 | aurel32 | if (v && (int64_t)((int32_t)r) != (int64_t)r) {
|
951 | f18cd223 | aurel32 | helper_excp(EXCP_ARITH, EXCP_ARITH_OVERFLOW); |
952 | f18cd223 | aurel32 | } |
953 | f18cd223 | aurel32 | if (s) {
|
954 | f18cd223 | aurel32 | /* TODO */
|
955 | f18cd223 | aurel32 | } |
956 | f18cd223 | aurel32 | return r;
|
957 | 4c9649a9 | j_mayer | } |
958 | 4c9649a9 | j_mayer | |
959 | f18cd223 | aurel32 | uint64_t helper_cvtql (uint64_t a) |
960 | 4c9649a9 | j_mayer | { |
961 | f18cd223 | aurel32 | return __helper_cvtql(a, 0, 0); |
962 | 4c9649a9 | j_mayer | } |
963 | 4c9649a9 | j_mayer | |
964 | f18cd223 | aurel32 | uint64_t helper_cvtqlv (uint64_t a) |
965 | 4c9649a9 | j_mayer | { |
966 | f18cd223 | aurel32 | return __helper_cvtql(a, 0, 1); |
967 | 4c9649a9 | j_mayer | } |
968 | 4c9649a9 | j_mayer | |
969 | f18cd223 | aurel32 | uint64_t helper_cvtqlsv (uint64_t a) |
970 | 4c9649a9 | j_mayer | { |
971 | f18cd223 | aurel32 | return __helper_cvtql(a, 1, 1); |
972 | 4c9649a9 | j_mayer | } |
973 | 4c9649a9 | j_mayer | |
974 | 8bb6e981 | aurel32 | /* PALcode support special instructions */
|
975 | 4c9649a9 | j_mayer | #if !defined (CONFIG_USER_ONLY)
|
976 | 8bb6e981 | aurel32 | void helper_hw_rei (void) |
977 | 8bb6e981 | aurel32 | { |
978 | 8bb6e981 | aurel32 | env->pc = env->ipr[IPR_EXC_ADDR] & ~3;
|
979 | 8bb6e981 | aurel32 | env->ipr[IPR_EXC_ADDR] = env->ipr[IPR_EXC_ADDR] & 1;
|
980 | 8bb6e981 | aurel32 | /* XXX: re-enable interrupts and memory mapping */
|
981 | 8bb6e981 | aurel32 | } |
982 | 8bb6e981 | aurel32 | |
983 | 8bb6e981 | aurel32 | void helper_hw_ret (uint64_t a)
|
984 | 8bb6e981 | aurel32 | { |
985 | 8bb6e981 | aurel32 | env->pc = a & ~3;
|
986 | 8bb6e981 | aurel32 | env->ipr[IPR_EXC_ADDR] = a & 1;
|
987 | 8bb6e981 | aurel32 | /* XXX: re-enable interrupts and memory mapping */
|
988 | 8bb6e981 | aurel32 | } |
989 | 8bb6e981 | aurel32 | |
990 | 8bb6e981 | aurel32 | uint64_t helper_mfpr (int iprn, uint64_t val)
|
991 | 8bb6e981 | aurel32 | { |
992 | 8bb6e981 | aurel32 | uint64_t tmp; |
993 | 8bb6e981 | aurel32 | |
994 | 8bb6e981 | aurel32 | if (cpu_alpha_mfpr(env, iprn, &tmp) == 0) |
995 | 8bb6e981 | aurel32 | val = tmp; |
996 | 8bb6e981 | aurel32 | |
997 | 8bb6e981 | aurel32 | return val;
|
998 | 8bb6e981 | aurel32 | } |
999 | 8bb6e981 | aurel32 | |
1000 | 8bb6e981 | aurel32 | void helper_mtpr (int iprn, uint64_t val) |
1001 | 4c9649a9 | j_mayer | { |
1002 | 8bb6e981 | aurel32 | cpu_alpha_mtpr(env, iprn, val, NULL);
|
1003 | 8bb6e981 | aurel32 | } |
1004 | 4c9649a9 | j_mayer | |
1005 | 8bb6e981 | aurel32 | void helper_set_alt_mode (void) |
1006 | 8bb6e981 | aurel32 | { |
1007 | 8bb6e981 | aurel32 | env->saved_mode = env->ps & 0xC;
|
1008 | 8bb6e981 | aurel32 | env->ps = (env->ps & ~0xC) | (env->ipr[IPR_ALT_MODE] & 0xC); |
1009 | 4c9649a9 | j_mayer | } |
1010 | 4c9649a9 | j_mayer | |
1011 | 8bb6e981 | aurel32 | void helper_restore_mode (void) |
1012 | 4c9649a9 | j_mayer | { |
1013 | 8bb6e981 | aurel32 | env->ps = (env->ps & ~0xC) | env->saved_mode;
|
1014 | 4c9649a9 | j_mayer | } |
1015 | 8bb6e981 | aurel32 | |
1016 | 4c9649a9 | j_mayer | #endif
|
1017 | 4c9649a9 | j_mayer | |
1018 | 4c9649a9 | j_mayer | /*****************************************************************************/
|
1019 | 4c9649a9 | j_mayer | /* Softmmu support */
|
1020 | 4c9649a9 | j_mayer | #if !defined (CONFIG_USER_ONLY)
|
1021 | 4c9649a9 | j_mayer | |
1022 | 4c9649a9 | j_mayer | /* XXX: the two following helpers are pure hacks.
|
1023 | 4c9649a9 | j_mayer | * Hopefully, we emulate the PALcode, then we should never see
|
1024 | 4c9649a9 | j_mayer | * HW_LD / HW_ST instructions.
|
1025 | 4c9649a9 | j_mayer | */
|
1026 | 8bb6e981 | aurel32 | uint64_t helper_ld_virt_to_phys (uint64_t virtaddr) |
1027 | 4c9649a9 | j_mayer | { |
1028 | 4c9649a9 | j_mayer | uint64_t tlb_addr, physaddr; |
1029 | 6ebbf390 | j_mayer | int index, mmu_idx;
|
1030 | 4c9649a9 | j_mayer | void *retaddr;
|
1031 | 4c9649a9 | j_mayer | |
1032 | 6ebbf390 | j_mayer | mmu_idx = cpu_mmu_index(env); |
1033 | 8bb6e981 | aurel32 | index = (virtaddr >> TARGET_PAGE_BITS) & (CPU_TLB_SIZE - 1);
|
1034 | 4c9649a9 | j_mayer | redo:
|
1035 | 6ebbf390 | j_mayer | tlb_addr = env->tlb_table[mmu_idx][index].addr_read; |
1036 | 8bb6e981 | aurel32 | if ((virtaddr & TARGET_PAGE_MASK) ==
|
1037 | 4c9649a9 | j_mayer | (tlb_addr & (TARGET_PAGE_MASK | TLB_INVALID_MASK))) { |
1038 | 8bb6e981 | aurel32 | physaddr = virtaddr + env->tlb_table[mmu_idx][index].addend; |
1039 | 4c9649a9 | j_mayer | } else {
|
1040 | 4c9649a9 | j_mayer | /* the page is not in the TLB : fill it */
|
1041 | 4c9649a9 | j_mayer | retaddr = GETPC(); |
1042 | 8bb6e981 | aurel32 | tlb_fill(virtaddr, 0, mmu_idx, retaddr);
|
1043 | 4c9649a9 | j_mayer | goto redo;
|
1044 | 4c9649a9 | j_mayer | } |
1045 | 8bb6e981 | aurel32 | return physaddr;
|
1046 | 4c9649a9 | j_mayer | } |
1047 | 4c9649a9 | j_mayer | |
1048 | 8bb6e981 | aurel32 | uint64_t helper_st_virt_to_phys (uint64_t virtaddr) |
1049 | 4c9649a9 | j_mayer | { |
1050 | 4c9649a9 | j_mayer | uint64_t tlb_addr, physaddr; |
1051 | 6ebbf390 | j_mayer | int index, mmu_idx;
|
1052 | 4c9649a9 | j_mayer | void *retaddr;
|
1053 | 4c9649a9 | j_mayer | |
1054 | 6ebbf390 | j_mayer | mmu_idx = cpu_mmu_index(env); |
1055 | 8bb6e981 | aurel32 | index = (virtaddr >> TARGET_PAGE_BITS) & (CPU_TLB_SIZE - 1);
|
1056 | 4c9649a9 | j_mayer | redo:
|
1057 | 6ebbf390 | j_mayer | tlb_addr = env->tlb_table[mmu_idx][index].addr_write; |
1058 | 8bb6e981 | aurel32 | if ((virtaddr & TARGET_PAGE_MASK) ==
|
1059 | 4c9649a9 | j_mayer | (tlb_addr & (TARGET_PAGE_MASK | TLB_INVALID_MASK))) { |
1060 | 8bb6e981 | aurel32 | physaddr = virtaddr + env->tlb_table[mmu_idx][index].addend; |
1061 | 4c9649a9 | j_mayer | } else {
|
1062 | 4c9649a9 | j_mayer | /* the page is not in the TLB : fill it */
|
1063 | 4c9649a9 | j_mayer | retaddr = GETPC(); |
1064 | 8bb6e981 | aurel32 | tlb_fill(virtaddr, 1, mmu_idx, retaddr);
|
1065 | 4c9649a9 | j_mayer | goto redo;
|
1066 | 4c9649a9 | j_mayer | } |
1067 | 8bb6e981 | aurel32 | return physaddr;
|
1068 | 8bb6e981 | aurel32 | } |
1069 | 8bb6e981 | aurel32 | |
1070 | 8bb6e981 | aurel32 | void helper_ldl_raw(uint64_t t0, uint64_t t1)
|
1071 | 8bb6e981 | aurel32 | { |
1072 | 8bb6e981 | aurel32 | ldl_raw(t1, t0); |
1073 | 8bb6e981 | aurel32 | } |
1074 | 8bb6e981 | aurel32 | |
1075 | 8bb6e981 | aurel32 | void helper_ldq_raw(uint64_t t0, uint64_t t1)
|
1076 | 8bb6e981 | aurel32 | { |
1077 | 8bb6e981 | aurel32 | ldq_raw(t1, t0); |
1078 | 8bb6e981 | aurel32 | } |
1079 | 8bb6e981 | aurel32 | |
1080 | 8bb6e981 | aurel32 | void helper_ldl_l_raw(uint64_t t0, uint64_t t1)
|
1081 | 8bb6e981 | aurel32 | { |
1082 | 8bb6e981 | aurel32 | env->lock = t1; |
1083 | 8bb6e981 | aurel32 | ldl_raw(t1, t0); |
1084 | 8bb6e981 | aurel32 | } |
1085 | 8bb6e981 | aurel32 | |
1086 | 8bb6e981 | aurel32 | void helper_ldq_l_raw(uint64_t t0, uint64_t t1)
|
1087 | 8bb6e981 | aurel32 | { |
1088 | 8bb6e981 | aurel32 | env->lock = t1; |
1089 | 8bb6e981 | aurel32 | ldl_raw(t1, t0); |
1090 | 8bb6e981 | aurel32 | } |
1091 | 8bb6e981 | aurel32 | |
1092 | 8bb6e981 | aurel32 | void helper_ldl_kernel(uint64_t t0, uint64_t t1)
|
1093 | 8bb6e981 | aurel32 | { |
1094 | 8bb6e981 | aurel32 | ldl_kernel(t1, t0); |
1095 | 8bb6e981 | aurel32 | } |
1096 | 8bb6e981 | aurel32 | |
1097 | 8bb6e981 | aurel32 | void helper_ldq_kernel(uint64_t t0, uint64_t t1)
|
1098 | 8bb6e981 | aurel32 | { |
1099 | 8bb6e981 | aurel32 | ldq_kernel(t1, t0); |
1100 | 8bb6e981 | aurel32 | } |
1101 | 8bb6e981 | aurel32 | |
1102 | 8bb6e981 | aurel32 | void helper_ldl_data(uint64_t t0, uint64_t t1)
|
1103 | 8bb6e981 | aurel32 | { |
1104 | 8bb6e981 | aurel32 | ldl_data(t1, t0); |
1105 | 8bb6e981 | aurel32 | } |
1106 | 8bb6e981 | aurel32 | |
1107 | 8bb6e981 | aurel32 | void helper_ldq_data(uint64_t t0, uint64_t t1)
|
1108 | 8bb6e981 | aurel32 | { |
1109 | 8bb6e981 | aurel32 | ldq_data(t1, t0); |
1110 | 8bb6e981 | aurel32 | } |
1111 | 8bb6e981 | aurel32 | |
1112 | 8bb6e981 | aurel32 | void helper_stl_raw(uint64_t t0, uint64_t t1)
|
1113 | 8bb6e981 | aurel32 | { |
1114 | 8bb6e981 | aurel32 | stl_raw(t1, t0); |
1115 | 8bb6e981 | aurel32 | } |
1116 | 8bb6e981 | aurel32 | |
1117 | 8bb6e981 | aurel32 | void helper_stq_raw(uint64_t t0, uint64_t t1)
|
1118 | 8bb6e981 | aurel32 | { |
1119 | 8bb6e981 | aurel32 | stq_raw(t1, t0); |
1120 | 8bb6e981 | aurel32 | } |
1121 | 8bb6e981 | aurel32 | |
1122 | 8bb6e981 | aurel32 | uint64_t helper_stl_c_raw(uint64_t t0, uint64_t t1) |
1123 | 8bb6e981 | aurel32 | { |
1124 | 8bb6e981 | aurel32 | uint64_t ret; |
1125 | 8bb6e981 | aurel32 | |
1126 | 8bb6e981 | aurel32 | if (t1 == env->lock) {
|
1127 | 8bb6e981 | aurel32 | stl_raw(t1, t0); |
1128 | 8bb6e981 | aurel32 | ret = 0;
|
1129 | 8bb6e981 | aurel32 | } else
|
1130 | 8bb6e981 | aurel32 | ret = 1;
|
1131 | 8bb6e981 | aurel32 | |
1132 | 8bb6e981 | aurel32 | env->lock = 1;
|
1133 | 8bb6e981 | aurel32 | |
1134 | 8bb6e981 | aurel32 | return ret;
|
1135 | 8bb6e981 | aurel32 | } |
1136 | 8bb6e981 | aurel32 | |
1137 | 8bb6e981 | aurel32 | uint64_t helper_stq_c_raw(uint64_t t0, uint64_t t1) |
1138 | 8bb6e981 | aurel32 | { |
1139 | 8bb6e981 | aurel32 | uint64_t ret; |
1140 | 8bb6e981 | aurel32 | |
1141 | 8bb6e981 | aurel32 | if (t1 == env->lock) {
|
1142 | 8bb6e981 | aurel32 | stq_raw(t1, t0); |
1143 | 8bb6e981 | aurel32 | ret = 0;
|
1144 | 8bb6e981 | aurel32 | } else
|
1145 | 8bb6e981 | aurel32 | ret = 1;
|
1146 | 8bb6e981 | aurel32 | |
1147 | 8bb6e981 | aurel32 | env->lock = 1;
|
1148 | 8bb6e981 | aurel32 | |
1149 | 8bb6e981 | aurel32 | return ret;
|
1150 | 4c9649a9 | j_mayer | } |
1151 | 4c9649a9 | j_mayer | |
1152 | 4c9649a9 | j_mayer | #define MMUSUFFIX _mmu
|
1153 | 4c9649a9 | j_mayer | |
1154 | 4c9649a9 | j_mayer | #define SHIFT 0 |
1155 | 4c9649a9 | j_mayer | #include "softmmu_template.h" |
1156 | 4c9649a9 | j_mayer | |
1157 | 4c9649a9 | j_mayer | #define SHIFT 1 |
1158 | 4c9649a9 | j_mayer | #include "softmmu_template.h" |
1159 | 4c9649a9 | j_mayer | |
1160 | 4c9649a9 | j_mayer | #define SHIFT 2 |
1161 | 4c9649a9 | j_mayer | #include "softmmu_template.h" |
1162 | 4c9649a9 | j_mayer | |
1163 | 4c9649a9 | j_mayer | #define SHIFT 3 |
1164 | 4c9649a9 | j_mayer | #include "softmmu_template.h" |
1165 | 4c9649a9 | j_mayer | |
1166 | 4c9649a9 | j_mayer | /* try to fill the TLB and return an exception if error. If retaddr is
|
1167 | 4c9649a9 | j_mayer | NULL, it means that the function was called in C code (i.e. not
|
1168 | 4c9649a9 | j_mayer | from generated code or from helper.c) */
|
1169 | 4c9649a9 | j_mayer | /* XXX: fix it to restore all registers */
|
1170 | 6ebbf390 | j_mayer | void tlb_fill (target_ulong addr, int is_write, int mmu_idx, void *retaddr) |
1171 | 4c9649a9 | j_mayer | { |
1172 | 4c9649a9 | j_mayer | TranslationBlock *tb; |
1173 | 4c9649a9 | j_mayer | CPUState *saved_env; |
1174 | 44f8625d | bellard | unsigned long pc; |
1175 | 4c9649a9 | j_mayer | int ret;
|
1176 | 4c9649a9 | j_mayer | |
1177 | 4c9649a9 | j_mayer | /* XXX: hack to restore env in all cases, even if not called from
|
1178 | 4c9649a9 | j_mayer | generated code */
|
1179 | 4c9649a9 | j_mayer | saved_env = env; |
1180 | 4c9649a9 | j_mayer | env = cpu_single_env; |
1181 | 6ebbf390 | j_mayer | ret = cpu_alpha_handle_mmu_fault(env, addr, is_write, mmu_idx, 1);
|
1182 | 4c9649a9 | j_mayer | if (!likely(ret == 0)) { |
1183 | 4c9649a9 | j_mayer | if (likely(retaddr)) {
|
1184 | 4c9649a9 | j_mayer | /* now we have a real cpu fault */
|
1185 | 44f8625d | bellard | pc = (unsigned long)retaddr; |
1186 | 4c9649a9 | j_mayer | tb = tb_find_pc(pc); |
1187 | 4c9649a9 | j_mayer | if (likely(tb)) {
|
1188 | 4c9649a9 | j_mayer | /* the PC is inside the translated code. It means that we have
|
1189 | 4c9649a9 | j_mayer | a virtual CPU fault */
|
1190 | 4c9649a9 | j_mayer | cpu_restore_state(tb, env, pc, NULL);
|
1191 | 4c9649a9 | j_mayer | } |
1192 | 4c9649a9 | j_mayer | } |
1193 | 4c9649a9 | j_mayer | /* Exception index and error code are already set */
|
1194 | 4c9649a9 | j_mayer | cpu_loop_exit(); |
1195 | 4c9649a9 | j_mayer | } |
1196 | 4c9649a9 | j_mayer | env = saved_env; |
1197 | 4c9649a9 | j_mayer | } |
1198 | 4c9649a9 | j_mayer | |
1199 | 4c9649a9 | j_mayer | #endif |