2016-09-14 00:30:09 +02:00
|
|
|
// See LICENSE for license details.
|
|
|
|
|
2016-09-28 06:27:07 +02:00
|
|
|
package util
|
2016-09-14 00:30:09 +02:00
|
|
|
import Chisel._
|
|
|
|
|
|
|
|
object GrayCounter {
|
2016-10-09 05:25:19 +02:00
|
|
|
def apply(bits: Int, increment: Bool = Bool(true), clear: Bool = Bool(false), name: String = "binary"): UInt = {
|
2016-09-26 20:08:38 +02:00
|
|
|
val incremented = Wire(UInt(width=bits))
|
2016-10-09 05:25:19 +02:00
|
|
|
val binary = AsyncResetReg(incremented, name)
|
2016-10-07 07:31:42 +02:00
|
|
|
incremented := Mux(clear, UInt(0), binary + increment.asUInt())
|
2016-09-14 00:30:09 +02:00
|
|
|
incremented ^ (incremented >> UInt(1))
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-10-09 05:31:43 +02:00
|
|
|
object UIntSyncChain {
|
2016-10-09 05:25:19 +02:00
|
|
|
def apply(in: UInt, sync: Int, name: String = "gray"): UInt = {
|
|
|
|
val syncv = List.tabulate(sync) { i =>
|
|
|
|
Module (new AsyncResetRegVec(w = in.getWidth, 0)).suggestName(s"${name}_sync_${i}")
|
|
|
|
}
|
2016-09-26 20:08:38 +02:00
|
|
|
syncv.last.io.d := in
|
|
|
|
syncv.last.io.en := Bool(true)
|
2016-09-28 06:27:07 +02:00
|
|
|
(syncv.init zip syncv.tail).foreach { case (sink, source) =>
|
2016-09-26 20:08:38 +02:00
|
|
|
sink.io.d := source.io.q
|
|
|
|
sink.io.en := Bool(true)
|
|
|
|
}
|
2016-10-05 06:02:06 +02:00
|
|
|
syncv.head.io.q
|
2016-09-14 00:30:09 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-10-15 03:05:35 +02:00
|
|
|
class AsyncValidSync(sync: Int, desc: String) extends Module {
|
|
|
|
val io = new Bundle {
|
|
|
|
val in = Bool(INPUT)
|
|
|
|
val out = Bool(OUTPUT)
|
|
|
|
}
|
|
|
|
io.out := UIntSyncChain(io.in.asUInt, sync, desc)(0)
|
|
|
|
}
|
|
|
|
|
|
|
|
class AsyncQueueSource[T <: Data](gen: T, depth: Int, sync: Int, safe: Boolean = true) extends Module {
|
2016-09-14 00:30:09 +02:00
|
|
|
val bits = log2Ceil(depth)
|
|
|
|
val io = new Bundle {
|
|
|
|
// These come from the source domain
|
2016-10-07 05:41:21 +02:00
|
|
|
val enq = Decoupled(gen).flip
|
2016-09-14 00:30:09 +02:00
|
|
|
// These cross to the sink clock domain
|
|
|
|
val ridx = UInt(INPUT, width = bits+1)
|
|
|
|
val widx = UInt(OUTPUT, width = bits+1)
|
|
|
|
val mem = Vec(depth, gen).asOutput
|
2016-10-15 03:05:35 +02:00
|
|
|
// Signals used to self-stabilize a safe AsyncQueue
|
|
|
|
val sink_reset_n = Bool(INPUT)
|
|
|
|
val ridx_valid = Bool(INPUT)
|
|
|
|
val widx_valid = Bool(OUTPUT)
|
2016-09-14 00:30:09 +02:00
|
|
|
}
|
|
|
|
|
2016-10-15 03:05:35 +02:00
|
|
|
val sink_ready = Wire(init = Bool(true))
|
|
|
|
val mem = Reg(Vec(depth, gen)) // This does NOT need to be reset at all.
|
|
|
|
val widx = GrayCounter(bits+1, io.enq.fire(), !sink_ready, "widx_bin")
|
2016-10-09 05:31:43 +02:00
|
|
|
val ridx = UIntSyncChain(io.ridx, sync, "ridx_gray")
|
2016-09-14 00:30:09 +02:00
|
|
|
val ready = widx =/= (ridx ^ UInt(depth | depth >> 1))
|
|
|
|
|
|
|
|
val index = if (depth == 1) UInt(0) else io.widx(bits-1, 0) ^ (io.widx(bits, bits) << (bits-1))
|
2016-10-07 05:42:51 +02:00
|
|
|
when (io.enq.fire()) { mem(index) := io.enq.bits }
|
2016-10-07 05:27:34 +02:00
|
|
|
|
2016-10-09 05:32:08 +02:00
|
|
|
val ready_reg = AsyncResetReg(ready.asUInt, "ready_reg")(0)
|
2016-10-15 03:05:35 +02:00
|
|
|
io.enq.ready := ready_reg && sink_ready
|
2016-09-26 20:08:38 +02:00
|
|
|
|
2016-10-09 05:25:19 +02:00
|
|
|
val widx_reg = AsyncResetReg(widx, "widx_gray")
|
2016-09-26 20:08:38 +02:00
|
|
|
io.widx := widx_reg
|
|
|
|
|
2016-09-14 00:30:09 +02:00
|
|
|
io.mem := mem
|
2016-10-07 07:41:27 +02:00
|
|
|
|
2016-10-15 03:05:35 +02:00
|
|
|
io.widx_valid := Bool(true)
|
|
|
|
if (safe) {
|
|
|
|
val source_valid = Module(new AsyncValidSync(sync+1, "source_valid"))
|
|
|
|
val sink_extend = Module(new AsyncValidSync(1, "sink_extend"))
|
|
|
|
val sink_valid = Module(new AsyncValidSync(sync, "sink_valid"))
|
|
|
|
source_valid.reset := reset || !io.sink_reset_n
|
|
|
|
sink_extend .reset := reset || !io.sink_reset_n
|
|
|
|
|
|
|
|
source_valid.io.in := Bool(true)
|
|
|
|
io.widx_valid := source_valid.io.out
|
|
|
|
sink_extend.io.in := io.ridx_valid
|
|
|
|
sink_valid.io.in := sink_extend.io.out
|
|
|
|
sink_ready := sink_valid.io.out
|
|
|
|
|
|
|
|
assert (io.sink_reset_n || !sink_ready || !io.enq.valid, "Enque while sink is reset and AsyncQueueSource is unprotected")
|
|
|
|
assert (io.sink_reset_n || widx === ridx, "Sink reset while AsyncQueueSource not empty")
|
|
|
|
}
|
2016-09-14 00:30:09 +02:00
|
|
|
}
|
|
|
|
|
2016-10-15 03:05:35 +02:00
|
|
|
class AsyncQueueSink[T <: Data](gen: T, depth: Int, sync: Int, safe: Boolean = true) extends Module {
|
2016-09-14 00:30:09 +02:00
|
|
|
val bits = log2Ceil(depth)
|
|
|
|
val io = new Bundle {
|
|
|
|
// These come from the sink domain
|
|
|
|
val deq = Decoupled(gen)
|
|
|
|
// These cross to the source clock domain
|
|
|
|
val ridx = UInt(OUTPUT, width = bits+1)
|
|
|
|
val widx = UInt(INPUT, width = bits+1)
|
|
|
|
val mem = Vec(depth, gen).asInput
|
2016-10-15 03:05:35 +02:00
|
|
|
// Signals used to self-stabilize a safe AsyncQueue
|
|
|
|
val source_reset_n = Bool(INPUT)
|
|
|
|
val ridx_valid = Bool(OUTPUT)
|
|
|
|
val widx_valid = Bool(INPUT)
|
2016-09-14 00:30:09 +02:00
|
|
|
}
|
|
|
|
|
2016-10-15 03:05:35 +02:00
|
|
|
val source_ready = Wire(init = Bool(true))
|
|
|
|
val ridx = GrayCounter(bits+1, io.deq.fire(), !source_ready, "ridx_bin")
|
2016-10-09 05:31:43 +02:00
|
|
|
val widx = UIntSyncChain(io.widx, sync, "widx_gray")
|
2016-09-14 00:30:09 +02:00
|
|
|
val valid = ridx =/= widx
|
|
|
|
|
|
|
|
// The mux is safe because timing analysis ensures ridx has reached the register
|
|
|
|
// On an ASIC, changes to the unread location cannot affect the selected value
|
|
|
|
// On an FPGA, only one input changes at a time => mem updates don't cause glitches
|
|
|
|
// The register only latches when the selected valued is not being written
|
|
|
|
val index = if (depth == 1) UInt(0) else ridx(bits-1, 0) ^ (ridx(bits, bits) << (bits-1))
|
2016-09-26 20:08:38 +02:00
|
|
|
// This register does not NEED to be reset, as its contents will not
|
|
|
|
// be considered unless the asynchronously reset deq valid register is set.
|
2016-10-07 23:21:09 +02:00
|
|
|
// It is possible that bits latches when the source domain is reset / has power cut
|
|
|
|
// This is safe, because isolation gates brought mem low before the zeroed widx reached us
|
2016-10-07 07:31:42 +02:00
|
|
|
io.deq.bits := RegEnable(io.mem(index), valid)
|
|
|
|
|
2016-10-09 05:25:19 +02:00
|
|
|
val valid_reg = AsyncResetReg(valid.asUInt, "valid_reg")(0)
|
2016-10-15 03:05:35 +02:00
|
|
|
io.deq.valid := valid_reg && source_ready
|
2016-09-26 20:08:38 +02:00
|
|
|
|
2016-10-09 05:25:19 +02:00
|
|
|
val ridx_reg = AsyncResetReg(ridx, "ridx_gray")
|
2016-10-07 07:31:42 +02:00
|
|
|
io.ridx := ridx_reg
|
2016-10-07 07:41:27 +02:00
|
|
|
|
2016-10-15 03:05:35 +02:00
|
|
|
io.ridx_valid := Bool(true)
|
|
|
|
if (safe) {
|
|
|
|
val sink_valid = Module(new AsyncValidSync(sync+1, "sink_valid"))
|
|
|
|
val source_extend = Module(new AsyncValidSync(1, "source_extend"))
|
|
|
|
val source_valid = Module(new AsyncValidSync(sync, "source_valid"))
|
|
|
|
sink_valid .reset := reset || !io.source_reset_n
|
|
|
|
source_extend.reset := reset || !io.source_reset_n
|
|
|
|
|
|
|
|
sink_valid.io.in := Bool(true)
|
|
|
|
io.ridx_valid := sink_valid.io.out
|
|
|
|
source_extend.io.in := io.widx_valid
|
|
|
|
source_valid.io.in := source_extend.io.out
|
|
|
|
source_ready := source_valid.io.out
|
|
|
|
|
|
|
|
assert (io.source_reset_n || widx === ridx, "Source reset while AsyncQueueSink not empty")
|
|
|
|
}
|
2016-09-14 00:30:09 +02:00
|
|
|
}
|
|
|
|
|
2016-10-15 03:05:35 +02:00
|
|
|
class AsyncQueue[T <: Data](gen: T, depth: Int = 8, sync: Int = 3, safe: Boolean = true) extends Crossing[T] {
|
2016-09-14 00:30:09 +02:00
|
|
|
require (sync >= 2)
|
|
|
|
require (depth > 0 && isPow2(depth))
|
|
|
|
|
|
|
|
val io = new CrossingIO(gen)
|
2016-10-15 03:05:35 +02:00
|
|
|
val source = Module(new AsyncQueueSource(gen, depth, sync, safe))
|
|
|
|
val sink = Module(new AsyncQueueSink (gen, depth, sync, safe))
|
2016-09-30 02:12:13 +02:00
|
|
|
|
|
|
|
source.clock := io.enq_clock
|
|
|
|
source.reset := io.enq_reset
|
|
|
|
sink.clock := io.deq_clock
|
|
|
|
sink.reset := io.deq_reset
|
2016-09-14 00:30:09 +02:00
|
|
|
|
2016-10-07 05:27:34 +02:00
|
|
|
source.io.sink_reset_n := !io.deq_reset
|
|
|
|
sink.io.source_reset_n := !io.enq_reset
|
|
|
|
|
2016-09-14 00:30:09 +02:00
|
|
|
source.io.enq <> io.enq
|
|
|
|
io.deq <> sink.io.deq
|
|
|
|
|
|
|
|
sink.io.mem := source.io.mem
|
|
|
|
sink.io.widx := source.io.widx
|
|
|
|
source.io.ridx := sink.io.ridx
|
2016-10-15 03:05:35 +02:00
|
|
|
sink.io.widx_valid := source.io.widx_valid
|
|
|
|
source.io.ridx_valid := sink.io.ridx_valid
|
2016-09-14 00:30:09 +02:00
|
|
|
}
|