add new stages etc. to get multiply working without xer_ca
[soc.git] / src / soc / fu / mul / post_stage.py
1 # This stage is intended to do most of the work of analysing the multiply result
2
3 from nmigen import (Module, Signal, Cat, Repl, Mux, signed)
4 from nmutil.pipemodbase import PipeModBase
5 from soc.fu.div.pipe_data import DivMulOutputData
6 from soc.fu.mul.pipe_data import MulOutputData
7 from ieee754.part.partsig import PartitionedSignal
8 from soc.decoder.power_enums import InternalOp
9
10
11 class MulMainStage3(PipeModBase):
12 def __init__(self, pspec):
13 super().__init__(pspec, "mul3")
14
15 def ispec(self):
16 return MulOutputData(self.pspec) # pipeline stage output format
17
18 def ospec(self):
19 return DivMulOutputData(self.pspec) # defines stage output format
20
21 def elaborate(self, platform):
22 m = Module()
23 comb = m.d.comb
24
25 # convenience variables
26 o, cr0 = self.o.o, self.o.cr0
27 ov_o, o_i, op = self.o.xer_ov, self.i.o, self.i.ctx.op
28
29 # check if op is 32-bit, and get sign bit from operand a
30 is_32bit = Signal(reset_less=True)
31 comb += is_32bit.eq(op.is_32bit)
32
33 # check negate: select signed/unsigned
34 mul_o = Signal(o_i.width, reset_less=True)
35 comb += mul_o.eq(Mux(self.i.neg_res, -o_i, o_i))
36 comb += o.ok.eq(1)
37
38 # OP_MUL_nnn - select hi32/hi64/lo64 from result
39 with m.Switch(op.insn_type):
40 # hi-32 replicated twice
41 with m.Case(InternalOp.OP_MUL_H32):
42 comb += o.data.eq(Repl(mul_o[32:64], 2))
43 # hi-64
44 with m.Case(InternalOp.OP_MUL_H64):
45 comb += o.data.eq(mul_o[64:128])
46 # lo-64 - overflow
47 with m.Default():
48 comb += o.data.eq(mul_o[0:64])
49
50 # compute overflow
51 mul_ov = Signal(reset_less=True)
52 with m.If(is_32bit):
53 m32 = mul_o[32:64]
54 comb += mul_ov.eq(m32.bool() & ~m32.all())
55 with m.Else():
56 m64 = mul_o[64:128]
57 comb += mul_ov.eq(m64.bool() & ~m64.all())
58
59 # 32-bit (ov[1]) and 64-bit (ov[0]) overflow
60 ov = Signal(2, reset_less=True)
61 comb += ov[0].eq(mul_ov)
62 comb += ov[1].eq(mul_ov)
63 comb += ov_o.data.eq(ov)
64 comb += ov_o.ok.eq(1)
65
66 ###### sticky overflow and context, both pass-through #####
67
68 comb += self.o.xer_so.data.eq(self.i.xer_so)
69 comb += self.o.ctx.eq(self.i.ctx)
70
71 return m
72