vm/instruction_operands.cpp

   1 #include "master.hpp"
   2
   3 namespace factor
   4 {
   5
   6 /* Load a 32-bit value from a PowerPC LIS/ORI sequence */
   7 fixnum instruction_operand::load_value_2_2()
   8 {
   9         cell *ptr = (cell *)pointer;
  10         cell hi = (ptr[-1] & 0xffff);
  11         cell lo = (ptr[ 0] & 0xffff);
  12         return hi << 16 | lo;
  13 }
  14
  15 /* Load a value from a bitfield of a PowerPC instruction */
  16 fixnum instruction_operand::load_value_masked(cell mask, fixnum shift)
  17 {
  18         cell *ptr = (cell *)pointer;
  19
  20         return (*ptr & mask) << shift;
  21 }
  22
  23 fixnum instruction_operand::load_value(cell relative_to)
  24 {
  25         switch(rel_class)
  26         {
  27         case RC_ABSOLUTE_CELL:
  28                 return *(cell *)pointer;
  29         case RC_ABSOLUTE:
  30                 return *(u32*)pointer;
  31         case RC_RELATIVE:
  32                 return *(s32*)pointer + relative_to + sizeof(u32);
  33         case RC_ABSOLUTE_PPC_2_2:
  34                 return load_value_2_2();
  35         case RC_ABSOLUTE_PPC_2:
  36                 return load_value_masked(rel_absolute_ppc_2_mask,0);
  37         case RC_RELATIVE_PPC_2:
  38                 return load_value_masked(rel_relative_ppc_2_mask,0) + relative_to;
  39         case RC_RELATIVE_PPC_3:
  40                 return load_value_masked(rel_relative_ppc_3_mask,0) + relative_to;
  41         case RC_RELATIVE_ARM_3:
  42                 return load_value_masked(rel_relative_arm_3_mask,2) + relative_to + sizeof(cell) * 2;
  43         case RC_INDIRECT_ARM:
  44                 return load_value_masked(rel_indirect_arm_mask,0) + relative_to + sizeof(cell);
  45         case RC_INDIRECT_ARM_PC:
  46                 return load_value_masked(rel_indirect_arm_mask,0) + relative_to + sizeof(cell) * 2;
  47         default:
  48                 critical_error("Bad rel class",rel_class);
  49                 return 0;
  50         }
  51 }
  52
  53 fixnum instruction_operand::load_value()
  54 {
  55         return load_value(pointer);
  56 }
  57
  58 /* Store a 32-bit value into a PowerPC LIS/ORI sequence */
  59 void instruction_operand::store_value_2_2(fixnum value)
  60 {
  61         cell *ptr = (cell *)pointer;
  62         ptr[-1] = ((ptr[-1] & ~0xffff) | ((value >> 16) & 0xffff));
  63         ptr[ 0] = ((ptr[ 0] & ~0xffff) | (value & 0xffff));
  64 }
  65
  66 /* Store a value into a bitfield of a PowerPC instruction */
  67 void instruction_operand::store_value_masked(fixnum value, cell mask, fixnum shift)
  68 {
  69         cell *ptr = (cell *)pointer;
  70
  71         /* This is unaccurate but good enough */
  72         fixnum test = (fixnum)mask >> 1;
  73         if(value <= -test || value >= test)
  74                 critical_error("Value does not fit inside relocation",0);
  75
  76         *ptr = ((*ptr & ~mask) | ((value >> shift) & mask));
  77 }
  78
  79 void instruction_operand::store_value(fixnum absolute_value)
  80 {
  81         fixnum relative_value = absolute_value - pointer;
  82
  83         switch(rel_class)
  84         {
  85         case RC_ABSOLUTE_CELL:
  86                 *(cell *)pointer = absolute_value;
  87                 break;
  88         case RC_ABSOLUTE:
  89                 *(u32*)pointer = absolute_value;
  90                 break;
  91         case RC_RELATIVE:
  92                 *(s32*)pointer = relative_value - sizeof(u32);
  93                 break;
  94         case RC_ABSOLUTE_PPC_2_2:
  95                 store_value_2_2(absolute_value);
  96                 break;
  97         case RC_ABSOLUTE_PPC_2:
  98                 store_value_masked(absolute_value,rel_absolute_ppc_2_mask,0);
  99                 break;
 100         case RC_RELATIVE_PPC_2:
 101                 store_value_masked(relative_value,rel_relative_ppc_2_mask,0);
 102                 break;
 103         case RC_RELATIVE_PPC_3:
 104                 store_value_masked(relative_value,rel_relative_ppc_3_mask,0);
 105                 break;
 106         case RC_RELATIVE_ARM_3:
 107                 store_value_masked(relative_value - sizeof(cell) * 2,rel_relative_arm_3_mask,2);
 108                 break;
 109         case RC_INDIRECT_ARM:
 110                 store_value_masked(relative_value - sizeof(cell),rel_indirect_arm_mask,0);
 111                 break;
 112         case RC_INDIRECT_ARM_PC:
 113                 store_value_masked(relative_value - sizeof(cell) * 2,rel_indirect_arm_mask,0);
 114                 break;
 115         default:
 116                 critical_error("Bad rel class",rel_class);
 117                 break;
 118         }
 119 }
 120
 121 }