target-arm/op_helper.c

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