src/soc/fu/div/setup_stage.py

   1 # This stage is the setup stage that converts the inputs
   2 # into the values expected by DivPipeCore
   3
   4 from nmigen import (Module, Signal, Cat, Repl, Mux, Const, Array)
   5 from nmutil.pipemodbase import PipeModBase
   6 from soc.fu.div.pipe_data import DIVInputData
   7 from ieee754.part.partsig import PartitionedSignal
   8 from soc.decoder.power_enums import InternalOp
   9
  10 from soc.decoder.power_fields import DecodeFields
  11 from soc.decoder.power_fieldsn import SignalBitRange
  12 from soc.fu.div.pipe_data import CoreInputData
  13 from ieee754.div_rem_sqrt_rsqrt.core import DivPipeCoreOperation
  14 from nmutil.util import eq32
  15
  16
  17 class DivSetupStage(PipeModBase):
  18     def __init__(self, pspec):
  19         super().__init__(pspec, "setup_stage")
  20         self.fields = DecodeFields(SignalBitRange, [self.i.ctx.op.insn])
  21         self.fields.create_specs()
  22
  23     def ispec(self):
  24         return DIVInputData(self.pspec)
  25
  26     def ospec(self):
  27         return CoreInputData(self.pspec)
  28
  29     def elaborate(self, platform):
  30         m = Module()
  31         comb = m.d.comb
  32         # convenience variables
  33         op, a, b = self.i.ctx.op, self.i.a, self.i.b
  34         core_o = self.o.core
  35         dividend_neg_o = self.o.dividend_neg
  36         divisor_neg_o = self.o.divisor_neg
  37         dividend_o = core_o.dividend
  38         divisor_o = core_o.divisor_radicand
  39
  40         # set operation to unsigned div/remainder
  41         comb += core_o.operation.eq(int(DivPipeCoreOperation.UDivRem))
  42
  43         # work out if a/b are negative (check 32-bit / signed)
  44         comb += dividend_neg_o.eq(Mux(op.is_32bit, a[31], a[63]) & op.is_signed)
  45         comb += divisor_neg_o.eq(Mux(op.is_32bit, b[31], b[63]) & op.is_signed)
  46
  47         # negation of a 64-bit value produces the same lower 32-bit
  48         # result as negation of just the lower 32-bits, so we don't
  49         # need to do anything special before negating
  50         abs_dor = Signal(64, reset_less=True) # absolute of divisor
  51         abs_dend = Signal(64, reset_less=True) # absolute of dividend
  52         comb += abs_dor.eq(Mux(divisor_neg_o, -b, b))
  53         comb += abs_dend.eq(Mux(dividend_neg_o, -a, a))
  54
  55         # check for absolute overflow condition (32/64)
  56         comb += self.o.dive_abs_ov64.eq((abs_dend >= abs_dor)
  57                                         & (op.insn_type == InternalOp.OP_DIVE))
  58
  59         comb += self.o.dive_abs_ov32.eq((abs_dend[0:32] >= abs_dor[0:32])
  60                                         & (op.insn_type == InternalOp.OP_DIVE))
  61
  62         # set divisor based on 32/64 bit mode (must be absolute)
  63         comb += eq32(op.is_32bit, divisor_o, abs_dor)
  64
  65         # divide by zero error detection
  66         comb += self.o.div_by_zero.eq(divisor_o == 0)
  67
  68         ##########################
  69         # main switch for DIV
  70
  71         with m.Switch(op.insn_type):
  72             # div/mod takes straight (absolute) dividend
  73             with m.Case(InternalOp.OP_DIV, InternalOp.OP_MOD):
  74                 comb += eq32(op.is_32bit, dividend_o, abs_dend)
  75             # extended div shifts dividend up
  76             with m.Case(InternalOp.OP_DIVE):
  77                 with m.If(op.is_32bit):
  78                     comb += dividend_o.eq(abs_dend[0:32] << 32)
  79                 with m.Else():
  80                     comb += dividend_o.eq(abs_dend[0:64] << 64)
  81
  82         ###### sticky overflow and context, both pass-through #####
  83
  84         comb += self.o.xer_so.eq(self.i.xer_so)
  85         comb += self.o.ctx.eq(self.i.ctx)
  86
  87         return m