Subversion Repositories spk

Rev

Rev 1 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 cycrow 1 
/* Bra.c -- Converters for RISC code
2 
2008-10-04 : Igor Pavlov : Public domain */
3 
 
4 
#include "Bra.h"
5 
 
6 
SizeT ARM_Convert(Byte *data, SizeT size, UInt32 ip, int encoding)
7 
{
8 
  SizeT i;
9 
  if (size < 4)
10 
    return 0;
11 
  size -= 4;
12 
  ip += 8;
13 
  for (i = 0; i <= size; i += 4)
14 
  {
15 
    if (data[i + 3] == 0xEB)
16 
    {
17 
      UInt32 dest;
18 
      UInt32 src = ((UInt32)data[i + 2] << 16) | ((UInt32)data[i + 1] << 8) | (data[i + 0]);
19 
      src <<= 2;
20 
      if (encoding)
21 
        dest = ip + (UInt32)i + src;
22 
      else
23 
        dest = src - (ip + (UInt32)i);
24 
      dest >>= 2;
25 
      data[i + 2] = (Byte)(dest >> 16);
26 
      data[i + 1] = (Byte)(dest >> 8);
27 
      data[i + 0] = (Byte)dest;
28 
    }
29 
  }
30 
  return i;
31 
}
32 
 
33 
SizeT ARMT_Convert(Byte *data, SizeT size, UInt32 ip, int encoding)
34 
{
35 
  SizeT i;
36 
  if (size < 4)
37 
    return 0;
38 
  size -= 4;
39 
  ip += 4;
40 
  for (i = 0; i <= size; i += 2)
41 
  {
42 
    if ((data[i + 1] & 0xF8) == 0xF0 &&
43 
        (data[i + 3] & 0xF8) == 0xF8)
44 
    {
45 
      UInt32 dest;
46 
      UInt32 src =
47 
        (((UInt32)data[i + 1] & 0x7) << 19) |
48 
        ((UInt32)data[i + 0] << 11) |
49 
        (((UInt32)data[i + 3] & 0x7) << 8) |
50 
        (data[i + 2]);
51 
 
52 
      src <<= 1;
53 
      if (encoding)
54 
        dest = ip + (UInt32)i + src;
55 
      else
56 
        dest = src - (ip + (UInt32)i);
57 
      dest >>= 1;
58 
 
59 
      data[i + 1] = (Byte)(0xF0 | ((dest >> 19) & 0x7));
60 
      data[i + 0] = (Byte)(dest >> 11);
61 
      data[i + 3] = (Byte)(0xF8 | ((dest >> 8) & 0x7));
62 
      data[i + 2] = (Byte)dest;
63 
      i += 2;
64 
    }
65 
  }
66 
  return i;
67 
}
68 
 
69 
SizeT PPC_Convert(Byte *data, SizeT size, UInt32 ip, int encoding)
70 
{
71 
  SizeT i;
72 
  if (size < 4)
73 
    return 0;
74 
  size -= 4;
75 
  for (i = 0; i <= size; i += 4)
76 
  {
77 
    if ((data[i] >> 2) == 0x12 && (data[i + 3] & 3) == 1)
78 
    {
79 
      UInt32 src = ((UInt32)(data[i + 0] & 3) << 24) |
80 
        ((UInt32)data[i + 1] << 16) |
81 
        ((UInt32)data[i + 2] << 8) |
82 
        ((UInt32)data[i + 3] & (~3));
83 
 
84 
      UInt32 dest;
85 
      if (encoding)
86 
        dest = ip + (UInt32)i + src;
87 
      else
88 
        dest = src - (ip + (UInt32)i);
89 
      data[i + 0] = (Byte)(0x48 | ((dest >> 24) &  0x3));
90 
      data[i + 1] = (Byte)(dest >> 16);
91 
      data[i + 2] = (Byte)(dest >> 8);
92 
      data[i + 3] &= 0x3;
93 
      data[i + 3] |= dest;
94 
    }
95 
  }
96 
  return i;
97 
}
98 
 
99 
SizeT SPARC_Convert(Byte *data, SizeT size, UInt32 ip, int encoding)
100 
{
101 
  UInt32 i;
102 
  if (size < 4)
103 
    return 0;
104 
  size -= 4;
105 
  for (i = 0; i <= size; i += 4)
106 
  {
107 
    if (data[i] == 0x40 && (data[i + 1] & 0xC0) == 0x00 ||
108 
        data[i] == 0x7F && (data[i + 1] & 0xC0) == 0xC0)
109 
    {
110 
      UInt32 src =
111 
        ((UInt32)data[i + 0] << 24) |
112 
        ((UInt32)data[i + 1] << 16) |
113 
        ((UInt32)data[i + 2] << 8) |
114 
        ((UInt32)data[i + 3]);
115 
      UInt32 dest;
116 
 
117 
      src <<= 2;
118 
      if (encoding)
119 
        dest = ip + i + src;
120 
      else
121 
        dest = src - (ip + i);
122 
      dest >>= 2;
123 
 
124 
      dest = (((0 - ((dest >> 22) & 1)) << 22) & 0x3FFFFFFF) | (dest & 0x3FFFFF) | 0x40000000;
125 
 
126 
      data[i + 0] = (Byte)(dest >> 24);
127 
      data[i + 1] = (Byte)(dest >> 16);
128 
      data[i + 2] = (Byte)(dest >> 8);
129 
      data[i + 3] = (Byte)dest;
130 
    }
131 
  }
132 
  return i;
133 
}