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