3 from soc
.decoder
.power_fields
import BitRange
4 from operator
import (add
, sub
, mul
, truediv
, mod
, or_
, and_
, xor
, neg
, inv
)
7 def check_extsign(a
, b
):
8 if isinstance(b
, FieldSelectableInt
):
12 return SelectableInt(b
.value
, a
.bits
)
15 class FieldSelectableInt
:
16 """FieldSelectableInt: allows bit-range selection onto another target
18 def __init__(self
, si
, br
):
19 self
.si
= si
# target selectable int
20 if isinstance(br
, list) or isinstance(br
, tuple):
22 for i
, v
in enumerate(br
):
25 self
.br
= br
# map of indices.
28 if isinstance(b
, SelectableInt
):
29 for i
in range(b
.bits
):
45 def __getitem__(self
, key
):
46 print ("getitem", key
, self
.br
)
47 key
= self
.br
[key
] # don't do POWER 1.3.4 bit-inversion
50 def __setitem__(self
, key
, value
):
51 key
= self
.br
[key
] # don't do POWER 1.3.4 bit-inversion
52 return self
.si
.__setitem
__(key
, value
)
55 return self
._op
1(negate
)
59 return self
._op
(add
, b
)
61 return self
._op
(sub
, b
)
63 return self
._op
(mul
, b
)
65 return self
._op
(truediv
, b
)
67 return self
._op
(mod
, b
)
69 return self
._op
(and_
, b
)
71 return self
._op
(or_
, b
)
73 return self
._op
(xor
, b
)
76 print ("get_range", self
.si
)
77 vi
= SelectableInt(0, len(self
.br
))
78 for k
, v
in self
.br
.items():
79 print ("get_range", k
, v
, self
.si
[v
])
81 print ("get_range", vi
)
86 for i
, v
in fi
.br
.items():
91 return "FieldSelectableInt(si=%s, br=%s)" % (self
.si
, self
.br
)
94 class FieldSelectableIntTestCase(unittest
.TestCase
):
96 a
= SelectableInt(0b10101, 5)
97 b
= SelectableInt(0b011, 3)
102 fs
= FieldSelectableInt(a
, br
)
105 #self.assertEqual(c.value, a.value + b.value)
109 def __init__(self
, value
, bits
):
110 mask
= (1 << bits
) - 1
111 self
.value
= value
& mask
118 def __add__(self
, b
):
119 if isinstance(b
, int):
120 b
= SelectableInt(b
, self
.bits
)
121 b
= check_extsign(self
, b
)
122 assert b
.bits
== self
.bits
123 return SelectableInt(self
.value
+ b
.value
, self
.bits
)
125 def __sub__(self
, b
):
126 if isinstance(b
, int):
127 b
= SelectableInt(b
, self
.bits
)
128 b
= check_extsign(self
, b
)
129 assert b
.bits
== self
.bits
130 return SelectableInt(self
.value
- b
.value
, self
.bits
)
132 def __mul__(self
, b
):
133 b
= check_extsign(self
, b
)
134 assert b
.bits
== self
.bits
135 return SelectableInt(self
.value
* b
.value
, self
.bits
)
137 def __div__(self
, b
):
138 b
= check_extsign(self
, b
)
139 assert b
.bits
== self
.bits
140 return SelectableInt(self
.value
/ b
.value
, self
.bits
)
142 def __mod__(self
, b
):
143 b
= check_extsign(self
, b
)
144 assert b
.bits
== self
.bits
145 return SelectableInt(self
.value
% b
.value
, self
.bits
)
148 b
= check_extsign(self
, b
)
149 assert b
.bits
== self
.bits
150 return SelectableInt(self
.value | b
.value
, self
.bits
)
152 def __and__(self
, b
):
153 print ("__and__", self
, b
)
154 b
= check_extsign(self
, b
)
155 assert b
.bits
== self
.bits
156 return SelectableInt(self
.value
& b
.value
, self
.bits
)
158 def __xor__(self
, b
):
159 b
= check_extsign(self
, b
)
160 assert b
.bits
== self
.bits
161 return SelectableInt(self
.value ^ b
.value
, self
.bits
)
163 def __invert__(self
):
164 return SelectableInt(~self
.value
, self
.bits
)
167 return SelectableInt(~self
.value
+ 1, self
.bits
)
169 def __getitem__(self
, key
):
170 if isinstance(key
, int):
171 assert key
< self
.bits
, "key %d accessing %d" % (key
, self
.bits
)
173 # NOTE: POWER 3.0B annotation order! see p4 1.3.2
174 # MSB is indexed **LOWEST** (sigh)
175 key
= self
.bits
- (key
+ 1)
177 value
= (self
.value
>> key
) & 1
178 return SelectableInt(value
, 1)
179 elif isinstance(key
, slice):
180 assert key
.step
is None or key
.step
== 1
181 assert key
.start
< key
.stop
182 assert key
.start
>= 0
183 assert key
.stop
<= self
.bits
185 stop
= self
.bits
- key
.start
186 start
= self
.bits
- key
.stop
189 #print ("__getitem__ slice num bits", bits)
190 mask
= (1 << bits
) - 1
191 value
= (self
.value
>> start
) & mask
192 return SelectableInt(value
, bits
)
194 def __setitem__(self
, key
, value
):
195 if isinstance(key
, int):
196 assert key
< self
.bits
198 key
= self
.bits
- (key
+ 1)
199 if isinstance(value
, SelectableInt
):
200 assert value
.bits
== 1
205 self
.value
= (self
.value
& ~mask
) |
(value
& mask
)
206 elif isinstance(key
, slice):
207 assert key
.step
is None or key
.step
== 1
208 assert key
.start
< key
.stop
209 assert key
.start
>= 0
210 assert key
.stop
<= self
.bits
212 stop
= self
.bits
- key
.start
213 start
= self
.bits
- key
.stop
216 #print ("__setitem__ slice num bits", bits)
217 if isinstance(value
, SelectableInt
):
218 assert value
.bits
== bits
, "%d into %d" % (value
.bits
, bits
)
220 mask
= ((1 << bits
) - 1) << start
221 value
= value
<< start
222 self
.value
= (self
.value
& ~mask
) |
(value
& mask
)
224 def __ge__(self
, other
):
225 if isinstance(other
, FieldSelectableInt
):
226 other
= other
.get_range()
227 if isinstance(other
, SelectableInt
):
228 other
= check_extsign(self
, other
)
229 assert other
.bits
== self
.bits
231 if isinstance(other
, int):
232 return other
>= self
.value
235 def __le__(self
, other
):
236 if isinstance(other
, FieldSelectableInt
):
237 other
= other
.get_range()
238 if isinstance(other
, SelectableInt
):
239 other
= check_extsign(self
, other
)
240 assert other
.bits
== self
.bits
242 if isinstance(other
, int):
243 return onebit(other
<= self
.value
)
246 def __gt__(self
, other
):
247 if isinstance(other
, FieldSelectableInt
):
248 other
= other
.get_range()
249 if isinstance(other
, SelectableInt
):
250 other
= check_extsign(self
, other
)
251 assert other
.bits
== self
.bits
253 if isinstance(other
, int):
254 return onebit(other
> self
.value
)
257 def __lt__(self
, other
):
258 if isinstance(other
, FieldSelectableInt
):
259 other
= other
.get_range()
260 if isinstance(other
, SelectableInt
):
261 other
= check_extsign(self
, other
)
262 assert other
.bits
== self
.bits
264 if isinstance(other
, int):
265 return onebit(other
< self
.value
)
268 def __eq__(self
, other
):
269 print ("__eq__", self
, other
)
270 if isinstance(other
, FieldSelectableInt
):
271 other
= other
.get_range()
272 if isinstance(other
, SelectableInt
):
273 other
= check_extsign(self
, other
)
274 assert other
.bits
== self
.bits
276 if isinstance(other
, int):
277 return onebit(other
== self
.value
)
280 def narrow(self
, bits
):
281 assert bits
<= self
.bits
282 return SelectableInt(self
.value
, bits
)
285 return self
.value
!= 0
288 return "SelectableInt(value=0x{:x}, bits={})".format(self
.value
,
292 return SelectableInt(1 if bit
else 0, 1)
294 def selectltu(lhs
, rhs
):
295 """ less-than (unsigned)
297 if isinstance(rhs
, SelectableInt
):
299 return onebit(lhs
.value
< rhs
)
301 def selectgtu(lhs
, rhs
):
302 """ greater-than (unsigned)
304 if isinstance(rhs
, SelectableInt
):
306 return onebit(lhs
.value
> rhs
)
309 # XXX this probably isn't needed...
310 def selectassign(lhs
, idx
, rhs
):
311 if isinstance(idx
, tuple):
316 lower
, upper
, step
= idx
317 toidx
= range(lower
, upper
, step
)
318 fromidx
= range(0, upper
-lower
, step
) # XXX eurgh...
322 for t
, f
in zip(toidx
, fromidx
):
326 def selectconcat(*args
, repeat
=1):
327 if repeat
!= 1 and len(args
) == 1 and isinstance(args
[0], int):
328 args
= [SelectableInt(args
[0], 1)]
329 if repeat
!= 1: # multiplies the incoming arguments
331 for i
in range(repeat
):
336 assert isinstance(i
, SelectableInt
), "can only concat SIs, sorry"
338 res
.value
= (res
.value
<< i
.bits
) | i
.value
339 print ("concat", repeat
, res
)
343 class SelectableIntTestCase(unittest
.TestCase
):
344 def test_arith(self
):
345 a
= SelectableInt(5, 8)
346 b
= SelectableInt(9, 8)
351 self
.assertEqual(c
.value
, a
.value
+ b
.value
)
352 self
.assertEqual(d
.value
, (a
.value
- b
.value
) & 0xFF)
353 self
.assertEqual(e
.value
, (a
.value
* b
.value
) & 0xFF)
354 self
.assertEqual(f
.value
, (-a
.value
) & 0xFF)
355 self
.assertEqual(c
.bits
, a
.bits
)
356 self
.assertEqual(d
.bits
, a
.bits
)
357 self
.assertEqual(e
.bits
, a
.bits
)
359 def test_logic(self
):
360 a
= SelectableInt(0x0F, 8)
361 b
= SelectableInt(0xA5, 8)
366 self
.assertEqual(c
.value
, a
.value
& b
.value
)
367 self
.assertEqual(d
.value
, a
.value | b
.value
)
368 self
.assertEqual(e
.value
, a
.value ^ b
.value
)
369 self
.assertEqual(f
.value
, 0xF0)
372 a
= SelectableInt(0xa2, 8)
373 # These should be big endian
374 self
.assertEqual(a
[7], 0)
375 self
.assertEqual(a
[0:4], 10)
376 self
.assertEqual(a
[4:8], 2)
379 a
= SelectableInt(0x5, 8)
380 a
[7] = SelectableInt(0, 1)
381 self
.assertEqual(a
, 4)
383 self
.assertEqual(a
, 9)
385 self
.assertEqual(a
, 0x39)
387 self
.assertEqual(a
, 0x99)
389 def test_concat(self
):
390 a
= SelectableInt(0x1, 1)
391 c
= selectconcat(a
, repeat
=8)
392 self
.assertEqual(c
, 0xff)
393 self
.assertEqual(c
.bits
, 8)
394 a
= SelectableInt(0x0, 1)
395 c
= selectconcat(a
, repeat
=8)
396 self
.assertEqual(c
, 0x00)
397 self
.assertEqual(c
.bits
, 8)
400 for i
in range(65536):
401 a
= SelectableInt(i
, 16)
403 self
.assertEqual(a
, b
)
405 if __name__
== "__main__":