Fix broken mask when x == y
[soc.git] / src / soc / decoder / helpers.py
1 import unittest
2 from soc.decoder.selectable_int import SelectableInt
3
4
5 def exts(value, bits):
6 sign = 1 << (bits - 1)
7 return (value & (sign - 1)) - (value & sign)
8
9
10 def EXTS(value):
11 """ extends sign bit out from current MSB to all 256 bits
12 """
13 assert isinstance(value, SelectableInt)
14 return SelectableInt(exts(value.value, value.bits) & ((1 << 256)-1), 256)
15
16 def EXTS64(value):
17 """ extends sign bit out from current MSB to 64 bits
18 """
19 assert isinstance(value, SelectableInt)
20 return SelectableInt(exts(value.value, value.bits) & ((1 << 64)-1), 64)
21
22
23 # XXX should this explicitly extend from 32 to 64?
24 def EXTZ64(value):
25 if isinstance(value, SelectableInt):
26 value = value.value
27 return SelectableInt(value & ((1<<32)-1), 64)
28
29
30 def rotl(value, bits, wordlen):
31 if isinstance(bits, SelectableInt):
32 bits = bits.value
33 mask = (1 << wordlen) - 1
34 bits = bits & (wordlen - 1)
35 return ((value << bits) | (value >> (wordlen-bits))) & mask
36
37
38 def ROTL64(value, bits):
39 return rotl(value, bits, 64)
40
41
42 def ROTL32(value, bits):
43 return rotl(value, bits, 32)
44
45
46 def MASK(x, y):
47 if isinstance(x, SelectableInt):
48 x = x.value
49 if isinstance(y, SelectableInt):
50 y = y.value
51 if x < y:
52 x = 64-x
53 y = 63-y
54 mask_a = ((1 << x) - 1) & ((1 << 64) - 1)
55 mask_b = ((1 << y) - 1) & ((1 << 64) - 1)
56 elif x == y:
57 return 1 << (63-x)
58 else:
59 x = 64-x
60 y = 63-y
61 mask_a = ((1 << x) - 1) & ((1 << 64) - 1)
62 mask_b = (~((1 << y) - 1)) & ((1 << 64) - 1)
63 return mask_a ^ mask_b
64
65 def ne(a, b):
66 return SelectableInt((a != b), bits=1)
67
68 def eq(a, b):
69 return SelectableInt((a == b), bits=1)
70
71 def gt(a, b):
72 return SelectableInt((a > b), bits=1)
73
74 def ge(a, b):
75 return SelectableInt((a >= b), bits=1)
76
77 def lt(a, b):
78 return SelectableInt((a < b), bits=1)
79
80 def le(a, b):
81 return SelectableInt((a <= b), bits=1)
82
83 def length(a):
84 return len(a)
85
86 # For these tests I tried to find power instructions that would let me
87 # isolate each of these helper operations. So for instance, when I was
88 # testing the MASK() function, I chose rlwinm and rldicl because if I
89 # set the shift equal to 0 and passed in a value of all ones, the
90 # result I got would be exactly the same as the output of MASK()
91
92 class HelperTests(unittest.TestCase):
93 def test_MASK(self):
94 # Verified using rlwinm, rldicl, rldicr in qemu
95 # li 1, -1
96 # rlwinm reg, 1, 0, 5, 15
97 self.assertHex(MASK(5+32, 15+32), 0x7ff0000)
98 # rlwinm reg, 1, 0, 15, 5
99 self.assertHex(MASK(15+32, 5+32), 0xfffffffffc01ffff)
100 self.assertHex(MASK(30+32, 2+32), 0xffffffffe0000003)
101 # rldicl reg, 1, 0, 37
102 self.assertHex(MASK(37, 63), 0x7ffffff)
103 self.assertHex(MASK(10, 63), 0x3fffffffffffff)
104 self.assertHex(MASK(58, 63), 0x3f)
105 # rldicr reg, 1, 0, 37
106 self.assertHex(MASK(0, 37), 0xfffffffffc000000)
107 self.assertHex(MASK(0, 10), 0xffe0000000000000)
108 self.assertHex(MASK(0, 58), 0xffffffffffffffe0)
109
110 # li 2, 5
111 # slw 1, 1, 2
112 self.assertHex(MASK(32, 63-5), 0xffffffe0)
113
114 self.assertHex(MASK(32, 33), 0xc0000000)
115 self.assertHex(MASK(32, 32), 0x80000000)
116 self.assertHex(MASK(33, 33), 0x40000000)
117
118 def test_ROTL64(self):
119 # r1 = 0xdeadbeef12345678
120 value = 0xdeadbeef12345678
121
122 # rldicl reg, 1, 10, 0
123 self.assertHex(ROTL64(value, 10), 0xb6fbbc48d159e37a)
124 # rldicl reg, 1, 35, 0
125 self.assertHex(ROTL64(value, 35), 0x91a2b3c6f56df778)
126 self.assertHex(ROTL64(value, 58), 0xe37ab6fbbc48d159)
127 self.assertHex(ROTL64(value, 22), 0xbbc48d159e37ab6f)
128
129 def test_ROTL32(self):
130 # r1 = 0xdeadbeef
131 value = 0xdeadbeef
132
133 # rlwinm reg, 1, 10, 0, 31
134 self.assertHex(ROTL32(value, 10), 0xb6fbbf7a)
135 # rlwinm reg, 1, 17, 0, 31
136 self.assertHex(ROTL32(value, 17), 0x7ddfbd5b)
137 self.assertHex(ROTL32(value, 25), 0xdfbd5b7d)
138 self.assertHex(ROTL32(value, 30), 0xf7ab6fbb)
139
140 def test_EXTS64(self):
141 value_a = SelectableInt(0xdeadbeef, 32) # r1
142 value_b = SelectableInt(0x73123456, 32) # r2
143 value_c = SelectableInt(0x80000000, 32) # r3
144
145 # extswsli reg, 1, 0
146 self.assertHex(EXTS64(value_a), 0xffffffffdeadbeef)
147 # extswsli reg, 2, 0
148 self.assertHex(EXTS64(value_b), SelectableInt(value_b.value, 64))
149 # extswsli reg, 3, 0
150 self.assertHex(EXTS64(value_c), 0xffffffff80000000)
151
152 def assertHex(self, a, b):
153 a_val = a
154 if isinstance(a, SelectableInt):
155 a_val = a.value
156 b_val = b
157 if isinstance(b, SelectableInt):
158 b_val = b.value
159 msg = "{:x} != {:x}".format(a_val, b_val)
160 return self.assertEqual(a, b, msg)
161
162
163 if __name__ == '__main__':
164 print (SelectableInt.__bases__)
165 unittest.main()