root / target-arm / op_helper.c @ e3e87df4
History | View | Annotate | Download (9.5 kB)
1 | b7bcbe95 | bellard | /*
|
---|---|---|---|
2 | b7bcbe95 | bellard | * ARM helper routines
|
3 | 5fafdf24 | ths | *
|
4 | 9ee6e8bb | pbrook | * Copyright (c) 2005-2007 CodeSourcery, LLC
|
5 | b7bcbe95 | bellard | *
|
6 | b7bcbe95 | bellard | * This library is free software; you can redistribute it and/or
|
7 | b7bcbe95 | bellard | * modify it under the terms of the GNU Lesser General Public
|
8 | b7bcbe95 | bellard | * License as published by the Free Software Foundation; either
|
9 | b7bcbe95 | bellard | * version 2 of the License, or (at your option) any later version.
|
10 | b7bcbe95 | bellard | *
|
11 | b7bcbe95 | bellard | * This library is distributed in the hope that it will be useful,
|
12 | b7bcbe95 | bellard | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 | b7bcbe95 | bellard | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
14 | b7bcbe95 | bellard | * Lesser General Public License for more details.
|
15 | b7bcbe95 | bellard | *
|
16 | b7bcbe95 | 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 | b7bcbe95 | bellard | */
|
19 | 3e457172 | Blue Swirl | #include "cpu.h" |
20 | 3e457172 | Blue Swirl | #include "dyngen-exec.h" |
21 | 7b59220e | Lluís | #include "helper.h" |
22 | b7bcbe95 | bellard | |
23 | ad69471c | pbrook | #define SIGNBIT (uint32_t)0x80000000 |
24 | ad69471c | pbrook | #define SIGNBIT64 ((uint64_t)1 << 63) |
25 | ad69471c | pbrook | |
26 | 3e457172 | Blue Swirl | #if !defined(CONFIG_USER_ONLY)
|
27 | 3e457172 | Blue Swirl | static void raise_exception(int tt) |
28 | b7bcbe95 | bellard | { |
29 | b7bcbe95 | bellard | env->exception_index = tt; |
30 | 1162c041 | Blue Swirl | cpu_loop_exit(env); |
31 | b7bcbe95 | bellard | } |
32 | 3e457172 | Blue Swirl | #endif
|
33 | b7bcbe95 | bellard | |
34 | 8f8e3aa4 | pbrook | uint32_t HELPER(neon_tbl)(uint32_t ireg, uint32_t def, |
35 | 8f8e3aa4 | pbrook | uint32_t rn, uint32_t maxindex) |
36 | 9ee6e8bb | pbrook | { |
37 | 9ee6e8bb | pbrook | uint32_t val; |
38 | 9ee6e8bb | pbrook | uint32_t tmp; |
39 | 9ee6e8bb | pbrook | int index;
|
40 | 9ee6e8bb | pbrook | int shift;
|
41 | 9ee6e8bb | pbrook | uint64_t *table; |
42 | 9ee6e8bb | pbrook | table = (uint64_t *)&env->vfp.regs[rn]; |
43 | 9ee6e8bb | pbrook | val = 0;
|
44 | 9ee6e8bb | pbrook | for (shift = 0; shift < 32; shift += 8) { |
45 | 8f8e3aa4 | pbrook | index = (ireg >> shift) & 0xff;
|
46 | 8f8e3aa4 | pbrook | if (index < maxindex) {
|
47 | 3018f259 | pbrook | tmp = (table[index >> 3] >> ((index & 7) << 3)) & 0xff; |
48 | 9ee6e8bb | pbrook | val |= tmp << shift; |
49 | 9ee6e8bb | pbrook | } else {
|
50 | 8f8e3aa4 | pbrook | val |= def & (0xff << shift);
|
51 | 9ee6e8bb | pbrook | } |
52 | 9ee6e8bb | pbrook | } |
53 | 8f8e3aa4 | pbrook | return val;
|
54 | 9ee6e8bb | pbrook | } |
55 | 9ee6e8bb | pbrook | |
56 | b5ff1b31 | bellard | #if !defined(CONFIG_USER_ONLY)
|
57 | b5ff1b31 | bellard | |
58 | 3e457172 | Blue Swirl | #include "softmmu_exec.h" |
59 | 3e457172 | Blue Swirl | |
60 | b5ff1b31 | bellard | #define MMUSUFFIX _mmu
|
61 | b5ff1b31 | bellard | |
62 | b5ff1b31 | bellard | #define SHIFT 0 |
63 | b5ff1b31 | bellard | #include "softmmu_template.h" |
64 | b5ff1b31 | bellard | |
65 | b5ff1b31 | bellard | #define SHIFT 1 |
66 | b5ff1b31 | bellard | #include "softmmu_template.h" |
67 | b5ff1b31 | bellard | |
68 | b5ff1b31 | bellard | #define SHIFT 2 |
69 | b5ff1b31 | bellard | #include "softmmu_template.h" |
70 | b5ff1b31 | bellard | |
71 | b5ff1b31 | bellard | #define SHIFT 3 |
72 | b5ff1b31 | bellard | #include "softmmu_template.h" |
73 | b5ff1b31 | bellard | |
74 | b5ff1b31 | bellard | /* try to fill the TLB and return an exception if error. If retaddr is
|
75 | b5ff1b31 | bellard | NULL, it means that the function was called in C code (i.e. not
|
76 | b5ff1b31 | bellard | from generated code or from helper.c) */
|
77 | b5ff1b31 | bellard | /* XXX: fix it to restore all registers */
|
78 | 0ecb72a5 | Andreas Färber | void tlb_fill(CPUARMState *env1, target_ulong addr, int is_write, int mmu_idx, |
79 | 20503968 | Blue Swirl | uintptr_t retaddr) |
80 | b5ff1b31 | bellard | { |
81 | b5ff1b31 | bellard | TranslationBlock *tb; |
82 | 0ecb72a5 | Andreas Färber | CPUARMState *saved_env; |
83 | b5ff1b31 | bellard | int ret;
|
84 | b5ff1b31 | bellard | |
85 | b5ff1b31 | bellard | saved_env = env; |
86 | 6e19a137 | Blue Swirl | env = env1; |
87 | 97b348e7 | Blue Swirl | ret = cpu_arm_handle_mmu_fault(env, addr, is_write, mmu_idx); |
88 | 551bd27f | ths | if (unlikely(ret)) {
|
89 | b5ff1b31 | bellard | if (retaddr) {
|
90 | b5ff1b31 | bellard | /* now we have a real cpu fault */
|
91 | 20503968 | Blue Swirl | tb = tb_find_pc(retaddr); |
92 | b5ff1b31 | bellard | if (tb) {
|
93 | b5ff1b31 | bellard | /* the PC is inside the translated code. It means that we have
|
94 | b5ff1b31 | bellard | a virtual CPU fault */
|
95 | 20503968 | Blue Swirl | cpu_restore_state(tb, env, retaddr); |
96 | b5ff1b31 | bellard | } |
97 | b5ff1b31 | bellard | } |
98 | b5ff1b31 | bellard | raise_exception(env->exception_index); |
99 | b5ff1b31 | bellard | } |
100 | b5ff1b31 | bellard | env = saved_env; |
101 | b5ff1b31 | bellard | } |
102 | b5ff1b31 | bellard | #endif
|
103 | 1497c961 | pbrook | |
104 | 0ecb72a5 | Andreas Färber | /* FIXME: Pass an axplicit pointer to QF to CPUARMState, and move saturating
|
105 | ad69471c | pbrook | instructions into helper.c */
|
106 | 1497c961 | pbrook | uint32_t HELPER(add_setq)(uint32_t a, uint32_t b) |
107 | 1497c961 | pbrook | { |
108 | 1497c961 | pbrook | uint32_t res = a + b; |
109 | 1497c961 | pbrook | if (((res ^ a) & SIGNBIT) && !((a ^ b) & SIGNBIT))
|
110 | 1497c961 | pbrook | env->QF = 1;
|
111 | 1497c961 | pbrook | return res;
|
112 | 1497c961 | pbrook | } |
113 | 1497c961 | pbrook | |
114 | 1497c961 | pbrook | uint32_t HELPER(add_saturate)(uint32_t a, uint32_t b) |
115 | 1497c961 | pbrook | { |
116 | 1497c961 | pbrook | uint32_t res = a + b; |
117 | 1497c961 | pbrook | if (((res ^ a) & SIGNBIT) && !((a ^ b) & SIGNBIT)) {
|
118 | 1497c961 | pbrook | env->QF = 1;
|
119 | 1497c961 | pbrook | res = ~(((int32_t)a >> 31) ^ SIGNBIT);
|
120 | 1497c961 | pbrook | } |
121 | 1497c961 | pbrook | return res;
|
122 | 1497c961 | pbrook | } |
123 | 1497c961 | pbrook | |
124 | 1497c961 | pbrook | uint32_t HELPER(sub_saturate)(uint32_t a, uint32_t b) |
125 | 1497c961 | pbrook | { |
126 | 1497c961 | pbrook | uint32_t res = a - b; |
127 | 1497c961 | pbrook | if (((res ^ a) & SIGNBIT) && ((a ^ b) & SIGNBIT)) {
|
128 | 1497c961 | pbrook | env->QF = 1;
|
129 | 1497c961 | pbrook | res = ~(((int32_t)a >> 31) ^ SIGNBIT);
|
130 | 1497c961 | pbrook | } |
131 | 1497c961 | pbrook | return res;
|
132 | 1497c961 | pbrook | } |
133 | 1497c961 | pbrook | |
134 | 1497c961 | pbrook | uint32_t HELPER(double_saturate)(int32_t val) |
135 | 1497c961 | pbrook | { |
136 | 1497c961 | pbrook | uint32_t res; |
137 | 1497c961 | pbrook | if (val >= 0x40000000) { |
138 | 1497c961 | pbrook | res = ~SIGNBIT; |
139 | 1497c961 | pbrook | env->QF = 1;
|
140 | 1497c961 | pbrook | } else if (val <= (int32_t)0xc0000000) { |
141 | 1497c961 | pbrook | res = SIGNBIT; |
142 | 1497c961 | pbrook | env->QF = 1;
|
143 | 1497c961 | pbrook | } else {
|
144 | 1497c961 | pbrook | res = val << 1;
|
145 | 1497c961 | pbrook | } |
146 | 1497c961 | pbrook | return res;
|
147 | 1497c961 | pbrook | } |
148 | 1497c961 | pbrook | |
149 | 1497c961 | pbrook | uint32_t HELPER(add_usaturate)(uint32_t a, uint32_t b) |
150 | 1497c961 | pbrook | { |
151 | 1497c961 | pbrook | uint32_t res = a + b; |
152 | 1497c961 | pbrook | if (res < a) {
|
153 | 1497c961 | pbrook | env->QF = 1;
|
154 | 1497c961 | pbrook | res = ~0;
|
155 | 1497c961 | pbrook | } |
156 | 1497c961 | pbrook | return res;
|
157 | 1497c961 | pbrook | } |
158 | 1497c961 | pbrook | |
159 | 1497c961 | pbrook | uint32_t HELPER(sub_usaturate)(uint32_t a, uint32_t b) |
160 | 1497c961 | pbrook | { |
161 | 1497c961 | pbrook | uint32_t res = a - b; |
162 | 1497c961 | pbrook | if (res > a) {
|
163 | 1497c961 | pbrook | env->QF = 1;
|
164 | 1497c961 | pbrook | res = 0;
|
165 | 1497c961 | pbrook | } |
166 | 1497c961 | pbrook | return res;
|
167 | 1497c961 | pbrook | } |
168 | 1497c961 | pbrook | |
169 | 6ddbc6e4 | pbrook | /* Signed saturation. */
|
170 | 6ddbc6e4 | pbrook | static inline uint32_t do_ssat(int32_t val, int shift) |
171 | 6ddbc6e4 | pbrook | { |
172 | 6ddbc6e4 | pbrook | int32_t top; |
173 | 6ddbc6e4 | pbrook | uint32_t mask; |
174 | 6ddbc6e4 | pbrook | |
175 | 6ddbc6e4 | pbrook | top = val >> shift; |
176 | 6ddbc6e4 | pbrook | mask = (1u << shift) - 1; |
177 | 6ddbc6e4 | pbrook | if (top > 0) { |
178 | 6ddbc6e4 | pbrook | env->QF = 1;
|
179 | 6ddbc6e4 | pbrook | return mask;
|
180 | 6ddbc6e4 | pbrook | } else if (top < -1) { |
181 | 6ddbc6e4 | pbrook | env->QF = 1;
|
182 | 6ddbc6e4 | pbrook | return ~mask;
|
183 | 6ddbc6e4 | pbrook | } |
184 | 6ddbc6e4 | pbrook | return val;
|
185 | 6ddbc6e4 | pbrook | } |
186 | 6ddbc6e4 | pbrook | |
187 | 6ddbc6e4 | pbrook | /* Unsigned saturation. */
|
188 | 6ddbc6e4 | pbrook | static inline uint32_t do_usat(int32_t val, int shift) |
189 | 6ddbc6e4 | pbrook | { |
190 | 6ddbc6e4 | pbrook | uint32_t max; |
191 | 6ddbc6e4 | pbrook | |
192 | 6ddbc6e4 | pbrook | max = (1u << shift) - 1; |
193 | 6ddbc6e4 | pbrook | if (val < 0) { |
194 | 6ddbc6e4 | pbrook | env->QF = 1;
|
195 | 6ddbc6e4 | pbrook | return 0; |
196 | 6ddbc6e4 | pbrook | } else if (val > max) { |
197 | 6ddbc6e4 | pbrook | env->QF = 1;
|
198 | 6ddbc6e4 | pbrook | return max;
|
199 | 6ddbc6e4 | pbrook | } |
200 | 6ddbc6e4 | pbrook | return val;
|
201 | 6ddbc6e4 | pbrook | } |
202 | 6ddbc6e4 | pbrook | |
203 | 6ddbc6e4 | pbrook | /* Signed saturate. */
|
204 | 6ddbc6e4 | pbrook | uint32_t HELPER(ssat)(uint32_t x, uint32_t shift) |
205 | 6ddbc6e4 | pbrook | { |
206 | 6ddbc6e4 | pbrook | return do_ssat(x, shift);
|
207 | 6ddbc6e4 | pbrook | } |
208 | 6ddbc6e4 | pbrook | |
209 | 6ddbc6e4 | pbrook | /* Dual halfword signed saturate. */
|
210 | 6ddbc6e4 | pbrook | uint32_t HELPER(ssat16)(uint32_t x, uint32_t shift) |
211 | 6ddbc6e4 | pbrook | { |
212 | 6ddbc6e4 | pbrook | uint32_t res; |
213 | 6ddbc6e4 | pbrook | |
214 | 6ddbc6e4 | pbrook | res = (uint16_t)do_ssat((int16_t)x, shift); |
215 | 6ddbc6e4 | pbrook | res |= do_ssat(((int32_t)x) >> 16, shift) << 16; |
216 | 6ddbc6e4 | pbrook | return res;
|
217 | 6ddbc6e4 | pbrook | } |
218 | 6ddbc6e4 | pbrook | |
219 | 6ddbc6e4 | pbrook | /* Unsigned saturate. */
|
220 | 6ddbc6e4 | pbrook | uint32_t HELPER(usat)(uint32_t x, uint32_t shift) |
221 | 6ddbc6e4 | pbrook | { |
222 | 6ddbc6e4 | pbrook | return do_usat(x, shift);
|
223 | 6ddbc6e4 | pbrook | } |
224 | 6ddbc6e4 | pbrook | |
225 | 6ddbc6e4 | pbrook | /* Dual halfword unsigned saturate. */
|
226 | 6ddbc6e4 | pbrook | uint32_t HELPER(usat16)(uint32_t x, uint32_t shift) |
227 | 6ddbc6e4 | pbrook | { |
228 | 6ddbc6e4 | pbrook | uint32_t res; |
229 | 6ddbc6e4 | pbrook | |
230 | 6ddbc6e4 | pbrook | res = (uint16_t)do_usat((int16_t)x, shift); |
231 | 6ddbc6e4 | pbrook | res |= do_usat(((int32_t)x) >> 16, shift) << 16; |
232 | 6ddbc6e4 | pbrook | return res;
|
233 | 6ddbc6e4 | pbrook | } |
234 | d9ba4830 | pbrook | |
235 | d9ba4830 | pbrook | void HELPER(wfi)(void) |
236 | d9ba4830 | pbrook | { |
237 | d9ba4830 | pbrook | env->exception_index = EXCP_HLT; |
238 | d9ba4830 | pbrook | env->halted = 1;
|
239 | 1162c041 | Blue Swirl | cpu_loop_exit(env); |
240 | d9ba4830 | pbrook | } |
241 | d9ba4830 | pbrook | |
242 | d9ba4830 | pbrook | void HELPER(exception)(uint32_t excp)
|
243 | d9ba4830 | pbrook | { |
244 | d9ba4830 | pbrook | env->exception_index = excp; |
245 | 1162c041 | Blue Swirl | cpu_loop_exit(env); |
246 | d9ba4830 | pbrook | } |
247 | d9ba4830 | pbrook | |
248 | d9ba4830 | pbrook | uint32_t HELPER(cpsr_read)(void)
|
249 | d9ba4830 | pbrook | { |
250 | d9ba4830 | pbrook | return cpsr_read(env) & ~CPSR_EXEC;
|
251 | d9ba4830 | pbrook | } |
252 | d9ba4830 | pbrook | |
253 | d9ba4830 | pbrook | void HELPER(cpsr_write)(uint32_t val, uint32_t mask)
|
254 | d9ba4830 | pbrook | { |
255 | d9ba4830 | pbrook | cpsr_write(env, val, mask); |
256 | d9ba4830 | pbrook | } |
257 | b0109805 | pbrook | |
258 | b0109805 | pbrook | /* Access to user mode registers from privileged modes. */
|
259 | b0109805 | pbrook | uint32_t HELPER(get_user_reg)(uint32_t regno) |
260 | b0109805 | pbrook | { |
261 | b0109805 | pbrook | uint32_t val; |
262 | b0109805 | pbrook | |
263 | b0109805 | pbrook | if (regno == 13) { |
264 | b0109805 | pbrook | val = env->banked_r13[0];
|
265 | b0109805 | pbrook | } else if (regno == 14) { |
266 | b0109805 | pbrook | val = env->banked_r14[0];
|
267 | b0109805 | pbrook | } else if (regno >= 8 |
268 | b0109805 | pbrook | && (env->uncached_cpsr & 0x1f) == ARM_CPU_MODE_FIQ) {
|
269 | b0109805 | pbrook | val = env->usr_regs[regno - 8];
|
270 | b0109805 | pbrook | } else {
|
271 | b0109805 | pbrook | val = env->regs[regno]; |
272 | b0109805 | pbrook | } |
273 | b0109805 | pbrook | return val;
|
274 | b0109805 | pbrook | } |
275 | b0109805 | pbrook | |
276 | b0109805 | pbrook | void HELPER(set_user_reg)(uint32_t regno, uint32_t val)
|
277 | b0109805 | pbrook | { |
278 | b0109805 | pbrook | if (regno == 13) { |
279 | b0109805 | pbrook | env->banked_r13[0] = val;
|
280 | b0109805 | pbrook | } else if (regno == 14) { |
281 | b0109805 | pbrook | env->banked_r14[0] = val;
|
282 | b0109805 | pbrook | } else if (regno >= 8 |
283 | b0109805 | pbrook | && (env->uncached_cpsr & 0x1f) == ARM_CPU_MODE_FIQ) {
|
284 | b0109805 | pbrook | env->usr_regs[regno - 8] = val;
|
285 | b0109805 | pbrook | } else {
|
286 | b0109805 | pbrook | env->regs[regno] = val; |
287 | b0109805 | pbrook | } |
288 | b0109805 | pbrook | } |
289 | b0109805 | pbrook | |
290 | 8984bd2e | pbrook | /* ??? Flag setting arithmetic is awkward because we need to do comparisons.
|
291 | 8984bd2e | pbrook | The only way to do that in TCG is a conditional branch, which clobbers
|
292 | 8984bd2e | pbrook | all our temporaries. For now implement these as helper functions. */
|
293 | 8984bd2e | pbrook | |
294 | 8984bd2e | pbrook | uint32_t HELPER (add_cc)(uint32_t a, uint32_t b) |
295 | 8984bd2e | pbrook | { |
296 | 8984bd2e | pbrook | uint32_t result; |
297 | 37f9ba46 | aurel32 | result = a + b; |
298 | 6fbe23d5 | pbrook | env->NF = env->ZF = result; |
299 | 8984bd2e | pbrook | env->CF = result < a; |
300 | 8984bd2e | pbrook | env->VF = (a ^ b ^ -1) & (a ^ result);
|
301 | 8984bd2e | pbrook | return result;
|
302 | 8984bd2e | pbrook | } |
303 | 8984bd2e | pbrook | |
304 | 8984bd2e | pbrook | uint32_t HELPER(adc_cc)(uint32_t a, uint32_t b) |
305 | 8984bd2e | pbrook | { |
306 | 8984bd2e | pbrook | uint32_t result; |
307 | 8984bd2e | pbrook | if (!env->CF) {
|
308 | 8984bd2e | pbrook | result = a + b; |
309 | 8984bd2e | pbrook | env->CF = result < a; |
310 | 8984bd2e | pbrook | } else {
|
311 | 8984bd2e | pbrook | result = a + b + 1;
|
312 | 8984bd2e | pbrook | env->CF = result <= a; |
313 | 8984bd2e | pbrook | } |
314 | 8984bd2e | pbrook | env->VF = (a ^ b ^ -1) & (a ^ result);
|
315 | 6fbe23d5 | pbrook | env->NF = env->ZF = result; |
316 | 8984bd2e | pbrook | return result;
|
317 | 8984bd2e | pbrook | } |
318 | 8984bd2e | pbrook | |
319 | 8984bd2e | pbrook | uint32_t HELPER(sub_cc)(uint32_t a, uint32_t b) |
320 | 8984bd2e | pbrook | { |
321 | 8984bd2e | pbrook | uint32_t result; |
322 | 8984bd2e | pbrook | result = a - b; |
323 | 6fbe23d5 | pbrook | env->NF = env->ZF = result; |
324 | 8984bd2e | pbrook | env->CF = a >= b; |
325 | 8984bd2e | pbrook | env->VF = (a ^ b) & (a ^ result); |
326 | 8984bd2e | pbrook | return result;
|
327 | 8984bd2e | pbrook | } |
328 | 8984bd2e | pbrook | |
329 | 8984bd2e | pbrook | uint32_t HELPER(sbc_cc)(uint32_t a, uint32_t b) |
330 | 8984bd2e | pbrook | { |
331 | 8984bd2e | pbrook | uint32_t result; |
332 | 8984bd2e | pbrook | if (!env->CF) {
|
333 | 8984bd2e | pbrook | result = a - b - 1;
|
334 | 8984bd2e | pbrook | env->CF = a > b; |
335 | 8984bd2e | pbrook | } else {
|
336 | 8984bd2e | pbrook | result = a - b; |
337 | 8984bd2e | pbrook | env->CF = a >= b; |
338 | 8984bd2e | pbrook | } |
339 | 8984bd2e | pbrook | env->VF = (a ^ b) & (a ^ result); |
340 | 6fbe23d5 | pbrook | env->NF = env->ZF = result; |
341 | 8984bd2e | pbrook | return result;
|
342 | 8984bd2e | pbrook | } |
343 | 8984bd2e | pbrook | |
344 | 8984bd2e | pbrook | /* Similarly for variable shift instructions. */
|
345 | 8984bd2e | pbrook | |
346 | 8984bd2e | pbrook | uint32_t HELPER(shl)(uint32_t x, uint32_t i) |
347 | 8984bd2e | pbrook | { |
348 | 8984bd2e | pbrook | int shift = i & 0xff; |
349 | 8984bd2e | pbrook | if (shift >= 32) |
350 | 8984bd2e | pbrook | return 0; |
351 | 8984bd2e | pbrook | return x << shift;
|
352 | 8984bd2e | pbrook | } |
353 | 8984bd2e | pbrook | |
354 | 8984bd2e | pbrook | uint32_t HELPER(shr)(uint32_t x, uint32_t i) |
355 | 8984bd2e | pbrook | { |
356 | 8984bd2e | pbrook | int shift = i & 0xff; |
357 | 8984bd2e | pbrook | if (shift >= 32) |
358 | 8984bd2e | pbrook | return 0; |
359 | 8984bd2e | pbrook | return (uint32_t)x >> shift;
|
360 | 8984bd2e | pbrook | } |
361 | 8984bd2e | pbrook | |
362 | 8984bd2e | pbrook | uint32_t HELPER(sar)(uint32_t x, uint32_t i) |
363 | 8984bd2e | pbrook | { |
364 | 8984bd2e | pbrook | int shift = i & 0xff; |
365 | 8984bd2e | pbrook | if (shift >= 32) |
366 | 8984bd2e | pbrook | shift = 31;
|
367 | 8984bd2e | pbrook | return (int32_t)x >> shift;
|
368 | 8984bd2e | pbrook | } |
369 | 8984bd2e | pbrook | |
370 | 8984bd2e | pbrook | uint32_t HELPER(shl_cc)(uint32_t x, uint32_t i) |
371 | 8984bd2e | pbrook | { |
372 | 8984bd2e | pbrook | int shift = i & 0xff; |
373 | 8984bd2e | pbrook | if (shift >= 32) { |
374 | 8984bd2e | pbrook | if (shift == 32) |
375 | 8984bd2e | pbrook | env->CF = x & 1;
|
376 | 8984bd2e | pbrook | else
|
377 | 8984bd2e | pbrook | env->CF = 0;
|
378 | 8984bd2e | pbrook | return 0; |
379 | 8984bd2e | pbrook | } else if (shift != 0) { |
380 | 8984bd2e | pbrook | env->CF = (x >> (32 - shift)) & 1; |
381 | 8984bd2e | pbrook | return x << shift;
|
382 | 8984bd2e | pbrook | } |
383 | 8984bd2e | pbrook | return x;
|
384 | 8984bd2e | pbrook | } |
385 | 8984bd2e | pbrook | |
386 | 8984bd2e | pbrook | uint32_t HELPER(shr_cc)(uint32_t x, uint32_t i) |
387 | 8984bd2e | pbrook | { |
388 | 8984bd2e | pbrook | int shift = i & 0xff; |
389 | 8984bd2e | pbrook | if (shift >= 32) { |
390 | 8984bd2e | pbrook | if (shift == 32) |
391 | 8984bd2e | pbrook | env->CF = (x >> 31) & 1; |
392 | 8984bd2e | pbrook | else
|
393 | 8984bd2e | pbrook | env->CF = 0;
|
394 | 8984bd2e | pbrook | return 0; |
395 | 8984bd2e | pbrook | } else if (shift != 0) { |
396 | 8984bd2e | pbrook | env->CF = (x >> (shift - 1)) & 1; |
397 | 8984bd2e | pbrook | return x >> shift;
|
398 | 8984bd2e | pbrook | } |
399 | 8984bd2e | pbrook | return x;
|
400 | 8984bd2e | pbrook | } |
401 | 8984bd2e | pbrook | |
402 | 8984bd2e | pbrook | uint32_t HELPER(sar_cc)(uint32_t x, uint32_t i) |
403 | 8984bd2e | pbrook | { |
404 | 8984bd2e | pbrook | int shift = i & 0xff; |
405 | 8984bd2e | pbrook | if (shift >= 32) { |
406 | 8984bd2e | pbrook | env->CF = (x >> 31) & 1; |
407 | 8984bd2e | pbrook | return (int32_t)x >> 31; |
408 | 8984bd2e | pbrook | } else if (shift != 0) { |
409 | 8984bd2e | pbrook | env->CF = (x >> (shift - 1)) & 1; |
410 | 8984bd2e | pbrook | return (int32_t)x >> shift;
|
411 | 8984bd2e | pbrook | } |
412 | 8984bd2e | pbrook | return x;
|
413 | 8984bd2e | pbrook | } |
414 | 8984bd2e | pbrook | |
415 | 8984bd2e | pbrook | uint32_t HELPER(ror_cc)(uint32_t x, uint32_t i) |
416 | 8984bd2e | pbrook | { |
417 | 8984bd2e | pbrook | int shift1, shift;
|
418 | 8984bd2e | pbrook | shift1 = i & 0xff;
|
419 | 8984bd2e | pbrook | shift = shift1 & 0x1f;
|
420 | 8984bd2e | pbrook | if (shift == 0) { |
421 | 8984bd2e | pbrook | if (shift1 != 0) |
422 | 8984bd2e | pbrook | env->CF = (x >> 31) & 1; |
423 | 8984bd2e | pbrook | return x;
|
424 | 8984bd2e | pbrook | } else {
|
425 | 8984bd2e | pbrook | env->CF = (x >> (shift - 1)) & 1; |
426 | 8984bd2e | pbrook | return ((uint32_t)x >> shift) | (x << (32 - shift)); |
427 | 8984bd2e | pbrook | } |
428 | 8984bd2e | pbrook | } |