15821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)/* Bra.c -- Converters for RISC code 25821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)2010-04-16 : Igor Pavlov : Public domain */ 35821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 45821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#include "Bra.h" 55821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 65821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)SizeT ARM_Convert(Byte *data, SizeT size, UInt32 ip, int encoding) 75821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 85821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) SizeT i; 95821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (size < 4) 105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size -= 4; 125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ip += 8; 135821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for (i = 0; i <= size; i += 4) 145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 155821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (data[i + 3] == 0xEB) 165821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 175821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 dest; 185821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 src = ((UInt32)data[i + 2] << 16) | ((UInt32)data[i + 1] << 8) | (data[i + 0]); 195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) src <<= 2; 205821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (encoding) 215821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = ip + (UInt32)i + src; 225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) else 235821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = src - (ip + (UInt32)i); 245821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest >>= 2; 255821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 2] = (Byte)(dest >> 16); 265821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 1] = (Byte)(dest >> 8); 275821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 0] = (Byte)dest; 285821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 295821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 305821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return i; 315821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 325821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 335821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)SizeT ARMT_Convert(Byte *data, SizeT size, UInt32 ip, int encoding) 345821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 355821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) SizeT i; 365821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (size < 4) 375821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 385821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size -= 4; 395821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ip += 4; 405821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for (i = 0; i <= size; i += 2) 415821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 425821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if ((data[i + 1] & 0xF8) == 0xF0 && 435821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) (data[i + 3] & 0xF8) == 0xF8) 445821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 455821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 dest; 465821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 src = 475821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) (((UInt32)data[i + 1] & 0x7) << 19) | 485821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 0] << 11) | 495821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) (((UInt32)data[i + 3] & 0x7) << 8) | 505821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) (data[i + 2]); 515821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 525821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) src <<= 1; 535821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (encoding) 545821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = ip + (UInt32)i + src; 555821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) else 565821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = src - (ip + (UInt32)i); 575821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest >>= 1; 585821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 595821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 1] = (Byte)(0xF0 | ((dest >> 19) & 0x7)); 605821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 0] = (Byte)(dest >> 11); 615821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 3] = (Byte)(0xF8 | ((dest >> 8) & 0x7)); 625821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 2] = (Byte)dest; 635821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) i += 2; 645821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 655821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 665821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return i; 675821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 685821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 695821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)SizeT PPC_Convert(Byte *data, SizeT size, UInt32 ip, int encoding) 705821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 715821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) SizeT i; 725821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (size < 4) 735821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 745821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size -= 4; 755821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for (i = 0; i <= size; i += 4) 765821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 775821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if ((data[i] >> 2) == 0x12 && (data[i + 3] & 3) == 1) 785821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 795821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 src = ((UInt32)(data[i + 0] & 3) << 24) | 805821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 1] << 16) | 815821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 2] << 8) | 825821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 3] & (~3)); 835821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 845821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 dest; 855821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (encoding) 865821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = ip + (UInt32)i + src; 875821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) else 885821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = src - (ip + (UInt32)i); 895821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 0] = (Byte)(0x48 | ((dest >> 24) & 0x3)); 905821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 1] = (Byte)(dest >> 16); 915821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 2] = (Byte)(dest >> 8); 925821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 3] &= 0x3; 935821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 3] |= dest; 945821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 955821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 965821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return i; 975821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 985821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 995821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)SizeT SPARC_Convert(Byte *data, SizeT size, UInt32 ip, int encoding) 1005821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 1015821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 i; 1025821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (size < 4) 1035821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1045821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size -= 4; 1055821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for (i = 0; i <= size; i += 4) 1065821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 1075821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if ((data[i] == 0x40 && (data[i + 1] & 0xC0) == 0x00) || 1085821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) (data[i] == 0x7F && (data[i + 1] & 0xC0) == 0xC0)) 1095821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) { 1105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 src = 1115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 0] << 24) | 1125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 1] << 16) | 1135821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 2] << 8) | 1145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) ((UInt32)data[i + 3]); 1155821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) UInt32 dest; 1165821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1175821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) src <<= 2; 1185821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (encoding) 1195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = ip + i + src; 1205821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) else 1215821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = src - (ip + i); 1225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest >>= 2; 1235821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1245821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dest = (((0 - ((dest >> 22) & 1)) << 22) & 0x3FFFFFFF) | (dest & 0x3FFFFF) | 0x40000000; 1255821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1265821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 0] = (Byte)(dest >> 24); 1275821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 1] = (Byte)(dest >> 16); 1285821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 2] = (Byte)(dest >> 8); 1295821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) data[i + 3] = (Byte)dest; 1305821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 1315821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 1325821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return i; 1335821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 134