Add helper functions to replace direct comparison in generated code
[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 mask = (1 << wordlen) - 1
32 bits = bits & (wordlen - 1)
33 return ((value << bits) | (value >> (wordlen-bits))) & mask
34
35
36 def ROTL64(value, bits):
37 return rotl(value, bits, 64)
38
39
40 def ROTL32(value, bits):
41 return rotl(value, bits, 32)
42
43
44 def MASK(x, y):
45 if x < y:
46 x = 64-x
47 y = 63-y
48 mask_a = ((1 << x) - 1) & ((1 << 64) - 1)
49 mask_b = ((1 << y) - 1) & ((1 << 64) - 1)
50 else:
51 x = 64-x
52 y = 63-y
53 mask_a = ((1 << x) - 1) & ((1 << 64) - 1)
54 mask_b = (~((1 << y) - 1)) & ((1 << 64) - 1)
55 return mask_a ^ mask_b
56
57 def ne(a, b):
58 return SelectableInt((a != b), bits=1)
59
60 def eq(a, b):
61 return SelectableInt((a == b), bits=1)
62
63 def gt(a, b):
64 return SelectableInt((a > b), bits=1)
65
66 def ge(a, b):
67 return SelectableInt((a >= b), bits=1)
68
69 def lt(a, b):
70 return SelectableInt((a < b), bits=1)
71
72 def le(a, b):
73 return SelectableInt((a <= b), bits=1)
74 # For these tests I tried to find power instructions that would let me
75 # isolate each of these helper operations. So for instance, when I was
76 # testing the MASK() function, I chose rlwinm and rldicl because if I
77 # set the shift equal to 0 and passed in a value of all ones, the
78 # result I got would be exactly the same as the output of MASK()
79
80 class HelperTests(unittest.TestCase):
81 def test_MASK(self):
82 # Verified using rlwinm, rldicl, rldicr in qemu
83 # li 1, -1
84 # rlwinm reg, 1, 0, 5, 15
85 self.assertHex(MASK(5+32, 15+32), 0x7ff0000)
86 # rlwinm reg, 1, 0, 15, 5
87 self.assertHex(MASK(15+32, 5+32), 0xfffffffffc01ffff)
88 self.assertHex(MASK(30+32, 2+32), 0xffffffffe0000003)
89 # rldicl reg, 1, 0, 37
90 self.assertHex(MASK(37, 63), 0x7ffffff)
91 self.assertHex(MASK(10, 63), 0x3fffffffffffff)
92 self.assertHex(MASK(58, 63), 0x3f)
93 # rldicr reg, 1, 0, 37
94 self.assertHex(MASK(0, 37), 0xfffffffffc000000)
95 self.assertHex(MASK(0, 10), 0xffe0000000000000)
96 self.assertHex(MASK(0, 58), 0xffffffffffffffe0)
97
98 def test_ROTL64(self):
99 # r1 = 0xdeadbeef12345678
100 value = 0xdeadbeef12345678
101
102 # rldicl reg, 1, 10, 0
103 self.assertHex(ROTL64(value, 10), 0xb6fbbc48d159e37a)
104 # rldicl reg, 1, 35, 0
105 self.assertHex(ROTL64(value, 35), 0x91a2b3c6f56df778)
106 self.assertHex(ROTL64(value, 58), 0xe37ab6fbbc48d159)
107 self.assertHex(ROTL64(value, 22), 0xbbc48d159e37ab6f)
108
109 def test_ROTL32(self):
110 # r1 = 0xdeadbeef
111 value = 0xdeadbeef
112
113 # rlwinm reg, 1, 10, 0, 31
114 self.assertHex(ROTL32(value, 10), 0xb6fbbf7a)
115 # rlwinm reg, 1, 17, 0, 31
116 self.assertHex(ROTL32(value, 17), 0x7ddfbd5b)
117 self.assertHex(ROTL32(value, 25), 0xdfbd5b7d)
118 self.assertHex(ROTL32(value, 30), 0xf7ab6fbb)
119
120 def test_EXTS64(self):
121 value_a = 0xdeadbeef # r1
122 value_b = 0x73123456 # r2
123 value_c = 0x80000000 # r3
124
125 # extswsli reg, 1, 0
126 self.assertHex(EXTS64(value_a), 0xffffffffdeadbeef)
127 # extswsli reg, 2, 0
128 self.assertHex(EXTS64(value_b), value_b)
129 # extswsli reg, 3, 0
130 self.assertHex(EXTS64(value_c), 0xffffffff80000000)
131
132 def assertHex(self, a, b):
133 msg = "{:x} != {:x}".format(a, b)
134 return self.assertEqual(a, b, msg)
135
136
137 if __name__ == '__main__':
138 print (SelectableInt.__bases__)
139 unittest.main()