|
| 1 | +from migen.fhdl.structure import * |
| 2 | +from migen.bus import dfi |
| 3 | +from migen.bank.description import * |
| 4 | +from migen.bank import csrgen |
| 5 | + |
| 6 | +def _data_en(trigger, output, delay, duration): |
| 7 | + dcounter = Signal(BV(4)) |
| 8 | + dce = Signal() |
| 9 | + return [ |
| 10 | + If(trigger, |
| 11 | + dcounter.eq(delay), |
| 12 | + dce.eq(1) |
| 13 | + ).Elif(dce, |
| 14 | + dcounter.eq(dcounter - 1), |
| 15 | + If(dcounter == 0, |
| 16 | + If(~output, |
| 17 | + output.eq(1), |
| 18 | + dcounter.eq(duration) |
| 19 | + ).Else( |
| 20 | + output.eq(0), |
| 21 | + dce.eq(0) |
| 22 | + ) |
| 23 | + ) |
| 24 | + ) |
| 25 | + ] |
| 26 | + |
| 27 | +class DFIInjector: |
| 28 | + def __init__(self, csr_address, a, ba, d, nphases=1): |
| 29 | + self._int = dfi.Interface(a, ba, d, nphases) |
| 30 | + self.slave = dfi.Interface(a, ba, d, nphases) |
| 31 | + self.master = dfi.Interface(a, ba, d, nphases) |
| 32 | + |
| 33 | + self._sel = Field("sel") |
| 34 | + self._cke = Field("cke") |
| 35 | + self._control = RegisterFields("control", [self._sel, self._cke]) |
| 36 | + |
| 37 | + self._cs = Field("cs", 1, WRITE_ONLY, READ_ONLY) |
| 38 | + self._we = Field("we", 1, WRITE_ONLY, READ_ONLY) |
| 39 | + self._cas = Field("cas", 1, WRITE_ONLY, READ_ONLY) |
| 40 | + self._ras = Field("ras", 1, WRITE_ONLY, READ_ONLY) |
| 41 | + self._rddata = Field("rddata", 1, WRITE_ONLY, READ_ONLY) |
| 42 | + self._wrdata = Field("wrdata", 1, WRITE_ONLY, READ_ONLY) |
| 43 | + self._command = RegisterFields("command", |
| 44 | + [self._cs, self._we, self._cas, self._ras, self._rddata, self._wrdata]) |
| 45 | + |
| 46 | + self._address = RegisterField("address", a) |
| 47 | + self._baddress = RegisterField("baddress", ba) |
| 48 | + |
| 49 | + self._rddelay = RegisterField("rddelay", 4, reset=5) |
| 50 | + self._rdduration = RegisterField("rdduration", 3, reset=0) |
| 51 | + self._wrdelay = RegisterField("wrdelay", 4, reset=3) |
| 52 | + self._wrduration = RegisterField("wrduration", 3, reset=0) |
| 53 | + |
| 54 | + self.bank = csrgen.Bank([ |
| 55 | + self._control, self._command, |
| 56 | + self._address, self._baddress, |
| 57 | + self._rddelay, self._rdduration, |
| 58 | + self._wrdelay, self._wrduration |
| 59 | + ], address=csr_address) |
| 60 | + |
| 61 | + def get_fragment(self): |
| 62 | + comb = [] |
| 63 | + sync = [] |
| 64 | + |
| 65 | + # mux |
| 66 | + connect_int = dfi.interconnect_stmts(self._int, self.master) |
| 67 | + connect_slave = dfi.interconnect_stmts(self.slave, self.master) |
| 68 | + comb.append(If(self._sel.r, *connect_slave).Else(*connect_int)) |
| 69 | + |
| 70 | + # phases |
| 71 | + rddata_en = Signal() |
| 72 | + wrdata_en = Signal() |
| 73 | + for phase in self._int.phases: |
| 74 | + comb += [ |
| 75 | + phase.cke.eq(self._cke.r), |
| 76 | + phase.rddata_en.eq(rddata_en), |
| 77 | + phase.wrdata_en.eq(wrdata_en) |
| 78 | + ] |
| 79 | + cmdphase = self._int.phases[0] |
| 80 | + for phase in self._int.phases[1:]: |
| 81 | + comb += [ |
| 82 | + phase.cs_n.eq(1), |
| 83 | + phase.we_n.eq(1), |
| 84 | + phase.cas_n.eq(1), |
| 85 | + phase.ras_n.eq(1) |
| 86 | + |
| 87 | + ] |
| 88 | + |
| 89 | + # commands |
| 90 | + comb += [ |
| 91 | + If(self._command.re, |
| 92 | + cmdphase.cs_n.eq(~self._cs.r), |
| 93 | + cmdphase.we_n.eq(~self._we.r), |
| 94 | + cmdphase.cas_n.eq(~self._cas.r), |
| 95 | + cmdphase.ras_n.eq(~self._ras.r) |
| 96 | + ).Else( |
| 97 | + cmdphase.cs_n.eq(1), |
| 98 | + cmdphase.we_n.eq(1), |
| 99 | + cmdphase.cas_n.eq(1), |
| 100 | + cmdphase.ras_n.eq(1) |
| 101 | + ) |
| 102 | + ] |
| 103 | + |
| 104 | + # data enables |
| 105 | + sync += _data_en(self._command.re & self._rddata.r, |
| 106 | + rddata_en, |
| 107 | + self._rddelay.field.r, self._rdduration.field.r) |
| 108 | + sync += _data_en(self._command.re & self._wrdata.r, |
| 109 | + wrdata_en, |
| 110 | + self._wrdelay.field.r, self._wrduration.field.r) |
| 111 | + |
| 112 | + return Fragment(comb, sync) + self.bank.get_fragment() |
0 commit comments