deps/lzma-16.04/C/BraIA64.c

   1 /* BraIA64.c -- Converter for IA-64 code\r
   2 2013-11-12 : Igor Pavlov : Public domain */\r
   3 \r
   4 #include "Precomp.h"\r
   5 \r
   6 #include "Bra.h"\r
   7 \r
   8 static const Byte kBranchTable[32] =\r
   9 {\r
  10   0, 0, 0, 0, 0, 0, 0, 0,\r
  11   0, 0, 0, 0, 0, 0, 0, 0,\r
  12   4, 4, 6, 6, 0, 0, 7, 7,\r
  13   4, 4, 0, 0, 4, 4, 0, 0\r
  14 };\r
  15 \r
  16 SizeT IA64_Convert(Byte *data, SizeT size, UInt32 ip, int encoding)\r
  17 {\r
  18   SizeT i;\r
  19   if (size < 16)\r
  20     return 0;\r
  21   size -= 16;\r
  22   for (i = 0; i <= size; i += 16)\r
  23   {\r
  24     UInt32 instrTemplate = data[i] & 0x1F;\r
  25     UInt32 mask = kBranchTable[instrTemplate];\r
  26     UInt32 bitPos = 5;\r
  27     int slot;\r
  28     for (slot = 0; slot < 3; slot++, bitPos += 41)\r
  29     {\r
  30       UInt32 bytePos, bitRes;\r
  31       UInt64 instruction, instNorm;\r
  32       int j;\r
  33       if (((mask >> slot) & 1) == 0)\r
  34         continue;\r
  35       bytePos = (bitPos >> 3);\r
  36       bitRes = bitPos & 0x7;\r
  37       instruction = 0;\r
  38       for (j = 0; j < 6; j++)\r
  39         instruction += (UInt64)data[i + j + bytePos] << (8 * j);\r
  40 \r
  41       instNorm = instruction >> bitRes;\r
  42       if (((instNorm >> 37) & 0xF) == 0x5 && ((instNorm >> 9) & 0x7) == 0)\r
  43       {\r
  44         UInt32 src = (UInt32)((instNorm >> 13) & 0xFFFFF);\r
  45         UInt32 dest;\r
  46         src |= ((UInt32)(instNorm >> 36) & 1) << 20;\r
  47         \r
  48         src <<= 4;\r
  49         \r
  50         if (encoding)\r
  51           dest = ip + (UInt32)i + src;\r
  52         else\r
  53           dest = src - (ip + (UInt32)i);\r
  54         \r
  55         dest >>= 4;\r
  56         \r
  57         instNorm &= ~((UInt64)(0x8FFFFF) << 13);\r
  58         instNorm |= ((UInt64)(dest & 0xFFFFF) << 13);\r
  59         instNorm |= ((UInt64)(dest & 0x100000) << (36 - 20));\r
  60         \r
  61         instruction &= (1 << bitRes) - 1;\r
  62         instruction |= (instNorm << bitRes);\r
  63         for (j = 0; j < 6; j++)\r
  64           data[i + j + bytePos] = (Byte)(instruction >> (8 * j));\r
  65       }\r
  66     }\r
  67   }\r
  68   return i;\r
  69 }\r