rlm@1: /* BraIA64.c -- Converter for IA-64 code
rlm@1: 2008-10-04 : Igor Pavlov : Public domain */
rlm@1: 
rlm@1: #include "Bra.h"
rlm@1: 
rlm@1: static const Byte kBranchTable[32] =
rlm@1: {
rlm@1:   0, 0, 0, 0, 0, 0, 0, 0,
rlm@1:   0, 0, 0, 0, 0, 0, 0, 0,
rlm@1:   4, 4, 6, 6, 0, 0, 7, 7,
rlm@1:   4, 4, 0, 0, 4, 4, 0, 0
rlm@1: };
rlm@1: 
rlm@1: SizeT IA64_Convert(Byte *data, SizeT size, UInt32 ip, int encoding)
rlm@1: {
rlm@1:   SizeT i;
rlm@1:   if (size < 16)
rlm@1:     return 0;
rlm@1:   size -= 16;
rlm@1:   for (i = 0; i <= size; i += 16)
rlm@1:   {
rlm@1:     UInt32 instrTemplate = data[i] & 0x1F;
rlm@1:     UInt32 mask = kBranchTable[instrTemplate];
rlm@1:     UInt32 bitPos = 5;
rlm@1:     int slot;
rlm@1:     for (slot = 0; slot < 3; slot++, bitPos += 41)
rlm@1:     {
rlm@1:       UInt32 bytePos, bitRes;
rlm@1:       UInt64 instruction, instNorm;
rlm@1:       int j;
rlm@1:       if (((mask >> slot) & 1) == 0)
rlm@1:         continue;
rlm@1:       bytePos = (bitPos >> 3);
rlm@1:       bitRes = bitPos & 0x7;
rlm@1:       instruction = 0;
rlm@1:       for (j = 0; j < 6; j++)
rlm@1:         instruction += (UInt64)data[i + j + bytePos] << (8 * j);
rlm@1: 
rlm@1:       instNorm = instruction >> bitRes;
rlm@1:       if (((instNorm >> 37) & 0xF) == 0x5 && ((instNorm >> 9) & 0x7) == 0)
rlm@1:       {
rlm@1:         UInt32 src = (UInt32)((instNorm >> 13) & 0xFFFFF);
rlm@1:         UInt32 dest;
rlm@1:         src |= ((UInt32)(instNorm >> 36) & 1) << 20;
rlm@1:         
rlm@1:         src <<= 4;
rlm@1:         
rlm@1:         if (encoding)
rlm@1:           dest = ip + (UInt32)i + src;
rlm@1:         else
rlm@1:           dest = src - (ip + (UInt32)i);
rlm@1:         
rlm@1:         dest >>= 4;
rlm@1:         
rlm@1:         instNorm &= ~((UInt64)(0x8FFFFF) << 13);
rlm@1:         instNorm |= ((UInt64)(dest & 0xFFFFF) << 13);
rlm@1:         instNorm |= ((UInt64)(dest & 0x100000) << (36 - 20));
rlm@1:         
rlm@1:         instruction &= (1 << bitRes) - 1;
rlm@1:         instruction |= (instNorm << bitRes);
rlm@1:         for (j = 0; j < 6; j++)
rlm@1:           data[i + j + bytePos] = (Byte)(instruction >> (8 * j));
rlm@1:       }
rlm@1:     }
rlm@1:   }
rlm@1:   return i;
rlm@1: }