xref: /XiangShan/src/main/scala/xiangshan/cache/mmu/PageTableCache.scala (revision 3c02ee8f82edea481fa8336c7f54ffc17fafba91)
16d5ddbceSLemover/***************************************************************************************
26d5ddbceSLemover* Copyright (c) 2020-2021 Institute of Computing Technology, Chinese Academy of Sciences
3f320e0f0SYinan Xu* Copyright (c) 2020-2021 Peng Cheng Laboratory
46d5ddbceSLemover*
56d5ddbceSLemover* XiangShan is licensed under Mulan PSL v2.
66d5ddbceSLemover* You can use this software according to the terms and conditions of the Mulan PSL v2.
76d5ddbceSLemover* You may obtain a copy of Mulan PSL v2 at:
86d5ddbceSLemover*          http://license.coscl.org.cn/MulanPSL2
96d5ddbceSLemover*
106d5ddbceSLemover* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
116d5ddbceSLemover* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
126d5ddbceSLemover* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
136d5ddbceSLemover*
146d5ddbceSLemover* See the Mulan PSL v2 for more details.
156d5ddbceSLemover***************************************************************************************/
166d5ddbceSLemover
176d5ddbceSLemoverpackage xiangshan.cache.mmu
186d5ddbceSLemover
196d5ddbceSLemoverimport chipsalliance.rocketchip.config.Parameters
206d5ddbceSLemoverimport chisel3._
216d5ddbceSLemoverimport chisel3.util._
22b848eea5SLemoverimport chisel3.internal.naming.chiselName
236d5ddbceSLemoverimport xiangshan._
246d5ddbceSLemoverimport xiangshan.cache.{HasDCacheParameters, MemoryOpConstants}
256d5ddbceSLemoverimport utils._
26*3c02ee8fSwakafaimport utility._
276d5ddbceSLemoverimport freechips.rocketchip.diplomacy.{LazyModule, LazyModuleImp}
286d5ddbceSLemoverimport freechips.rocketchip.tilelink._
296d5ddbceSLemover
306d5ddbceSLemover/* ptw cache caches the page table of all the three layers
316d5ddbceSLemover * ptw cache resp at next cycle
326d5ddbceSLemover * the cache should not be blocked
336d5ddbceSLemover * when miss queue if full, just block req outside
346d5ddbceSLemover */
353889e11eSLemover
363889e11eSLemoverclass PageCachePerPespBundle(implicit p: Parameters) extends PtwBundle {
373889e11eSLemover  val hit = Bool()
383889e11eSLemover  val pre = Bool()
393889e11eSLemover  val ppn = UInt(ppnLen.W)
403889e11eSLemover  val perm = new PtePermBundle()
413889e11eSLemover  val ecc = Bool()
423889e11eSLemover  val level = UInt(2.W)
438d8ac704SLemover  val v = Bool()
443889e11eSLemover
453889e11eSLemover  def apply(hit: Bool, pre: Bool, ppn: UInt, perm: PtePermBundle = 0.U.asTypeOf(new PtePermBundle()),
468d8ac704SLemover            ecc: Bool = false.B, level: UInt = 0.U, valid: Bool = true.B) {
473889e11eSLemover    this.hit := hit && !ecc
483889e11eSLemover    this.pre := pre
493889e11eSLemover    this.ppn := ppn
503889e11eSLemover    this.perm := perm
513889e11eSLemover    this.ecc := ecc && hit
523889e11eSLemover    this.level := level
538d8ac704SLemover    this.v := valid
543889e11eSLemover  }
553889e11eSLemover}
563889e11eSLemover
573889e11eSLemoverclass PageCacheRespBundle(implicit p: Parameters) extends PtwBundle {
583889e11eSLemover  val l1 = new PageCachePerPespBundle
593889e11eSLemover  val l2 = new PageCachePerPespBundle
603889e11eSLemover  val l3 = new PageCachePerPespBundle
613889e11eSLemover  val sp = new PageCachePerPespBundle
623889e11eSLemover}
633889e11eSLemover
643889e11eSLemoverclass PtwCacheReq(implicit p: Parameters) extends PtwBundle {
653889e11eSLemover  val req_info = new L2TlbInnerBundle()
663889e11eSLemover  val isFirst = Bool()
671f4a7c0cSLemover  val bypassed = Vec(3, Bool())
683889e11eSLemover}
693889e11eSLemover
703889e11eSLemoverclass PtwCacheIO()(implicit p: Parameters) extends MMUIOBaseBundle with HasPtwConst {
713889e11eSLemover  val req = Flipped(DecoupledIO(new PtwCacheReq()))
726d5ddbceSLemover  val resp = DecoupledIO(new Bundle {
7345f497a4Shappy-lx    val req_info = new L2TlbInnerBundle()
7494133605SLemover    val isFirst = Bool()
756d5ddbceSLemover    val hit = Bool()
76bc063562SLemover    val prefetch = Bool() // is the entry fetched by prefetch
771f4a7c0cSLemover    val bypassed = Bool()
786d5ddbceSLemover    val toFsm = new Bundle {
796d5ddbceSLemover      val l1Hit = Bool()
806d5ddbceSLemover      val l2Hit = Bool()
816d5ddbceSLemover      val ppn = UInt(ppnLen.W)
826d5ddbceSLemover    }
836d5ddbceSLemover    val toTlb = new PtwEntry(tagLen = vpnLen, hasPerm = true, hasLevel = true)
846d5ddbceSLemover  })
856d5ddbceSLemover  val refill = Flipped(ValidIO(new Bundle {
865854c1edSLemover    val ptes = UInt(blockBits.W)
877797f035SbugGenerator    val levelOH = new Bundle {
887797f035SbugGenerator      // NOTE: levelOH has (Level+1) bits, each stands for page cache entries
897797f035SbugGenerator      val sp = Bool()
907797f035SbugGenerator      val l3 = Bool()
917797f035SbugGenerator      val l2 = Bool()
927797f035SbugGenerator      val l1 = Bool()
937797f035SbugGenerator      def apply(levelUInt: UInt, valid: Bool) = {
947797f035SbugGenerator        sp := RegNext((levelUInt === 0.U || levelUInt === 1.U) && valid, false.B)
957797f035SbugGenerator        l3 := RegNext((levelUInt === 2.U) & valid, false.B)
967797f035SbugGenerator        l2 := RegNext((levelUInt === 1.U) & valid, false.B)
977797f035SbugGenerator        l1 := RegNext((levelUInt === 0.U) & valid, false.B)
987797f035SbugGenerator      }
997797f035SbugGenerator    }
1007797f035SbugGenerator    // duplicate level and sel_pte for each page caches, for better fanout
1017797f035SbugGenerator    val req_info_dup = Vec(3, new L2TlbInnerBundle())
1027797f035SbugGenerator    val level_dup = Vec(3, UInt(log2Up(Level).W))
1037797f035SbugGenerator    val sel_pte_dup = Vec(3, UInt(XLEN.W))
1046d5ddbceSLemover  }))
1057797f035SbugGenerator  val sfence_dup = Vec(4, Input(new SfenceBundle()))
1067797f035SbugGenerator  val csr_dup = Vec(3, Input(new TlbCsrBundle()))
1076d5ddbceSLemover}
1086d5ddbceSLemover
109b848eea5SLemover@chiselName
1101ca0e4f3SYinan Xuclass PtwCache()(implicit p: Parameters) extends XSModule with HasPtwConst with HasPerfEvents {
1116d5ddbceSLemover  val io = IO(new PtwCacheIO)
1126d5ddbceSLemover
1137196f5a2SLemover  val ecc = Code.fromString(l2tlbParams.ecc)
1147196f5a2SLemover  val l2EntryType = new PTWEntriesWithEcc(ecc, num = PtwL2SectorSize, tagLen = PtwL2TagLen, level = 1, hasPerm = false)
1157196f5a2SLemover  val l3EntryType = new PTWEntriesWithEcc(ecc, num = PtwL3SectorSize, tagLen = PtwL3TagLen, level = 2, hasPerm = true)
1167196f5a2SLemover
1176d5ddbceSLemover  // TODO: four caches make the codes dirty, think about how to deal with it
1186d5ddbceSLemover
1197797f035SbugGenerator  val sfence_dup = io.sfence_dup
1206d5ddbceSLemover  val refill = io.refill.bits
1217797f035SbugGenerator  val refill_prefetch_dup = io.refill.bits.req_info_dup.map(a => from_pre(a.source))
1227797f035SbugGenerator  val flush_dup = sfence_dup.zip(io.csr_dup).map(f => f._1.valid || f._2.satp.changed)
1237797f035SbugGenerator  val flush = flush_dup(0)
1246d5ddbceSLemover
1256d5ddbceSLemover  // when refill, refuce to accept new req
1265854c1edSLemover  val rwHarzad = if (sramSinglePort) io.refill.valid else false.B
1273889e11eSLemover
1283889e11eSLemover  // handle hand signal and req_info
1296c4dcc2dSLemover  // TODO: replace with FlushableQueue
1306c4dcc2dSLemover  val stageReq = Wire(Decoupled(new PtwCacheReq()))         // enq stage & read page cache valid
1316c4dcc2dSLemover  val stageDelay = Wire(Vec(2, Decoupled(new PtwCacheReq()))) // page cache resp
1326c4dcc2dSLemover  val stageCheck = Wire(Vec(2, Decoupled(new PtwCacheReq()))) // check hit & check ecc
1336c4dcc2dSLemover  val stageResp = Wire(Decoupled(new PtwCacheReq()))         // deq stage
1347797f035SbugGenerator
1357797f035SbugGenerator  val stageDelay_valid_1cycle = OneCycleValid(stageReq.fire, flush)      // catch ram data
1367797f035SbugGenerator  val stageCheck_valid_1cycle = OneCycleValid(stageDelay(1).fire, flush) // replace & perf counter
1377797f035SbugGenerator  val stageResp_valid_1cycle_dup = Wire(Vec(2, Bool()))
1387797f035SbugGenerator  stageResp_valid_1cycle_dup.map(_ := OneCycleValid(stageCheck(1).fire, flush))  // ecc flush
1397797f035SbugGenerator
1406c4dcc2dSLemover  stageReq <> io.req
1416c4dcc2dSLemover  PipelineConnect(stageReq, stageDelay(0), stageDelay(1).ready, flush, rwHarzad)
1427797f035SbugGenerator  InsideStageConnect(stageDelay(0), stageDelay(1), stageDelay_valid_1cycle)
1436c4dcc2dSLemover  PipelineConnect(stageDelay(1), stageCheck(0), stageCheck(1).ready, flush)
1447797f035SbugGenerator  InsideStageConnect(stageCheck(0), stageCheck(1), stageCheck_valid_1cycle)
1456c4dcc2dSLemover  PipelineConnect(stageCheck(1), stageResp, io.resp.ready, flush)
1466c4dcc2dSLemover  stageResp.ready := !stageResp.valid || io.resp.ready
1476d5ddbceSLemover
1486d5ddbceSLemover  // l1: level 0 non-leaf pte
1495854c1edSLemover  val l1 = Reg(Vec(l2tlbParams.l1Size, new PtwEntry(tagLen = PtwL1TagLen)))
1505854c1edSLemover  val l1v = RegInit(0.U(l2tlbParams.l1Size.W))
1515854c1edSLemover  val l1g = Reg(UInt(l2tlbParams.l1Size.W))
15245f497a4Shappy-lx  val l1asids = Reg(Vec(l2tlbParams.l1Size, UInt(AsidLength.W)))
1536d5ddbceSLemover
1546d5ddbceSLemover  // l2: level 1 non-leaf pte
1556d5ddbceSLemover  val l2 = Module(new SRAMTemplate(
1567196f5a2SLemover    l2EntryType,
1575854c1edSLemover    set = l2tlbParams.l2nSets,
1585854c1edSLemover    way = l2tlbParams.l2nWays,
1595854c1edSLemover    singlePort = sramSinglePort
1606d5ddbceSLemover  ))
1615854c1edSLemover  val l2v = RegInit(0.U((l2tlbParams.l2nSets * l2tlbParams.l2nWays).W))
1625854c1edSLemover  val l2g = Reg(UInt((l2tlbParams.l2nSets * l2tlbParams.l2nWays).W))
16345f497a4Shappy-lx  val l2asids = Reg(Vec(l2tlbParams.l2nSets, Vec(l2tlbParams.l2nWays, UInt(AsidLength.W))))
1646d5ddbceSLemover  def getl2vSet(vpn: UInt) = {
1655854c1edSLemover    require(log2Up(l2tlbParams.l2nWays) == log2Down(l2tlbParams.l2nWays))
1666d5ddbceSLemover    val set = genPtwL2SetIdx(vpn)
1675854c1edSLemover    require(set.getWidth == log2Up(l2tlbParams.l2nSets))
1685854c1edSLemover    val l2vVec = l2v.asTypeOf(Vec(l2tlbParams.l2nSets, UInt(l2tlbParams.l2nWays.W)))
1696d5ddbceSLemover    l2vVec(set)
1706d5ddbceSLemover  }
17145f497a4Shappy-lx  def getl2asidSet(vpn: UInt) = {
17245f497a4Shappy-lx    require(log2Up(l2tlbParams.l2nWays) == log2Down(l2tlbParams.l2nWays))
17345f497a4Shappy-lx    val set = genPtwL2SetIdx(vpn)
17445f497a4Shappy-lx    require(set.getWidth == log2Up(l2tlbParams.l2nSets))
17545f497a4Shappy-lx    l2asids(set)
17645f497a4Shappy-lx  }
1776d5ddbceSLemover
1786d5ddbceSLemover  // l3: level 2 leaf pte of 4KB pages
1796d5ddbceSLemover  val l3 = Module(new SRAMTemplate(
1807196f5a2SLemover    l3EntryType,
1815854c1edSLemover    set = l2tlbParams.l3nSets,
1825854c1edSLemover    way = l2tlbParams.l3nWays,
1835854c1edSLemover    singlePort = sramSinglePort
1846d5ddbceSLemover  ))
1855854c1edSLemover  val l3v = RegInit(0.U((l2tlbParams.l3nSets * l2tlbParams.l3nWays).W))
1865854c1edSLemover  val l3g = Reg(UInt((l2tlbParams.l3nSets * l2tlbParams.l3nWays).W))
18745f497a4Shappy-lx  val l3asids = Reg(Vec(l2tlbParams.l3nSets, Vec(l2tlbParams.l3nWays, UInt(AsidLength.W))))
1886d5ddbceSLemover  def getl3vSet(vpn: UInt) = {
1895854c1edSLemover    require(log2Up(l2tlbParams.l3nWays) == log2Down(l2tlbParams.l3nWays))
1906d5ddbceSLemover    val set = genPtwL3SetIdx(vpn)
1915854c1edSLemover    require(set.getWidth == log2Up(l2tlbParams.l3nSets))
1925854c1edSLemover    val l3vVec = l3v.asTypeOf(Vec(l2tlbParams.l3nSets, UInt(l2tlbParams.l3nWays.W)))
1936d5ddbceSLemover    l3vVec(set)
1946d5ddbceSLemover  }
19545f497a4Shappy-lx  def getl3asidSet(vpn: UInt) = {
19645f497a4Shappy-lx    require(log2Up(l2tlbParams.l3nWays) == log2Down(l2tlbParams.l3nWays))
19745f497a4Shappy-lx    val set = genPtwL3SetIdx(vpn)
19845f497a4Shappy-lx    require(set.getWidth == log2Up(l2tlbParams.l3nSets))
19945f497a4Shappy-lx    l3asids(set)
20045f497a4Shappy-lx  }
2016d5ddbceSLemover
2026d5ddbceSLemover  // sp: level 0/1 leaf pte of 1GB/2MB super pages
2035854c1edSLemover  val sp = Reg(Vec(l2tlbParams.spSize, new PtwEntry(tagLen = SPTagLen, hasPerm = true, hasLevel = true)))
2045854c1edSLemover  val spv = RegInit(0.U(l2tlbParams.spSize.W))
2055854c1edSLemover  val spg = Reg(UInt(l2tlbParams.spSize.W))
20645f497a4Shappy-lx  val spasids = Reg(Vec(l2tlbParams.spSize, UInt(AsidLength.W)))
2076d5ddbceSLemover
2086d5ddbceSLemover  // Access Perf
2095854c1edSLemover  val l1AccessPerf = Wire(Vec(l2tlbParams.l1Size, Bool()))
2105854c1edSLemover  val l2AccessPerf = Wire(Vec(l2tlbParams.l2nWays, Bool()))
2115854c1edSLemover  val l3AccessPerf = Wire(Vec(l2tlbParams.l3nWays, Bool()))
2125854c1edSLemover  val spAccessPerf = Wire(Vec(l2tlbParams.spSize, Bool()))
2136d5ddbceSLemover  l1AccessPerf.map(_ := false.B)
2146d5ddbceSLemover  l2AccessPerf.map(_ := false.B)
2156d5ddbceSLemover  l3AccessPerf.map(_ := false.B)
2166d5ddbceSLemover  spAccessPerf.map(_ := false.B)
2176d5ddbceSLemover
2183889e11eSLemover
2191f4a7c0cSLemover
2201f4a7c0cSLemover  def vpn_match(vpn1: UInt, vpn2: UInt, level: Int) = {
2211f4a7c0cSLemover    vpn1(vpnnLen*3-1, vpnnLen*(2-level)+3) === vpn2(vpnnLen*3-1, vpnnLen*(2-level)+3)
2221f4a7c0cSLemover  }
2231f4a7c0cSLemover  // NOTE: not actually bypassed, just check if hit, re-access the page cache
2241f4a7c0cSLemover  def refill_bypass(vpn: UInt, level: Int) = {
2257797f035SbugGenerator    io.refill.valid && (level.U === io.refill.bits.level_dup(0)) && vpn_match(io.refill.bits.req_info_dup(0).vpn, vpn, level),
2261f4a7c0cSLemover  }
2271f4a7c0cSLemover
2286d5ddbceSLemover  // l1
2295854c1edSLemover  val ptwl1replace = ReplacementPolicy.fromString(l2tlbParams.l1Replacer, l2tlbParams.l1Size)
230bc063562SLemover  val (l1Hit, l1HitPPN, l1Pre) = {
2317797f035SbugGenerator    val hitVecT = l1.zipWithIndex.map { case (e, i) => e.hit(stageReq.bits.req_info.vpn, io.csr_dup(0).satp.asid) && l1v(i) }
2326c4dcc2dSLemover    val hitVec = hitVecT.map(RegEnable(_, stageReq.fire))
2331f4a7c0cSLemover
2341f4a7c0cSLemover    // stageDelay, but check for l1
2359c503409SLemover    val hitPPN = DataHoldBypass(ParallelPriorityMux(hitVec zip l1.map(_.ppn)), stageDelay_valid_1cycle)
2369c503409SLemover    val hitPre = DataHoldBypass(ParallelPriorityMux(hitVec zip l1.map(_.prefetch)), stageDelay_valid_1cycle)
2371f4a7c0cSLemover    val hit = DataHoldBypass(ParallelOR(hitVec), stageDelay_valid_1cycle)
2386d5ddbceSLemover
2396c4dcc2dSLemover    when (hit && stageDelay_valid_1cycle) { ptwl1replace.access(OHToUInt(hitVec)) }
2406d5ddbceSLemover
2416c4dcc2dSLemover    l1AccessPerf.zip(hitVec).map{ case (l, h) => l := h && stageDelay_valid_1cycle}
2425854c1edSLemover    for (i <- 0 until l2tlbParams.l1Size) {
2437797f035SbugGenerator      XSDebug(stageReq.fire, p"[l1] l1(${i.U}) ${l1(i)} hit:${l1(i).hit(stageReq.bits.req_info.vpn, io.csr_dup(0).satp.asid)}\n")
2446d5ddbceSLemover    }
2456c4dcc2dSLemover    XSDebug(stageReq.fire, p"[l1] l1v:${Binary(l1v)} hitVecT:${Binary(VecInit(hitVecT).asUInt)}\n")
2466c4dcc2dSLemover    XSDebug(stageDelay(0).valid, p"[l1] l1Hit:${hit} l1HitPPN:0x${Hexadecimal(hitPPN)} hitVec:${VecInit(hitVec).asUInt}\n")
2476d5ddbceSLemover
2486d5ddbceSLemover    VecInit(hitVecT).suggestName(s"l1_hitVecT")
2496d5ddbceSLemover    VecInit(hitVec).suggestName(s"l1_hitVec")
2506d5ddbceSLemover
2516c4dcc2dSLemover    // synchronize with other entries with RegEnable
2526c4dcc2dSLemover    (RegEnable(hit, stageDelay(1).fire),
2536c4dcc2dSLemover     RegEnable(hitPPN, stageDelay(1).fire),
2546c4dcc2dSLemover     RegEnable(hitPre, stageDelay(1).fire))
2556d5ddbceSLemover  }
2566d5ddbceSLemover
2576d5ddbceSLemover  // l2
2585854c1edSLemover  val ptwl2replace = ReplacementPolicy.fromString(l2tlbParams.l2Replacer,l2tlbParams.l2nWays,l2tlbParams.l2nSets)
259bc063562SLemover  val (l2Hit, l2HitPPN, l2Pre, l2eccError) = {
2606c4dcc2dSLemover    val ridx = genPtwL2SetIdx(stageReq.bits.req_info.vpn)
2616c4dcc2dSLemover    l2.io.r.req.valid := stageReq.fire
2626d5ddbceSLemover    l2.io.r.req.bits.apply(setIdx = ridx)
2637797f035SbugGenerator    val vVec_req = getl2vSet(stageReq.bits.req_info.vpn)
2646c4dcc2dSLemover
2656c4dcc2dSLemover    // delay one cycle after sram read
2667797f035SbugGenerator    val delay_vpn = stageDelay(0).bits.req_info.vpn
2676c4dcc2dSLemover    val data_resp = DataHoldBypass(l2.io.r.resp.data, stageDelay_valid_1cycle)
2687797f035SbugGenerator    val vVec_delay = RegEnable(vVec_req, stageReq.fire)
2697797f035SbugGenerator    val hitVec_delay = VecInit(data_resp.zip(vVec_delay.asBools).map { case (wayData, v) =>
2707797f035SbugGenerator      wayData.entries.hit(delay_vpn, io.csr_dup(1).satp.asid) && v })
2716c4dcc2dSLemover
2726c4dcc2dSLemover    // check hit and ecc
2736c4dcc2dSLemover    val check_vpn = stageCheck(0).bits.req_info.vpn
2746c4dcc2dSLemover    val ramDatas = RegEnable(data_resp, stageDelay(1).fire)
2758a0e4b2fSLemover    val vVec = RegEnable(vVec_delay, stageDelay(1).fire).asBools()
2766c4dcc2dSLemover
2777797f035SbugGenerator    val hitVec = RegEnable(hitVec_delay, stageDelay(1).fire)
2787196f5a2SLemover    val hitWayEntry = ParallelPriorityMux(hitVec zip ramDatas)
2797196f5a2SLemover    val hitWayData = hitWayEntry.entries
2806c4dcc2dSLemover    val hit = ParallelOR(hitVec)
281f3034303SHaoyuan Feng    val hitWay = ParallelPriorityMux(hitVec zip (0 until l2tlbParams.l2nWays).map(_.U(log2Up(l2tlbParams.l2nWays).W)))
2823889e11eSLemover    val eccError = hitWayEntry.decode()
2837196f5a2SLemover
2846d5ddbceSLemover    ridx.suggestName(s"l2_ridx")
2856d5ddbceSLemover    ramDatas.suggestName(s"l2_ramDatas")
2866d5ddbceSLemover    hitVec.suggestName(s"l2_hitVec")
2876d5ddbceSLemover    hitWayData.suggestName(s"l2_hitWayData")
2886d5ddbceSLemover    hitWay.suggestName(s"l2_hitWay")
2896d5ddbceSLemover
2906c4dcc2dSLemover    when (hit && stageCheck_valid_1cycle) { ptwl2replace.access(genPtwL2SetIdx(check_vpn), hitWay) }
2916d5ddbceSLemover
2926c4dcc2dSLemover    l2AccessPerf.zip(hitVec).map{ case (l, h) => l := h && stageCheck_valid_1cycle }
2936c4dcc2dSLemover    XSDebug(stageDelay_valid_1cycle, p"[l2] ridx:0x${Hexadecimal(ridx)}\n")
2945854c1edSLemover    for (i <- 0 until l2tlbParams.l2nWays) {
2956c4dcc2dSLemover      XSDebug(stageCheck_valid_1cycle, p"[l2] ramDatas(${i.U}) ${ramDatas(i)}  l2v:${vVec(i)}  hit:${hit}\n")
2966d5ddbceSLemover    }
2976c4dcc2dSLemover    XSDebug(stageCheck_valid_1cycle, p"[l2] l2Hit:${hit} l2HitPPN:0x${Hexadecimal(hitWayData.ppns(genPtwL2SectorIdx(check_vpn)))} hitVec:${Binary(hitVec.asUInt)} hitWay:${hitWay} vidx:${vVec}\n")
2986d5ddbceSLemover
2996c4dcc2dSLemover    (hit, hitWayData.ppns(genPtwL2SectorIdx(check_vpn)), hitWayData.prefetch, eccError)
3006d5ddbceSLemover  }
3016d5ddbceSLemover
3026d5ddbceSLemover  // l3
3035854c1edSLemover  val ptwl3replace = ReplacementPolicy.fromString(l2tlbParams.l3Replacer,l2tlbParams.l3nWays,l2tlbParams.l3nSets)
304bc063562SLemover  val (l3Hit, l3HitData, l3Pre, l3eccError) = {
3056c4dcc2dSLemover    val ridx = genPtwL3SetIdx(stageReq.bits.req_info.vpn)
3066c4dcc2dSLemover    l3.io.r.req.valid := stageReq.fire
3076d5ddbceSLemover    l3.io.r.req.bits.apply(setIdx = ridx)
3087797f035SbugGenerator    val vVec_req = getl3vSet(stageReq.bits.req_info.vpn)
3096c4dcc2dSLemover
3106c4dcc2dSLemover    // delay one cycle after sram read
3117797f035SbugGenerator    val delay_vpn = stageDelay(0).bits.req_info.vpn
3126c4dcc2dSLemover    val data_resp = DataHoldBypass(l3.io.r.resp.data, stageDelay_valid_1cycle)
3137797f035SbugGenerator    val vVec_delay = RegEnable(vVec_req, stageReq.fire)
3147797f035SbugGenerator    val hitVec_delay = VecInit(data_resp.zip(vVec_delay.asBools).map { case (wayData, v) =>
3157797f035SbugGenerator      wayData.entries.hit(delay_vpn, io.csr_dup(2).satp.asid) && v })
3166c4dcc2dSLemover
3176c4dcc2dSLemover    // check hit and ecc
3186c4dcc2dSLemover    val check_vpn = stageCheck(0).bits.req_info.vpn
3196c4dcc2dSLemover    val ramDatas = RegEnable(data_resp, stageDelay(1).fire)
3208a0e4b2fSLemover    val vVec = RegEnable(vVec_delay, stageDelay(1).fire).asBools()
3216c4dcc2dSLemover
3227797f035SbugGenerator    val hitVec = RegEnable(hitVec_delay, stageDelay(1).fire)
3237196f5a2SLemover    val hitWayEntry = ParallelPriorityMux(hitVec zip ramDatas)
3247196f5a2SLemover    val hitWayData = hitWayEntry.entries
3257196f5a2SLemover    val hitWayEcc = hitWayEntry.ecc
3266c4dcc2dSLemover    val hit = ParallelOR(hitVec)
327f3034303SHaoyuan Feng    val hitWay = ParallelPriorityMux(hitVec zip (0 until l2tlbParams.l3nWays).map(_.U(log2Up(l2tlbParams.l3nWays).W)))
3283889e11eSLemover    val eccError = hitWayEntry.decode()
3296d5ddbceSLemover
3306c4dcc2dSLemover    when (hit && stageCheck_valid_1cycle) { ptwl3replace.access(genPtwL3SetIdx(check_vpn), hitWay) }
3317196f5a2SLemover
3326c4dcc2dSLemover    l3AccessPerf.zip(hitVec).map{ case (l, h) => l := h && stageCheck_valid_1cycle }
3336c4dcc2dSLemover    XSDebug(stageReq.fire, p"[l3] ridx:0x${Hexadecimal(ridx)}\n")
3345854c1edSLemover    for (i <- 0 until l2tlbParams.l3nWays) {
3356c4dcc2dSLemover      XSDebug(stageCheck_valid_1cycle, p"[l3] ramDatas(${i.U}) ${ramDatas(i)}  l3v:${vVec(i)}  hit:${hitVec(i)}\n")
3366d5ddbceSLemover    }
3376c4dcc2dSLemover    XSDebug(stageCheck_valid_1cycle, p"[l3] l3Hit:${hit} l3HitData:${hitWayData} hitVec:${Binary(hitVec.asUInt)} hitWay:${hitWay} v:${vVec}\n")
3386d5ddbceSLemover
3396d5ddbceSLemover    ridx.suggestName(s"l3_ridx")
3406d5ddbceSLemover    ramDatas.suggestName(s"l3_ramDatas")
3416d5ddbceSLemover    hitVec.suggestName(s"l3_hitVec")
3426d5ddbceSLemover    hitWay.suggestName(s"l3_hitWay")
3436d5ddbceSLemover
3443889e11eSLemover    (hit, hitWayData, hitWayData.prefetch, eccError)
3456d5ddbceSLemover  }
3466c4dcc2dSLemover  val l3HitPPN = l3HitData.ppns(genPtwL3SectorIdx(stageCheck(0).bits.req_info.vpn))
3476c4dcc2dSLemover  val l3HitPerm = l3HitData.perms.getOrElse(0.U.asTypeOf(Vec(PtwL3SectorSize, new PtePermBundle)))(genPtwL3SectorIdx(stageCheck(0).bits.req_info.vpn))
3481f4a7c0cSLemover  val l3HitValid = l3HitData.vs(genPtwL3SectorIdx(stageCheck(0).bits.req_info.vpn))
3496d5ddbceSLemover
3506d5ddbceSLemover  // super page
3515854c1edSLemover  val spreplace = ReplacementPolicy.fromString(l2tlbParams.spReplacer, l2tlbParams.spSize)
3528d8ac704SLemover  val (spHit, spHitData, spPre, spValid) = {
3537797f035SbugGenerator    val hitVecT = sp.zipWithIndex.map { case (e, i) => e.hit(stageReq.bits.req_info.vpn, io.csr_dup(0).satp.asid) && spv(i) }
3546c4dcc2dSLemover    val hitVec = hitVecT.map(RegEnable(_, stageReq.fire))
3556d5ddbceSLemover    val hitData = ParallelPriorityMux(hitVec zip sp)
3566c4dcc2dSLemover    val hit = ParallelOR(hitVec)
3576d5ddbceSLemover
3586c4dcc2dSLemover    when (hit && stageDelay_valid_1cycle) { spreplace.access(OHToUInt(hitVec)) }
3596d5ddbceSLemover
3606c4dcc2dSLemover    spAccessPerf.zip(hitVec).map{ case (s, h) => s := h && stageDelay_valid_1cycle }
3615854c1edSLemover    for (i <- 0 until l2tlbParams.spSize) {
3627797f035SbugGenerator      XSDebug(stageReq.fire, p"[sp] sp(${i.U}) ${sp(i)} hit:${sp(i).hit(stageReq.bits.req_info.vpn, io.csr_dup(0).satp.asid)} spv:${spv(i)}\n")
3636d5ddbceSLemover    }
3646c4dcc2dSLemover    XSDebug(stageDelay_valid_1cycle, p"[sp] spHit:${hit} spHitData:${hitData} hitVec:${Binary(VecInit(hitVec).asUInt)}\n")
3656d5ddbceSLemover
3666d5ddbceSLemover    VecInit(hitVecT).suggestName(s"sp_hitVecT")
3676d5ddbceSLemover    VecInit(hitVec).suggestName(s"sp_hitVec")
3686d5ddbceSLemover
3696c4dcc2dSLemover    (RegEnable(hit, stageDelay(1).fire),
3706c4dcc2dSLemover     RegEnable(hitData, stageDelay(1).fire),
3716c4dcc2dSLemover     RegEnable(hitData.prefetch, stageDelay(1).fire),
3726c4dcc2dSLemover     RegEnable(hitData.v, stageDelay(1).fire()))
3736d5ddbceSLemover  }
3746d5ddbceSLemover  val spHitPerm = spHitData.perm.getOrElse(0.U.asTypeOf(new PtePermBundle))
3756d5ddbceSLemover  val spHitLevel = spHitData.level.getOrElse(0.U)
3766d5ddbceSLemover
3776c4dcc2dSLemover  val check_res = Wire(new PageCacheRespBundle)
3786c4dcc2dSLemover  check_res.l1.apply(l1Hit, l1Pre, l1HitPPN)
3796c4dcc2dSLemover  check_res.l2.apply(l2Hit, l2Pre, l2HitPPN, ecc = l2eccError)
3801f4a7c0cSLemover  check_res.l3.apply(l3Hit, l3Pre, l3HitPPN, l3HitPerm, l3eccError, valid = l3HitValid)
3816c4dcc2dSLemover  check_res.sp.apply(spHit, spPre, spHitData.ppn, spHitPerm, false.B, spHitLevel, spValid)
3826d5ddbceSLemover
3836c4dcc2dSLemover  val resp_res = Reg(new PageCacheRespBundle)
3846c4dcc2dSLemover  when (stageCheck(1).fire) { resp_res := check_res }
3853889e11eSLemover
3861f4a7c0cSLemover  // stageResp bypass
3871f4a7c0cSLemover  val bypassed = Wire(Vec(3, Bool()))
3881f4a7c0cSLemover  bypassed.indices.foreach(i =>
3891f4a7c0cSLemover    bypassed(i) := stageResp.bits.bypassed(i) ||
3901f4a7c0cSLemover      ValidHoldBypass(refill_bypass(stageResp.bits.req_info.vpn, i),
3911f4a7c0cSLemover        OneCycleValid(stageCheck(1).fire, false.B) || io.refill.valid)
3921f4a7c0cSLemover  )
3931f4a7c0cSLemover
3946c4dcc2dSLemover  io.resp.bits.req_info   := stageResp.bits.req_info
3956c4dcc2dSLemover  io.resp.bits.isFirst  := stageResp.bits.isFirst
3966c4dcc2dSLemover  io.resp.bits.hit      := resp_res.l3.hit || resp_res.sp.hit
3971f4a7c0cSLemover  io.resp.bits.bypassed := bypassed(2) || (bypassed(1) && !resp_res.l2.hit) || (bypassed(0) && !resp_res.l1.hit)
3986c4dcc2dSLemover  io.resp.bits.prefetch := resp_res.l3.pre && resp_res.l3.hit || resp_res.sp.pre && resp_res.sp.hit
3996c4dcc2dSLemover  io.resp.bits.toFsm.l1Hit := resp_res.l1.hit
4006c4dcc2dSLemover  io.resp.bits.toFsm.l2Hit := resp_res.l2.hit
4016c4dcc2dSLemover  io.resp.bits.toFsm.ppn   := Mux(resp_res.l2.hit, resp_res.l2.ppn, resp_res.l1.ppn)
4026c4dcc2dSLemover  io.resp.bits.toTlb.tag   := stageResp.bits.req_info.vpn
4037797f035SbugGenerator  io.resp.bits.toTlb.asid  := io.csr_dup(0).satp.asid // DontCare
4046c4dcc2dSLemover  io.resp.bits.toTlb.ppn   := Mux(resp_res.l3.hit, resp_res.l3.ppn, resp_res.sp.ppn)
4056c4dcc2dSLemover  io.resp.bits.toTlb.perm.map(_ := Mux(resp_res.l3.hit, resp_res.l3.perm, resp_res.sp.perm))
4066c4dcc2dSLemover  io.resp.bits.toTlb.level.map(_ := Mux(resp_res.l3.hit, 2.U, resp_res.sp.level))
4076c4dcc2dSLemover  io.resp.bits.toTlb.prefetch := from_pre(stageResp.bits.req_info.source)
4086c4dcc2dSLemover  io.resp.bits.toTlb.v := Mux(resp_res.sp.hit, resp_res.sp.v, resp_res.l3.v)
4096c4dcc2dSLemover  io.resp.valid := stageResp.valid
4106c4dcc2dSLemover  XSError(stageResp.valid && resp_res.l3.hit && resp_res.sp.hit, "normal page and super page both hit")
4111f4a7c0cSLemover  XSError(stageResp.valid && io.resp.bits.hit && bypassed(2), "page cache, bypassed but hit")
4126d5ddbceSLemover
4136d5ddbceSLemover  // refill Perf
4145854c1edSLemover  val l1RefillPerf = Wire(Vec(l2tlbParams.l1Size, Bool()))
4155854c1edSLemover  val l2RefillPerf = Wire(Vec(l2tlbParams.l2nWays, Bool()))
4165854c1edSLemover  val l3RefillPerf = Wire(Vec(l2tlbParams.l3nWays, Bool()))
4175854c1edSLemover  val spRefillPerf = Wire(Vec(l2tlbParams.spSize, Bool()))
4186d5ddbceSLemover  l1RefillPerf.map(_ := false.B)
4196d5ddbceSLemover  l2RefillPerf.map(_ := false.B)
4206d5ddbceSLemover  l3RefillPerf.map(_ := false.B)
4216d5ddbceSLemover  spRefillPerf.map(_ := false.B)
4226d5ddbceSLemover
4236d5ddbceSLemover  // refill
4246d5ddbceSLemover  l2.io.w.req <> DontCare
4256d5ddbceSLemover  l3.io.w.req <> DontCare
4266d5ddbceSLemover  l2.io.w.req.valid := false.B
4276d5ddbceSLemover  l3.io.w.req.valid := false.B
4286d5ddbceSLemover
4296d5ddbceSLemover  val memRdata = refill.ptes
4305854c1edSLemover  val memPtes = (0 until (l2tlbParams.blockBytes/(XLEN/8))).map(i => memRdata((i+1)*XLEN-1, i*XLEN).asTypeOf(new PteBundle))
4317797f035SbugGenerator  val memSelData = io.refill.bits.sel_pte_dup
4327797f035SbugGenerator  val memPte = memSelData.map(a => a.asTypeOf(new PteBundle))
433b848eea5SLemover
4346d5ddbceSLemover  // TODO: handle sfenceLatch outsize
4357797f035SbugGenerator  when (!flush_dup(0) && refill.levelOH.l1 && !memPte(0).isLeaf() && !memPte(0).isPf(refill.level_dup(0))) {
4365854c1edSLemover    // val refillIdx = LFSR64()(log2Up(l2tlbParams.l1Size)-1,0) // TODO: may be LRU
4376d5ddbceSLemover    val refillIdx = replaceWrapper(l1v, ptwl1replace.way)
4386d5ddbceSLemover    refillIdx.suggestName(s"PtwL1RefillIdx")
4396d5ddbceSLemover    val rfOH = UIntToOH(refillIdx)
44045f497a4Shappy-lx    l1(refillIdx).refill(
4417797f035SbugGenerator      refill.req_info_dup(0).vpn,
4427797f035SbugGenerator      io.csr_dup(0).satp.asid,
4437797f035SbugGenerator      memSelData(0),
44445f497a4Shappy-lx      0.U,
4457797f035SbugGenerator      refill_prefetch_dup(0)
44645f497a4Shappy-lx    )
4476d5ddbceSLemover    ptwl1replace.access(refillIdx)
4486d5ddbceSLemover    l1v := l1v | rfOH
4497797f035SbugGenerator    l1g := (l1g & ~rfOH) | Mux(memPte(0).perm.g, rfOH, 0.U)
4506d5ddbceSLemover
4515854c1edSLemover    for (i <- 0 until l2tlbParams.l1Size) {
4526d5ddbceSLemover      l1RefillPerf(i) := i.U === refillIdx
4536d5ddbceSLemover    }
4546d5ddbceSLemover
4557797f035SbugGenerator    XSDebug(p"[l1 refill] refillIdx:${refillIdx} refillEntry:${l1(refillIdx).genPtwEntry(refill.req_info_dup(0).vpn, io.csr_dup(0).satp.asid, memSelData(0), 0.U, prefetch = refill_prefetch_dup(0))}\n")
4567797f035SbugGenerator    XSDebug(p"[l1 refill] l1v:${Binary(l1v)}->${Binary(l1v | rfOH)} l1g:${Binary(l1g)}->${Binary((l1g & ~rfOH) | Mux(memPte(0).perm.g, rfOH, 0.U))}\n")
4576d5ddbceSLemover
4586d5ddbceSLemover    refillIdx.suggestName(s"l1_refillIdx")
4596d5ddbceSLemover    rfOH.suggestName(s"l1_rfOH")
4606d5ddbceSLemover  }
4616d5ddbceSLemover
4627797f035SbugGenerator  when (!flush_dup(1) && refill.levelOH.l2 && !memPte(1).isLeaf() && !memPte(1).isPf(refill.level_dup(1))) {
4637797f035SbugGenerator    val refillIdx = genPtwL2SetIdx(refill.req_info_dup(1).vpn)
4647797f035SbugGenerator    val victimWay = replaceWrapper(getl2vSet(refill.req_info_dup(1).vpn), ptwl2replace.way(refillIdx))
4656d5ddbceSLemover    val victimWayOH = UIntToOH(victimWay)
4666d5ddbceSLemover    val rfvOH = UIntToOH(Cat(refillIdx, victimWay))
4677196f5a2SLemover    val wdata = Wire(l2EntryType)
4683889e11eSLemover    wdata.gen(
4697797f035SbugGenerator      vpn = refill.req_info_dup(1).vpn,
4707797f035SbugGenerator      asid = io.csr_dup(1).satp.asid,
47145f497a4Shappy-lx      data = memRdata,
47245f497a4Shappy-lx      levelUInt = 1.U,
4737797f035SbugGenerator      refill_prefetch_dup(1)
47445f497a4Shappy-lx    )
4756d5ddbceSLemover    l2.io.w.apply(
4766d5ddbceSLemover      valid = true.B,
4776d5ddbceSLemover      setIdx = refillIdx,
4787196f5a2SLemover      data = wdata,
4796d5ddbceSLemover      waymask = victimWayOH
4806d5ddbceSLemover    )
4816d5ddbceSLemover    ptwl2replace.access(refillIdx, victimWay)
4826d5ddbceSLemover    l2v := l2v | rfvOH
4836d5ddbceSLemover    l2g := l2g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U)
4846d5ddbceSLemover
4855854c1edSLemover    for (i <- 0 until l2tlbParams.l2nWays) {
4866d5ddbceSLemover      l2RefillPerf(i) := i.U === victimWay
4876d5ddbceSLemover    }
4886d5ddbceSLemover
4896d5ddbceSLemover    XSDebug(p"[l2 refill] refillIdx:0x${Hexadecimal(refillIdx)} victimWay:${victimWay} victimWayOH:${Binary(victimWayOH)} rfvOH(in UInt):${Cat(refillIdx, victimWay)}\n")
49045f497a4Shappy-lx    XSDebug(p"[l2 refill] refilldata:0x${wdata}\n")
4916d5ddbceSLemover    XSDebug(p"[l2 refill] l2v:${Binary(l2v)} -> ${Binary(l2v | rfvOH)}\n")
4926d5ddbceSLemover    XSDebug(p"[l2 refill] l2g:${Binary(l2g)} -> ${Binary(l2g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U))}\n")
4936d5ddbceSLemover
4946d5ddbceSLemover    refillIdx.suggestName(s"l2_refillIdx")
4956d5ddbceSLemover    victimWay.suggestName(s"l2_victimWay")
4966d5ddbceSLemover    victimWayOH.suggestName(s"l2_victimWayOH")
4976d5ddbceSLemover    rfvOH.suggestName(s"l2_rfvOH")
4986d5ddbceSLemover  }
4996d5ddbceSLemover
5007797f035SbugGenerator  when (!flush_dup(2) && refill.levelOH.l3) {
5017797f035SbugGenerator    val refillIdx = genPtwL3SetIdx(refill.req_info_dup(2).vpn)
5027797f035SbugGenerator    val victimWay = replaceWrapper(getl3vSet(refill.req_info_dup(2).vpn), ptwl3replace.way(refillIdx))
5036d5ddbceSLemover    val victimWayOH = UIntToOH(victimWay)
5046d5ddbceSLemover    val rfvOH = UIntToOH(Cat(refillIdx, victimWay))
5057196f5a2SLemover    val wdata = Wire(l3EntryType)
5063889e11eSLemover    wdata.gen(
5077797f035SbugGenerator      vpn = refill.req_info_dup(2).vpn,
5087797f035SbugGenerator      asid = io.csr_dup(2).satp.asid,
50945f497a4Shappy-lx      data = memRdata,
51045f497a4Shappy-lx      levelUInt = 2.U,
5117797f035SbugGenerator      refill_prefetch_dup(2)
51245f497a4Shappy-lx    )
5136d5ddbceSLemover    l3.io.w.apply(
5146d5ddbceSLemover      valid = true.B,
5156d5ddbceSLemover      setIdx = refillIdx,
5167196f5a2SLemover      data = wdata,
5176d5ddbceSLemover      waymask = victimWayOH
5186d5ddbceSLemover    )
5196d5ddbceSLemover    ptwl3replace.access(refillIdx, victimWay)
5206d5ddbceSLemover    l3v := l3v | rfvOH
5216d5ddbceSLemover    l3g := l3g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U)
5226d5ddbceSLemover
5235854c1edSLemover    for (i <- 0 until l2tlbParams.l3nWays) {
5246d5ddbceSLemover      l3RefillPerf(i) := i.U === victimWay
5256d5ddbceSLemover    }
5266d5ddbceSLemover
5276d5ddbceSLemover    XSDebug(p"[l3 refill] refillIdx:0x${Hexadecimal(refillIdx)} victimWay:${victimWay} victimWayOH:${Binary(victimWayOH)} rfvOH(in UInt):${Cat(refillIdx, victimWay)}\n")
52845f497a4Shappy-lx    XSDebug(p"[l3 refill] refilldata:0x${wdata}\n")
5296d5ddbceSLemover    XSDebug(p"[l3 refill] l3v:${Binary(l3v)} -> ${Binary(l3v | rfvOH)}\n")
5306d5ddbceSLemover    XSDebug(p"[l3 refill] l3g:${Binary(l3g)} -> ${Binary(l3g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U))}\n")
5316d5ddbceSLemover
5326d5ddbceSLemover    refillIdx.suggestName(s"l3_refillIdx")
5336d5ddbceSLemover    victimWay.suggestName(s"l3_victimWay")
5346d5ddbceSLemover    victimWayOH.suggestName(s"l3_victimWayOH")
5356d5ddbceSLemover    rfvOH.suggestName(s"l3_rfvOH")
5366d5ddbceSLemover  }
5377797f035SbugGenerator
5388d8ac704SLemover
5398d8ac704SLemover  // misc entries: super & invalid
5407797f035SbugGenerator  when (!flush_dup(0) && refill.levelOH.sp && (memPte(0).isLeaf() || memPte(0).isPf(refill.level_dup(0)))) {
5415854c1edSLemover    val refillIdx = spreplace.way// LFSR64()(log2Up(l2tlbParams.spSize)-1,0) // TODO: may be LRU
5426d5ddbceSLemover    val rfOH = UIntToOH(refillIdx)
54345f497a4Shappy-lx    sp(refillIdx).refill(
5447797f035SbugGenerator      refill.req_info_dup(0).vpn,
5457797f035SbugGenerator      io.csr_dup(0).satp.asid,
5467797f035SbugGenerator      memSelData(0),
5477797f035SbugGenerator      refill.level_dup(2),
5487797f035SbugGenerator      refill_prefetch_dup(0),
5497797f035SbugGenerator      !memPte(0).isPf(refill.level_dup(0)),
55045f497a4Shappy-lx    )
5516d5ddbceSLemover    spreplace.access(refillIdx)
5526d5ddbceSLemover    spv := spv | rfOH
5537797f035SbugGenerator    spg := spg & ~rfOH | Mux(memPte(0).perm.g, rfOH, 0.U)
5546d5ddbceSLemover
5555854c1edSLemover    for (i <- 0 until l2tlbParams.spSize) {
5566d5ddbceSLemover      spRefillPerf(i) := i.U === refillIdx
5576d5ddbceSLemover    }
5586d5ddbceSLemover
5597797f035SbugGenerator    XSDebug(p"[sp refill] refillIdx:${refillIdx} refillEntry:${sp(refillIdx).genPtwEntry(refill.req_info_dup(0).vpn, io.csr_dup(0).satp.asid, memSelData(0), refill.level_dup(0), refill_prefetch_dup(0))}\n")
5607797f035SbugGenerator    XSDebug(p"[sp refill] spv:${Binary(spv)}->${Binary(spv | rfOH)} spg:${Binary(spg)}->${Binary(spg & ~rfOH | Mux(memPte(0).perm.g, rfOH, 0.U))}\n")
5616d5ddbceSLemover
5626d5ddbceSLemover    refillIdx.suggestName(s"sp_refillIdx")
5636d5ddbceSLemover    rfOH.suggestName(s"sp_rfOH")
5646d5ddbceSLemover  }
5656d5ddbceSLemover
5667797f035SbugGenerator  val l2eccFlush = resp_res.l2.ecc && stageResp_valid_1cycle_dup(0) // RegNext(l2eccError, init = false.B)
5677797f035SbugGenerator  val l3eccFlush = resp_res.l3.ecc && stageResp_valid_1cycle_dup(1) // RegNext(l3eccError, init = false.B)
5686c4dcc2dSLemover  val eccVpn = stageResp.bits.req_info.vpn
5697196f5a2SLemover
5706c4dcc2dSLemover  XSError(l2eccFlush, "l2tlb.cache.l2 ecc error. Should not happen at sim stage")
5716c4dcc2dSLemover  XSError(l3eccFlush, "l2tlb.cache.l3 ecc error. Should not happen at sim stage")
5727196f5a2SLemover  when (l2eccFlush) {
5737196f5a2SLemover    val flushSetIdxOH = UIntToOH(genPtwL2SetIdx(eccVpn))
5747196f5a2SLemover    val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l2nWays, a.asUInt) }).asUInt
5757196f5a2SLemover    l2v := l2v & ~flushMask
5767196f5a2SLemover    l2g := l2g & ~flushMask
5777196f5a2SLemover  }
5787196f5a2SLemover
5797196f5a2SLemover  when (l3eccFlush) {
5807196f5a2SLemover    val flushSetIdxOH = UIntToOH(genPtwL3SetIdx(eccVpn))
5817196f5a2SLemover    val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l3nWays, a.asUInt) }).asUInt
5827196f5a2SLemover    l3v := l3v & ~flushMask
5837196f5a2SLemover    l3g := l3g & ~flushMask
5847196f5a2SLemover  }
5857196f5a2SLemover
5866d5ddbceSLemover  // sfence
5877797f035SbugGenerator  when (sfence_dup(3).valid) {
5887797f035SbugGenerator    val sfence_vpn = sfence_dup(3).bits.addr(sfence_dup(3).bits.addr.getWidth-1, offLen)
58945f497a4Shappy-lx
5907797f035SbugGenerator    when (sfence_dup(3).bits.rs1/*va*/) {
5917797f035SbugGenerator      when (sfence_dup(3).bits.rs2) {
5927797f035SbugGenerator        // all va && all asid
5937797f035SbugGenerator        l3v := 0.U
5947797f035SbugGenerator      } .otherwise {
5957797f035SbugGenerator        // all va && specific asid except global
5967797f035SbugGenerator        l3v := l3v & l3g
5977797f035SbugGenerator      }
5987797f035SbugGenerator    } .otherwise {
5997797f035SbugGenerator      // val flushMask = UIntToOH(genTlbL2Idx(sfence.bits.addr(sfence.bits.addr.getWidth-1, offLen)))
6007797f035SbugGenerator      val flushSetIdxOH = UIntToOH(genPtwL3SetIdx(sfence_vpn))
6017797f035SbugGenerator      // val flushMask = VecInit(flushSetIdxOH.asBools.map(Fill(l2tlbParams.l3nWays, _.asUInt))).asUInt
6027797f035SbugGenerator      val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l3nWays, a.asUInt) }).asUInt
6037797f035SbugGenerator      flushSetIdxOH.suggestName(s"sfence_nrs1_flushSetIdxOH")
6047797f035SbugGenerator      flushMask.suggestName(s"sfence_nrs1_flushMask")
6057797f035SbugGenerator
6067797f035SbugGenerator      when (sfence_dup(3).bits.rs2) {
6077797f035SbugGenerator        // specific leaf of addr && all asid
6087797f035SbugGenerator        l3v := l3v & ~flushMask
6097797f035SbugGenerator      } .otherwise {
6107797f035SbugGenerator        // specific leaf of addr && specific asid
6117797f035SbugGenerator        l3v := l3v & (~flushMask | l3g)
6127797f035SbugGenerator      }
6137797f035SbugGenerator    }
6147797f035SbugGenerator  }
6157797f035SbugGenerator
6167797f035SbugGenerator  when (sfence_dup(0).valid) {
6177797f035SbugGenerator    val l1asidhit = VecInit(l1asids.map(_ === sfence_dup(0).bits.asid)).asUInt
6187797f035SbugGenerator    val spasidhit = VecInit(spasids.map(_ === sfence_dup(0).bits.asid)).asUInt
6197797f035SbugGenerator    val sfence_vpn = sfence_dup(0).bits.addr(sfence_dup(0).bits.addr.getWidth-1, offLen)
6207797f035SbugGenerator
6217797f035SbugGenerator    when (sfence_dup(0).bits.rs1/*va*/) {
6227797f035SbugGenerator      when (sfence_dup(0).bits.rs2) {
6236d5ddbceSLemover        // all va && all asid
6246d5ddbceSLemover        l1v := 0.U
6256d5ddbceSLemover        l2v := 0.U
6266d5ddbceSLemover        spv := 0.U
6276d5ddbceSLemover      } .otherwise {
6286d5ddbceSLemover        // all va && specific asid except global
62945f497a4Shappy-lx
63045f497a4Shappy-lx        l1v := l1v & (~l1asidhit | l1g)
6316d5ddbceSLemover        l2v := l2v & l2g
63245f497a4Shappy-lx        spv := spv & (~spasidhit | spg)
6336d5ddbceSLemover      }
6346d5ddbceSLemover    } .otherwise {
6356d5ddbceSLemover      // val flushMask = UIntToOH(genTlbL2Idx(sfence.bits.addr(sfence.bits.addr.getWidth-1, offLen)))
63645f497a4Shappy-lx      val flushSetIdxOH = UIntToOH(genPtwL3SetIdx(sfence_vpn))
6375854c1edSLemover      // val flushMask = VecInit(flushSetIdxOH.asBools.map(Fill(l2tlbParams.l3nWays, _.asUInt))).asUInt
6385854c1edSLemover      val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l3nWays, a.asUInt) }).asUInt
6396d5ddbceSLemover      flushSetIdxOH.suggestName(s"sfence_nrs1_flushSetIdxOH")
6406d5ddbceSLemover      flushMask.suggestName(s"sfence_nrs1_flushMask")
64145f497a4Shappy-lx
6427797f035SbugGenerator      when (sfence_dup(0).bits.rs2) {
6436d5ddbceSLemover        // specific leaf of addr && all asid
64442a7f20fSbugGenerator        spv := spv & (~VecInit(sp.map(_.hit(sfence_vpn, sfence_dup(0).bits.asid, ignoreAsid = true))).asUInt)
6456d5ddbceSLemover      } .otherwise {
6466d5ddbceSLemover        // specific leaf of addr && specific asid
6477797f035SbugGenerator        spv := spv & (~VecInit(sp.map(_.hit(sfence_vpn, sfence_dup(0).bits.asid))).asUInt | spg)
6486d5ddbceSLemover      }
6496d5ddbceSLemover    }
6506d5ddbceSLemover  }
6516d5ddbceSLemover
6527797f035SbugGenerator  def InsideStageConnect(in: DecoupledIO[PtwCacheReq], out: DecoupledIO[PtwCacheReq], inFire: Bool): Unit = {
6532c86e165SZhangZifei    in.ready := !in.valid || out.ready
6542c86e165SZhangZifei    out.valid := in.valid
6552c86e165SZhangZifei    out.bits := in.bits
6561f4a7c0cSLemover    out.bits.bypassed.zip(in.bits.bypassed).zipWithIndex.map{ case (b, i) =>
6577797f035SbugGenerator      val bypassed_reg = Reg(Bool())
6587797f035SbugGenerator      val bypassed_wire = refill_bypass(in.bits.req_info.vpn, i) && io.refill.valid
6597797f035SbugGenerator      when (inFire) { bypassed_reg := bypassed_wire }
6607797f035SbugGenerator      .elsewhen (io.refill.valid) { bypassed_reg := bypassed_reg || bypassed_wire }
6617797f035SbugGenerator
6627797f035SbugGenerator      b._1 := b._2 || (bypassed_wire || (bypassed_reg && !inFire))
6631f4a7c0cSLemover    }
6642c86e165SZhangZifei  }
6652c86e165SZhangZifei
6666d5ddbceSLemover  // Perf Count
6676c4dcc2dSLemover  val resp_l3 = resp_res.l3.hit
6686c4dcc2dSLemover  val resp_sp = resp_res.sp.hit
6696c4dcc2dSLemover  val resp_l1_pre = resp_res.l1.pre
6706c4dcc2dSLemover  val resp_l2_pre = resp_res.l2.pre
6716c4dcc2dSLemover  val resp_l3_pre = resp_res.l3.pre
6726c4dcc2dSLemover  val resp_sp_pre = resp_res.sp.pre
67345f497a4Shappy-lx  val base_valid_access_0 = !from_pre(io.resp.bits.req_info.source) && io.resp.fire()
674bc063562SLemover  XSPerfAccumulate("access", base_valid_access_0)
675bc063562SLemover  XSPerfAccumulate("l1_hit", base_valid_access_0 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
676bc063562SLemover  XSPerfAccumulate("l2_hit", base_valid_access_0 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
677bc063562SLemover  XSPerfAccumulate("l3_hit", base_valid_access_0 && resp_l3)
678bc063562SLemover  XSPerfAccumulate("sp_hit", base_valid_access_0 && resp_sp)
679bc063562SLemover  XSPerfAccumulate("pte_hit",base_valid_access_0 && io.resp.bits.hit)
680bc063562SLemover
681bc063562SLemover  XSPerfAccumulate("l1_hit_pre", base_valid_access_0 && resp_l1_pre && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
682bc063562SLemover  XSPerfAccumulate("l2_hit_pre", base_valid_access_0 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
683bc063562SLemover  XSPerfAccumulate("l3_hit_pre", base_valid_access_0 && resp_l3_pre && resp_l3)
684bc063562SLemover  XSPerfAccumulate("sp_hit_pre", base_valid_access_0 && resp_sp_pre && resp_sp)
685bc063562SLemover  XSPerfAccumulate("pte_hit_pre",base_valid_access_0 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
686bc063562SLemover
68745f497a4Shappy-lx  val base_valid_access_1 = from_pre(io.resp.bits.req_info.source) && io.resp.fire()
688bc063562SLemover  XSPerfAccumulate("pre_access", base_valid_access_1)
689bc063562SLemover  XSPerfAccumulate("pre_l1_hit", base_valid_access_1 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
690bc063562SLemover  XSPerfAccumulate("pre_l2_hit", base_valid_access_1 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
691bc063562SLemover  XSPerfAccumulate("pre_l3_hit", base_valid_access_1 && resp_l3)
692bc063562SLemover  XSPerfAccumulate("pre_sp_hit", base_valid_access_1 && resp_sp)
693bc063562SLemover  XSPerfAccumulate("pre_pte_hit",base_valid_access_1 && io.resp.bits.hit)
694bc063562SLemover
695bc063562SLemover  XSPerfAccumulate("pre_l1_hit_pre", base_valid_access_1 && resp_l1_pre && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
696bc063562SLemover  XSPerfAccumulate("pre_l2_hit_pre", base_valid_access_1 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
697bc063562SLemover  XSPerfAccumulate("pre_l3_hit_pre", base_valid_access_1 && resp_l3_pre && resp_l3)
698bc063562SLemover  XSPerfAccumulate("pre_sp_hit_pre", base_valid_access_1 && resp_sp_pre && resp_sp)
699bc063562SLemover  XSPerfAccumulate("pre_pte_hit_pre",base_valid_access_1 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
700bc063562SLemover
7016c4dcc2dSLemover  val base_valid_access_2 = stageResp.bits.isFirst && !from_pre(io.resp.bits.req_info.source) && io.resp.fire()
702bc063562SLemover  XSPerfAccumulate("access_first", base_valid_access_2)
703bc063562SLemover  XSPerfAccumulate("l1_hit_first", base_valid_access_2 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
704bc063562SLemover  XSPerfAccumulate("l2_hit_first", base_valid_access_2 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
705bc063562SLemover  XSPerfAccumulate("l3_hit_first", base_valid_access_2 && resp_l3)
706bc063562SLemover  XSPerfAccumulate("sp_hit_first", base_valid_access_2 && resp_sp)
707bc063562SLemover  XSPerfAccumulate("pte_hit_first",base_valid_access_2 && io.resp.bits.hit)
708bc063562SLemover
709bc063562SLemover  XSPerfAccumulate("l1_hit_pre_first", base_valid_access_2 && resp_l1_pre && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
710bc063562SLemover  XSPerfAccumulate("l2_hit_pre_first", base_valid_access_2 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
711bc063562SLemover  XSPerfAccumulate("l3_hit_pre_first", base_valid_access_2 && resp_l3_pre && resp_l3)
712bc063562SLemover  XSPerfAccumulate("sp_hit_pre_first", base_valid_access_2 && resp_sp_pre && resp_sp)
713bc063562SLemover  XSPerfAccumulate("pte_hit_pre_first",base_valid_access_2 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
714bc063562SLemover
7156c4dcc2dSLemover  val base_valid_access_3 = stageResp.bits.isFirst && from_pre(io.resp.bits.req_info.source) && io.resp.fire()
716bc063562SLemover  XSPerfAccumulate("pre_access_first", base_valid_access_3)
717bc063562SLemover  XSPerfAccumulate("pre_l1_hit_first", base_valid_access_3 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
718bc063562SLemover  XSPerfAccumulate("pre_l2_hit_first", base_valid_access_3 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
719bc063562SLemover  XSPerfAccumulate("pre_l3_hit_first", base_valid_access_3 && resp_l3)
720bc063562SLemover  XSPerfAccumulate("pre_sp_hit_first", base_valid_access_3 && resp_sp)
721bc063562SLemover  XSPerfAccumulate("pre_pte_hit_first", base_valid_access_3 && io.resp.bits.hit)
722bc063562SLemover
723bc063562SLemover  XSPerfAccumulate("pre_l1_hit_pre_first", base_valid_access_3 && resp_l1_pre && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
724bc063562SLemover  XSPerfAccumulate("pre_l2_hit_pre_first", base_valid_access_3 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
725bc063562SLemover  XSPerfAccumulate("pre_l3_hit_pre_first", base_valid_access_3 && resp_l3_pre && resp_l3)
726bc063562SLemover  XSPerfAccumulate("pre_sp_hit_pre_first", base_valid_access_3 && resp_sp_pre && resp_sp)
727bc063562SLemover  XSPerfAccumulate("pre_pte_hit_pre_first",base_valid_access_3 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
728bc063562SLemover
7296d5ddbceSLemover  XSPerfAccumulate("rwHarzad", io.req.valid && !io.req.ready)
7306d5ddbceSLemover  XSPerfAccumulate("out_blocked", io.resp.valid && !io.resp.ready)
7316d5ddbceSLemover  l1AccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L1AccessIndex${i}", l) }
7326d5ddbceSLemover  l2AccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L2AccessIndex${i}", l) }
7336d5ddbceSLemover  l3AccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L3AccessIndex${i}", l) }
7346d5ddbceSLemover  spAccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"SPAccessIndex${i}", l) }
7356d5ddbceSLemover  l1RefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L1RefillIndex${i}", l) }
7366d5ddbceSLemover  l2RefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L2RefillIndex${i}", l) }
7376d5ddbceSLemover  l3RefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L3RefillIndex${i}", l) }
7386d5ddbceSLemover  spRefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"SPRefillIndex${i}", l) }
7396d5ddbceSLemover
740bc063562SLemover  XSPerfAccumulate("l1Refill", Cat(l1RefillPerf).orR)
741bc063562SLemover  XSPerfAccumulate("l2Refill", Cat(l2RefillPerf).orR)
742bc063562SLemover  XSPerfAccumulate("l3Refill", Cat(l3RefillPerf).orR)
743bc063562SLemover  XSPerfAccumulate("spRefill", Cat(spRefillPerf).orR)
7447797f035SbugGenerator  XSPerfAccumulate("l1Refill_pre", Cat(l1RefillPerf).orR && refill_prefetch_dup(0))
7457797f035SbugGenerator  XSPerfAccumulate("l2Refill_pre", Cat(l2RefillPerf).orR && refill_prefetch_dup(0))
7467797f035SbugGenerator  XSPerfAccumulate("l3Refill_pre", Cat(l3RefillPerf).orR && refill_prefetch_dup(0))
7477797f035SbugGenerator  XSPerfAccumulate("spRefill_pre", Cat(spRefillPerf).orR && refill_prefetch_dup(0))
748bc063562SLemover
7496d5ddbceSLemover  // debug
7507797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] original v and g vector:\n")
7517797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l1v:${Binary(l1v)}\n")
7527797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l2v:${Binary(l2v)}\n")
7537797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l3v:${Binary(l3v)}\n")
7547797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l3g:${Binary(l3g)}\n")
7557797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] spv:${Binary(spv)}\n")
7567797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] new v and g vector:\n")
7577797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l1v:${Binary(l1v)}\n")
7587797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l2v:${Binary(l2v)}\n")
7597797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l3v:${Binary(l3v)}\n")
7607797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l3g:${Binary(l3g)}\n")
7617797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] spv:${Binary(spv)}\n")
762cd365d4cSrvcoresjw
763cd365d4cSrvcoresjw  val perfEvents = Seq(
76456be8e20SYinan Xu    ("access           ", base_valid_access_0             ),
765cd365d4cSrvcoresjw    ("l1_hit           ", l1Hit                           ),
766cd365d4cSrvcoresjw    ("l2_hit           ", l2Hit                           ),
767cd365d4cSrvcoresjw    ("l3_hit           ", l3Hit                           ),
768cd365d4cSrvcoresjw    ("sp_hit           ", spHit                           ),
769cd365d4cSrvcoresjw    ("pte_hit          ", l3Hit || spHit                  ),
770cd365d4cSrvcoresjw    ("rwHarzad         ",  io.req.valid && !io.req.ready  ),
771cd365d4cSrvcoresjw    ("out_blocked      ",  io.resp.valid && !io.resp.ready),
772cd365d4cSrvcoresjw  )
7731ca0e4f3SYinan Xu  generatePerfEvent()
7746d5ddbceSLemover}
775