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 code_block *instruction_operand::load_code_block()
  59 {
  60         return ((code_block *)load_value() - 1);
  61 }
  62
  63 /* Store a 32-bit value into a PowerPC LIS/ORI sequence */
  64 void instruction_operand::store_value_2_2(fixnum value)
  65 {
  66         cell *ptr = (cell *)pointer;
  67         ptr[-1] = ((ptr[-1] & ~0xffff) | ((value >> 16) & 0xffff));
  68         ptr[ 0] = ((ptr[ 0] & ~0xffff) | (value & 0xffff));
  69 }
  70
  71 /* Store a value into a bitfield of a PowerPC instruction */
  72 void instruction_operand::store_value_masked(fixnum value, cell mask, fixnum shift)
  73 {
  74         cell *ptr = (cell *)pointer;
  75
  76         /* This is unaccurate but good enough */
  77         fixnum test = (fixnum)mask >> 1;
  78         if(value <= -test || value >= test)
  79                 critical_error("Value does not fit inside relocation",0);
  80
  81         *ptr = ((*ptr & ~mask) | ((value >> shift) & mask));
  82 }
  83
  84 void instruction_operand::store_value(fixnum absolute_value)
  85 {
  86         fixnum relative_value = absolute_value - pointer;
  87
  88         switch(rel_class)
  89         {
  90         case RC_ABSOLUTE_CELL:
  91                 *(cell *)pointer = absolute_value;
  92                 break;
  93         case RC_ABSOLUTE:
  94                 *(u32*)pointer = absolute_value;
  95                 break;
  96         case RC_RELATIVE:
  97                 *(s32*)pointer = relative_value - sizeof(u32);
  98                 break;
  99         case RC_ABSOLUTE_PPC_2_2:
 100                 store_value_2_2(absolute_value);
 101                 break;
 102         case RC_ABSOLUTE_PPC_2:
 103                 store_value_masked(absolute_value,rel_absolute_ppc_2_mask,0);
 104                 break;
 105         case RC_RELATIVE_PPC_2:
 106                 store_value_masked(relative_value,rel_relative_ppc_2_mask,0);
 107                 break;
 108         case RC_RELATIVE_PPC_3:
 109                 store_value_masked(relative_value,rel_relative_ppc_3_mask,0);
 110                 break;
 111         case RC_RELATIVE_ARM_3:
 112                 store_value_masked(relative_value - sizeof(cell) * 2,rel_relative_arm_3_mask,2);
 113                 break;
 114         case RC_INDIRECT_ARM:
 115                 store_value_masked(relative_value - sizeof(cell),rel_indirect_arm_mask,0);
 116                 break;
 117         case RC_INDIRECT_ARM_PC:
 118                 store_value_masked(relative_value - sizeof(cell) * 2,rel_indirect_arm_mask,0);
 119                 break;
 120         default:
 121                 critical_error("Bad rel class",rel_class);
 122                 break;
 123         }
 124 }
 125
 126 void instruction_operand::store_code_block(code_block *compiled)
 127 {
 128         store_value((cell)compiled->xt());
 129 }
 130
 131 }