| 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 |