xref: /XiangShan/src/main/scala/xiangshan/mem/sbuffer/Sbuffer.scala (revision e04c5f647e1e5251ae701f95f5b9bd4e0172caed)
1ad3ba452Szhanglinjuan/***************************************************************************************
2e3da8badSTang Haojin* Copyright (c) 2024 Beijing Institute of Open Source Chip (BOSC)
3e3da8badSTang Haojin* Copyright (c) 2020-2024 Institute of Computing Technology, Chinese Academy of Sciences
4ad3ba452Szhanglinjuan* Copyright (c) 2020-2021 Peng Cheng Laboratory
5ad3ba452Szhanglinjuan*
6ad3ba452Szhanglinjuan* XiangShan is licensed under Mulan PSL v2.
7ad3ba452Szhanglinjuan* You can use this software according to the terms and conditions of the Mulan PSL v2.
8ad3ba452Szhanglinjuan* You may obtain a copy of Mulan PSL v2 at:
9ad3ba452Szhanglinjuan*          http://license.coscl.org.cn/MulanPSL2
10ad3ba452Szhanglinjuan*
11ad3ba452Szhanglinjuan* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
12ad3ba452Szhanglinjuan* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
13ad3ba452Szhanglinjuan* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
14ad3ba452Szhanglinjuan*
15ad3ba452Szhanglinjuan* See the Mulan PSL v2 for more details.
16ad3ba452Szhanglinjuan***************************************************************************************/
17ad3ba452Szhanglinjuan
18ad3ba452Szhanglinjuanpackage xiangshan.mem
19ad3ba452Szhanglinjuan
208891a219SYinan Xuimport org.chipsalliance.cde.config.Parameters
21ad3ba452Szhanglinjuanimport chisel3._
22ad3ba452Szhanglinjuanimport chisel3.util._
23ad3ba452Szhanglinjuanimport xiangshan._
24ad3ba452Szhanglinjuanimport utils._
253c02ee8fSwakafaimport utility._
26ad3ba452Szhanglinjuanimport xiangshan.cache._
279ae95edaSAnzoooooimport xiangshan.mem._
289ae95edaSAnzoooooimport xiangshan.backend.Bundles.DynInst
29ad3ba452Szhanglinjuanimport difftest._
3074ea8036SJeniusimport freechips.rocketchip.util._
319ae95edaSAnzoooooimport xiangshan.backend.fu.FuType._
32ad3ba452Szhanglinjuan
33ad3ba452Szhanglinjuanclass SbufferFlushBundle extends Bundle {
34ad3ba452Szhanglinjuan  val valid = Output(Bool())
35ad3ba452Szhanglinjuan  val empty = Input(Bool())
36ad3ba452Szhanglinjuan}
37ad3ba452Szhanglinjuan
38ad3ba452Szhanglinjuantrait HasSbufferConst extends HasXSParameter {
39ad3ba452Szhanglinjuan  val EvictCycles = 1 << 20
40ad3ba452Szhanglinjuan  val SbufferReplayDelayCycles = 16
41ad3ba452Szhanglinjuan  require(isPow2(EvictCycles))
42ad3ba452Szhanglinjuan  val EvictCountBits = log2Up(EvictCycles+1)
43ad3ba452Szhanglinjuan  val MissqReplayCountBits = log2Up(SbufferReplayDelayCycles) + 1
44ad3ba452Szhanglinjuan
458b1251e1SWilliam Wang  // dcache write hit resp has 2 sources
46ffd3154dSCharlieLiu  // refill pipe resp and main pipe resp (fixed:only main pipe resp)
47ffd3154dSCharlieLiu  // val NumDcacheWriteResp = 2 // hardcoded
48ffd3154dSCharlieLiu  val NumDcacheWriteResp = 1 // hardcoded
498b1251e1SWilliam Wang
50ad3ba452Szhanglinjuan  val SbufferIndexWidth: Int = log2Up(StoreBufferSize)
51ad3ba452Szhanglinjuan  // paddr = ptag + offset
52ad3ba452Szhanglinjuan  val CacheLineBytes: Int = CacheLineSize / 8
53ad3ba452Szhanglinjuan  val CacheLineWords: Int = CacheLineBytes / DataBytes
54ad3ba452Szhanglinjuan  val OffsetWidth: Int = log2Up(CacheLineBytes)
55ad3ba452Szhanglinjuan  val WordsWidth: Int = log2Up(CacheLineWords)
56ad3ba452Szhanglinjuan  val PTagWidth: Int = PAddrBits - OffsetWidth
57ad3ba452Szhanglinjuan  val VTagWidth: Int = VAddrBits - OffsetWidth
58ad3ba452Szhanglinjuan  val WordOffsetWidth: Int = PAddrBits - WordsWidth
59cdbff57cSHaoyuan Feng
60cdbff57cSHaoyuan Feng  val CacheLineVWords: Int = CacheLineBytes / VDataBytes
61cdbff57cSHaoyuan Feng  val VWordsWidth: Int = log2Up(CacheLineVWords)
62cdbff57cSHaoyuan Feng  val VWordWidth: Int = log2Up(VDataBytes)
63cdbff57cSHaoyuan Feng  val VWordOffsetWidth: Int = PAddrBits - VWordWidth
64ad3ba452Szhanglinjuan}
65ad3ba452Szhanglinjuan
66ad3ba452Szhanglinjuanclass SbufferEntryState (implicit p: Parameters) extends SbufferBundle {
67ad3ba452Szhanglinjuan  val state_valid    = Bool() // this entry is active
68ad3ba452Szhanglinjuan  val state_inflight = Bool() // sbuffer is trying to write this entry to dcache
69a98b054bSWilliam Wang  val w_timeout = Bool() // with timeout resp, waiting for resend store pipeline req timeout
70a98b054bSWilliam Wang  val w_sameblock_inflight = Bool() // same cache block dcache req is inflight
71ad3ba452Szhanglinjuan
72ad3ba452Szhanglinjuan  def isInvalid(): Bool = !state_valid
73ad3ba452Szhanglinjuan  def isValid(): Bool = state_valid
74ad3ba452Szhanglinjuan  def isActive(): Bool = state_valid && !state_inflight
75ad3ba452Szhanglinjuan  def isInflight(): Bool = state_inflight
76a98b054bSWilliam Wang  def isDcacheReqCandidate(): Bool = state_valid && !state_inflight && !w_sameblock_inflight
77ad3ba452Szhanglinjuan}
78ad3ba452Szhanglinjuan
79ad3ba452Szhanglinjuanclass SbufferBundle(implicit p: Parameters) extends XSBundle with HasSbufferConst
80ad3ba452Szhanglinjuan
81ad3ba452Szhanglinjuanclass DataWriteReq(implicit p: Parameters) extends SbufferBundle {
823d3419b9SWilliam Wang  // univerisal writemask
8367c26c34SWilliam Wang  val wvec = UInt(StoreBufferSize.W)
843d3419b9SWilliam Wang  // 2 cycle update
85cdbff57cSHaoyuan Feng  val mask = UInt((VLEN/8).W)
86cdbff57cSHaoyuan Feng  val data = UInt(VLEN.W)
87cdbff57cSHaoyuan Feng  val vwordOffset = UInt(VWordOffsetWidth.W)
888b1251e1SWilliam Wang  val wline = Bool() // write full cacheline
898b1251e1SWilliam Wang}
908b1251e1SWilliam Wang
918b1251e1SWilliam Wangclass MaskFlushReq(implicit p: Parameters) extends SbufferBundle {
928b1251e1SWilliam Wang  // univerisal writemask
938b1251e1SWilliam Wang  val wvec = UInt(StoreBufferSize.W)
94ad3ba452Szhanglinjuan}
95ad3ba452Szhanglinjuan
96ad3ba452Szhanglinjuanclass SbufferData(implicit p: Parameters) extends XSModule with HasSbufferConst {
97ad3ba452Szhanglinjuan  val io = IO(new Bundle(){
988b1251e1SWilliam Wang    // update data and mask when alloc or merge
9946f74b57SHaojin Tang    val writeReq = Vec(EnsbufferWidth, Flipped(ValidIO(new DataWriteReq)))
1008b1251e1SWilliam Wang    // clean mask when deq
1018b1251e1SWilliam Wang    val maskFlushReq = Vec(NumDcacheWriteResp, Flipped(ValidIO(new MaskFlushReq)))
102cdbff57cSHaoyuan Feng    val dataOut = Output(Vec(StoreBufferSize, Vec(CacheLineVWords, Vec(VDataBytes, UInt(8.W)))))
103cdbff57cSHaoyuan Feng    val maskOut = Output(Vec(StoreBufferSize, Vec(CacheLineVWords, Vec(VDataBytes, Bool()))))
104ad3ba452Szhanglinjuan  })
105ad3ba452Szhanglinjuan
106cdbff57cSHaoyuan Feng  val data = Reg(Vec(StoreBufferSize, Vec(CacheLineVWords, Vec(VDataBytes, UInt(8.W)))))
1078b1251e1SWilliam Wang  // val mask = Reg(Vec(StoreBufferSize, Vec(CacheLineWords, Vec(DataBytes, Bool()))))
1088b1251e1SWilliam Wang  val mask = RegInit(
1098b1251e1SWilliam Wang    VecInit(Seq.fill(StoreBufferSize)(
110cdbff57cSHaoyuan Feng      VecInit(Seq.fill(CacheLineVWords)(
111cdbff57cSHaoyuan Feng        VecInit(Seq.fill(VDataBytes)(false.B))
1128b1251e1SWilliam Wang      ))
1138b1251e1SWilliam Wang    ))
1148b1251e1SWilliam Wang  )
1158b1251e1SWilliam Wang
1168b1251e1SWilliam Wang  // 2 cycle line mask clean
1178b1251e1SWilliam Wang  for(line <- 0 until StoreBufferSize){
1185adc4829SYanqin Li    val line_mask_clean_flag = GatedValidRegNext(
1198b1251e1SWilliam Wang      io.maskFlushReq.map(a => a.valid && a.bits.wvec(line)).reduce(_ || _)
1208b1251e1SWilliam Wang    )
1218b1251e1SWilliam Wang    line_mask_clean_flag.suggestName("line_mask_clean_flag_"+line)
1228b1251e1SWilliam Wang    when(line_mask_clean_flag){
123cdbff57cSHaoyuan Feng      for(word <- 0 until CacheLineVWords){
124cdbff57cSHaoyuan Feng        for(byte <- 0 until VDataBytes){
1258b1251e1SWilliam Wang          mask(line)(word)(byte) := false.B
1268b1251e1SWilliam Wang        }
1278b1251e1SWilliam Wang      }
1288b1251e1SWilliam Wang    }
1298b1251e1SWilliam Wang  }
130ad3ba452Szhanglinjuan
1313d3419b9SWilliam Wang  // 2 cycle data / mask update
13246f74b57SHaojin Tang  for(i <- 0 until EnsbufferWidth) {
1333d3419b9SWilliam Wang    val req = io.writeReq(i)
13467c26c34SWilliam Wang    for(line <- 0 until StoreBufferSize){
1353d3419b9SWilliam Wang      val sbuffer_in_s1_line_wen = req.valid && req.bits.wvec(line)
1365adc4829SYanqin Li      val sbuffer_in_s2_line_wen = GatedValidRegNext(sbuffer_in_s1_line_wen)
1373d3419b9SWilliam Wang      val line_write_buffer_data = RegEnable(req.bits.data, sbuffer_in_s1_line_wen)
1383d3419b9SWilliam Wang      val line_write_buffer_wline = RegEnable(req.bits.wline, sbuffer_in_s1_line_wen)
1393d3419b9SWilliam Wang      val line_write_buffer_mask = RegEnable(req.bits.mask, sbuffer_in_s1_line_wen)
140cdbff57cSHaoyuan Feng      val line_write_buffer_offset = RegEnable(req.bits.vwordOffset(VWordsWidth-1, 0), sbuffer_in_s1_line_wen)
1413d3419b9SWilliam Wang      sbuffer_in_s1_line_wen.suggestName("sbuffer_in_s1_line_wen_"+line)
1423d3419b9SWilliam Wang      sbuffer_in_s2_line_wen.suggestName("sbuffer_in_s2_line_wen_"+line)
1433d3419b9SWilliam Wang      line_write_buffer_data.suggestName("line_write_buffer_data_"+line)
1443d3419b9SWilliam Wang      line_write_buffer_wline.suggestName("line_write_buffer_wline_"+line)
1453d3419b9SWilliam Wang      line_write_buffer_mask.suggestName("line_write_buffer_mask_"+line)
1463d3419b9SWilliam Wang      line_write_buffer_offset.suggestName("line_write_buffer_offset_"+line)
147cdbff57cSHaoyuan Feng      for(word <- 0 until CacheLineVWords){
148cdbff57cSHaoyuan Feng        for(byte <- 0 until VDataBytes){
1493d3419b9SWilliam Wang          val write_byte = sbuffer_in_s2_line_wen && (
1503d3419b9SWilliam Wang            line_write_buffer_mask(byte) && (line_write_buffer_offset === word.U) ||
1513d3419b9SWilliam Wang            line_write_buffer_wline
15267c26c34SWilliam Wang          )
1533d3419b9SWilliam Wang          when(write_byte){
1543d3419b9SWilliam Wang            data(line)(word)(byte) := line_write_buffer_data(byte*8+7, byte*8)
1553d3419b9SWilliam Wang            mask(line)(word)(byte) := true.B
1563d3419b9SWilliam Wang          }
1573d3419b9SWilliam Wang        }
1583d3419b9SWilliam Wang      }
1593d3419b9SWilliam Wang    }
1603d3419b9SWilliam Wang  }
1613d3419b9SWilliam Wang
1623d3419b9SWilliam Wang  // 1 cycle line mask clean
1638b1251e1SWilliam Wang  // for(i <- 0 until EnsbufferWidth) {
1648b1251e1SWilliam Wang  //   val req = io.writeReq(i)
1658b1251e1SWilliam Wang  //   when(req.valid){
1668b1251e1SWilliam Wang  //     for(line <- 0 until StoreBufferSize){
1678b1251e1SWilliam Wang  //       when(
1688b1251e1SWilliam Wang  //         req.bits.wvec(line) &&
1698b1251e1SWilliam Wang  //         req.bits.cleanMask
1708b1251e1SWilliam Wang  //       ){
1718b1251e1SWilliam Wang  //         for(word <- 0 until CacheLineWords){
1728b1251e1SWilliam Wang  //           for(byte <- 0 until DataBytes){
1738b1251e1SWilliam Wang  //             mask(line)(word)(byte) := false.B
1748b1251e1SWilliam Wang  //             val debug_last_cycle_write_byte = RegNext(req.valid && req.bits.wvec(line) && (
1758b1251e1SWilliam Wang  //               req.bits.mask(byte) && (req.bits.wordOffset(WordsWidth-1, 0) === word.U) ||
1768b1251e1SWilliam Wang  //               req.bits.wline
1778b1251e1SWilliam Wang  //             ))
1788b1251e1SWilliam Wang  //             assert(!debug_last_cycle_write_byte)
1798b1251e1SWilliam Wang  //           }
1808b1251e1SWilliam Wang  //         }
1818b1251e1SWilliam Wang  //       }
1828b1251e1SWilliam Wang  //     }
1838b1251e1SWilliam Wang  //   }
1848b1251e1SWilliam Wang  // }
185ad3ba452Szhanglinjuan
186ad3ba452Szhanglinjuan  io.dataOut := data
1873d3419b9SWilliam Wang  io.maskOut := mask
188ad3ba452Szhanglinjuan}
189ad3ba452Szhanglinjuan
1909ae95edaSAnzoooooclass Sbuffer(implicit p: Parameters)
1919ae95edaSAnzooooo  extends DCacheModule
1929ae95edaSAnzooooo    with HasSbufferConst
1939ae95edaSAnzooooo    with HasPerfEvents {
194ad3ba452Szhanglinjuan  val io = IO(new Bundle() {
195f57f7f2aSYangyu Chen    val hartId = Input(UInt(hartIdLen.W))
1960d32f713Shappy-lx    val in = Vec(EnsbufferWidth, Flipped(Decoupled(new DCacheWordReqWithVaddrAndPfFlag)))  //Todo: store logic only support Width == 2 now
1979ae95edaSAnzooooo    val vecDifftestInfo = Vec(EnsbufferWidth, Flipped(Decoupled(new DynInst)))
198ad3ba452Szhanglinjuan    val dcache = Flipped(new DCacheToSbufferIO)
199ad3ba452Szhanglinjuan    val forward = Vec(LoadPipelineWidth, Flipped(new LoadForwardQueryIO))
200ad3ba452Szhanglinjuan    val sqempty = Input(Bool())
2013fbc86fcSChen Xi    val sbempty = Output(Bool())
202ad3ba452Szhanglinjuan    val flush = Flipped(new SbufferFlushBundle)
203ad3ba452Szhanglinjuan    val csrCtrl = Flipped(new CustomCSRCtrlIO)
2040d32f713Shappy-lx    val store_prefetch = Vec(StorePipelineWidth, DecoupledIO(new StorePrefetchReq)) // to dcache
2050d32f713Shappy-lx    val memSetPattenDetected = Input(Bool())
2062fdb4d6aShappy-lx    val force_write = Input(Bool())
207ad3ba452Szhanglinjuan  })
208ad3ba452Szhanglinjuan
209ad3ba452Szhanglinjuan  val dataModule = Module(new SbufferData)
210ad3ba452Szhanglinjuan  dataModule.io.writeReq <> DontCare
2110d32f713Shappy-lx  val prefetcher = Module(new StorePfWrapper())
212ad3ba452Szhanglinjuan  val writeReq = dataModule.io.writeReq
213ad3ba452Szhanglinjuan
214ad3ba452Szhanglinjuan  val ptag = Reg(Vec(StoreBufferSize, UInt(PTagWidth.W)))
215ad3ba452Szhanglinjuan  val vtag = Reg(Vec(StoreBufferSize, UInt(VTagWidth.W)))
2163d3419b9SWilliam Wang  val debug_mask = Reg(Vec(StoreBufferSize, Vec(CacheLineWords, Vec(DataBytes, Bool()))))
217a98b054bSWilliam Wang  val waitInflightMask = Reg(Vec(StoreBufferSize, UInt(StoreBufferSize.W)))
218ad3ba452Szhanglinjuan  val data = dataModule.io.dataOut
2193d3419b9SWilliam Wang  val mask = dataModule.io.maskOut
220ad3ba452Szhanglinjuan  val stateVec = RegInit(VecInit(Seq.fill(StoreBufferSize)(0.U.asTypeOf(new SbufferEntryState))))
221ad3ba452Szhanglinjuan  val cohCount = RegInit(VecInit(Seq.fill(StoreBufferSize)(0.U(EvictCountBits.W))))
222ad3ba452Szhanglinjuan  val missqReplayCount = RegInit(VecInit(Seq.fill(StoreBufferSize)(0.U(MissqReplayCountBits.W))))
223ad3ba452Szhanglinjuan
22480382c05SWilliam Wang  val sbuffer_out_s0_fire = Wire(Bool())
22596b1e495SWilliam Wang
226ad3ba452Szhanglinjuan  /*
227ad3ba452Szhanglinjuan       idle --[flush]   --> drain   --[buf empty]--> idle
228ad3ba452Szhanglinjuan            --[buf full]--> replace --[dcache resp]--> idle
229ad3ba452Szhanglinjuan  */
230ad3ba452Szhanglinjuan  // x_drain_all: drain store queue and sbuffer
231ad3ba452Szhanglinjuan  // x_drain_sbuffer: drain sbuffer only, block store queue to sbuffer write
232ad3ba452Szhanglinjuan  val x_idle :: x_replace :: x_drain_all :: x_drain_sbuffer :: Nil = Enum(4)
233ad3ba452Szhanglinjuan  def needDrain(state: UInt): Bool =
234ad3ba452Szhanglinjuan    state(1)
235ad3ba452Szhanglinjuan  val sbuffer_state = RegInit(x_idle)
236ad3ba452Szhanglinjuan
237ad3ba452Szhanglinjuan  // ---------------------- Store Enq Sbuffer ---------------------
238ad3ba452Szhanglinjuan
239ad3ba452Szhanglinjuan  def getPTag(pa: UInt): UInt =
240ad3ba452Szhanglinjuan    pa(PAddrBits - 1, PAddrBits - PTagWidth)
241ad3ba452Szhanglinjuan
242ad3ba452Szhanglinjuan  def getVTag(va: UInt): UInt =
243ad3ba452Szhanglinjuan    va(VAddrBits - 1, VAddrBits - VTagWidth)
244ad3ba452Szhanglinjuan
245ad3ba452Szhanglinjuan  def getWord(pa: UInt): UInt =
246ad3ba452Szhanglinjuan    pa(PAddrBits-1, 3)
247ad3ba452Szhanglinjuan
248cdbff57cSHaoyuan Feng  def getVWord(pa: UInt): UInt =
249cdbff57cSHaoyuan Feng    pa(PAddrBits-1, 4)
250cdbff57cSHaoyuan Feng
251ad3ba452Szhanglinjuan  def getWordOffset(pa: UInt): UInt =
252ad3ba452Szhanglinjuan    pa(OffsetWidth-1, 3)
253ad3ba452Szhanglinjuan
254cdbff57cSHaoyuan Feng  def getVWordOffset(pa: UInt): UInt =
255cdbff57cSHaoyuan Feng    pa(OffsetWidth-1, 4)
256cdbff57cSHaoyuan Feng
257ad3ba452Szhanglinjuan  def getAddr(ptag: UInt): UInt =
258ad3ba452Szhanglinjuan    Cat(ptag, 0.U((PAddrBits - PTagWidth).W))
259ad3ba452Szhanglinjuan
260ad3ba452Szhanglinjuan  def getByteOffset(offect: UInt): UInt =
261ad3ba452Szhanglinjuan    Cat(offect(OffsetWidth - 1, 3), 0.U(3.W))
262ad3ba452Szhanglinjuan
263ad3ba452Szhanglinjuan  def isOneOf(key: UInt, seq: Seq[UInt]): Bool =
264935edac4STang Haojin    if(seq.isEmpty) false.B else Cat(seq.map(_===key)).orR
265ad3ba452Szhanglinjuan
266ad3ba452Szhanglinjuan  def widthMap[T <: Data](f: Int => T) = (0 until StoreBufferSize) map f
267ad3ba452Szhanglinjuan
268ad3ba452Szhanglinjuan  // sbuffer entry count
269ad3ba452Szhanglinjuan
2702fdb4d6aShappy-lx  val plru = new ValidPseudoLRU(StoreBufferSize)
27146f74b57SHaojin Tang  val accessIdx = Wire(Vec(EnsbufferWidth + 1, Valid(UInt(SbufferIndexWidth.W))))
272ad3ba452Szhanglinjuan
273d2b20d1aSTang Haojin  val candidateVec = VecInit(stateVec.map(s => s.isDcacheReqCandidate()))
274d2b20d1aSTang Haojin
2752fdb4d6aShappy-lx  val replaceAlgoIdx = plru.way(candidateVec.reverse)._2
276d2b20d1aSTang Haojin  val replaceAlgoNotDcacheCandidate = !stateVec(replaceAlgoIdx).isDcacheReqCandidate()
277d2b20d1aSTang Haojin
278935edac4STang Haojin  assert(!(candidateVec.asUInt.orR && replaceAlgoNotDcacheCandidate), "we have way to select, but replace algo selects invalid way")
2792fdb4d6aShappy-lx
2802fdb4d6aShappy-lx  val replaceIdx = replaceAlgoIdx
281ad3ba452Szhanglinjuan  plru.access(accessIdx)
282ad3ba452Szhanglinjuan
283ad3ba452Szhanglinjuan  //-------------------------cohCount-----------------------------
284ad3ba452Szhanglinjuan  // insert and merge: cohCount=0
285ad3ba452Szhanglinjuan  // every cycle cohCount+=1
286ad3ba452Szhanglinjuan  // if cohCount(EvictCountBits-1)==1, evict
287ad3ba452Szhanglinjuan  val cohTimeOutMask = VecInit(widthMap(i => cohCount(i)(EvictCountBits - 1) && stateVec(i).isActive()))
288ad3ba452Szhanglinjuan  val (cohTimeOutIdx, cohHasTimeOut) = PriorityEncoderWithFlag(cohTimeOutMask)
289779faf12SWilliam Wang  val cohTimeOutOH = PriorityEncoderOH(cohTimeOutMask)
290ad3ba452Szhanglinjuan  val missqReplayTimeOutMask = VecInit(widthMap(i => missqReplayCount(i)(MissqReplayCountBits - 1) && stateVec(i).w_timeout))
291779faf12SWilliam Wang  val (missqReplayTimeOutIdxGen, missqReplayHasTimeOutGen) = PriorityEncoderWithFlag(missqReplayTimeOutMask)
2925adc4829SYanqin Li  val missqReplayHasTimeOut = GatedValidRegNext(missqReplayHasTimeOutGen) && !GatedValidRegNext(sbuffer_out_s0_fire)
293779faf12SWilliam Wang  val missqReplayTimeOutIdx = RegEnable(missqReplayTimeOutIdxGen, missqReplayHasTimeOutGen)
294ad3ba452Szhanglinjuan
2953d3419b9SWilliam Wang  //-------------------------sbuffer enqueue-----------------------------
2963d3419b9SWilliam Wang
2973d3419b9SWilliam Wang  // Now sbuffer enq logic is divided into 3 stages:
2983d3419b9SWilliam Wang
2993d3419b9SWilliam Wang  // sbuffer_in_s0:
3003d3419b9SWilliam Wang  // * read data and meta from store queue
3013d3419b9SWilliam Wang  // * store them in 2 entry fifo queue
3023d3419b9SWilliam Wang
3033d3419b9SWilliam Wang  // sbuffer_in_s1:
3043d3419b9SWilliam Wang  // * read data and meta from fifo queue
3053d3419b9SWilliam Wang  // * update sbuffer meta (vtag, ptag, flag)
306*e04c5f64SYanqin Li  // * prevent that line from being sent to dcache (add a block condition)
3073d3419b9SWilliam Wang  // * prepare cacheline level write enable signal, RegNext() data and mask
3083d3419b9SWilliam Wang
3093d3419b9SWilliam Wang  // sbuffer_in_s2:
3103d3419b9SWilliam Wang  // * use cacheline level buffer to update sbuffer data and mask
3113d3419b9SWilliam Wang  // * remove dcache write block (if there is)
3123d3419b9SWilliam Wang
313ad3ba452Szhanglinjuan  val activeMask = VecInit(stateVec.map(s => s.isActive()))
314d2b20d1aSTang Haojin  val validMask  = VecInit(stateVec.map(s => s.isValid()))
315ad3ba452Szhanglinjuan  val drainIdx = PriorityEncoder(activeMask)
316ad3ba452Szhanglinjuan
317ad3ba452Szhanglinjuan  val inflightMask = VecInit(stateVec.map(s => s.isInflight()))
318ad3ba452Szhanglinjuan
319ad3ba452Szhanglinjuan  val inptags = io.in.map(in => getPTag(in.bits.addr))
320ad3ba452Szhanglinjuan  val invtags = io.in.map(in => getVTag(in.bits.vaddr))
321c9ae2b14SXuan Hu  val sameTag = inptags(0) === inptags(1) && io.in(0).valid && io.in(1).valid && io.in(0).bits.vecValid && io.in(1).bits.vecValid
322cdbff57cSHaoyuan Feng  val firstWord = getVWord(io.in(0).bits.addr)
323cdbff57cSHaoyuan Feng  val secondWord = getVWord(io.in(1).bits.addr)
324ad3ba452Szhanglinjuan  // merge condition
32546f74b57SHaojin Tang  val mergeMask = Wire(Vec(EnsbufferWidth, Vec(StoreBufferSize, Bool())))
32667c26c34SWilliam Wang  val mergeIdx = mergeMask.map(PriorityEncoder(_)) // avoid using mergeIdx for better timing
327ad3ba452Szhanglinjuan  val canMerge = mergeMask.map(ParallelOR(_))
32867c26c34SWilliam Wang  val mergeVec = mergeMask.map(_.asUInt)
329ad3ba452Szhanglinjuan
33046f74b57SHaojin Tang  for(i <- 0 until EnsbufferWidth){
331ad3ba452Szhanglinjuan    mergeMask(i) := widthMap(j =>
332ad3ba452Szhanglinjuan      inptags(i) === ptag(j) && activeMask(j)
333ad3ba452Szhanglinjuan    )
334315e1323Sgood-circle    assert(!(PopCount(mergeMask(i).asUInt) > 1.U && io.in(i).fire && io.in(i).bits.vecValid))
335ad3ba452Szhanglinjuan  }
336ad3ba452Szhanglinjuan
337ad3ba452Szhanglinjuan  // insert condition
338ad3ba452Szhanglinjuan  // firstInsert: the first invalid entry
339ad3ba452Szhanglinjuan  // if first entry canMerge or second entry has the same ptag with the first entry,
340ad3ba452Szhanglinjuan  // secondInsert equal the first invalid entry, otherwise, the second invalid entry
341ad3ba452Szhanglinjuan  val invalidMask = VecInit(stateVec.map(s => s.isInvalid()))
342db7f55d9SWilliam Wang  val evenInvalidMask = GetEvenBits(invalidMask.asUInt)
343db7f55d9SWilliam Wang  val oddInvalidMask = GetOddBits(invalidMask.asUInt)
344ad3ba452Szhanglinjuan
34567c26c34SWilliam Wang  def getFirstOneOH(input: UInt): UInt = {
34667c26c34SWilliam Wang    assert(input.getWidth > 1)
34767c26c34SWilliam Wang    val output = WireInit(VecInit(input.asBools))
34867c26c34SWilliam Wang    (1 until input.getWidth).map(i => {
34967c26c34SWilliam Wang      output(i) := !input(i - 1, 0).orR && input(i)
35067c26c34SWilliam Wang    })
35167c26c34SWilliam Wang    output.asUInt
35267c26c34SWilliam Wang  }
35367c26c34SWilliam Wang
354db7f55d9SWilliam Wang  val evenRawInsertVec = getFirstOneOH(evenInvalidMask)
355db7f55d9SWilliam Wang  val oddRawInsertVec = getFirstOneOH(oddInvalidMask)
356db7f55d9SWilliam Wang  val (evenRawInsertIdx, evenCanInsert) = PriorityEncoderWithFlag(evenInvalidMask)
357db7f55d9SWilliam Wang  val (oddRawInsertIdx, oddCanInsert) = PriorityEncoderWithFlag(oddInvalidMask)
358db7f55d9SWilliam Wang  val evenInsertIdx = Cat(evenRawInsertIdx, 0.U(1.W)) // slow to generate, for debug only
359db7f55d9SWilliam Wang  val oddInsertIdx = Cat(oddRawInsertIdx, 1.U(1.W)) // slow to generate, for debug only
360db7f55d9SWilliam Wang  val evenInsertVec = GetEvenBits.reverse(evenRawInsertVec)
361db7f55d9SWilliam Wang  val oddInsertVec = GetOddBits.reverse(oddRawInsertVec)
362ad3ba452Szhanglinjuan
363db7f55d9SWilliam Wang  val enbufferSelReg = RegInit(false.B)
364db7f55d9SWilliam Wang  when(io.in(0).valid) {
365db7f55d9SWilliam Wang    enbufferSelReg := ~enbufferSelReg
366ad3ba452Szhanglinjuan  }
367ad3ba452Szhanglinjuan
368db7f55d9SWilliam Wang  val firstInsertIdx = Mux(enbufferSelReg, evenInsertIdx, oddInsertIdx) // slow to generate, for debug only
369db7f55d9SWilliam Wang  val secondInsertIdx = Mux(sameTag,
370db7f55d9SWilliam Wang    firstInsertIdx,
371db7f55d9SWilliam Wang    Mux(~enbufferSelReg, evenInsertIdx, oddInsertIdx)
37267c26c34SWilliam Wang  ) // slow to generate, for debug only
373db7f55d9SWilliam Wang  val firstInsertVec = Mux(enbufferSelReg, evenInsertVec, oddInsertVec)
374db7f55d9SWilliam Wang  val secondInsertVec = Mux(sameTag,
375db7f55d9SWilliam Wang    firstInsertVec,
376db7f55d9SWilliam Wang    Mux(~enbufferSelReg, evenInsertVec, oddInsertVec)
37767c26c34SWilliam Wang  ) // slow to generate, for debug only
378db7f55d9SWilliam Wang  val firstCanInsert = sbuffer_state =/= x_drain_sbuffer && Mux(enbufferSelReg, evenCanInsert, oddCanInsert)
379db7f55d9SWilliam Wang  val secondCanInsert = sbuffer_state =/= x_drain_sbuffer && Mux(sameTag,
380db7f55d9SWilliam Wang    firstCanInsert,
381db7f55d9SWilliam Wang    Mux(~enbufferSelReg, evenCanInsert, oddCanInsert)
382db7f55d9SWilliam Wang  ) && (EnsbufferWidth >= 1).B
38396b1e495SWilliam Wang  val forward_need_uarch_drain = WireInit(false.B)
38496b1e495SWilliam Wang  val merge_need_uarch_drain = WireInit(false.B)
3855adc4829SYanqin Li  val do_uarch_drain = GatedValidRegNext(forward_need_uarch_drain) || GatedValidRegNext(GatedValidRegNext(merge_need_uarch_drain))
386ad3ba452Szhanglinjuan  XSPerfAccumulate("do_uarch_drain", do_uarch_drain)
387ad3ba452Szhanglinjuan
388db7f55d9SWilliam Wang  io.in(0).ready := firstCanInsert
38945a77344SHaoyuan Feng  io.in(1).ready := secondCanInsert && io.in(0).ready
390ad3ba452Szhanglinjuan
3910d32f713Shappy-lx  for (i <- 0 until EnsbufferWidth) {
3920d32f713Shappy-lx    // train
3930d32f713Shappy-lx    if (EnableStorePrefetchSPB) {
394315e1323Sgood-circle      prefetcher.io.sbuffer_enq(i).valid := io.in(i).fire && io.in(i).bits.vecValid
3950d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).bits := DontCare
3960d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).bits.vaddr := io.in(i).bits.vaddr
3970d32f713Shappy-lx    } else {
3980d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).valid := false.B
3990d32f713Shappy-lx      prefetcher.io.sbuffer_enq(i).bits := DontCare
4000d32f713Shappy-lx    }
4010d32f713Shappy-lx
4020d32f713Shappy-lx    // prefetch req
4030d32f713Shappy-lx    if (EnableStorePrefetchAtCommit) {
4040d32f713Shappy-lx      if (EnableAtCommitMissTrigger) {
405315e1323Sgood-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)
4060d32f713Shappy-lx      } else {
407315e1323Sgood-circle        io.store_prefetch(i).valid := prefetcher.io.prefetch_req(i).valid || (io.in(i).fire && io.in(i).bits.vecValid)
4080d32f713Shappy-lx      }
4090d32f713Shappy-lx      io.store_prefetch(i).bits.paddr := DontCare
4100d32f713Shappy-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)
4110d32f713Shappy-lx      prefetcher.io.prefetch_req(i).ready := io.store_prefetch(i).ready
4120d32f713Shappy-lx    } else {
4130d32f713Shappy-lx      io.store_prefetch(i) <> prefetcher.io.prefetch_req(i)
4140d32f713Shappy-lx    }
415202674aeSHaojin Tang    io.store_prefetch zip prefetcher.io.prefetch_req drop 2 foreach (x => x._1 <> x._2)
4160d32f713Shappy-lx  }
4170d32f713Shappy-lx  prefetcher.io.memSetPattenDetected := io.memSetPattenDetected
4180d32f713Shappy-lx
4193d3419b9SWilliam Wang  def wordReqToBufLine( // allocate a new line in sbuffer
4203d3419b9SWilliam Wang    req: DCacheWordReq,
4213d3419b9SWilliam Wang    reqptag: UInt,
4223d3419b9SWilliam Wang    reqvtag: UInt,
4233d3419b9SWilliam Wang    insertIdx: UInt,
4243d3419b9SWilliam Wang    insertVec: UInt,
4258b1251e1SWilliam Wang    wordOffset: UInt
4263d3419b9SWilliam Wang  ): Unit = {
42767c26c34SWilliam Wang    assert(UIntToOH(insertIdx) === insertVec)
428a98b054bSWilliam Wang    val sameBlockInflightMask = genSameBlockInflightMask(reqptag)
42967c26c34SWilliam Wang    (0 until StoreBufferSize).map(entryIdx => {
43067c26c34SWilliam Wang      when(insertVec(entryIdx)){
43167c26c34SWilliam Wang        stateVec(entryIdx).state_valid := true.B
43267c26c34SWilliam Wang        stateVec(entryIdx).w_sameblock_inflight := sameBlockInflightMask.orR // set w_sameblock_inflight when a line is first allocated
433a98b054bSWilliam Wang        when(sameBlockInflightMask.orR){
43467c26c34SWilliam Wang          waitInflightMask(entryIdx) := sameBlockInflightMask
435a98b054bSWilliam Wang        }
43667c26c34SWilliam Wang        cohCount(entryIdx) := 0.U
43796b1e495SWilliam Wang        // missqReplayCount(insertIdx) := 0.U
43867c26c34SWilliam Wang        ptag(entryIdx) := reqptag
439cdbff57cSHaoyuan Feng        vtag(entryIdx) := reqvtag // update vtag if a new sbuffer line is allocated
440ad3ba452Szhanglinjuan      }
44167c26c34SWilliam Wang    })
44267c26c34SWilliam Wang  }
443ad3ba452Szhanglinjuan
4443d3419b9SWilliam Wang  def mergeWordReq( // merge write req into an existing line
4453d3419b9SWilliam Wang    req: DCacheWordReq,
4463d3419b9SWilliam Wang    reqptag: UInt,
4473d3419b9SWilliam Wang    reqvtag: UInt,
4483d3419b9SWilliam Wang    mergeIdx: UInt,
4493d3419b9SWilliam Wang    mergeVec: UInt,
4503d3419b9SWilliam Wang    wordOffset: UInt
4513d3419b9SWilliam Wang  ): Unit = {
45267c26c34SWilliam Wang    assert(UIntToOH(mergeIdx) === mergeVec)
45367c26c34SWilliam Wang    (0 until StoreBufferSize).map(entryIdx => {
45467c26c34SWilliam Wang      when(mergeVec(entryIdx)) {
45567c26c34SWilliam Wang        cohCount(entryIdx) := 0.U
45667c26c34SWilliam Wang        // missqReplayCount(entryIdx) := 0.U
457ad3ba452Szhanglinjuan        // check if vtag is the same, if not, trigger sbuffer flush
45867c26c34SWilliam Wang        when(reqvtag =/= vtag(entryIdx)) {
459ad3ba452Szhanglinjuan          XSDebug("reqvtag =/= sbufvtag req(vtag %x ptag %x) sbuffer(vtag %x ptag %x)\n",
460ad3ba452Szhanglinjuan            reqvtag << OffsetWidth,
461ad3ba452Szhanglinjuan            reqptag << OffsetWidth,
46267c26c34SWilliam Wang            vtag(entryIdx) << OffsetWidth,
46367c26c34SWilliam Wang            ptag(entryIdx) << OffsetWidth
464ad3ba452Szhanglinjuan          )
46596b1e495SWilliam Wang          merge_need_uarch_drain := true.B
466ad3ba452Szhanglinjuan        }
467ad3ba452Szhanglinjuan      }
46867c26c34SWilliam Wang    })
46967c26c34SWilliam Wang  }
470ad3ba452Szhanglinjuan
471cdbff57cSHaoyuan Feng  for(((in, vwordOffset), i) <- io.in.zip(Seq(firstWord, secondWord)).zipWithIndex){
472315e1323Sgood-circle    writeReq(i).valid := in.fire && in.bits.vecValid
473cdbff57cSHaoyuan Feng    writeReq(i).bits.vwordOffset := vwordOffset
474ad3ba452Szhanglinjuan    writeReq(i).bits.mask := in.bits.mask
475ad3ba452Szhanglinjuan    writeReq(i).bits.data := in.bits.data
476ca18a0b4SWilliam Wang    writeReq(i).bits.wline := in.bits.wline
4773d3419b9SWilliam Wang    val debug_insertIdx = if(i == 0) firstInsertIdx else secondInsertIdx
4783d3419b9SWilliam Wang    val insertVec = if(i == 0) firstInsertVec else secondInsertVec
479315e1323Sgood-circle    assert(!((PopCount(insertVec) > 1.U) && in.fire && in.bits.vecValid))
48067c26c34SWilliam Wang    val insertIdx = OHToUInt(insertVec)
4815adc4829SYanqin Li    val accessValid = in.fire && in.bits.vecValid
4825adc4829SYanqin Li    accessIdx(i).valid := RegNext(accessValid)
4835adc4829SYanqin Li    accessIdx(i).bits := RegEnable(Mux(canMerge(i), mergeIdx(i), insertIdx), accessValid)
4845adc4829SYanqin Li    when(accessValid){
485ad3ba452Szhanglinjuan      when(canMerge(i)){
48667c26c34SWilliam Wang        writeReq(i).bits.wvec := mergeVec(i)
487cdbff57cSHaoyuan Feng        mergeWordReq(in.bits, inptags(i), invtags(i), mergeIdx(i), mergeVec(i), vwordOffset)
488ad3ba452Szhanglinjuan        XSDebug(p"merge req $i to line [${mergeIdx(i)}]\n")
489ad3ba452Szhanglinjuan      }.otherwise({
49067c26c34SWilliam Wang        writeReq(i).bits.wvec := insertVec
491cdbff57cSHaoyuan Feng        wordReqToBufLine(in.bits, inptags(i), invtags(i), insertIdx, insertVec, vwordOffset)
492ad3ba452Szhanglinjuan        XSDebug(p"insert req $i to line[$insertIdx]\n")
49367c26c34SWilliam Wang        assert(debug_insertIdx === insertIdx)
494ad3ba452Szhanglinjuan      })
495ad3ba452Szhanglinjuan    }
496ad3ba452Szhanglinjuan  }
497ad3ba452Szhanglinjuan
498ad3ba452Szhanglinjuan
499ad3ba452Szhanglinjuan  for(i <- 0 until StoreBufferSize){
500ad3ba452Szhanglinjuan    XSDebug(stateVec(i).isValid(),
501ad3ba452Szhanglinjuan      p"[$i] timeout:${cohCount(i)(EvictCountBits-1)} state:${stateVec(i)}\n"
502ad3ba452Szhanglinjuan    )
503ad3ba452Szhanglinjuan  }
504ad3ba452Szhanglinjuan
505ad3ba452Szhanglinjuan  for((req, i) <- io.in.zipWithIndex){
506315e1323Sgood-circle    XSDebug(req.fire && req.bits.vecValid,
507ad3ba452Szhanglinjuan      p"accept req [$i]: " +
508ad3ba452Szhanglinjuan        p"addr:${Hexadecimal(req.bits.addr)} " +
509cdbff57cSHaoyuan Feng        p"mask:${Binary(shiftMaskToLow(req.bits.addr,req.bits.mask))} " +
510cdbff57cSHaoyuan Feng        p"data:${Hexadecimal(shiftDataToLow(req.bits.addr,req.bits.data))}\n"
511ad3ba452Szhanglinjuan    )
512ad3ba452Szhanglinjuan    XSDebug(req.valid && !req.ready,
513ad3ba452Szhanglinjuan      p"req [$i] blocked by sbuffer\n"
514ad3ba452Szhanglinjuan    )
515ad3ba452Szhanglinjuan  }
516ad3ba452Szhanglinjuan
5170d32f713Shappy-lx  // for now, when enq, trigger a prefetch (if EnableAtCommitMissTrigger)
518202674aeSHaojin Tang  require(EnsbufferWidth <= StorePipelineWidth)
5190d32f713Shappy-lx
520ad3ba452Szhanglinjuan  // ---------------------- Send Dcache Req ---------------------
521ad3ba452Szhanglinjuan
522935edac4STang Haojin  val sbuffer_empty = Cat(invalidMask).andR
523935edac4STang Haojin  val sq_empty = !Cat(io.in.map(_.valid)).orR
524ad3ba452Szhanglinjuan  val empty = sbuffer_empty && sq_empty
5252fdb4d6aShappy-lx  val threshold = Wire(UInt(5.W)) // RegNext(io.csrCtrl.sbuffer_threshold +& 1.U)
526c686adcdSYinan Xu  threshold := Constantin.createRecord(s"StoreBufferThreshold_${p(XSCoreParamsKey).HartId}", initValue = 7)
5272fdb4d6aShappy-lx  val base = Wire(UInt(5.W))
528c686adcdSYinan Xu  base := Constantin.createRecord(s"StoreBufferBase_${p(XSCoreParamsKey).HartId}", initValue = 4)
529d2b20d1aSTang Haojin  val ActiveCount = PopCount(activeMask)
530d2b20d1aSTang Haojin  val ValidCount = PopCount(validMask)
5312fdb4d6aShappy-lx  val forceThreshold = Mux(io.force_write, threshold - base, threshold)
5325adc4829SYanqin Li  val do_eviction = GatedValidRegNext(ActiveCount >= forceThreshold || ActiveCount === (StoreBufferSize-1).U || ValidCount === (StoreBufferSize).U, init = false.B)
533ad3ba452Szhanglinjuan  require((StoreBufferThreshold + 1) <= StoreBufferSize)
534ad3ba452Szhanglinjuan
535d2b20d1aSTang Haojin  XSDebug(p"ActiveCount[$ActiveCount]\n")
536ad3ba452Szhanglinjuan
5373fbc86fcSChen Xi  io.sbempty := GatedValidRegNext(empty)
5385adc4829SYanqin Li  io.flush.empty := GatedValidRegNext(empty && io.sqempty)
539ad3ba452Szhanglinjuan  // lru.io.flush := sbuffer_state === x_drain_all && empty
540ad3ba452Szhanglinjuan  switch(sbuffer_state){
541ad3ba452Szhanglinjuan    is(x_idle){
542ad3ba452Szhanglinjuan      when(io.flush.valid){
543ad3ba452Szhanglinjuan        sbuffer_state := x_drain_all
544ad3ba452Szhanglinjuan      }.elsewhen(do_uarch_drain){
545ad3ba452Szhanglinjuan        sbuffer_state := x_drain_sbuffer
546ad3ba452Szhanglinjuan      }.elsewhen(do_eviction){
547ad3ba452Szhanglinjuan        sbuffer_state := x_replace
548ad3ba452Szhanglinjuan      }
549ad3ba452Szhanglinjuan    }
550ad3ba452Szhanglinjuan    is(x_drain_all){
551ad3ba452Szhanglinjuan      when(empty){
552ad3ba452Szhanglinjuan        sbuffer_state := x_idle
553ad3ba452Szhanglinjuan      }
554ad3ba452Szhanglinjuan    }
555ad3ba452Szhanglinjuan    is(x_drain_sbuffer){
556a98b054bSWilliam Wang      when(io.flush.valid){
557a98b054bSWilliam Wang        sbuffer_state := x_drain_all
558a98b054bSWilliam Wang      }.elsewhen(sbuffer_empty){
559ad3ba452Szhanglinjuan        sbuffer_state := x_idle
560ad3ba452Szhanglinjuan      }
561ad3ba452Szhanglinjuan    }
562ad3ba452Szhanglinjuan    is(x_replace){
563ad3ba452Szhanglinjuan      when(io.flush.valid){
564ad3ba452Szhanglinjuan        sbuffer_state := x_drain_all
565ad3ba452Szhanglinjuan      }.elsewhen(do_uarch_drain){
566ad3ba452Szhanglinjuan        sbuffer_state := x_drain_sbuffer
567ad3ba452Szhanglinjuan      }.elsewhen(!do_eviction){
568ad3ba452Szhanglinjuan        sbuffer_state := x_idle
569ad3ba452Szhanglinjuan      }
570ad3ba452Szhanglinjuan    }
571ad3ba452Szhanglinjuan  }
572ad3ba452Szhanglinjuan  XSDebug(p"sbuffer state:${sbuffer_state} do eviction:${do_eviction} empty:${empty}\n")
573ad3ba452Szhanglinjuan
574ad3ba452Szhanglinjuan  def noSameBlockInflight(idx: UInt): Bool = {
575ad3ba452Szhanglinjuan    // stateVec(idx) itself must not be s_inflight
576935edac4STang Haojin    !Cat(widthMap(i => inflightMask(i) && ptag(idx) === ptag(i))).orR
577ad3ba452Szhanglinjuan  }
578ad3ba452Szhanglinjuan
579a98b054bSWilliam Wang  def genSameBlockInflightMask(ptag_in: UInt): UInt = {
580a98b054bSWilliam Wang    val mask = VecInit(widthMap(i => inflightMask(i) && ptag_in === ptag(i))).asUInt // quite slow, use it with care
581a98b054bSWilliam Wang    assert(!(PopCount(mask) > 1.U))
582a98b054bSWilliam Wang    mask
583a98b054bSWilliam Wang  }
584a98b054bSWilliam Wang
585a98b054bSWilliam Wang  def haveSameBlockInflight(ptag_in: UInt): Bool = {
586a98b054bSWilliam Wang    genSameBlockInflightMask(ptag_in).orR
587a98b054bSWilliam Wang  }
588a98b054bSWilliam Wang
58980382c05SWilliam Wang  // ---------------------------------------------------------------------------
59080382c05SWilliam Wang  // sbuffer to dcache pipeline
59180382c05SWilliam Wang  // ---------------------------------------------------------------------------
59280382c05SWilliam Wang
5933d3419b9SWilliam Wang  // Now sbuffer deq logic is divided into 2 stages:
5943d3419b9SWilliam Wang
5953d3419b9SWilliam Wang  // sbuffer_out_s0:
5963d3419b9SWilliam Wang  // * read data and meta from sbuffer
5973d3419b9SWilliam Wang  // * RegNext() them
5983d3419b9SWilliam Wang  // * set line state to inflight
5993d3419b9SWilliam Wang
6003d3419b9SWilliam Wang  // sbuffer_out_s1:
6013d3419b9SWilliam Wang  // * send write req to dcache
6023d3419b9SWilliam Wang
6033d3419b9SWilliam Wang  // sbuffer_out_extra:
6043d3419b9SWilliam Wang  // * receive write result from dcache
6053d3419b9SWilliam Wang  // * update line state
6063d3419b9SWilliam Wang
60780382c05SWilliam Wang  val sbuffer_out_s1_ready = Wire(Bool())
60880382c05SWilliam Wang
60980382c05SWilliam Wang  // ---------------------------------------------------------------------------
61080382c05SWilliam Wang  // sbuffer_out_s0
61180382c05SWilliam Wang  // ---------------------------------------------------------------------------
61280382c05SWilliam Wang
613ad3ba452Szhanglinjuan  val need_drain = needDrain(sbuffer_state)
614ad3ba452Szhanglinjuan  val need_replace = do_eviction || (sbuffer_state === x_replace)
61580382c05SWilliam Wang  val sbuffer_out_s0_evictionIdx = Mux(missqReplayHasTimeOut,
616779faf12SWilliam Wang    missqReplayTimeOutIdx,
617ad3ba452Szhanglinjuan    Mux(need_drain,
618ad3ba452Szhanglinjuan      drainIdx,
619ad3ba452Szhanglinjuan      Mux(cohHasTimeOut, cohTimeOutIdx, replaceIdx)
620ad3ba452Szhanglinjuan    )
621ad3ba452Szhanglinjuan  )
622ad3ba452Szhanglinjuan
62380382c05SWilliam Wang  // If there is a inflight dcache req which has same ptag with sbuffer_out_s0_evictionIdx's ptag,
62480382c05SWilliam Wang  // current eviction should be blocked.
62580382c05SWilliam Wang  val sbuffer_out_s0_valid = missqReplayHasTimeOut ||
62680382c05SWilliam Wang    stateVec(sbuffer_out_s0_evictionIdx).isDcacheReqCandidate() &&
62780382c05SWilliam Wang    (need_drain || cohHasTimeOut || need_replace)
62880382c05SWilliam Wang  assert(!(
629e3da8badSTang Haojin    stateVec(sbuffer_out_s0_evictionIdx).isDcacheReqCandidate() &&
63080382c05SWilliam Wang    !noSameBlockInflight(sbuffer_out_s0_evictionIdx)
63180382c05SWilliam Wang  ))
63280382c05SWilliam Wang  val sbuffer_out_s0_cango = sbuffer_out_s1_ready
63380382c05SWilliam Wang  sbuffer_out_s0_fire := sbuffer_out_s0_valid && sbuffer_out_s0_cango
63480382c05SWilliam Wang
63580382c05SWilliam Wang  // ---------------------------------------------------------------------------
63680382c05SWilliam Wang  // sbuffer_out_s1
63780382c05SWilliam Wang  // ---------------------------------------------------------------------------
63880382c05SWilliam Wang
6393d3419b9SWilliam Wang  // TODO: use EnsbufferWidth
6405adc4829SYanqin Li  val shouldWaitWriteFinish = GatedValidRegNext(VecInit((0 until EnsbufferWidth).map{i =>
641779faf12SWilliam Wang    (writeReq(i).bits.wvec.asUInt & UIntToOH(sbuffer_out_s0_evictionIdx).asUInt).orR &&
642779faf12SWilliam Wang    writeReq(i).valid
643779faf12SWilliam Wang  }).asUInt.orR)
6443d3419b9SWilliam Wang  // block dcache write if read / write hazard
6453d3419b9SWilliam Wang  val blockDcacheWrite = shouldWaitWriteFinish
6463d3419b9SWilliam Wang
64780382c05SWilliam Wang  val sbuffer_out_s1_valid = RegInit(false.B)
6483d3419b9SWilliam Wang  sbuffer_out_s1_ready := io.dcache.req.ready && !blockDcacheWrite || !sbuffer_out_s1_valid
649935edac4STang Haojin  val sbuffer_out_s1_fire = io.dcache.req.fire
65080382c05SWilliam Wang
65180382c05SWilliam Wang  // when sbuffer_out_s1_fire, send dcache req stored in pipeline reg to dcache
65280382c05SWilliam Wang  when(sbuffer_out_s1_fire){
65380382c05SWilliam Wang    sbuffer_out_s1_valid := false.B
654ad3ba452Szhanglinjuan  }
65580382c05SWilliam Wang  // when sbuffer_out_s0_fire, read dcache req data and store them in a pipeline reg
65680382c05SWilliam Wang  when(sbuffer_out_s0_cango){
65780382c05SWilliam Wang    sbuffer_out_s1_valid := sbuffer_out_s0_valid
658ad3ba452Szhanglinjuan  }
65980382c05SWilliam Wang  when(sbuffer_out_s0_fire){
66080382c05SWilliam Wang    stateVec(sbuffer_out_s0_evictionIdx).state_inflight := true.B
66180382c05SWilliam Wang    stateVec(sbuffer_out_s0_evictionIdx).w_timeout := false.B
66280382c05SWilliam Wang    // stateVec(sbuffer_out_s0_evictionIdx).s_pipe_req := true.B
66380382c05SWilliam Wang    XSDebug(p"$sbuffer_out_s0_evictionIdx will be sent to Dcache\n")
664ad3ba452Szhanglinjuan  }
66580382c05SWilliam Wang
666ad3ba452Szhanglinjuan  XSDebug(p"need drain:$need_drain cohHasTimeOut: $cohHasTimeOut need replace:$need_replace\n")
667ad3ba452Szhanglinjuan  XSDebug(p"drainIdx:$drainIdx tIdx:$cohTimeOutIdx replIdx:$replaceIdx " +
66880382c05SWilliam Wang    p"blocked:${!noSameBlockInflight(sbuffer_out_s0_evictionIdx)} v:${activeMask(sbuffer_out_s0_evictionIdx)}\n")
66980382c05SWilliam Wang  XSDebug(p"sbuffer_out_s0_valid:$sbuffer_out_s0_valid evictIdx:$sbuffer_out_s0_evictionIdx dcache ready:${io.dcache.req.ready}\n")
670ad3ba452Szhanglinjuan  // Note: if other dcache req in the same block are inflight,
671ad3ba452Szhanglinjuan  // the lru update may not accurate
67246f74b57SHaojin Tang  accessIdx(EnsbufferWidth).valid := invalidMask(replaceIdx) || (
67380382c05SWilliam Wang    need_replace && !need_drain && !cohHasTimeOut && !missqReplayHasTimeOut && sbuffer_out_s0_cango && activeMask(replaceIdx))
67446f74b57SHaojin Tang  accessIdx(EnsbufferWidth).bits := replaceIdx
675935edac4STang Haojin  val sbuffer_out_s1_evictionIdx = RegEnable(sbuffer_out_s0_evictionIdx, sbuffer_out_s0_fire)
676935edac4STang Haojin  val sbuffer_out_s1_evictionPTag = RegEnable(ptag(sbuffer_out_s0_evictionIdx), sbuffer_out_s0_fire)
677935edac4STang Haojin  val sbuffer_out_s1_evictionVTag = RegEnable(vtag(sbuffer_out_s0_evictionIdx), sbuffer_out_s0_fire)
678ad3ba452Szhanglinjuan
6793d3419b9SWilliam Wang  io.dcache.req.valid := sbuffer_out_s1_valid && !blockDcacheWrite
680ad3ba452Szhanglinjuan  io.dcache.req.bits := DontCare
681ad3ba452Szhanglinjuan  io.dcache.req.bits.cmd   := MemoryOpConstants.M_XWR
68280382c05SWilliam Wang  io.dcache.req.bits.addr  := getAddr(sbuffer_out_s1_evictionPTag)
68380382c05SWilliam Wang  io.dcache.req.bits.vaddr := getAddr(sbuffer_out_s1_evictionVTag)
68480382c05SWilliam Wang  io.dcache.req.bits.data  := data(sbuffer_out_s1_evictionIdx).asUInt
68580382c05SWilliam Wang  io.dcache.req.bits.mask  := mask(sbuffer_out_s1_evictionIdx).asUInt
68680382c05SWilliam Wang  io.dcache.req.bits.id := sbuffer_out_s1_evictionIdx
687ad3ba452Szhanglinjuan
68880382c05SWilliam Wang  when (sbuffer_out_s1_fire) {
689ad3ba452Szhanglinjuan    assert(!(io.dcache.req.bits.vaddr === 0.U))
690ad3ba452Szhanglinjuan    assert(!(io.dcache.req.bits.addr === 0.U))
691ad3ba452Szhanglinjuan  }
692ad3ba452Szhanglinjuan
69380382c05SWilliam Wang  XSDebug(sbuffer_out_s1_fire,
69480382c05SWilliam Wang    p"send buf [$sbuffer_out_s1_evictionIdx] to Dcache, req fire\n"
695ad3ba452Szhanglinjuan  )
696ad3ba452Szhanglinjuan
697ad3ba452Szhanglinjuan  // update sbuffer status according to dcache resp source
698ad3ba452Szhanglinjuan
699a98b054bSWilliam Wang  def id_to_sbuffer_id(id: UInt): UInt = {
700a98b054bSWilliam Wang    require(id.getWidth >= log2Up(StoreBufferSize))
701a98b054bSWilliam Wang    id(log2Up(StoreBufferSize)-1, 0)
702a98b054bSWilliam Wang  }
703a98b054bSWilliam Wang
704ad3ba452Szhanglinjuan  // hit resp
705ad3ba452Szhanglinjuan  io.dcache.hit_resps.map(resp => {
706ad3ba452Szhanglinjuan    val dcache_resp_id = resp.bits.id
707935edac4STang Haojin    when (resp.fire) {
708ad3ba452Szhanglinjuan      stateVec(dcache_resp_id).state_inflight := false.B
709ad3ba452Szhanglinjuan      stateVec(dcache_resp_id).state_valid := false.B
710ad3ba452Szhanglinjuan      assert(!resp.bits.replay)
711ad3ba452Szhanglinjuan      assert(!resp.bits.miss) // not need to resp if miss, to be opted
712ad3ba452Szhanglinjuan      assert(stateVec(dcache_resp_id).state_inflight === true.B)
713ad3ba452Szhanglinjuan    }
714a98b054bSWilliam Wang
715a98b054bSWilliam Wang    // Update w_sameblock_inflight flag is delayed for 1 cycle
716a98b054bSWilliam Wang    //
717a98b054bSWilliam Wang    // When a new req allocate a new line in sbuffer, sameblock_inflight check will ignore
718a98b054bSWilliam Wang    // current dcache.hit_resps. Then, in the next cycle, we have plenty of time to check
719a98b054bSWilliam Wang    // if the same block is still inflight
720a98b054bSWilliam Wang    (0 until StoreBufferSize).map(i => {
721a98b054bSWilliam Wang      when(
722a98b054bSWilliam Wang        stateVec(i).w_sameblock_inflight &&
723a98b054bSWilliam Wang        stateVec(i).state_valid &&
7245adc4829SYanqin Li        GatedValidRegNext(resp.fire) &&
7255adc4829SYanqin Li        waitInflightMask(i) === UIntToOH(RegEnable(id_to_sbuffer_id(dcache_resp_id), resp.fire))
726a98b054bSWilliam Wang      ){
727a98b054bSWilliam Wang        stateVec(i).w_sameblock_inflight := false.B
728a98b054bSWilliam Wang      }
729ad3ba452Szhanglinjuan    })
730a98b054bSWilliam Wang  })
731a98b054bSWilliam Wang
7328b1251e1SWilliam Wang  io.dcache.hit_resps.zip(dataModule.io.maskFlushReq).map{case (resp, maskFlush) => {
733935edac4STang Haojin    maskFlush.valid := resp.fire
7348b1251e1SWilliam Wang    maskFlush.bits.wvec := UIntToOH(resp.bits.id)
7358b1251e1SWilliam Wang  }}
736ad3ba452Szhanglinjuan
737ad3ba452Szhanglinjuan  // replay resp
738ad3ba452Szhanglinjuan  val replay_resp_id = io.dcache.replay_resp.bits.id
739935edac4STang Haojin  when (io.dcache.replay_resp.fire) {
740ad3ba452Szhanglinjuan    missqReplayCount(replay_resp_id) := 0.U
741ad3ba452Szhanglinjuan    stateVec(replay_resp_id).w_timeout := true.B
742ad3ba452Szhanglinjuan    // waiting for timeout
743ad3ba452Szhanglinjuan    assert(io.dcache.replay_resp.bits.replay)
744ad3ba452Szhanglinjuan    assert(stateVec(replay_resp_id).state_inflight === true.B)
745ad3ba452Szhanglinjuan  }
746ad3ba452Szhanglinjuan
747ad3ba452Szhanglinjuan  // TODO: reuse cohCount
748ad3ba452Szhanglinjuan  (0 until StoreBufferSize).map(i => {
749ad3ba452Szhanglinjuan    when(stateVec(i).w_timeout && stateVec(i).state_inflight && !missqReplayCount(i)(MissqReplayCountBits-1)) {
750ad3ba452Szhanglinjuan      missqReplayCount(i) := missqReplayCount(i) + 1.U
751ad3ba452Szhanglinjuan    }
752ad3ba452Szhanglinjuan    when(activeMask(i) && !cohTimeOutMask(i)){
753ad3ba452Szhanglinjuan      cohCount(i) := cohCount(i)+1.U
754ad3ba452Szhanglinjuan    }
755ad3ba452Szhanglinjuan  })
756ad3ba452Szhanglinjuan
7571545277aSYinan Xu  if (env.EnableDifftest) {
758ad3ba452Szhanglinjuan    // hit resp
759ad3ba452Szhanglinjuan    io.dcache.hit_resps.zipWithIndex.map{case (resp, index) => {
7607d45a146SYinan Xu      val difftest = DifftestModule(new DiffSbufferEvent, delay = 1)
761ad3ba452Szhanglinjuan      val dcache_resp_id = resp.bits.id
7627d45a146SYinan Xu      difftest.coreid := io.hartId
7637d45a146SYinan Xu      difftest.index  := index.U
764935edac4STang Haojin      difftest.valid  := resp.fire
7657d45a146SYinan Xu      difftest.addr   := getAddr(ptag(dcache_resp_id))
7667d45a146SYinan Xu      difftest.data   := data(dcache_resp_id).asTypeOf(Vec(CacheLineBytes, UInt(8.W)))
7677d45a146SYinan Xu      difftest.mask   := mask(dcache_resp_id).asUInt
768ad3ba452Szhanglinjuan    }}
769ad3ba452Szhanglinjuan  }
770ad3ba452Szhanglinjuan
771ad3ba452Szhanglinjuan  // ---------------------- Load Data Forward ---------------------
772ad3ba452Szhanglinjuan  val mismatch = Wire(Vec(LoadPipelineWidth, Bool()))
773db7f55d9SWilliam Wang  XSPerfAccumulate("vaddr_match_failed", mismatch(0) || mismatch(1))
774ad3ba452Szhanglinjuan  for ((forward, i) <- io.forward.zipWithIndex) {
775ad3ba452Szhanglinjuan    val vtag_matches = VecInit(widthMap(w => vtag(w) === getVTag(forward.vaddr)))
77667cddb05SWilliam Wang    // ptag_matches uses paddr from dtlb, which is far from sbuffer
77767cddb05SWilliam Wang    val ptag_matches = VecInit(widthMap(w => RegEnable(ptag(w), forward.valid) === RegEnable(getPTag(forward.paddr), forward.valid)))
778ad3ba452Szhanglinjuan    val tag_matches = vtag_matches
7795adc4829SYanqin Li    val tag_mismatch = GatedValidRegNext(forward.valid) && VecInit(widthMap(w =>
7805adc4829SYanqin Li      GatedValidRegNext(vtag_matches(w)) =/= ptag_matches(w) && GatedValidRegNext((activeMask(w) || inflightMask(w)))
781ad3ba452Szhanglinjuan    )).asUInt.orR
782ad3ba452Szhanglinjuan    mismatch(i) := tag_mismatch
783ad3ba452Szhanglinjuan    when (tag_mismatch) {
784ad3ba452Szhanglinjuan      XSDebug("forward tag mismatch: pmatch %x vmatch %x vaddr %x paddr %x\n",
785ad3ba452Szhanglinjuan        RegNext(ptag_matches.asUInt),
786ad3ba452Szhanglinjuan        RegNext(vtag_matches.asUInt),
787ad3ba452Szhanglinjuan        RegNext(forward.vaddr),
788ad3ba452Szhanglinjuan        RegNext(forward.paddr)
789ad3ba452Szhanglinjuan      )
79096b1e495SWilliam Wang      forward_need_uarch_drain := true.B
791ad3ba452Szhanglinjuan    }
792ad3ba452Szhanglinjuan    val valid_tag_matches = widthMap(w => tag_matches(w) && activeMask(w))
793ad3ba452Szhanglinjuan    val inflight_tag_matches = widthMap(w => tag_matches(w) && inflightMask(w))
794cdbff57cSHaoyuan Feng    val line_offset_mask = UIntToOH(getVWordOffset(forward.paddr))
795ad3ba452Szhanglinjuan
7965adc4829SYanqin Li    val valid_tag_match_reg = valid_tag_matches.map(RegEnable(_, forward.valid))
7975adc4829SYanqin Li    val inflight_tag_match_reg = inflight_tag_matches.map(RegEnable(_, forward.valid))
798a98b054bSWilliam Wang    val forward_mask_candidate_reg = RegEnable(
799cdbff57cSHaoyuan Feng      VecInit(mask.map(entry => entry(getVWordOffset(forward.paddr)))),
800a98b054bSWilliam Wang      forward.valid
801a98b054bSWilliam Wang    )
80296b1e495SWilliam Wang    val forward_data_candidate_reg = RegEnable(
803cdbff57cSHaoyuan Feng      VecInit(data.map(entry => entry(getVWordOffset(forward.paddr)))),
80496b1e495SWilliam Wang      forward.valid
80596b1e495SWilliam Wang    )
806ad3ba452Szhanglinjuan
807a98b054bSWilliam Wang    val selectedValidMask = Mux1H(valid_tag_match_reg, forward_mask_candidate_reg)
80896b1e495SWilliam Wang    val selectedValidData = Mux1H(valid_tag_match_reg, forward_data_candidate_reg)
809a98b054bSWilliam Wang    selectedValidMask.suggestName("selectedValidMask_"+i)
81096b1e495SWilliam Wang    selectedValidData.suggestName("selectedValidData_"+i)
811ad3ba452Szhanglinjuan
812a98b054bSWilliam Wang    val selectedInflightMask = Mux1H(inflight_tag_match_reg, forward_mask_candidate_reg)
81396b1e495SWilliam Wang    val selectedInflightData = Mux1H(inflight_tag_match_reg, forward_data_candidate_reg)
814a98b054bSWilliam Wang    selectedInflightMask.suggestName("selectedInflightMask_"+i)
81596b1e495SWilliam Wang    selectedInflightData.suggestName("selectedInflightData_"+i)
816ad3ba452Szhanglinjuan
817a98b054bSWilliam Wang    // currently not being used
818cdbff57cSHaoyuan Feng    val selectedInflightMaskFast = Mux1H(line_offset_mask, Mux1H(inflight_tag_matches, mask).asTypeOf(Vec(CacheLineVWords, Vec(VDataBytes, Bool()))))
819cdbff57cSHaoyuan Feng    val selectedValidMaskFast = Mux1H(line_offset_mask, Mux1H(valid_tag_matches, mask).asTypeOf(Vec(CacheLineVWords, Vec(VDataBytes, Bool()))))
820ad3ba452Szhanglinjuan
821ad3ba452Szhanglinjuan    forward.dataInvalid := false.B // data in store line merge buffer is always ready
822ad3ba452Szhanglinjuan    forward.matchInvalid := tag_mismatch // paddr / vaddr cam result does not match
823cdbff57cSHaoyuan Feng    for (j <- 0 until VDataBytes) {
824ad3ba452Szhanglinjuan      forward.forwardMask(j) := false.B
825ad3ba452Szhanglinjuan      forward.forwardData(j) := DontCare
826ad3ba452Szhanglinjuan
827ad3ba452Szhanglinjuan      // valid entries have higher priority than inflight entries
828ad3ba452Szhanglinjuan      when(selectedInflightMask(j)) {
829ad3ba452Szhanglinjuan        forward.forwardMask(j) := true.B
830ad3ba452Szhanglinjuan        forward.forwardData(j) := selectedInflightData(j)
831ad3ba452Szhanglinjuan      }
832ad3ba452Szhanglinjuan      when(selectedValidMask(j)) {
833ad3ba452Szhanglinjuan        forward.forwardMask(j) := true.B
834ad3ba452Szhanglinjuan        forward.forwardData(j) := selectedValidData(j)
835ad3ba452Szhanglinjuan      }
836ad3ba452Szhanglinjuan
837ad3ba452Szhanglinjuan      forward.forwardMaskFast(j) := selectedInflightMaskFast(j) || selectedValidMaskFast(j)
838ad3ba452Szhanglinjuan    }
839e4f69d78Ssfencevma    forward.addrInvalid := DontCare
840ad3ba452Szhanglinjuan  }
841ad3ba452Szhanglinjuan
842ad3ba452Szhanglinjuan  for (i <- 0 until StoreBufferSize) {
84396b1e495SWilliam Wang    XSDebug("sbf entry " + i + " : ptag %x vtag %x valid %x active %x inflight %x w_timeout %x\n",
844ad3ba452Szhanglinjuan      ptag(i) << OffsetWidth,
845ad3ba452Szhanglinjuan      vtag(i) << OffsetWidth,
846ad3ba452Szhanglinjuan      stateVec(i).isValid(),
847ad3ba452Szhanglinjuan      activeMask(i),
848ad3ba452Szhanglinjuan      inflightMask(i),
849ad3ba452Szhanglinjuan      stateVec(i).w_timeout
850ad3ba452Szhanglinjuan    )
851ad3ba452Szhanglinjuan  }
852ad3ba452Szhanglinjuan
8539ae95edaSAnzooooo  /*
8549ae95edaSAnzooooo  *
8559ae95edaSAnzooooo  **********************************************************
8569ae95edaSAnzooooo  *      -------------                   -------------     *
8579ae95edaSAnzooooo  *      | XiangShan |                   |    NEMU   |     *
8589ae95edaSAnzooooo  *      -------------                   -------------     *
8599ae95edaSAnzooooo  *            |                               |           *
8609ae95edaSAnzooooo  *            V                               V           *
8619ae95edaSAnzooooo  *          -----                           -----         *
8629ae95edaSAnzooooo  *          | Q |                           | Q |         *
8639ae95edaSAnzooooo  *          | U |                           | U |         *
8649ae95edaSAnzooooo  *          | E |                           | E |         *
8659ae95edaSAnzooooo  *          | U |                           | U |         *
8669ae95edaSAnzooooo  *          | E |                           | E |         *
8679ae95edaSAnzooooo  *          |   |                           |   |         *
8689ae95edaSAnzooooo  *          -----                           -----         *
8699ae95edaSAnzooooo  *            |                               |           *
8709ae95edaSAnzooooo  *            |        --------------         |           *
8719ae95edaSAnzooooo  *            |>>>>>>>>|  DIFFTEST  |<<<<<<<<<|           *
8729ae95edaSAnzooooo  *                     --------------                     *
8739ae95edaSAnzooooo  **********************************************************
8749ae95edaSAnzooooo  */
8753e11bedfSAnzooooo  // Initialize when unenabled difftest.
8763e11bedfSAnzooooo  for (i <- 0 until EnsbufferWidth) {
8773e11bedfSAnzooooo    io.vecDifftestInfo(i) := DontCare
8783e11bedfSAnzooooo  }
87960bd4d3cSweiding liu  if (env.EnableDifftest) {
8809ae95edaSAnzooooo    val VecMemFLOWMaxNumber = 16
8813fbc86fcSChen Xi    val WlineMaxNumber = blockWords
8829ae95edaSAnzooooo
8839ae95edaSAnzooooo    def UIntSlice(in: UInt, High: UInt, Low: UInt): UInt = {
8849ae95edaSAnzooooo      val maxNum = in.getWidth
8859ae95edaSAnzooooo      val result = Wire(Vec(maxNum, Bool()))
8869ae95edaSAnzooooo
8879ae95edaSAnzooooo      for (i <- 0 until maxNum) {
8889ae95edaSAnzooooo        when (Low + i.U <= High) {
8899ae95edaSAnzooooo          result(i) := in(Low + i.U)
8909ae95edaSAnzooooo        }.otherwise{
8919ae95edaSAnzooooo          result(i) := 0.U
8929ae95edaSAnzooooo        }
8939ae95edaSAnzooooo      }
8949ae95edaSAnzooooo
8959ae95edaSAnzooooo      result.asUInt
8969ae95edaSAnzooooo    }
8979ae95edaSAnzooooo
8989ae95edaSAnzooooo    // To align with 'nemu', we need:
8999ae95edaSAnzooooo    //  For 'unit-store' and 'whole' vector store instr, we re-split here,
9009ae95edaSAnzooooo    //  and for the res, we do nothing.
90160bd4d3cSweiding liu    for (i <- 0 until EnsbufferWidth) {
9029ae95edaSAnzooooo      io.vecDifftestInfo(i).ready := io.in(i).ready
9039ae95edaSAnzooooo
9049ae95edaSAnzooooo      val uop             = io.vecDifftestInfo(i).bits
9059ae95edaSAnzooooo
9069ae95edaSAnzooooo      val isVse           = isVStore(uop.fuType) && LSUOpType.isUStride(uop.fuOpType)
9079ae95edaSAnzooooo      val isVsm           = isVStore(uop.fuType) && VstuType.isMasked(uop.fuOpType)
9089ae95edaSAnzooooo      val isVsr           = isVStore(uop.fuType) && VstuType.isWhole(uop.fuOpType)
9099ae95edaSAnzooooo
9109ae95edaSAnzooooo      val vpu             = uop.vpu
9119ae95edaSAnzooooo      val veew            = uop.vpu.veew
9129ae95edaSAnzooooo      val eew             = EewLog2(veew)
9139ae95edaSAnzooooo      val EEB             = (1.U << eew).asUInt //Only when VLEN=128 effective element byte
9149ae95edaSAnzooooo      val EEWBits         = (EEB << 3.U).asUInt
9159ae95edaSAnzooooo      val nf              = Mux(isVsr, 0.U, vpu.nf)
9169ae95edaSAnzooooo
9179ae95edaSAnzooooo      val isSegment       = nf =/= 0.U && !isVsm
9189ae95edaSAnzooooo      val isVSLine        = (isVse || isVsm || isVsr) && !isSegment
9193fbc86fcSChen Xi      val isWline         = io.in(i).bits.wline
9209ae95edaSAnzooooo
9219ae95edaSAnzooooo      // The number of stores generated by a uop theroy.
9229ae95edaSAnzooooo      // No other vector instructions need to be considered.
9239ae95edaSAnzooooo      val flow            = Mux(
9249ae95edaSAnzooooo                              isVSLine,
9259ae95edaSAnzooooo                              (16.U >> eew).asUInt,
9269ae95edaSAnzooooo                              0.U
9279ae95edaSAnzooooo                            )
9289ae95edaSAnzooooo
9299ae95edaSAnzooooo      val rawData         = io.in(i).bits.data
9309ae95edaSAnzooooo      val rawMask         = io.in(i).bits.mask
9319ae95edaSAnzooooo      val rawAddr         = io.in(i).bits.addr
9329ae95edaSAnzooooo
9339ae95edaSAnzooooo      // A common difftest interface for scalar and vector instr
93416b5cf13STang Haojin      val difftestCommon = DifftestModule(new DiffStoreEvent, delay = 2, dontCare = true)
9359ae95edaSAnzooooo      when (isVSLine) {
9369ae95edaSAnzooooo        val splitMask         = UIntSlice(rawMask, EEB - 1.U, 0.U)(7,0)  // Byte
9379ae95edaSAnzooooo        val splitData         = UIntSlice(rawData, EEWBits - 1.U, 0.U)(63,0) // Double word
9389ae95edaSAnzooooo        val storeCommit       = io.in(i).fire && splitMask.orR && io.in(i).bits.vecValid
9399ae95edaSAnzooooo        val waddr             = rawAddr
9409ae95edaSAnzooooo        val wmask             = splitMask
9419ae95edaSAnzooooo        val wdata             = splitData & MaskExpand(splitMask)
9429ae95edaSAnzooooo
9439ae95edaSAnzooooo        difftestCommon.coreid := io.hartId
9449ae95edaSAnzooooo        difftestCommon.index  := (i*VecMemFLOWMaxNumber).U
9459ae95edaSAnzooooo        difftestCommon.valid  := storeCommit
9469ae95edaSAnzooooo        difftestCommon.addr   := waddr
9479ae95edaSAnzooooo        difftestCommon.data   := wdata
9489ae95edaSAnzooooo        difftestCommon.mask   := wmask
9491bf9a598SAnzo        difftestCommon.robidx := io.vecDifftestInfo(i).bits.robIdx.value
9501bf9a598SAnzo        difftestCommon.pc     := io.vecDifftestInfo(i).bits.pc
9519ae95edaSAnzooooo
95216b5cf13STang Haojin      } .elsewhen (!isWline) {
9539ae95edaSAnzooooo        val storeCommit       = io.in(i).fire
95460bd4d3cSweiding liu        val waddr             = ZeroExt(Cat(io.in(i).bits.addr(PAddrBits - 1, 3), 0.U(3.W)), 64)
95560bd4d3cSweiding liu        val sbufferMask       = shiftMaskToLow(io.in(i).bits.addr, io.in(i).bits.mask)
95660bd4d3cSweiding liu        val sbufferData       = shiftDataToLow(io.in(i).bits.addr, io.in(i).bits.data)
95760bd4d3cSweiding liu        val wmask             = sbufferMask
95860bd4d3cSweiding liu        val wdata             = sbufferData & MaskExpand(sbufferMask)
95960bd4d3cSweiding liu
9609ae95edaSAnzooooo        difftestCommon.coreid := io.hartId
9619ae95edaSAnzooooo        difftestCommon.index  := (i*VecMemFLOWMaxNumber).U
9629ae95edaSAnzooooo        difftestCommon.valid  := storeCommit && io.in(i).bits.vecValid
9639ae95edaSAnzooooo        difftestCommon.addr   := waddr
9649ae95edaSAnzooooo        difftestCommon.data   := wdata
9659ae95edaSAnzooooo        difftestCommon.mask   := wmask
9661bf9a598SAnzo        difftestCommon.robidx := io.vecDifftestInfo(i).bits.robIdx.value
9671bf9a598SAnzo        difftestCommon.pc     := io.vecDifftestInfo(i).bits.pc
9689ae95edaSAnzooooo      }
9699ae95edaSAnzooooo
97016b5cf13STang Haojin      for (index <- 0 until WlineMaxNumber) {
97116b5cf13STang Haojin        val difftest = DifftestModule(new DiffStoreEvent, delay = 2, dontCare = true)
97216b5cf13STang Haojin
97316b5cf13STang Haojin        val storeCommit = io.in(i).fire && io.in(i).bits.vecValid
97416b5cf13STang Haojin        val blockAddr = get_block_addr(io.in(i).bits.addr)
97516b5cf13STang Haojin
97616b5cf13STang Haojin        when (isWline) {
97716b5cf13STang Haojin          difftest.coreid := io.hartId
97816b5cf13STang Haojin          difftest.index  := (i*VecMemFLOWMaxNumber + index).U
97916b5cf13STang Haojin          difftest.valid  := storeCommit
98016b5cf13STang Haojin          difftest.addr   := blockAddr + (index.U << wordOffBits)
98116b5cf13STang Haojin          difftest.data   := io.in(i).bits.data
98216b5cf13STang Haojin          difftest.mask   := ((1 << wordBytes) - 1).U
9831bf9a598SAnzo          difftest.robidx := io.vecDifftestInfo(i).bits.robIdx.value
9841bf9a598SAnzo          difftest.pc     := io.vecDifftestInfo(i).bits.pc
98516b5cf13STang Haojin
98616b5cf13STang Haojin          assert(!storeCommit || (io.in(i).bits.data === 0.U), "wline only supports whole zero write now")
98716b5cf13STang Haojin        }
98816b5cf13STang Haojin      }
98916b5cf13STang Haojin
9909ae95edaSAnzooooo      // Only the interface used by the 'unit-store' and 'whole' vector store instr
9919ae95edaSAnzooooo      for (index <- 1 until VecMemFLOWMaxNumber) {
99216b5cf13STang Haojin        val difftest = DifftestModule(new DiffStoreEvent, delay = 2, dontCare = true)
9939ae95edaSAnzooooo
9949ae95edaSAnzooooo        // I've already done something process with 'mask' outside:
9959ae95edaSAnzooooo        //  Different cases of 'vm' have been considered:
9969ae95edaSAnzooooo        //    Any valid store will definitely not have all 0 masks,
9979ae95edaSAnzooooo        //    and the extra part due to unaligned access must have a mask of 0
9989ae95edaSAnzooooo        when (index.U < flow && isVSLine) {
9999ae95edaSAnzooooo          // Make NEMU-difftest happy
10009ae95edaSAnzooooo          val shiftIndex  = EEB*index.U
10019ae95edaSAnzooooo          val shiftFlag   = shiftIndex(2,0).orR // Double word Flag
10029ae95edaSAnzooooo          val shiftBytes  = Mux(shiftFlag, shiftIndex(2,0), 0.U)
10039ae95edaSAnzooooo          val shiftBits   = shiftBytes << 3.U
10049ae95edaSAnzooooo          val splitMask   = UIntSlice(rawMask, (EEB*(index+1).U - 1.U), EEB*index.U)(7,0)  // Byte
10059ae95edaSAnzooooo          val splitData   = UIntSlice(rawData, (EEWBits*(index+1).U - 1.U), EEWBits*index.U)(63,0) // Double word
10069ae95edaSAnzooooo          val storeCommit = io.in(i).fire && splitMask.orR  && io.in(i).bits.vecValid
10079ae95edaSAnzooooo          val waddr       = Cat(rawAddr(PAddrBits - 1, 4), Cat(shiftIndex(3), 0.U(3.W)))
10089ae95edaSAnzooooo          val wmask       = splitMask << shiftBytes
10099ae95edaSAnzooooo          val wdata       = (splitData & MaskExpand(splitMask)) << shiftBits
10109ae95edaSAnzooooo
101160bd4d3cSweiding liu          difftest.coreid := io.hartId
10129ae95edaSAnzooooo          difftest.index  := (i*VecMemFLOWMaxNumber+index).U
101360bd4d3cSweiding liu          difftest.valid  := storeCommit
101460bd4d3cSweiding liu          difftest.addr   := waddr
101560bd4d3cSweiding liu          difftest.data   := wdata
101660bd4d3cSweiding liu          difftest.mask   := wmask
10171bf9a598SAnzo          difftest.robidx := io.vecDifftestInfo(i).bits.robIdx.value
10181bf9a598SAnzo          difftest.pc     := io.vecDifftestInfo(i).bits.pc
10199ae95edaSAnzooooo        }
10209ae95edaSAnzooooo      }
102160bd4d3cSweiding liu    }
102260bd4d3cSweiding liu  }
102360bd4d3cSweiding liu
1024b6d53cefSWilliam Wang  val perf_valid_entry_count = RegNext(PopCount(VecInit(stateVec.map(s => !s.isInvalid())).asUInt))
1025ad3ba452Szhanglinjuan  XSPerfHistogram("util", perf_valid_entry_count, true.B, 0, StoreBufferSize, 1)
1026ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_req_valid", PopCount(VecInit(io.in.map(_.valid)).asUInt))
1027935edac4STang Haojin  XSPerfAccumulate("sbuffer_req_fire", PopCount(VecInit(io.in.map(_.fire)).asUInt))
1028b2d6d8e7Sgood-circle  XSPerfAccumulate("sbuffer_req_fire_vecinvalid", PopCount(VecInit(io.in.map(data => data.fire && !data.bits.vecValid)).asUInt))
1029935edac4STang Haojin  XSPerfAccumulate("sbuffer_merge", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && canMerge(i)})).asUInt))
1030935edac4STang Haojin  XSPerfAccumulate("sbuffer_newline", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && !canMerge(i)})).asUInt))
1031ad3ba452Szhanglinjuan  XSPerfAccumulate("dcache_req_valid", io.dcache.req.valid)
1032935edac4STang Haojin  XSPerfAccumulate("dcache_req_fire", io.dcache.req.fire)
1033ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_idle", sbuffer_state === x_idle)
1034ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_flush", sbuffer_state === x_drain_sbuffer)
1035ad3ba452Szhanglinjuan  XSPerfAccumulate("sbuffer_replace", sbuffer_state === x_replace)
1036db7f55d9SWilliam Wang  XSPerfAccumulate("evenCanInsert", evenCanInsert)
1037db7f55d9SWilliam Wang  XSPerfAccumulate("oddCanInsert", oddCanInsert)
1038935edac4STang Haojin  XSPerfAccumulate("mainpipe_resp_valid", io.dcache.main_pipe_hit_resp.fire)
1039ffd3154dSCharlieLiu  //XSPerfAccumulate("refill_resp_valid", io.dcache.refill_hit_resp.fire)
1040935edac4STang Haojin  XSPerfAccumulate("replay_resp_valid", io.dcache.replay_resp.fire)
104196b1e495SWilliam Wang  XSPerfAccumulate("coh_timeout", cohHasTimeOut)
104296b1e495SWilliam Wang
1043935edac4STang Haojin  // val (store_latency_sample, store_latency) = TransactionLatencyCounter(io.lsu.req.fire, io.lsu.resp.fire)
104496b1e495SWilliam Wang  // XSPerfHistogram("store_latency", store_latency, store_latency_sample, 0, 100, 10)
1045935edac4STang Haojin  // XSPerfAccumulate("store_req", io.lsu.req.fire)
1046cd365d4cSrvcoresjw
1047cd365d4cSrvcoresjw  val perfEvents = Seq(
1048cd365d4cSrvcoresjw    ("sbuffer_req_valid ", PopCount(VecInit(io.in.map(_.valid)).asUInt)                                                                ),
1049935edac4STang Haojin    ("sbuffer_req_fire  ", PopCount(VecInit(io.in.map(_.fire)).asUInt)                                                               ),
1050935edac4STang Haojin    ("sbuffer_merge     ", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && canMerge(i)})).asUInt)                ),
1051935edac4STang Haojin    ("sbuffer_newline   ", PopCount(VecInit(io.in.zipWithIndex.map({case (in, i) => in.fire && !canMerge(i)})).asUInt)               ),
1052cd365d4cSrvcoresjw    ("dcache_req_valid  ", io.dcache.req.valid                                                                                         ),
1053935edac4STang Haojin    ("dcache_req_fire   ", io.dcache.req.fire                                                                                        ),
105496b1e495SWilliam Wang    ("sbuffer_idle      ", sbuffer_state === x_idle                                                                                    ),
105596b1e495SWilliam Wang    ("sbuffer_flush     ", sbuffer_state === x_drain_sbuffer                                                                           ),
105696b1e495SWilliam Wang    ("sbuffer_replace   ", sbuffer_state === x_replace                                                                                 ),
1057935edac4STang Haojin    ("mpipe_resp_valid  ", io.dcache.main_pipe_hit_resp.fire                                                                         ),
1058ffd3154dSCharlieLiu    //("refill_resp_valid ", io.dcache.refill_hit_resp.fire                                                                            ),
1059935edac4STang Haojin    ("replay_resp_valid ", io.dcache.replay_resp.fire                                                                                ),
106096b1e495SWilliam Wang    ("coh_timeout       ", cohHasTimeOut                                                                                               ),
10611ca0e4f3SYinan Xu    ("sbuffer_1_4_valid ", (perf_valid_entry_count < (StoreBufferSize.U/4.U))                                                          ),
10621ca0e4f3SYinan Xu    ("sbuffer_2_4_valid ", (perf_valid_entry_count > (StoreBufferSize.U/4.U)) & (perf_valid_entry_count <= (StoreBufferSize.U/2.U))    ),
10631ca0e4f3SYinan Xu    ("sbuffer_3_4_valid ", (perf_valid_entry_count > (StoreBufferSize.U/2.U)) & (perf_valid_entry_count <= (StoreBufferSize.U*3.U/4.U))),
1064cd365d4cSrvcoresjw    ("sbuffer_full_valid", (perf_valid_entry_count > (StoreBufferSize.U*3.U/4.U)))
1065cd365d4cSrvcoresjw  )
10661ca0e4f3SYinan Xu  generatePerfEvent()
1067cd365d4cSrvcoresjw
1068ad3ba452Szhanglinjuan}
1069