xref: /XiangShan/src/main/scala/xiangshan/mem/sbuffer/Sbuffer.scala (revision 3e11bedfaba6696e681b4756510c0934bf46c40f)
1ad3ba452Szhanglinjuan/***************************************************************************************
2ad3ba452Szhanglinjuan* Copyright (c) 2020-2021 Institute of Computing Technology, Chinese Academy of Sciences
3ad3ba452Szhanglinjuan* Copyright (c) 2020-2021 Peng Cheng Laboratory
4ad3ba452Szhanglinjuan*
5ad3ba452Szhanglinjuan* XiangShan is licensed under Mulan PSL v2.
6ad3ba452Szhanglinjuan* You can use this software according to the terms and conditions of the Mulan PSL v2.
7ad3ba452Szhanglinjuan* You may obtain a copy of Mulan PSL v2 at:
8ad3ba452Szhanglinjuan*          http://license.coscl.org.cn/MulanPSL2
9ad3ba452Szhanglinjuan*
10ad3ba452Szhanglinjuan* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
11ad3ba452Szhanglinjuan* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
12ad3ba452Szhanglinjuan* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
13ad3ba452Szhanglinjuan*
14ad3ba452Szhanglinjuan* See the Mulan PSL v2 for more details.
15ad3ba452Szhanglinjuan***************************************************************************************/
16ad3ba452Szhanglinjuan
17ad3ba452Szhanglinjuanpackage xiangshan.mem
18ad3ba452Szhanglinjuan
198891a219SYinan Xuimport org.chipsalliance.cde.config.Parameters
20ad3ba452Szhanglinjuanimport chisel3._
21ad3ba452Szhanglinjuanimport chisel3.util._
22ad3ba452Szhanglinjuanimport xiangshan._
23ad3ba452Szhanglinjuanimport utils._
243c02ee8fSwakafaimport utility._
25ad3ba452Szhanglinjuanimport xiangshan.cache._
269ae95edaSAnzoooooimport xiangshan.mem._
279ae95edaSAnzoooooimport xiangshan.backend.Bundles.DynInst
28ad3ba452Szhanglinjuanimport difftest._
2974ea8036SJeniusimport freechips.rocketchip.util._
309ae95edaSAnzoooooimport xiangshan.backend.fu.FuType._
31ad3ba452Szhanglinjuan
32ad3ba452Szhanglinjuanclass SbufferFlushBundle extends Bundle {
33ad3ba452Szhanglinjuan  val valid = Output(Bool())
34ad3ba452Szhanglinjuan  val empty = Input(Bool())
35ad3ba452Szhanglinjuan}
36ad3ba452Szhanglinjuan
37ad3ba452Szhanglinjuantrait HasSbufferConst extends HasXSParameter {
38ad3ba452Szhanglinjuan  val EvictCycles = 1 << 20
39ad3ba452Szhanglinjuan  val SbufferReplayDelayCycles = 16
40ad3ba452Szhanglinjuan  require(isPow2(EvictCycles))
41ad3ba452Szhanglinjuan  val EvictCountBits = log2Up(EvictCycles+1)
42ad3ba452Szhanglinjuan  val MissqReplayCountBits = log2Up(SbufferReplayDelayCycles) + 1
43ad3ba452Szhanglinjuan
448b1251e1SWilliam Wang  // dcache write hit resp has 2 sources
45ffd3154dSCharlieLiu  // refill pipe resp and main pipe resp (fixed:only main pipe resp)
46ffd3154dSCharlieLiu  // val NumDcacheWriteResp = 2 // hardcoded
47ffd3154dSCharlieLiu  val NumDcacheWriteResp = 1 // hardcoded
488b1251e1SWilliam Wang
49ad3ba452Szhanglinjuan  val SbufferIndexWidth: Int = log2Up(StoreBufferSize)
50ad3ba452Szhanglinjuan  // paddr = ptag + offset
51ad3ba452Szhanglinjuan  val CacheLineBytes: Int = CacheLineSize / 8
52ad3ba452Szhanglinjuan  val CacheLineWords: Int = CacheLineBytes / DataBytes
53ad3ba452Szhanglinjuan  val OffsetWidth: Int = log2Up(CacheLineBytes)
54ad3ba452Szhanglinjuan  val WordsWidth: Int = log2Up(CacheLineWords)
55ad3ba452Szhanglinjuan  val PTagWidth: Int = PAddrBits - OffsetWidth
56ad3ba452Szhanglinjuan  val VTagWidth: Int = VAddrBits - OffsetWidth
57ad3ba452Szhanglinjuan  val WordOffsetWidth: Int = PAddrBits - WordsWidth
58cdbff57cSHaoyuan Feng
59cdbff57cSHaoyuan Feng  val CacheLineVWords: Int = CacheLineBytes / VDataBytes
60cdbff57cSHaoyuan Feng  val VWordsWidth: Int = log2Up(CacheLineVWords)
61cdbff57cSHaoyuan Feng  val VWordWidth: Int = log2Up(VDataBytes)
62cdbff57cSHaoyuan Feng  val VWordOffsetWidth: Int = PAddrBits - VWordWidth
63ad3ba452Szhanglinjuan}
64ad3ba452Szhanglinjuan
65ad3ba452Szhanglinjuanclass SbufferEntryState (implicit p: Parameters) extends SbufferBundle {
66ad3ba452Szhanglinjuan  val state_valid    = Bool() // this entry is active
67ad3ba452Szhanglinjuan  val state_inflight = Bool() // sbuffer is trying to write this entry to dcache
68a98b054bSWilliam Wang  val w_timeout = Bool() // with timeout resp, waiting for resend store pipeline req timeout
69a98b054bSWilliam Wang  val w_sameblock_inflight = Bool() // same cache block dcache req is inflight
70ad3ba452Szhanglinjuan
71ad3ba452Szhanglinjuan  def isInvalid(): Bool = !state_valid
72ad3ba452Szhanglinjuan  def isValid(): Bool = state_valid
73ad3ba452Szhanglinjuan  def isActive(): Bool = state_valid && !state_inflight
74ad3ba452Szhanglinjuan  def isInflight(): Bool = state_inflight
75a98b054bSWilliam Wang  def isDcacheReqCandidate(): Bool = state_valid && !state_inflight && !w_sameblock_inflight
76ad3ba452Szhanglinjuan}
77ad3ba452Szhanglinjuan
78ad3ba452Szhanglinjuanclass SbufferBundle(implicit p: Parameters) extends XSBundle with HasSbufferConst
79ad3ba452Szhanglinjuan
80ad3ba452Szhanglinjuanclass DataWriteReq(implicit p: Parameters) extends SbufferBundle {
813d3419b9SWilliam Wang  // univerisal writemask
8267c26c34SWilliam Wang  val wvec = UInt(StoreBufferSize.W)
833d3419b9SWilliam Wang  // 2 cycle update
84cdbff57cSHaoyuan Feng  val mask = UInt((VLEN/8).W)
85cdbff57cSHaoyuan Feng  val data = UInt(VLEN.W)
86cdbff57cSHaoyuan Feng  val vwordOffset = UInt(VWordOffsetWidth.W)
878b1251e1SWilliam Wang  val wline = Bool() // write full cacheline
888b1251e1SWilliam Wang}
898b1251e1SWilliam Wang
908b1251e1SWilliam Wangclass MaskFlushReq(implicit p: Parameters) extends SbufferBundle {
918b1251e1SWilliam Wang  // univerisal writemask
928b1251e1SWilliam Wang  val wvec = UInt(StoreBufferSize.W)
93ad3ba452Szhanglinjuan}
94ad3ba452Szhanglinjuan
95ad3ba452Szhanglinjuanclass SbufferData(implicit p: Parameters) extends XSModule with HasSbufferConst {
96ad3ba452Szhanglinjuan  val io = IO(new Bundle(){
978b1251e1SWilliam Wang    // update data and mask when alloc or merge
9846f74b57SHaojin Tang    val writeReq = Vec(EnsbufferWidth, Flipped(ValidIO(new DataWriteReq)))
998b1251e1SWilliam Wang    // clean mask when deq
1008b1251e1SWilliam Wang    val maskFlushReq = Vec(NumDcacheWriteResp, Flipped(ValidIO(new MaskFlushReq)))
101cdbff57cSHaoyuan Feng    val dataOut = Output(Vec(StoreBufferSize, Vec(CacheLineVWords, Vec(VDataBytes, UInt(8.W)))))
102cdbff57cSHaoyuan Feng    val maskOut = Output(Vec(StoreBufferSize, Vec(CacheLineVWords, Vec(VDataBytes, Bool()))))
103ad3ba452Szhanglinjuan  })
104ad3ba452Szhanglinjuan
105cdbff57cSHaoyuan Feng  val data = Reg(Vec(StoreBufferSize, Vec(CacheLineVWords, Vec(VDataBytes, UInt(8.W)))))
1068b1251e1SWilliam Wang  // val mask = Reg(Vec(StoreBufferSize, Vec(CacheLineWords, Vec(DataBytes, Bool()))))
1078b1251e1SWilliam Wang  val mask = RegInit(
1088b1251e1SWilliam Wang    VecInit(Seq.fill(StoreBufferSize)(
109cdbff57cSHaoyuan Feng      VecInit(Seq.fill(CacheLineVWords)(
110cdbff57cSHaoyuan Feng        VecInit(Seq.fill(VDataBytes)(false.B))
1118b1251e1SWilliam Wang      ))
1128b1251e1SWilliam Wang    ))
1138b1251e1SWilliam Wang  )
1148b1251e1SWilliam Wang
1158b1251e1SWilliam Wang  // 2 cycle line mask clean
1168b1251e1SWilliam Wang  for(line <- 0 until StoreBufferSize){
1178b1251e1SWilliam Wang    val line_mask_clean_flag = RegNext(
1188b1251e1SWilliam Wang      io.maskFlushReq.map(a => a.valid && a.bits.wvec(line)).reduce(_ || _)
1198b1251e1SWilliam Wang    )
1208b1251e1SWilliam Wang    line_mask_clean_flag.suggestName("line_mask_clean_flag_"+line)
1218b1251e1SWilliam Wang    when(line_mask_clean_flag){
122cdbff57cSHaoyuan Feng      for(word <- 0 until CacheLineVWords){
123cdbff57cSHaoyuan Feng        for(byte <- 0 until VDataBytes){
1248b1251e1SWilliam Wang          mask(line)(word)(byte) := false.B
1258b1251e1SWilliam Wang        }
1268b1251e1SWilliam Wang      }
1278b1251e1SWilliam Wang    }
1288b1251e1SWilliam Wang  }
129ad3ba452Szhanglinjuan
1303d3419b9SWilliam Wang  // 2 cycle data / mask update
13146f74b57SHaojin Tang  for(i <- 0 until EnsbufferWidth) {
1323d3419b9SWilliam Wang    val req = io.writeReq(i)
13367c26c34SWilliam Wang    for(line <- 0 until StoreBufferSize){
1343d3419b9SWilliam Wang      val sbuffer_in_s1_line_wen = req.valid && req.bits.wvec(line)
1353d3419b9SWilliam Wang      val sbuffer_in_s2_line_wen = RegNext(sbuffer_in_s1_line_wen)
1363d3419b9SWilliam Wang      val line_write_buffer_data = RegEnable(req.bits.data, sbuffer_in_s1_line_wen)
1373d3419b9SWilliam Wang      val line_write_buffer_wline = RegEnable(req.bits.wline, sbuffer_in_s1_line_wen)
1383d3419b9SWilliam Wang      val line_write_buffer_mask = RegEnable(req.bits.mask, sbuffer_in_s1_line_wen)
139cdbff57cSHaoyuan Feng      val line_write_buffer_offset = RegEnable(req.bits.vwordOffset(VWordsWidth-1, 0), sbuffer_in_s1_line_wen)
1403d3419b9SWilliam Wang      sbuffer_in_s1_line_wen.suggestName("sbuffer_in_s1_line_wen_"+line)
1413d3419b9SWilliam Wang      sbuffer_in_s2_line_wen.suggestName("sbuffer_in_s2_line_wen_"+line)
1423d3419b9SWilliam Wang      line_write_buffer_data.suggestName("line_write_buffer_data_"+line)
1433d3419b9SWilliam Wang      line_write_buffer_wline.suggestName("line_write_buffer_wline_"+line)
1443d3419b9SWilliam Wang      line_write_buffer_mask.suggestName("line_write_buffer_mask_"+line)
1453d3419b9SWilliam Wang      line_write_buffer_offset.suggestName("line_write_buffer_offset_"+line)
146cdbff57cSHaoyuan Feng      for(word <- 0 until CacheLineVWords){
147cdbff57cSHaoyuan Feng        for(byte <- 0 until VDataBytes){
1483d3419b9SWilliam Wang          val write_byte = sbuffer_in_s2_line_wen && (
1493d3419b9SWilliam Wang            line_write_buffer_mask(byte) && (line_write_buffer_offset === word.U) ||
1503d3419b9SWilliam Wang            line_write_buffer_wline
15167c26c34SWilliam Wang          )
1523d3419b9SWilliam Wang          when(write_byte){
1533d3419b9SWilliam Wang            data(line)(word)(byte) := line_write_buffer_data(byte*8+7, byte*8)
1543d3419b9SWilliam Wang            mask(line)(word)(byte) := true.B
1553d3419b9SWilliam Wang          }
1563d3419b9SWilliam Wang        }
1573d3419b9SWilliam Wang      }
1583d3419b9SWilliam Wang    }
1593d3419b9SWilliam Wang  }
1603d3419b9SWilliam Wang
1613d3419b9SWilliam Wang  // 1 cycle line mask clean
1628b1251e1SWilliam Wang  // for(i <- 0 until EnsbufferWidth) {
1638b1251e1SWilliam Wang  //   val req = io.writeReq(i)
1648b1251e1SWilliam Wang  //   when(req.valid){
1658b1251e1SWilliam Wang  //     for(line <- 0 until StoreBufferSize){
1668b1251e1SWilliam Wang  //       when(
1678b1251e1SWilliam Wang  //         req.bits.wvec(line) &&
1688b1251e1SWilliam Wang  //         req.bits.cleanMask
1698b1251e1SWilliam Wang  //       ){
1708b1251e1SWilliam Wang  //         for(word <- 0 until CacheLineWords){
1718b1251e1SWilliam Wang  //           for(byte <- 0 until DataBytes){
1728b1251e1SWilliam Wang  //             mask(line)(word)(byte) := false.B
1738b1251e1SWilliam Wang  //             val debug_last_cycle_write_byte = RegNext(req.valid && req.bits.wvec(line) && (
1748b1251e1SWilliam Wang  //               req.bits.mask(byte) && (req.bits.wordOffset(WordsWidth-1, 0) === word.U) ||
1758b1251e1SWilliam Wang  //               req.bits.wline
1768b1251e1SWilliam Wang  //             ))
1778b1251e1SWilliam Wang  //             assert(!debug_last_cycle_write_byte)
1788b1251e1SWilliam Wang  //           }
1798b1251e1SWilliam Wang  //         }
1808b1251e1SWilliam Wang  //       }
1818b1251e1SWilliam Wang  //     }
1828b1251e1SWilliam Wang  //   }
1838b1251e1SWilliam Wang  // }
184ad3ba452Szhanglinjuan
185ad3ba452Szhanglinjuan  io.dataOut := data
1863d3419b9SWilliam Wang  io.maskOut := mask
187ad3ba452Szhanglinjuan}
188ad3ba452Szhanglinjuan
1899ae95edaSAnzoooooclass Sbuffer(implicit p: Parameters)
1909ae95edaSAnzooooo  extends DCacheModule
1919ae95edaSAnzooooo    with HasSbufferConst
1929ae95edaSAnzooooo    with HasPerfEvents {
193ad3ba452Szhanglinjuan  val io = IO(new Bundle() {
194f57f7f2aSYangyu Chen    val hartId = Input(UInt(hartIdLen.W))
1950d32f713Shappy-lx    val in = Vec(EnsbufferWidth, Flipped(Decoupled(new DCacheWordReqWithVaddrAndPfFlag)))  //Todo: store logic only support Width == 2 now
1969ae95edaSAnzooooo    val vecDifftestInfo = Vec(EnsbufferWidth, Flipped(Decoupled(new DynInst)))
197ad3ba452Szhanglinjuan    val dcache = Flipped(new DCacheToSbufferIO)
198ad3ba452Szhanglinjuan    val forward = Vec(LoadPipelineWidth, Flipped(new LoadForwardQueryIO))
199ad3ba452Szhanglinjuan    val sqempty = Input(Bool())
200ad3ba452Szhanglinjuan    val flush = Flipped(new SbufferFlushBundle)
201ad3ba452Szhanglinjuan    val csrCtrl = Flipped(new CustomCSRCtrlIO)
2020d32f713Shappy-lx    val store_prefetch = Vec(StorePipelineWidth, DecoupledIO(new StorePrefetchReq)) // to dcache
2030d32f713Shappy-lx    val memSetPattenDetected = Input(Bool())
2042fdb4d6aShappy-lx    val force_write = Input(Bool())
205ad3ba452Szhanglinjuan  })
206ad3ba452Szhanglinjuan
207ad3ba452Szhanglinjuan  val dataModule = Module(new SbufferData)
208ad3ba452Szhanglinjuan  dataModule.io.writeReq <> DontCare
2090d32f713Shappy-lx  val prefetcher = Module(new StorePfWrapper())
210ad3ba452Szhanglinjuan  val writeReq = dataModule.io.writeReq
211ad3ba452Szhanglinjuan
212ad3ba452Szhanglinjuan  val ptag = Reg(Vec(StoreBufferSize, UInt(PTagWidth.W)))
213ad3ba452Szhanglinjuan  val vtag = Reg(Vec(StoreBufferSize, UInt(VTagWidth.W)))
2143d3419b9SWilliam Wang  val debug_mask = Reg(Vec(StoreBufferSize, Vec(CacheLineWords, Vec(DataBytes, Bool()))))
215a98b054bSWilliam Wang  val waitInflightMask = Reg(Vec(StoreBufferSize, UInt(StoreBufferSize.W)))
216ad3ba452Szhanglinjuan  val data = dataModule.io.dataOut
2173d3419b9SWilliam Wang  val mask = dataModule.io.maskOut
218ad3ba452Szhanglinjuan  val stateVec = RegInit(VecInit(Seq.fill(StoreBufferSize)(0.U.asTypeOf(new SbufferEntryState))))
219ad3ba452Szhanglinjuan  val cohCount = RegInit(VecInit(Seq.fill(StoreBufferSize)(0.U(EvictCountBits.W))))
220ad3ba452Szhanglinjuan  val missqReplayCount = RegInit(VecInit(Seq.fill(StoreBufferSize)(0.U(MissqReplayCountBits.W))))
221ad3ba452Szhanglinjuan
22280382c05SWilliam Wang  val sbuffer_out_s0_fire = Wire(Bool())
22396b1e495SWilliam Wang
224ad3ba452Szhanglinjuan  /*
225ad3ba452Szhanglinjuan       idle --[flush]   --> drain   --[buf empty]--> idle
226ad3ba452Szhanglinjuan            --[buf full]--> replace --[dcache resp]--> idle
227ad3ba452Szhanglinjuan  */
228ad3ba452Szhanglinjuan  // x_drain_all: drain store queue and sbuffer
229ad3ba452Szhanglinjuan  // x_drain_sbuffer: drain sbuffer only, block store queue to sbuffer write
230ad3ba452Szhanglinjuan  val x_idle :: x_replace :: x_drain_all :: x_drain_sbuffer :: Nil = Enum(4)
231ad3ba452Szhanglinjuan  def needDrain(state: UInt): Bool =
232ad3ba452Szhanglinjuan    state(1)
233ad3ba452Szhanglinjuan  val sbuffer_state = RegInit(x_idle)
234ad3ba452Szhanglinjuan
235ad3ba452Szhanglinjuan  // ---------------------- Store Enq Sbuffer ---------------------
236ad3ba452Szhanglinjuan
237ad3ba452Szhanglinjuan  def getPTag(pa: UInt): UInt =
238ad3ba452Szhanglinjuan    pa(PAddrBits - 1, PAddrBits - PTagWidth)
239ad3ba452Szhanglinjuan
240ad3ba452Szhanglinjuan  def getVTag(va: UInt): UInt =
241ad3ba452Szhanglinjuan    va(VAddrBits - 1, VAddrBits - VTagWidth)
242ad3ba452Szhanglinjuan
243ad3ba452Szhanglinjuan  def getWord(pa: UInt): UInt =
244ad3ba452Szhanglinjuan    pa(PAddrBits-1, 3)
245ad3ba452Szhanglinjuan
246cdbff57cSHaoyuan Feng  def getVWord(pa: UInt): UInt =
247cdbff57cSHaoyuan Feng    pa(PAddrBits-1, 4)
248cdbff57cSHaoyuan Feng
249ad3ba452Szhanglinjuan  def getWordOffset(pa: UInt): UInt =
250ad3ba452Szhanglinjuan    pa(OffsetWidth-1, 3)
251ad3ba452Szhanglinjuan
252cdbff57cSHaoyuan Feng  def getVWordOffset(pa: UInt): UInt =
253cdbff57cSHaoyuan Feng    pa(OffsetWidth-1, 4)
254cdbff57cSHaoyuan Feng
255ad3ba452Szhanglinjuan  def getAddr(ptag: UInt): UInt =
256ad3ba452Szhanglinjuan    Cat(ptag, 0.U((PAddrBits - PTagWidth).W))
257ad3ba452Szhanglinjuan
258ad3ba452Szhanglinjuan  def getByteOffset(offect: UInt): UInt =
259ad3ba452Szhanglinjuan    Cat(offect(OffsetWidth - 1, 3), 0.U(3.W))
260ad3ba452Szhanglinjuan
261ad3ba452Szhanglinjuan  def isOneOf(key: UInt, seq: Seq[UInt]): Bool =
262935edac4STang Haojin    if(seq.isEmpty) false.B else Cat(seq.map(_===key)).orR
263ad3ba452Szhanglinjuan
264ad3ba452Szhanglinjuan  def widthMap[T <: Data](f: Int => T) = (0 until StoreBufferSize) map f
265ad3ba452Szhanglinjuan
266ad3ba452Szhanglinjuan  // sbuffer entry count
267ad3ba452Szhanglinjuan
2682fdb4d6aShappy-lx  val plru = new ValidPseudoLRU(StoreBufferSize)
26946f74b57SHaojin Tang  val accessIdx = Wire(Vec(EnsbufferWidth + 1, Valid(UInt(SbufferIndexWidth.W))))
270ad3ba452Szhanglinjuan
271d2b20d1aSTang Haojin  val candidateVec = VecInit(stateVec.map(s => s.isDcacheReqCandidate()))
272d2b20d1aSTang Haojin
2732fdb4d6aShappy-lx  val replaceAlgoIdx = plru.way(candidateVec.reverse)._2
274d2b20d1aSTang Haojin  val replaceAlgoNotDcacheCandidate = !stateVec(replaceAlgoIdx).isDcacheReqCandidate()
275d2b20d1aSTang Haojin
276935edac4STang Haojin  assert(!(candidateVec.asUInt.orR && replaceAlgoNotDcacheCandidate), "we have way to select, but replace algo selects invalid way")
2772fdb4d6aShappy-lx
2782fdb4d6aShappy-lx  val replaceIdx = replaceAlgoIdx
279ad3ba452Szhanglinjuan  plru.access(accessIdx)
280ad3ba452Szhanglinjuan
281ad3ba452Szhanglinjuan  //-------------------------cohCount-----------------------------
282ad3ba452Szhanglinjuan  // insert and merge: cohCount=0
283ad3ba452Szhanglinjuan  // every cycle cohCount+=1
284ad3ba452Szhanglinjuan  // if cohCount(EvictCountBits-1)==1, evict
285ad3ba452Szhanglinjuan  val cohTimeOutMask = VecInit(widthMap(i => cohCount(i)(EvictCountBits - 1) && stateVec(i).isActive()))
286ad3ba452Szhanglinjuan  val (cohTimeOutIdx, cohHasTimeOut) = PriorityEncoderWithFlag(cohTimeOutMask)
287779faf12SWilliam Wang  val cohTimeOutOH = PriorityEncoderOH(cohTimeOutMask)
288ad3ba452Szhanglinjuan  val missqReplayTimeOutMask = VecInit(widthMap(i => missqReplayCount(i)(MissqReplayCountBits - 1) && stateVec(i).w_timeout))
289779faf12SWilliam Wang  val (missqReplayTimeOutIdxGen, missqReplayHasTimeOutGen) = PriorityEncoderWithFlag(missqReplayTimeOutMask)
290779faf12SWilliam Wang  val missqReplayHasTimeOut = RegNext(missqReplayHasTimeOutGen) && !RegNext(sbuffer_out_s0_fire)
291779faf12SWilliam Wang  val missqReplayTimeOutIdx = RegEnable(missqReplayTimeOutIdxGen, missqReplayHasTimeOutGen)
292ad3ba452Szhanglinjuan
2933d3419b9SWilliam Wang  //-------------------------sbuffer enqueue-----------------------------
2943d3419b9SWilliam Wang
2953d3419b9SWilliam Wang  // Now sbuffer enq logic is divided into 3 stages:
2963d3419b9SWilliam Wang
2973d3419b9SWilliam Wang  // sbuffer_in_s0:
2983d3419b9SWilliam Wang  // * read data and meta from store queue
2993d3419b9SWilliam Wang  // * store them in 2 entry fifo queue
3003d3419b9SWilliam Wang
3013d3419b9SWilliam Wang  // sbuffer_in_s1:
3023d3419b9SWilliam Wang  // * read data and meta from fifo queue
3033d3419b9SWilliam Wang  // * update sbuffer meta (vtag, ptag, flag)
3043d3419b9SWilliam Wang  // * prevert that line from being sent to dcache (add a block condition)
3053d3419b9SWilliam Wang  // * prepare cacheline level write enable signal, RegNext() data and mask
3063d3419b9SWilliam Wang
3073d3419b9SWilliam Wang  // sbuffer_in_s2:
3083d3419b9SWilliam Wang  // * use cacheline level buffer to update sbuffer data and mask
3093d3419b9SWilliam Wang  // * remove dcache write block (if there is)
3103d3419b9SWilliam Wang
311ad3ba452Szhanglinjuan  val activeMask = VecInit(stateVec.map(s => s.isActive()))
312d2b20d1aSTang Haojin  val validMask  = VecInit(stateVec.map(s => s.isValid()))
313ad3ba452Szhanglinjuan  val drainIdx = PriorityEncoder(activeMask)
314ad3ba452Szhanglinjuan
315ad3ba452Szhanglinjuan  val inflightMask = VecInit(stateVec.map(s => s.isInflight()))
316ad3ba452Szhanglinjuan
317ad3ba452Szhanglinjuan  val inptags = io.in.map(in => getPTag(in.bits.addr))
318ad3ba452Szhanglinjuan  val invtags = io.in.map(in => getVTag(in.bits.vaddr))
319db7f55d9SWilliam Wang  val sameTag = inptags(0) === inptags(1)
320cdbff57cSHaoyuan Feng  val firstWord = getVWord(io.in(0).bits.addr)
321cdbff57cSHaoyuan Feng  val secondWord = getVWord(io.in(1).bits.addr)
322ad3ba452Szhanglinjuan  // merge condition
32346f74b57SHaojin Tang  val mergeMask = Wire(Vec(EnsbufferWidth, Vec(StoreBufferSize, Bool())))
32467c26c34SWilliam Wang  val mergeIdx = mergeMask.map(PriorityEncoder(_)) // avoid using mergeIdx for better timing
325ad3ba452Szhanglinjuan  val canMerge = mergeMask.map(ParallelOR(_))
32667c26c34SWilliam Wang  val mergeVec = mergeMask.map(_.asUInt)
327ad3ba452Szhanglinjuan
32846f74b57SHaojin Tang  for(i <- 0 until EnsbufferWidth){
329ad3ba452Szhanglinjuan    mergeMask(i) := widthMap(j =>
330ad3ba452Szhanglinjuan      inptags(i) === ptag(j) && activeMask(j)
331ad3ba452Szhanglinjuan    )
332315e1323Sgood-circle    assert(!(PopCount(mergeMask(i).asUInt) > 1.U && io.in(i).fire && io.in(i).bits.vecValid))
333ad3ba452Szhanglinjuan  }
334ad3ba452Szhanglinjuan
335ad3ba452Szhanglinjuan  // insert condition
336ad3ba452Szhanglinjuan  // firstInsert: the first invalid entry
337ad3ba452Szhanglinjuan  // if first entry canMerge or second entry has the same ptag with the first entry,
338ad3ba452Szhanglinjuan  // secondInsert equal the first invalid entry, otherwise, the second invalid entry
339ad3ba452Szhanglinjuan  val invalidMask = VecInit(stateVec.map(s => s.isInvalid()))
340db7f55d9SWilliam Wang  val evenInvalidMask = GetEvenBits(invalidMask.asUInt)
341db7f55d9SWilliam Wang  val oddInvalidMask = GetOddBits(invalidMask.asUInt)
342ad3ba452Szhanglinjuan
34367c26c34SWilliam Wang  def getFirstOneOH(input: UInt): UInt = {
34467c26c34SWilliam Wang    assert(input.getWidth > 1)
34567c26c34SWilliam Wang    val output = WireInit(VecInit(input.asBools))
34667c26c34SWilliam Wang    (1 until input.getWidth).map(i => {
34767c26c34SWilliam Wang      output(i) := !input(i - 1, 0).orR && input(i)
34867c26c34SWilliam Wang    })
34967c26c34SWilliam Wang    output.asUInt
35067c26c34SWilliam Wang  }
35167c26c34SWilliam Wang
352db7f55d9SWilliam Wang  val evenRawInsertVec = getFirstOneOH(evenInvalidMask)
353db7f55d9SWilliam Wang  val oddRawInsertVec = getFirstOneOH(oddInvalidMask)
354db7f55d9SWilliam Wang  val (evenRawInsertIdx, evenCanInsert) = PriorityEncoderWithFlag(evenInvalidMask)
355db7f55d9SWilliam Wang  val (oddRawInsertIdx, oddCanInsert) = PriorityEncoderWithFlag(oddInvalidMask)
356db7f55d9SWilliam Wang  val evenInsertIdx = Cat(evenRawInsertIdx, 0.U(1.W)) // slow to generate, for debug only
357db7f55d9SWilliam Wang  val oddInsertIdx = Cat(oddRawInsertIdx, 1.U(1.W)) // slow to generate, for debug only
358db7f55d9SWilliam Wang  val evenInsertVec = GetEvenBits.reverse(evenRawInsertVec)
359db7f55d9SWilliam Wang  val oddInsertVec = GetOddBits.reverse(oddRawInsertVec)
360ad3ba452Szhanglinjuan
361db7f55d9SWilliam Wang  val enbufferSelReg = RegInit(false.B)
362db7f55d9SWilliam Wang  when(io.in(0).valid) {
363db7f55d9SWilliam Wang    enbufferSelReg := ~enbufferSelReg
364ad3ba452Szhanglinjuan  }
365ad3ba452Szhanglinjuan
366db7f55d9SWilliam Wang  val firstInsertIdx = Mux(enbufferSelReg, evenInsertIdx, oddInsertIdx) // slow to generate, for debug only
367db7f55d9SWilliam Wang  val secondInsertIdx = Mux(sameTag,
368db7f55d9SWilliam Wang    firstInsertIdx,
369db7f55d9SWilliam Wang    Mux(~enbufferSelReg, evenInsertIdx, oddInsertIdx)
37067c26c34SWilliam Wang  ) // slow to generate, for debug only
371db7f55d9SWilliam Wang  val firstInsertVec = Mux(enbufferSelReg, evenInsertVec, oddInsertVec)
372db7f55d9SWilliam Wang  val secondInsertVec = Mux(sameTag,
373db7f55d9SWilliam Wang    firstInsertVec,
374db7f55d9SWilliam Wang    Mux(~enbufferSelReg, evenInsertVec, oddInsertVec)
37567c26c34SWilliam Wang  ) // slow to generate, for debug only
376db7f55d9SWilliam Wang  val firstCanInsert = sbuffer_state =/= x_drain_sbuffer && Mux(enbufferSelReg, evenCanInsert, oddCanInsert)
377db7f55d9SWilliam Wang  val secondCanInsert = sbuffer_state =/= x_drain_sbuffer && Mux(sameTag,
378db7f55d9SWilliam Wang    firstCanInsert,
379db7f55d9SWilliam Wang    Mux(~enbufferSelReg, evenCanInsert, oddCanInsert)
380db7f55d9SWilliam Wang  ) && (EnsbufferWidth >= 1).B
38196b1e495SWilliam Wang  val forward_need_uarch_drain = WireInit(false.B)
38296b1e495SWilliam Wang  val merge_need_uarch_drain = WireInit(false.B)
38396b1e495SWilliam Wang  val do_uarch_drain = RegNext(forward_need_uarch_drain) || RegNext(RegNext(merge_need_uarch_drain))
384ad3ba452Szhanglinjuan  XSPerfAccumulate("do_uarch_drain", do_uarch_drain)
385ad3ba452Szhanglinjuan
386db7f55d9SWilliam Wang  io.in(0).ready := firstCanInsert
38745a77344SHaoyuan Feng  io.in(1).ready := secondCanInsert && io.in(0).ready
388ad3ba452Szhanglinjuan
3890d32f713Shappy-lx  for (i <- 0 until EnsbufferWidth) {
3900d32f713Shappy-lx    // train
3910d32f713Shappy-lx    if (EnableStorePrefetchSPB) {
392315e1323Sgood-circle      prefetcher.io.sbuffer_enq(i).valid := io.in(i).fire && io.in(i).bits.vecValid
3930d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).bits := DontCare
3940d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).bits.vaddr := io.in(i).bits.vaddr
3950d32f713Shappy-lx    } else {
3960d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).valid := false.B
3970d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).bits := DontCare
3980d32f713Shappy-lx    }
3990d32f713Shappy-lx
4000d32f713Shappy-lx    // prefetch req
4010d32f713Shappy-lx    if (EnableStorePrefetchAtCommit) {
4020d32f713Shappy-lx      if (EnableAtCommitMissTrigger) {
403315e1323Sgood-circle        io.store_prefetch(i).valid := prefetcher.io.prefetch_req(i).valid || (io.in(i).fire && io.in(i).bits.vecValid && io.in(i).bits.prefetch)
4040d32f713Shappy-lx      } else {
405315e1323Sgood-circle        io.store_prefetch(i).valid := prefetcher.io.prefetch_req(i).valid || (io.in(i).fire && io.in(i).bits.vecValid)
4060d32f713Shappy-lx      }
4070d32f713Shappy-lx      io.store_prefetch(i).bits.paddr := DontCare
4080d32f713Shappy-lx      io.store_prefetch(i).bits.vaddr := Mux(prefetcher.io.prefetch_req(i).valid, prefetcher.io.prefetch_req(i).bits.vaddr, io.in(i).bits.vaddr)
4090d32f713Shappy-lx      prefetcher.io.prefetch_req(i).ready := io.store_prefetch(i).ready
4100d32f713Shappy-lx    } else {
4110d32f713Shappy-lx      io.store_prefetch(i) <> prefetcher.io.prefetch_req(i)
4120d32f713Shappy-lx    }
413202674aeSHaojin Tang    io.store_prefetch zip prefetcher.io.prefetch_req drop 2 foreach (x => x._1 <> x._2)
4140d32f713Shappy-lx  }
4150d32f713Shappy-lx  prefetcher.io.memSetPattenDetected := io.memSetPattenDetected
4160d32f713Shappy-lx
4173d3419b9SWilliam Wang  def wordReqToBufLine( // allocate a new line in sbuffer
4183d3419b9SWilliam Wang    req: DCacheWordReq,
4193d3419b9SWilliam Wang    reqptag: UInt,
4203d3419b9SWilliam Wang    reqvtag: UInt,
4213d3419b9SWilliam Wang    insertIdx: UInt,
4223d3419b9SWilliam Wang    insertVec: UInt,
4238b1251e1SWilliam Wang    wordOffset: UInt
4243d3419b9SWilliam Wang  ): Unit = {
42567c26c34SWilliam Wang    assert(UIntToOH(insertIdx) === insertVec)
426a98b054bSWilliam Wang    val sameBlockInflightMask = genSameBlockInflightMask(reqptag)
42767c26c34SWilliam Wang    (0 until StoreBufferSize).map(entryIdx => {
42867c26c34SWilliam Wang      when(insertVec(entryIdx)){
42967c26c34SWilliam Wang        stateVec(entryIdx).state_valid := true.B
43067c26c34SWilliam Wang        stateVec(entryIdx).w_sameblock_inflight := sameBlockInflightMask.orR // set w_sameblock_inflight when a line is first allocated
431a98b054bSWilliam Wang        when(sameBlockInflightMask.orR){
43267c26c34SWilliam Wang          waitInflightMask(entryIdx) := sameBlockInflightMask
433a98b054bSWilliam Wang        }
43467c26c34SWilliam Wang        cohCount(entryIdx) := 0.U
43596b1e495SWilliam Wang        // missqReplayCount(insertIdx) := 0.U
43667c26c34SWilliam Wang        ptag(entryIdx) := reqptag
437cdbff57cSHaoyuan Feng        vtag(entryIdx) := reqvtag // update vtag if a new sbuffer line is allocated
438ad3ba452Szhanglinjuan      }
43967c26c34SWilliam Wang    })
44067c26c34SWilliam Wang  }
441ad3ba452Szhanglinjuan
4423d3419b9SWilliam Wang  def mergeWordReq( // merge write req into an existing line
4433d3419b9SWilliam Wang    req: DCacheWordReq,
4443d3419b9SWilliam Wang    reqptag: UInt,
4453d3419b9SWilliam Wang    reqvtag: UInt,
4463d3419b9SWilliam Wang    mergeIdx: UInt,
4473d3419b9SWilliam Wang    mergeVec: UInt,
4483d3419b9SWilliam Wang    wordOffset: UInt
4493d3419b9SWilliam Wang  ): Unit = {
45067c26c34SWilliam Wang    assert(UIntToOH(mergeIdx) === mergeVec)
45167c26c34SWilliam Wang    (0 until StoreBufferSize).map(entryIdx => {
45267c26c34SWilliam Wang      when(mergeVec(entryIdx)) {
45367c26c34SWilliam Wang        cohCount(entryIdx) := 0.U
45467c26c34SWilliam Wang        // missqReplayCount(entryIdx) := 0.U
455ad3ba452Szhanglinjuan        // check if vtag is the same, if not, trigger sbuffer flush
45667c26c34SWilliam Wang        when(reqvtag =/= vtag(entryIdx)) {
457ad3ba452Szhanglinjuan          XSDebug("reqvtag =/= sbufvtag req(vtag %x ptag %x) sbuffer(vtag %x ptag %x)\n",
458ad3ba452Szhanglinjuan            reqvtag << OffsetWidth,
459ad3ba452Szhanglinjuan            reqptag << OffsetWidth,
46067c26c34SWilliam Wang            vtag(entryIdx) << OffsetWidth,
46167c26c34SWilliam Wang            ptag(entryIdx) << OffsetWidth
462ad3ba452Szhanglinjuan          )
46396b1e495SWilliam Wang          merge_need_uarch_drain := true.B
464ad3ba452Szhanglinjuan        }
465ad3ba452Szhanglinjuan      }
46667c26c34SWilliam Wang    })
46767c26c34SWilliam Wang  }
468ad3ba452Szhanglinjuan
469cdbff57cSHaoyuan Feng  for(((in, vwordOffset), i) <- io.in.zip(Seq(firstWord, secondWord)).zipWithIndex){
470315e1323Sgood-circle    writeReq(i).valid := in.fire && in.bits.vecValid
471cdbff57cSHaoyuan Feng    writeReq(i).bits.vwordOffset := vwordOffset
472ad3ba452Szhanglinjuan    writeReq(i).bits.mask := in.bits.mask
473ad3ba452Szhanglinjuan    writeReq(i).bits.data := in.bits.data
474ca18a0b4SWilliam Wang    writeReq(i).bits.wline := in.bits.wline
4753d3419b9SWilliam Wang    val debug_insertIdx = if(i == 0) firstInsertIdx else secondInsertIdx
4763d3419b9SWilliam Wang    val insertVec = if(i == 0) firstInsertVec else secondInsertVec
477315e1323Sgood-circle    assert(!((PopCount(insertVec) > 1.U) && in.fire && in.bits.vecValid))
47867c26c34SWilliam Wang    val insertIdx = OHToUInt(insertVec)
479315e1323Sgood-circle    accessIdx(i).valid := RegNext(in.fire && in.bits.vecValid)
480ad3ba452Szhanglinjuan    accessIdx(i).bits := RegNext(Mux(canMerge(i), mergeIdx(i), insertIdx))
481315e1323Sgood-circle    when(in.fire && in.bits.vecValid){
482ad3ba452Szhanglinjuan      when(canMerge(i)){
48367c26c34SWilliam Wang        writeReq(i).bits.wvec := mergeVec(i)
484cdbff57cSHaoyuan Feng        mergeWordReq(in.bits, inptags(i), invtags(i), mergeIdx(i), mergeVec(i), vwordOffset)
485ad3ba452Szhanglinjuan        XSDebug(p"merge req $i to line [${mergeIdx(i)}]\n")
486ad3ba452Szhanglinjuan      }.otherwise({
48767c26c34SWilliam Wang        writeReq(i).bits.wvec := insertVec
488cdbff57cSHaoyuan Feng        wordReqToBufLine(in.bits, inptags(i), invtags(i), insertIdx, insertVec, vwordOffset)
489ad3ba452Szhanglinjuan        XSDebug(p"insert req $i to line[$insertIdx]\n")
49067c26c34SWilliam Wang        assert(debug_insertIdx === insertIdx)
491ad3ba452Szhanglinjuan      })
492ad3ba452Szhanglinjuan    }
493ad3ba452Szhanglinjuan  }
494ad3ba452Szhanglinjuan
495ad3ba452Szhanglinjuan
496ad3ba452Szhanglinjuan  for(i <- 0 until StoreBufferSize){
497ad3ba452Szhanglinjuan    XSDebug(stateVec(i).isValid(),
498ad3ba452Szhanglinjuan      p"[$i] timeout:${cohCount(i)(EvictCountBits-1)} state:${stateVec(i)}\n"
499ad3ba452Szhanglinjuan    )
500ad3ba452Szhanglinjuan  }
501ad3ba452Szhanglinjuan
502ad3ba452Szhanglinjuan  for((req, i) <- io.in.zipWithIndex){
503315e1323Sgood-circle    XSDebug(req.fire && req.bits.vecValid,
504ad3ba452Szhanglinjuan      p"accept req [$i]: " +
505ad3ba452Szhanglinjuan        p"addr:${Hexadecimal(req.bits.addr)} " +
506cdbff57cSHaoyuan Feng        p"mask:${Binary(shiftMaskToLow(req.bits.addr,req.bits.mask))} " +
507cdbff57cSHaoyuan Feng        p"data:${Hexadecimal(shiftDataToLow(req.bits.addr,req.bits.data))}\n"
508ad3ba452Szhanglinjuan    )
509ad3ba452Szhanglinjuan    XSDebug(req.valid && !req.ready,
510ad3ba452Szhanglinjuan      p"req [$i] blocked by sbuffer\n"
511ad3ba452Szhanglinjuan    )
512ad3ba452Szhanglinjuan  }
513ad3ba452Szhanglinjuan
5140d32f713Shappy-lx  // for now, when enq, trigger a prefetch (if EnableAtCommitMissTrigger)
515202674aeSHaojin Tang  require(EnsbufferWidth <= StorePipelineWidth)
5160d32f713Shappy-lx
517ad3ba452Szhanglinjuan  // ---------------------- Send Dcache Req ---------------------
518ad3ba452Szhanglinjuan
519935edac4STang Haojin  val sbuffer_empty = Cat(invalidMask).andR
520935edac4STang Haojin  val sq_empty = !Cat(io.in.map(_.valid)).orR
521ad3ba452Szhanglinjuan  val empty = sbuffer_empty && sq_empty
5222fdb4d6aShappy-lx  val threshold = Wire(UInt(5.W)) // RegNext(io.csrCtrl.sbuffer_threshold +& 1.U)
523c686adcdSYinan Xu  threshold := Constantin.createRecord(s"StoreBufferThreshold_${p(XSCoreParamsKey).HartId}", initValue = 7)
5242fdb4d6aShappy-lx  val base = Wire(UInt(5.W))
525c686adcdSYinan Xu  base := Constantin.createRecord(s"StoreBufferBase_${p(XSCoreParamsKey).HartId}", initValue = 4)
526d2b20d1aSTang Haojin  val ActiveCount = PopCount(activeMask)
527d2b20d1aSTang Haojin  val ValidCount = PopCount(validMask)
5282fdb4d6aShappy-lx  val forceThreshold = Mux(io.force_write, threshold - base, threshold)
5292fdb4d6aShappy-lx  val do_eviction = RegNext(ActiveCount >= forceThreshold || ActiveCount === (StoreBufferSize-1).U || ValidCount === (StoreBufferSize).U, init = false.B)
530ad3ba452Szhanglinjuan  require((StoreBufferThreshold + 1) <= StoreBufferSize)
531ad3ba452Szhanglinjuan
532d2b20d1aSTang Haojin  XSDebug(p"ActiveCount[$ActiveCount]\n")
533ad3ba452Szhanglinjuan
534ad3ba452Szhanglinjuan  io.flush.empty := RegNext(empty && io.sqempty)
535ad3ba452Szhanglinjuan  // lru.io.flush := sbuffer_state === x_drain_all && empty
536ad3ba452Szhanglinjuan  switch(sbuffer_state){
537ad3ba452Szhanglinjuan    is(x_idle){
538ad3ba452Szhanglinjuan      when(io.flush.valid){
539ad3ba452Szhanglinjuan        sbuffer_state := x_drain_all
540ad3ba452Szhanglinjuan      }.elsewhen(do_uarch_drain){
541ad3ba452Szhanglinjuan        sbuffer_state := x_drain_sbuffer
542ad3ba452Szhanglinjuan      }.elsewhen(do_eviction){
543ad3ba452Szhanglinjuan        sbuffer_state := x_replace
544ad3ba452Szhanglinjuan      }
545ad3ba452Szhanglinjuan    }
546ad3ba452Szhanglinjuan    is(x_drain_all){
547ad3ba452Szhanglinjuan      when(empty){
548ad3ba452Szhanglinjuan        sbuffer_state := x_idle
549ad3ba452Szhanglinjuan      }
550ad3ba452Szhanglinjuan    }
551ad3ba452Szhanglinjuan    is(x_drain_sbuffer){
552a98b054bSWilliam Wang      when(io.flush.valid){
553a98b054bSWilliam Wang        sbuffer_state := x_drain_all
554a98b054bSWilliam Wang      }.elsewhen(sbuffer_empty){
555ad3ba452Szhanglinjuan        sbuffer_state := x_idle
556ad3ba452Szhanglinjuan      }
557ad3ba452Szhanglinjuan    }
558ad3ba452Szhanglinjuan    is(x_replace){
559ad3ba452Szhanglinjuan      when(io.flush.valid){
560ad3ba452Szhanglinjuan        sbuffer_state := x_drain_all
561ad3ba452Szhanglinjuan      }.elsewhen(do_uarch_drain){
562ad3ba452Szhanglinjuan        sbuffer_state := x_drain_sbuffer
563ad3ba452Szhanglinjuan      }.elsewhen(!do_eviction){
564ad3ba452Szhanglinjuan        sbuffer_state := x_idle
565ad3ba452Szhanglinjuan      }
566ad3ba452Szhanglinjuan    }
567ad3ba452Szhanglinjuan  }
568ad3ba452Szhanglinjuan  XSDebug(p"sbuffer state:${sbuffer_state} do eviction:${do_eviction} empty:${empty}\n")
569ad3ba452Szhanglinjuan
570ad3ba452Szhanglinjuan  def noSameBlockInflight(idx: UInt): Bool = {
571ad3ba452Szhanglinjuan    // stateVec(idx) itself must not be s_inflight
572935edac4STang Haojin    !Cat(widthMap(i => inflightMask(i) && ptag(idx) === ptag(i))).orR
573ad3ba452Szhanglinjuan  }
574ad3ba452Szhanglinjuan
575a98b054bSWilliam Wang  def genSameBlockInflightMask(ptag_in: UInt): UInt = {
576a98b054bSWilliam Wang    val mask = VecInit(widthMap(i => inflightMask(i) && ptag_in === ptag(i))).asUInt // quite slow, use it with care
577a98b054bSWilliam Wang    assert(!(PopCount(mask) > 1.U))
578a98b054bSWilliam Wang    mask
579a98b054bSWilliam Wang  }
580a98b054bSWilliam Wang
581a98b054bSWilliam Wang  def haveSameBlockInflight(ptag_in: UInt): Bool = {
582a98b054bSWilliam Wang    genSameBlockInflightMask(ptag_in).orR
583a98b054bSWilliam Wang  }
584a98b054bSWilliam Wang
58580382c05SWilliam Wang  // ---------------------------------------------------------------------------
58680382c05SWilliam Wang  // sbuffer to dcache pipeline
58780382c05SWilliam Wang  // ---------------------------------------------------------------------------
58880382c05SWilliam Wang
5893d3419b9SWilliam Wang  // Now sbuffer deq logic is divided into 2 stages:
5903d3419b9SWilliam Wang
5913d3419b9SWilliam Wang  // sbuffer_out_s0:
5923d3419b9SWilliam Wang  // * read data and meta from sbuffer
5933d3419b9SWilliam Wang  // * RegNext() them
5943d3419b9SWilliam Wang  // * set line state to inflight
5953d3419b9SWilliam Wang
5963d3419b9SWilliam Wang  // sbuffer_out_s1:
5973d3419b9SWilliam Wang  // * send write req to dcache
5983d3419b9SWilliam Wang
5993d3419b9SWilliam Wang  // sbuffer_out_extra:
6003d3419b9SWilliam Wang  // * receive write result from dcache
6013d3419b9SWilliam Wang  // * update line state
6023d3419b9SWilliam Wang
60380382c05SWilliam Wang  val sbuffer_out_s1_ready = Wire(Bool())
60480382c05SWilliam Wang
60580382c05SWilliam Wang  // ---------------------------------------------------------------------------
60680382c05SWilliam Wang  // sbuffer_out_s0
60780382c05SWilliam Wang  // ---------------------------------------------------------------------------
60880382c05SWilliam Wang
609ad3ba452Szhanglinjuan  val need_drain = needDrain(sbuffer_state)
610ad3ba452Szhanglinjuan  val need_replace = do_eviction || (sbuffer_state === x_replace)
61180382c05SWilliam Wang  val sbuffer_out_s0_evictionIdx = Mux(missqReplayHasTimeOut,
612779faf12SWilliam Wang    missqReplayTimeOutIdx,
613ad3ba452Szhanglinjuan    Mux(need_drain,
614ad3ba452Szhanglinjuan      drainIdx,
615ad3ba452Szhanglinjuan      Mux(cohHasTimeOut, cohTimeOutIdx, replaceIdx)
616ad3ba452Szhanglinjuan    )
617ad3ba452Szhanglinjuan  )
618ad3ba452Szhanglinjuan
61980382c05SWilliam Wang  // If there is a inflight dcache req which has same ptag with sbuffer_out_s0_evictionIdx's ptag,
62080382c05SWilliam Wang  // current eviction should be blocked.
62180382c05SWilliam Wang  val sbuffer_out_s0_valid = missqReplayHasTimeOut ||
62280382c05SWilliam Wang    stateVec(sbuffer_out_s0_evictionIdx).isDcacheReqCandidate() &&
62380382c05SWilliam Wang    (need_drain || cohHasTimeOut || need_replace)
62480382c05SWilliam Wang  assert(!(
62580382c05SWilliam Wang    stateVec(sbuffer_out_s0_evictionIdx).isDcacheReqCandidate &&
62680382c05SWilliam Wang    !noSameBlockInflight(sbuffer_out_s0_evictionIdx)
62780382c05SWilliam Wang  ))
62880382c05SWilliam Wang  val sbuffer_out_s0_cango = sbuffer_out_s1_ready
62980382c05SWilliam Wang  sbuffer_out_s0_fire := sbuffer_out_s0_valid && sbuffer_out_s0_cango
63080382c05SWilliam Wang
63180382c05SWilliam Wang  // ---------------------------------------------------------------------------
63280382c05SWilliam Wang  // sbuffer_out_s1
63380382c05SWilliam Wang  // ---------------------------------------------------------------------------
63480382c05SWilliam Wang
6353d3419b9SWilliam Wang  // TODO: use EnsbufferWidth
636779faf12SWilliam Wang  val shouldWaitWriteFinish = RegNext(VecInit((0 until EnsbufferWidth).map{i =>
637779faf12SWilliam Wang    (writeReq(i).bits.wvec.asUInt & UIntToOH(sbuffer_out_s0_evictionIdx).asUInt).orR &&
638779faf12SWilliam Wang    writeReq(i).valid
639779faf12SWilliam Wang  }).asUInt.orR)
6403d3419b9SWilliam Wang  // block dcache write if read / write hazard
6413d3419b9SWilliam Wang  val blockDcacheWrite = shouldWaitWriteFinish
6423d3419b9SWilliam Wang
64380382c05SWilliam Wang  val sbuffer_out_s1_valid = RegInit(false.B)
6443d3419b9SWilliam Wang  sbuffer_out_s1_ready := io.dcache.req.ready && !blockDcacheWrite || !sbuffer_out_s1_valid
645935edac4STang Haojin  val sbuffer_out_s1_fire = io.dcache.req.fire
64680382c05SWilliam Wang
64780382c05SWilliam Wang  // when sbuffer_out_s1_fire, send dcache req stored in pipeline reg to dcache
64880382c05SWilliam Wang  when(sbuffer_out_s1_fire){
64980382c05SWilliam Wang    sbuffer_out_s1_valid := false.B
650ad3ba452Szhanglinjuan  }
65180382c05SWilliam Wang  // when sbuffer_out_s0_fire, read dcache req data and store them in a pipeline reg
65280382c05SWilliam Wang  when(sbuffer_out_s0_cango){
65380382c05SWilliam Wang    sbuffer_out_s1_valid := sbuffer_out_s0_valid
654ad3ba452Szhanglinjuan  }
65580382c05SWilliam Wang  when(sbuffer_out_s0_fire){
65680382c05SWilliam Wang    stateVec(sbuffer_out_s0_evictionIdx).state_inflight := true.B
65780382c05SWilliam Wang    stateVec(sbuffer_out_s0_evictionIdx).w_timeout := false.B
65880382c05SWilliam Wang    // stateVec(sbuffer_out_s0_evictionIdx).s_pipe_req := true.B
65980382c05SWilliam Wang    XSDebug(p"$sbuffer_out_s0_evictionIdx will be sent to Dcache\n")
660ad3ba452Szhanglinjuan  }
66180382c05SWilliam Wang
662ad3ba452Szhanglinjuan  XSDebug(p"need drain:$need_drain cohHasTimeOut: $cohHasTimeOut need replace:$need_replace\n")
663ad3ba452Szhanglinjuan  XSDebug(p"drainIdx:$drainIdx tIdx:$cohTimeOutIdx replIdx:$replaceIdx " +
66480382c05SWilliam Wang    p"blocked:${!noSameBlockInflight(sbuffer_out_s0_evictionIdx)} v:${activeMask(sbuffer_out_s0_evictionIdx)}\n")
66580382c05SWilliam Wang  XSDebug(p"sbuffer_out_s0_valid:$sbuffer_out_s0_valid evictIdx:$sbuffer_out_s0_evictionIdx dcache ready:${io.dcache.req.ready}\n")
666ad3ba452Szhanglinjuan  // Note: if other dcache req in the same block are inflight,
667ad3ba452Szhanglinjuan  // the lru update may not accurate
66846f74b57SHaojin Tang  accessIdx(EnsbufferWidth).valid := invalidMask(replaceIdx) || (
66980382c05SWilliam Wang    need_replace && !need_drain && !cohHasTimeOut && !missqReplayHasTimeOut && sbuffer_out_s0_cango && activeMask(replaceIdx))
67046f74b57SHaojin Tang  accessIdx(EnsbufferWidth).bits := replaceIdx
671935edac4STang Haojin  val sbuffer_out_s1_evictionIdx = RegEnable(sbuffer_out_s0_evictionIdx, sbuffer_out_s0_fire)
672935edac4STang Haojin  val sbuffer_out_s1_evictionPTag = RegEnable(ptag(sbuffer_out_s0_evictionIdx), sbuffer_out_s0_fire)
673935edac4STang Haojin  val sbuffer_out_s1_evictionVTag = RegEnable(vtag(sbuffer_out_s0_evictionIdx), sbuffer_out_s0_fire)
674ad3ba452Szhanglinjuan
6753d3419b9SWilliam Wang  io.dcache.req.valid := sbuffer_out_s1_valid && !blockDcacheWrite
676ad3ba452Szhanglinjuan  io.dcache.req.bits := DontCare
677ad3ba452Szhanglinjuan  io.dcache.req.bits.cmd   := MemoryOpConstants.M_XWR
67880382c05SWilliam Wang  io.dcache.req.bits.addr  := getAddr(sbuffer_out_s1_evictionPTag)
67980382c05SWilliam Wang  io.dcache.req.bits.vaddr := getAddr(sbuffer_out_s1_evictionVTag)
68080382c05SWilliam Wang  io.dcache.req.bits.data  := data(sbuffer_out_s1_evictionIdx).asUInt
68180382c05SWilliam Wang  io.dcache.req.bits.mask  := mask(sbuffer_out_s1_evictionIdx).asUInt
68280382c05SWilliam Wang  io.dcache.req.bits.id := sbuffer_out_s1_evictionIdx
683ad3ba452Szhanglinjuan
68480382c05SWilliam Wang  when (sbuffer_out_s1_fire) {
685ad3ba452Szhanglinjuan    assert(!(io.dcache.req.bits.vaddr === 0.U))
686ad3ba452Szhanglinjuan    assert(!(io.dcache.req.bits.addr === 0.U))
687ad3ba452Szhanglinjuan  }
688ad3ba452Szhanglinjuan
68980382c05SWilliam Wang  XSDebug(sbuffer_out_s1_fire,
69080382c05SWilliam Wang    p"send buf [$sbuffer_out_s1_evictionIdx] to Dcache, req fire\n"
691ad3ba452Szhanglinjuan  )
692ad3ba452Szhanglinjuan
693ad3ba452Szhanglinjuan  // update sbuffer status according to dcache resp source
694ad3ba452Szhanglinjuan
695a98b054bSWilliam Wang  def id_to_sbuffer_id(id: UInt): UInt = {
696a98b054bSWilliam Wang    require(id.getWidth >= log2Up(StoreBufferSize))
697a98b054bSWilliam Wang    id(log2Up(StoreBufferSize)-1, 0)
698a98b054bSWilliam Wang  }
699a98b054bSWilliam Wang
700ad3ba452Szhanglinjuan  // hit resp
701ad3ba452Szhanglinjuan  io.dcache.hit_resps.map(resp => {
702ad3ba452Szhanglinjuan    val dcache_resp_id = resp.bits.id
703935edac4STang Haojin    when (resp.fire) {
704ad3ba452Szhanglinjuan      stateVec(dcache_resp_id).state_inflight := false.B
705ad3ba452Szhanglinjuan      stateVec(dcache_resp_id).state_valid := false.B
706ad3ba452Szhanglinjuan      assert(!resp.bits.replay)
707ad3ba452Szhanglinjuan      assert(!resp.bits.miss) // not need to resp if miss, to be opted
708ad3ba452Szhanglinjuan      assert(stateVec(dcache_resp_id).state_inflight === true.B)
709ad3ba452Szhanglinjuan    }
710a98b054bSWilliam Wang
711a98b054bSWilliam Wang    // Update w_sameblock_inflight flag is delayed for 1 cycle
712a98b054bSWilliam Wang    //
713a98b054bSWilliam Wang    // When a new req allocate a new line in sbuffer, sameblock_inflight check will ignore
714a98b054bSWilliam Wang    // current dcache.hit_resps. Then, in the next cycle, we have plenty of time to check
715a98b054bSWilliam Wang    // if the same block is still inflight
716a98b054bSWilliam Wang    (0 until StoreBufferSize).map(i => {
717a98b054bSWilliam Wang      when(
718a98b054bSWilliam Wang        stateVec(i).w_sameblock_inflight &&
719a98b054bSWilliam Wang        stateVec(i).state_valid &&
720935edac4STang Haojin        RegNext(resp.fire) &&
721a98b054bSWilliam Wang        waitInflightMask(i) === UIntToOH(RegNext(id_to_sbuffer_id(dcache_resp_id)))
722a98b054bSWilliam Wang      ){
723a98b054bSWilliam Wang        stateVec(i).w_sameblock_inflight := false.B
724a98b054bSWilliam Wang      }
725ad3ba452Szhanglinjuan    })
726a98b054bSWilliam Wang  })
727a98b054bSWilliam Wang
7288b1251e1SWilliam Wang  io.dcache.hit_resps.zip(dataModule.io.maskFlushReq).map{case (resp, maskFlush) => {
729935edac4STang Haojin    maskFlush.valid := resp.fire
7308b1251e1SWilliam Wang    maskFlush.bits.wvec := UIntToOH(resp.bits.id)
7318b1251e1SWilliam Wang  }}
732ad3ba452Szhanglinjuan
733ad3ba452Szhanglinjuan  // replay resp
734ad3ba452Szhanglinjuan  val replay_resp_id = io.dcache.replay_resp.bits.id
735935edac4STang Haojin  when (io.dcache.replay_resp.fire) {
736ad3ba452Szhanglinjuan    missqReplayCount(replay_resp_id) := 0.U
737ad3ba452Szhanglinjuan    stateVec(replay_resp_id).w_timeout := true.B
738ad3ba452Szhanglinjuan    // waiting for timeout
739ad3ba452Szhanglinjuan    assert(io.dcache.replay_resp.bits.replay)
740ad3ba452Szhanglinjuan    assert(stateVec(replay_resp_id).state_inflight === true.B)
741ad3ba452Szhanglinjuan  }
742ad3ba452Szhanglinjuan
743ad3ba452Szhanglinjuan  // TODO: reuse cohCount
744ad3ba452Szhanglinjuan  (0 until StoreBufferSize).map(i => {
745ad3ba452Szhanglinjuan    when(stateVec(i).w_timeout && stateVec(i).state_inflight && !missqReplayCount(i)(MissqReplayCountBits-1)) {
746ad3ba452Szhanglinjuan      missqReplayCount(i) := missqReplayCount(i) + 1.U
747ad3ba452Szhanglinjuan    }
748ad3ba452Szhanglinjuan    when(activeMask(i) && !cohTimeOutMask(i)){
749ad3ba452Szhanglinjuan      cohCount(i) := cohCount(i)+1.U
750ad3ba452Szhanglinjuan    }
751ad3ba452Szhanglinjuan  })
752ad3ba452Szhanglinjuan
7531545277aSYinan Xu  if (env.EnableDifftest) {
754ad3ba452Szhanglinjuan    // hit resp
755ad3ba452Szhanglinjuan    io.dcache.hit_resps.zipWithIndex.map{case (resp, index) => {
7567d45a146SYinan Xu      val difftest = DifftestModule(new DiffSbufferEvent, delay = 1)
757ad3ba452Szhanglinjuan      val dcache_resp_id = resp.bits.id
7587d45a146SYinan Xu      difftest.coreid := io.hartId
7597d45a146SYinan Xu      difftest.index  := index.U
760935edac4STang Haojin      difftest.valid  := resp.fire
7617d45a146SYinan Xu      difftest.addr   := getAddr(ptag(dcache_resp_id))
7627d45a146SYinan Xu      difftest.data   := data(dcache_resp_id).asTypeOf(Vec(CacheLineBytes, UInt(8.W)))
7637d45a146SYinan Xu      difftest.mask   := mask(dcache_resp_id).asUInt
764ad3ba452Szhanglinjuan    }}
765ad3ba452Szhanglinjuan  }
766ad3ba452Szhanglinjuan
767ad3ba452Szhanglinjuan  // ---------------------- Load Data Forward ---------------------
768ad3ba452Szhanglinjuan  val mismatch = Wire(Vec(LoadPipelineWidth, Bool()))
769db7f55d9SWilliam Wang  XSPerfAccumulate("vaddr_match_failed", mismatch(0) || mismatch(1))
770ad3ba452Szhanglinjuan  for ((forward, i) <- io.forward.zipWithIndex) {
771ad3ba452Szhanglinjuan    val vtag_matches = VecInit(widthMap(w => vtag(w) === getVTag(forward.vaddr)))
77267cddb05SWilliam Wang    // ptag_matches uses paddr from dtlb, which is far from sbuffer
77367cddb05SWilliam Wang    val ptag_matches = VecInit(widthMap(w => RegEnable(ptag(w), forward.valid) === RegEnable(getPTag(forward.paddr), forward.valid)))
774ad3ba452Szhanglinjuan    val tag_matches = vtag_matches
775ad3ba452Szhanglinjuan    val tag_mismatch = RegNext(forward.valid) && VecInit(widthMap(w =>
77667cddb05SWilliam Wang      RegNext(vtag_matches(w)) =/= ptag_matches(w) && RegNext((activeMask(w) || inflightMask(w)))
777ad3ba452Szhanglinjuan    )).asUInt.orR
778ad3ba452Szhanglinjuan    mismatch(i) := tag_mismatch
779ad3ba452Szhanglinjuan    when (tag_mismatch) {
780ad3ba452Szhanglinjuan      XSDebug("forward tag mismatch: pmatch %x vmatch %x vaddr %x paddr %x\n",
781ad3ba452Szhanglinjuan        RegNext(ptag_matches.asUInt),
782ad3ba452Szhanglinjuan        RegNext(vtag_matches.asUInt),
783ad3ba452Szhanglinjuan        RegNext(forward.vaddr),
784ad3ba452Szhanglinjuan        RegNext(forward.paddr)
785ad3ba452Szhanglinjuan      )
78696b1e495SWilliam Wang      forward_need_uarch_drain := true.B
787ad3ba452Szhanglinjuan    }
788ad3ba452Szhanglinjuan    val valid_tag_matches = widthMap(w => tag_matches(w) && activeMask(w))
789ad3ba452Szhanglinjuan    val inflight_tag_matches = widthMap(w => tag_matches(w) && inflightMask(w))
790cdbff57cSHaoyuan Feng    val line_offset_mask = UIntToOH(getVWordOffset(forward.paddr))
791ad3ba452Szhanglinjuan
792ad3ba452Szhanglinjuan    val valid_tag_match_reg = valid_tag_matches.map(RegNext(_))
793ad3ba452Szhanglinjuan    val inflight_tag_match_reg = inflight_tag_matches.map(RegNext(_))
794ad3ba452Szhanglinjuan    val line_offset_reg = RegNext(line_offset_mask)
795a98b054bSWilliam Wang    val forward_mask_candidate_reg = RegEnable(
796cdbff57cSHaoyuan Feng      VecInit(mask.map(entry => entry(getVWordOffset(forward.paddr)))),
797a98b054bSWilliam Wang      forward.valid
798a98b054bSWilliam Wang    )
79996b1e495SWilliam Wang    val forward_data_candidate_reg = RegEnable(
800cdbff57cSHaoyuan Feng      VecInit(data.map(entry => entry(getVWordOffset(forward.paddr)))),
80196b1e495SWilliam Wang      forward.valid
80296b1e495SWilliam Wang    )
803ad3ba452Szhanglinjuan
804a98b054bSWilliam Wang    val selectedValidMask = Mux1H(valid_tag_match_reg, forward_mask_candidate_reg)
80596b1e495SWilliam Wang    val selectedValidData = Mux1H(valid_tag_match_reg, forward_data_candidate_reg)
806a98b054bSWilliam Wang    selectedValidMask.suggestName("selectedValidMask_"+i)
80796b1e495SWilliam Wang    selectedValidData.suggestName("selectedValidData_"+i)
808ad3ba452Szhanglinjuan
809a98b054bSWilliam Wang    val selectedInflightMask = Mux1H(inflight_tag_match_reg, forward_mask_candidate_reg)
81096b1e495SWilliam Wang    val selectedInflightData = Mux1H(inflight_tag_match_reg, forward_data_candidate_reg)
811a98b054bSWilliam Wang    selectedInflightMask.suggestName("selectedInflightMask_"+i)
81296b1e495SWilliam Wang    selectedInflightData.suggestName("selectedInflightData_"+i)
813ad3ba452Szhanglinjuan
814a98b054bSWilliam Wang    // currently not being used
815cdbff57cSHaoyuan Feng    val selectedInflightMaskFast = Mux1H(line_offset_mask, Mux1H(inflight_tag_matches, mask).asTypeOf(Vec(CacheLineVWords, Vec(VDataBytes, Bool()))))
816cdbff57cSHaoyuan Feng    val selectedValidMaskFast = Mux1H(line_offset_mask, Mux1H(valid_tag_matches, mask).asTypeOf(Vec(CacheLineVWords, Vec(VDataBytes, Bool()))))
817ad3ba452Szhanglinjuan
818ad3ba452Szhanglinjuan    forward.dataInvalid := false.B // data in store line merge buffer is always ready
819ad3ba452Szhanglinjuan    forward.matchInvalid := tag_mismatch // paddr / vaddr cam result does not match
820cdbff57cSHaoyuan Feng    for (j <- 0 until VDataBytes) {
821ad3ba452Szhanglinjuan      forward.forwardMask(j) := false.B
822ad3ba452Szhanglinjuan      forward.forwardData(j) := DontCare
823ad3ba452Szhanglinjuan
824ad3ba452Szhanglinjuan      // valid entries have higher priority than inflight entries
825ad3ba452Szhanglinjuan      when(selectedInflightMask(j)) {
826ad3ba452Szhanglinjuan        forward.forwardMask(j) := true.B
827ad3ba452Szhanglinjuan        forward.forwardData(j) := selectedInflightData(j)
828ad3ba452Szhanglinjuan      }
829ad3ba452Szhanglinjuan      when(selectedValidMask(j)) {
830ad3ba452Szhanglinjuan        forward.forwardMask(j) := true.B
831ad3ba452Szhanglinjuan        forward.forwardData(j) := selectedValidData(j)
832ad3ba452Szhanglinjuan      }
833ad3ba452Szhanglinjuan
834ad3ba452Szhanglinjuan      forward.forwardMaskFast(j) := selectedInflightMaskFast(j) || selectedValidMaskFast(j)
835ad3ba452Szhanglinjuan    }
836e4f69d78Ssfencevma    forward.addrInvalid := DontCare
837ad3ba452Szhanglinjuan  }
838ad3ba452Szhanglinjuan
839ad3ba452Szhanglinjuan  for (i <- 0 until StoreBufferSize) {
84096b1e495SWilliam Wang    XSDebug("sbf entry " + i + " : ptag %x vtag %x valid %x active %x inflight %x w_timeout %x\n",
841ad3ba452Szhanglinjuan      ptag(i) << OffsetWidth,
842ad3ba452Szhanglinjuan      vtag(i) << OffsetWidth,
843ad3ba452Szhanglinjuan      stateVec(i).isValid(),
844ad3ba452Szhanglinjuan      activeMask(i),
845ad3ba452Szhanglinjuan      inflightMask(i),
846ad3ba452Szhanglinjuan      stateVec(i).w_timeout
847ad3ba452Szhanglinjuan    )
848ad3ba452Szhanglinjuan  }
849ad3ba452Szhanglinjuan
8509ae95edaSAnzooooo  /*
8519ae95edaSAnzooooo  *
8529ae95edaSAnzooooo  **********************************************************
8539ae95edaSAnzooooo  *      -------------                   -------------     *
8549ae95edaSAnzooooo  *      | XiangShan |                   |    NEMU   |     *
8559ae95edaSAnzooooo  *      -------------                   -------------     *
8569ae95edaSAnzooooo  *            |                               |           *
8579ae95edaSAnzooooo  *            V                               V           *
8589ae95edaSAnzooooo  *          -----                           -----         *
8599ae95edaSAnzooooo  *          | Q |                           | Q |         *
8609ae95edaSAnzooooo  *          | U |                           | U |         *
8619ae95edaSAnzooooo  *          | E |                           | E |         *
8629ae95edaSAnzooooo  *          | U |                           | U |         *
8639ae95edaSAnzooooo  *          | E |                           | E |         *
8649ae95edaSAnzooooo  *          |   |                           |   |         *
8659ae95edaSAnzooooo  *          -----                           -----         *
8669ae95edaSAnzooooo  *            |                               |           *
8679ae95edaSAnzooooo  *            |        --------------         |           *
8689ae95edaSAnzooooo  *            |>>>>>>>>|  DIFFTEST  |<<<<<<<<<|           *
8699ae95edaSAnzooooo  *                     --------------                     *
8709ae95edaSAnzooooo  **********************************************************
8719ae95edaSAnzooooo  */
872*3e11bedfSAnzooooo  // Initialize when unenabled difftest.
873*3e11bedfSAnzooooo  for (i <- 0 until EnsbufferWidth) {
874*3e11bedfSAnzooooo    io.vecDifftestInfo(i) := DontCare
875*3e11bedfSAnzooooo  }
87660bd4d3cSweiding liu  if (env.EnableDifftest) {
8779ae95edaSAnzooooo    val VecMemFLOWMaxNumber = 16
8789ae95edaSAnzooooo
8799ae95edaSAnzooooo    def UIntSlice(in: UInt, High: UInt, Low: UInt): UInt = {
8809ae95edaSAnzooooo      val maxNum = in.getWidth
8819ae95edaSAnzooooo      val result = Wire(Vec(maxNum, Bool()))
8829ae95edaSAnzooooo
8839ae95edaSAnzooooo      for (i <- 0 until maxNum) {
8849ae95edaSAnzooooo        when (Low + i.U <= High) {
8859ae95edaSAnzooooo          result(i) := in(Low + i.U)
8869ae95edaSAnzooooo        }.otherwise{
8879ae95edaSAnzooooo          result(i) := 0.U
8889ae95edaSAnzooooo        }
8899ae95edaSAnzooooo      }
8909ae95edaSAnzooooo
8919ae95edaSAnzooooo      result.asUInt
8929ae95edaSAnzooooo    }
8939ae95edaSAnzooooo
8949ae95edaSAnzooooo    // To align with 'nemu', we need:
8959ae95edaSAnzooooo    //  For 'unit-store' and 'whole' vector store instr, we re-split here,
8969ae95edaSAnzooooo    //  and for the res, we do nothing.
89760bd4d3cSweiding liu    for (i <- 0 until EnsbufferWidth) {
8989ae95edaSAnzooooo      io.vecDifftestInfo(i).ready := io.in(i).ready
8999ae95edaSAnzooooo
9009ae95edaSAnzooooo      val uop             = io.vecDifftestInfo(i).bits
9019ae95edaSAnzooooo
9029ae95edaSAnzooooo      val isVse           = isVStore(uop.fuType) && LSUOpType.isUStride(uop.fuOpType)
9039ae95edaSAnzooooo      val isVsm           = isVStore(uop.fuType) && VstuType.isMasked(uop.fuOpType)
9049ae95edaSAnzooooo      val isVsr           = isVStore(uop.fuType) && VstuType.isWhole(uop.fuOpType)
9059ae95edaSAnzooooo
9069ae95edaSAnzooooo      val vpu             = uop.vpu
9079ae95edaSAnzooooo      val veew            = uop.vpu.veew
9089ae95edaSAnzooooo      val eew             = EewLog2(veew)
9099ae95edaSAnzooooo      val EEB             = (1.U << eew).asUInt //Only when VLEN=128 effective element byte
9109ae95edaSAnzooooo      val EEWBits         = (EEB << 3.U).asUInt
9119ae95edaSAnzooooo      val nf              = Mux(isVsr, 0.U, vpu.nf)
9129ae95edaSAnzooooo
9139ae95edaSAnzooooo      val isSegment       = nf =/= 0.U && !isVsm
9149ae95edaSAnzooooo      val isVSLine        = (isVse || isVsm || isVsr) && !isSegment
9159ae95edaSAnzooooo
9169ae95edaSAnzooooo      // The number of stores generated by a uop theroy.
9179ae95edaSAnzooooo      // No other vector instructions need to be considered.
9189ae95edaSAnzooooo      val flow            = Mux(
9199ae95edaSAnzooooo                              isVSLine,
9209ae95edaSAnzooooo                              (16.U >> eew).asUInt,
9219ae95edaSAnzooooo                              0.U
9229ae95edaSAnzooooo                            )
9239ae95edaSAnzooooo
9249ae95edaSAnzooooo      val rawData         = io.in(i).bits.data
9259ae95edaSAnzooooo      val rawMask         = io.in(i).bits.mask
9269ae95edaSAnzooooo      val rawAddr         = io.in(i).bits.addr
9279ae95edaSAnzooooo
9289ae95edaSAnzooooo      // A common difftest interface for scalar and vector instr
9299ae95edaSAnzooooo      val difftestCommon = DifftestModule(new DiffStoreEvent, delay = 2)
9309ae95edaSAnzooooo      when (isVSLine) {
9319ae95edaSAnzooooo        val splitMask         = UIntSlice(rawMask, EEB - 1.U, 0.U)(7,0)  // Byte
9329ae95edaSAnzooooo        val splitData         = UIntSlice(rawData, EEWBits - 1.U, 0.U)(63,0) // Double word
9339ae95edaSAnzooooo        val storeCommit       = io.in(i).fire && splitMask.orR && io.in(i).bits.vecValid
9349ae95edaSAnzooooo        val waddr             = rawAddr
9359ae95edaSAnzooooo        val wmask             = splitMask
9369ae95edaSAnzooooo        val wdata             = splitData & MaskExpand(splitMask)
9379ae95edaSAnzooooo
9389ae95edaSAnzooooo        difftestCommon.coreid := io.hartId
9399ae95edaSAnzooooo        difftestCommon.index  := (i*VecMemFLOWMaxNumber).U
9409ae95edaSAnzooooo        difftestCommon.valid  := storeCommit
9419ae95edaSAnzooooo        difftestCommon.addr   := waddr
9429ae95edaSAnzooooo        difftestCommon.data   := wdata
9439ae95edaSAnzooooo        difftestCommon.mask   := wmask
9449ae95edaSAnzooooo
9459ae95edaSAnzooooo      }.otherwise{
9469ae95edaSAnzooooo        val storeCommit       = io.in(i).fire
94760bd4d3cSweiding liu        val waddr             = ZeroExt(Cat(io.in(i).bits.addr(PAddrBits - 1, 3), 0.U(3.W)), 64)
94860bd4d3cSweiding liu        val sbufferMask       = shiftMaskToLow(io.in(i).bits.addr, io.in(i).bits.mask)
94960bd4d3cSweiding liu        val sbufferData       = shiftDataToLow(io.in(i).bits.addr, io.in(i).bits.data)
95060bd4d3cSweiding liu        val wmask             = sbufferMask
95160bd4d3cSweiding liu        val wdata             = sbufferData & MaskExpand(sbufferMask)
95260bd4d3cSweiding liu
9539ae95edaSAnzooooo        difftestCommon.coreid := io.hartId
9549ae95edaSAnzooooo        difftestCommon.index  := (i*VecMemFLOWMaxNumber).U
9559ae95edaSAnzooooo        difftestCommon.valid  := storeCommit && io.in(i).bits.vecValid
9569ae95edaSAnzooooo        difftestCommon.addr   := waddr
9579ae95edaSAnzooooo        difftestCommon.data   := wdata
9589ae95edaSAnzooooo        difftestCommon.mask   := wmask
9599ae95edaSAnzooooo
9609ae95edaSAnzooooo      }
9619ae95edaSAnzooooo
9629ae95edaSAnzooooo      // Only the interface used by the 'unit-store' and 'whole' vector store instr
9639ae95edaSAnzooooo      for (index <- 1 until VecMemFLOWMaxNumber) {
96460bd4d3cSweiding liu        val difftest = DifftestModule(new DiffStoreEvent, delay = 2)
9659ae95edaSAnzooooo
9669ae95edaSAnzooooo        // I've already done something process with 'mask' outside:
9679ae95edaSAnzooooo        //  Different cases of 'vm' have been considered:
9689ae95edaSAnzooooo        //    Any valid store will definitely not have all 0 masks,
9699ae95edaSAnzooooo        //    and the extra part due to unaligned access must have a mask of 0
9709ae95edaSAnzooooo        when (index.U < flow && isVSLine) {
9719ae95edaSAnzooooo          // Make NEMU-difftest happy
9729ae95edaSAnzooooo          val shiftIndex  = EEB*index.U
9739ae95edaSAnzooooo          val shiftFlag   = shiftIndex(2,0).orR // Double word Flag
9749ae95edaSAnzooooo          val shiftBytes  = Mux(shiftFlag, shiftIndex(2,0), 0.U)
9759ae95edaSAnzooooo          val shiftBits   = shiftBytes << 3.U
9769ae95edaSAnzooooo          val splitMask   = UIntSlice(rawMask, (EEB*(index+1).U - 1.U), EEB*index.U)(7,0)  // Byte
9779ae95edaSAnzooooo          val splitData   = UIntSlice(rawData, (EEWBits*(index+1).U - 1.U), EEWBits*index.U)(63,0) // Double word
9789ae95edaSAnzooooo          val storeCommit = io.in(i).fire && splitMask.orR  && io.in(i).bits.vecValid
9799ae95edaSAnzooooo          val waddr       = Cat(rawAddr(PAddrBits - 1, 4), Cat(shiftIndex(3), 0.U(3.W)))
9809ae95edaSAnzooooo          val wmask       = splitMask << shiftBytes
9819ae95edaSAnzooooo          val wdata       = (splitData & MaskExpand(splitMask)) << shiftBits
9829ae95edaSAnzooooo
98360bd4d3cSweiding liu          difftest.coreid := io.hartId
9849ae95edaSAnzooooo          difftest.index  := (i*VecMemFLOWMaxNumber+index).U
98560bd4d3cSweiding liu          difftest.valid  := storeCommit
98660bd4d3cSweiding liu          difftest.addr   := waddr
98760bd4d3cSweiding liu          difftest.data   := wdata
98860bd4d3cSweiding liu          difftest.mask   := wmask
9899ae95edaSAnzooooo
9909ae95edaSAnzooooo        }.otherwise{
9919ae95edaSAnzooooo          difftest.coreid := 0.U
9929ae95edaSAnzooooo          difftest.index  := 0.U
9939ae95edaSAnzooooo          difftest.valid  := 0.U
9949ae95edaSAnzooooo          difftest.addr   := 0.U
9959ae95edaSAnzooooo          difftest.data   := 0.U
9969ae95edaSAnzooooo          difftest.mask   := 0.U
9979ae95edaSAnzooooo
9989ae95edaSAnzooooo        }
9999ae95edaSAnzooooo      }
100060bd4d3cSweiding liu    }
100160bd4d3cSweiding liu  }
100260bd4d3cSweiding liu
1003b6d53cefSWilliam Wang  val perf_valid_entry_count = RegNext(PopCount(VecInit(stateVec.map(s => !s.isInvalid())).asUInt))
1004ad3ba452Szhanglinjuan  XSPerfHistogram("util", perf_valid_entry_count, true.B, 0, StoreBufferSize, 1)
1005ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_req_valid", PopCount(VecInit(io.in.map(_.valid)).asUInt))
1006935edac4STang Haojin  XSPerfAccumulate("sbuffer_req_fire", PopCount(VecInit(io.in.map(_.fire)).asUInt))
1007b2d6d8e7Sgood-circle  XSPerfAccumulate("sbuffer_req_fire_vecinvalid", PopCount(VecInit(io.in.map(data => data.fire && !data.bits.vecValid)).asUInt))
1008935edac4STang Haojin  XSPerfAccumulate("sbuffer_merge", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && canMerge(i)})).asUInt))
1009935edac4STang Haojin  XSPerfAccumulate("sbuffer_newline", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && !canMerge(i)})).asUInt))
1010ad3ba452Szhanglinjuan  XSPerfAccumulate("dcache_req_valid", io.dcache.req.valid)
1011935edac4STang Haojin  XSPerfAccumulate("dcache_req_fire", io.dcache.req.fire)
1012ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_idle", sbuffer_state === x_idle)
1013ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_flush", sbuffer_state === x_drain_sbuffer)
1014ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_replace", sbuffer_state === x_replace)
1015db7f55d9SWilliam Wang  XSPerfAccumulate("evenCanInsert", evenCanInsert)
1016db7f55d9SWilliam Wang  XSPerfAccumulate("oddCanInsert", oddCanInsert)
1017935edac4STang Haojin  XSPerfAccumulate("mainpipe_resp_valid", io.dcache.main_pipe_hit_resp.fire)
1018ffd3154dSCharlieLiu  //XSPerfAccumulate("refill_resp_valid", io.dcache.refill_hit_resp.fire)
1019935edac4STang Haojin  XSPerfAccumulate("replay_resp_valid", io.dcache.replay_resp.fire)
102096b1e495SWilliam Wang  XSPerfAccumulate("coh_timeout", cohHasTimeOut)
102196b1e495SWilliam Wang
1022935edac4STang Haojin  // val (store_latency_sample, store_latency) = TransactionLatencyCounter(io.lsu.req.fire, io.lsu.resp.fire)
102396b1e495SWilliam Wang  // XSPerfHistogram("store_latency", store_latency, store_latency_sample, 0, 100, 10)
1024935edac4STang Haojin  // XSPerfAccumulate("store_req", io.lsu.req.fire)
1025cd365d4cSrvcoresjw
1026cd365d4cSrvcoresjw  val perfEvents = Seq(
1027cd365d4cSrvcoresjw    ("sbuffer_req_valid ", PopCount(VecInit(io.in.map(_.valid)).asUInt)                                                                ),
1028935edac4STang Haojin    ("sbuffer_req_fire  ", PopCount(VecInit(io.in.map(_.fire)).asUInt)                                                               ),
1029935edac4STang Haojin    ("sbuffer_merge     ", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && canMerge(i)})).asUInt)                ),
1030935edac4STang Haojin    ("sbuffer_newline   ", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && !canMerge(i)})).asUInt)               ),
1031cd365d4cSrvcoresjw    ("dcache_req_valid  ", io.dcache.req.valid                                                                                         ),
1032935edac4STang Haojin    ("dcache_req_fire   ", io.dcache.req.fire                                                                                        ),
103396b1e495SWilliam Wang    ("sbuffer_idle      ", sbuffer_state === x_idle                                                                                    ),
103496b1e495SWilliam Wang    ("sbuffer_flush     ", sbuffer_state === x_drain_sbuffer                                                                           ),
103596b1e495SWilliam Wang    ("sbuffer_replace   ", sbuffer_state === x_replace                                                                                 ),
1036935edac4STang Haojin    ("mpipe_resp_valid  ", io.dcache.main_pipe_hit_resp.fire                                                                         ),
1037ffd3154dSCharlieLiu    //("refill_resp_valid ", io.dcache.refill_hit_resp.fire                                                                            ),
1038935edac4STang Haojin    ("replay_resp_valid ", io.dcache.replay_resp.fire                                                                                ),
103996b1e495SWilliam Wang    ("coh_timeout       ", cohHasTimeOut                                                                                               ),
10401ca0e4f3SYinan Xu    ("sbuffer_1_4_valid ", (perf_valid_entry_count < (StoreBufferSize.U/4.U))                                                          ),
10411ca0e4f3SYinan Xu    ("sbuffer_2_4_valid ", (perf_valid_entry_count > (StoreBufferSize.U/4.U)) & (perf_valid_entry_count <= (StoreBufferSize.U/2.U))    ),
10421ca0e4f3SYinan Xu    ("sbuffer_3_4_valid ", (perf_valid_entry_count > (StoreBufferSize.U/2.U)) & (perf_valid_entry_count <= (StoreBufferSize.U*3.U/4.U))),
1043cd365d4cSrvcoresjw    ("sbuffer_full_valid", (perf_valid_entry_count > (StoreBufferSize.U*3.U/4.U)))
1044cd365d4cSrvcoresjw  )
10451ca0e4f3SYinan Xu  generatePerfEvent()
1046cd365d4cSrvcoresjw
1047ad3ba452Szhanglinjuan}
1048