xref: /XiangShan/src/main/scala/xiangshan/cache/mmu/PageTableCache.scala (revision 42a7f20f629194ecefa712da9b485ade79f6e843)
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._
266d5ddbceSLemoverimport freechips.rocketchip.diplomacy.{LazyModule, LazyModuleImp}
276d5ddbceSLemoverimport freechips.rocketchip.tilelink._
286d5ddbceSLemover
296d5ddbceSLemover/* ptw cache caches the page table of all the three layers
306d5ddbceSLemover * ptw cache resp at next cycle
316d5ddbceSLemover * the cache should not be blocked
326d5ddbceSLemover * when miss queue if full, just block req outside
336d5ddbceSLemover */
343889e11eSLemover
353889e11eSLemoverclass PageCachePerPespBundle(implicit p: Parameters) extends PtwBundle {
363889e11eSLemover  val hit = Bool()
373889e11eSLemover  val pre = Bool()
383889e11eSLemover  val ppn = UInt(ppnLen.W)
393889e11eSLemover  val perm = new PtePermBundle()
403889e11eSLemover  val ecc = Bool()
413889e11eSLemover  val level = UInt(2.W)
428d8ac704SLemover  val v = Bool()
433889e11eSLemover
443889e11eSLemover  def apply(hit: Bool, pre: Bool, ppn: UInt, perm: PtePermBundle = 0.U.asTypeOf(new PtePermBundle()),
458d8ac704SLemover            ecc: Bool = false.B, level: UInt = 0.U, valid: Bool = true.B) {
463889e11eSLemover    this.hit := hit && !ecc
473889e11eSLemover    this.pre := pre
483889e11eSLemover    this.ppn := ppn
493889e11eSLemover    this.perm := perm
503889e11eSLemover    this.ecc := ecc && hit
513889e11eSLemover    this.level := level
528d8ac704SLemover    this.v := valid
533889e11eSLemover  }
543889e11eSLemover}
553889e11eSLemover
563889e11eSLemoverclass PageCacheRespBundle(implicit p: Parameters) extends PtwBundle {
573889e11eSLemover  val l1 = new PageCachePerPespBundle
583889e11eSLemover  val l2 = new PageCachePerPespBundle
593889e11eSLemover  val l3 = new PageCachePerPespBundle
603889e11eSLemover  val sp = new PageCachePerPespBundle
613889e11eSLemover}
623889e11eSLemover
633889e11eSLemoverclass PtwCacheReq(implicit p: Parameters) extends PtwBundle {
643889e11eSLemover  val req_info = new L2TlbInnerBundle()
653889e11eSLemover  val isFirst = Bool()
661f4a7c0cSLemover  val bypassed = Vec(3, Bool())
673889e11eSLemover}
683889e11eSLemover
693889e11eSLemoverclass PtwCacheIO()(implicit p: Parameters) extends MMUIOBaseBundle with HasPtwConst {
703889e11eSLemover  val req = Flipped(DecoupledIO(new PtwCacheReq()))
716d5ddbceSLemover  val resp = DecoupledIO(new Bundle {
7245f497a4Shappy-lx    val req_info = new L2TlbInnerBundle()
7394133605SLemover    val isFirst = Bool()
746d5ddbceSLemover    val hit = Bool()
75bc063562SLemover    val prefetch = Bool() // is the entry fetched by prefetch
761f4a7c0cSLemover    val bypassed = Bool()
776d5ddbceSLemover    val toFsm = new Bundle {
786d5ddbceSLemover      val l1Hit = Bool()
796d5ddbceSLemover      val l2Hit = Bool()
806d5ddbceSLemover      val ppn = UInt(ppnLen.W)
816d5ddbceSLemover    }
826d5ddbceSLemover    val toTlb = new PtwEntry(tagLen = vpnLen, hasPerm = true, hasLevel = true)
836d5ddbceSLemover  })
846d5ddbceSLemover  val refill = Flipped(ValidIO(new Bundle {
855854c1edSLemover    val ptes = UInt(blockBits.W)
867797f035SbugGenerator    val levelOH = new Bundle {
877797f035SbugGenerator      // NOTE: levelOH has (Level+1) bits, each stands for page cache entries
887797f035SbugGenerator      val sp = Bool()
897797f035SbugGenerator      val l3 = Bool()
907797f035SbugGenerator      val l2 = Bool()
917797f035SbugGenerator      val l1 = Bool()
927797f035SbugGenerator      def apply(levelUInt: UInt, valid: Bool) = {
937797f035SbugGenerator        sp := RegNext((levelUInt === 0.U || levelUInt === 1.U) && valid, false.B)
947797f035SbugGenerator        l3 := RegNext((levelUInt === 2.U) & valid, false.B)
957797f035SbugGenerator        l2 := RegNext((levelUInt === 1.U) & valid, false.B)
967797f035SbugGenerator        l1 := RegNext((levelUInt === 0.U) & valid, false.B)
977797f035SbugGenerator      }
987797f035SbugGenerator    }
997797f035SbugGenerator    // duplicate level and sel_pte for each page caches, for better fanout
1007797f035SbugGenerator    val req_info_dup = Vec(3, new L2TlbInnerBundle())
1017797f035SbugGenerator    val level_dup = Vec(3, UInt(log2Up(Level).W))
1027797f035SbugGenerator    val sel_pte_dup = Vec(3, UInt(XLEN.W))
1036d5ddbceSLemover  }))
1047797f035SbugGenerator  val sfence_dup = Vec(4, Input(new SfenceBundle()))
1057797f035SbugGenerator  val csr_dup = Vec(3, Input(new TlbCsrBundle()))
1066d5ddbceSLemover}
1076d5ddbceSLemover
108b848eea5SLemover@chiselName
1091ca0e4f3SYinan Xuclass PtwCache()(implicit p: Parameters) extends XSModule with HasPtwConst with HasPerfEvents {
1106d5ddbceSLemover  val io = IO(new PtwCacheIO)
1116d5ddbceSLemover
1127196f5a2SLemover  val ecc = Code.fromString(l2tlbParams.ecc)
1137196f5a2SLemover  val l2EntryType = new PTWEntriesWithEcc(ecc, num = PtwL2SectorSize, tagLen = PtwL2TagLen, level = 1, hasPerm = false)
1147196f5a2SLemover  val l3EntryType = new PTWEntriesWithEcc(ecc, num = PtwL3SectorSize, tagLen = PtwL3TagLen, level = 2, hasPerm = true)
1157196f5a2SLemover
1166d5ddbceSLemover  // TODO: four caches make the codes dirty, think about how to deal with it
1176d5ddbceSLemover
1187797f035SbugGenerator  val sfence_dup = io.sfence_dup
1196d5ddbceSLemover  val refill = io.refill.bits
1207797f035SbugGenerator  val refill_prefetch_dup = io.refill.bits.req_info_dup.map(a => from_pre(a.source))
1217797f035SbugGenerator  val flush_dup = sfence_dup.zip(io.csr_dup).map(f => f._1.valid || f._2.satp.changed)
1227797f035SbugGenerator  val flush = flush_dup(0)
1236d5ddbceSLemover
1246d5ddbceSLemover  // when refill, refuce to accept new req
1255854c1edSLemover  val rwHarzad = if (sramSinglePort) io.refill.valid else false.B
1263889e11eSLemover
1273889e11eSLemover  // handle hand signal and req_info
1286c4dcc2dSLemover  // TODO: replace with FlushableQueue
1296c4dcc2dSLemover  val stageReq = Wire(Decoupled(new PtwCacheReq()))         // enq stage & read page cache valid
1306c4dcc2dSLemover  val stageDelay = Wire(Vec(2, Decoupled(new PtwCacheReq()))) // page cache resp
1316c4dcc2dSLemover  val stageCheck = Wire(Vec(2, Decoupled(new PtwCacheReq()))) // check hit & check ecc
1326c4dcc2dSLemover  val stageResp = Wire(Decoupled(new PtwCacheReq()))         // deq stage
1337797f035SbugGenerator
1347797f035SbugGenerator  val stageDelay_valid_1cycle = OneCycleValid(stageReq.fire, flush)      // catch ram data
1357797f035SbugGenerator  val stageCheck_valid_1cycle = OneCycleValid(stageDelay(1).fire, flush) // replace & perf counter
1367797f035SbugGenerator  val stageResp_valid_1cycle_dup = Wire(Vec(2, Bool()))
1377797f035SbugGenerator  stageResp_valid_1cycle_dup.map(_ := OneCycleValid(stageCheck(1).fire, flush))  // ecc flush
1387797f035SbugGenerator
1396c4dcc2dSLemover  stageReq <> io.req
1406c4dcc2dSLemover  PipelineConnect(stageReq, stageDelay(0), stageDelay(1).ready, flush, rwHarzad)
1417797f035SbugGenerator  InsideStageConnect(stageDelay(0), stageDelay(1), stageDelay_valid_1cycle)
1426c4dcc2dSLemover  PipelineConnect(stageDelay(1), stageCheck(0), stageCheck(1).ready, flush)
1437797f035SbugGenerator  InsideStageConnect(stageCheck(0), stageCheck(1), stageCheck_valid_1cycle)
1446c4dcc2dSLemover  PipelineConnect(stageCheck(1), stageResp, io.resp.ready, flush)
1456c4dcc2dSLemover  stageResp.ready := !stageResp.valid || io.resp.ready
1466d5ddbceSLemover
1476d5ddbceSLemover  // l1: level 0 non-leaf pte
1485854c1edSLemover  val l1 = Reg(Vec(l2tlbParams.l1Size, new PtwEntry(tagLen = PtwL1TagLen)))
1495854c1edSLemover  val l1v = RegInit(0.U(l2tlbParams.l1Size.W))
1505854c1edSLemover  val l1g = Reg(UInt(l2tlbParams.l1Size.W))
15145f497a4Shappy-lx  val l1asids = Reg(Vec(l2tlbParams.l1Size, UInt(AsidLength.W)))
1526d5ddbceSLemover
1536d5ddbceSLemover  // l2: level 1 non-leaf pte
1546d5ddbceSLemover  val l2 = Module(new SRAMTemplate(
1557196f5a2SLemover    l2EntryType,
1565854c1edSLemover    set = l2tlbParams.l2nSets,
1575854c1edSLemover    way = l2tlbParams.l2nWays,
1585854c1edSLemover    singlePort = sramSinglePort
1596d5ddbceSLemover  ))
1605854c1edSLemover  val l2v = RegInit(0.U((l2tlbParams.l2nSets * l2tlbParams.l2nWays).W))
1615854c1edSLemover  val l2g = Reg(UInt((l2tlbParams.l2nSets * l2tlbParams.l2nWays).W))
16245f497a4Shappy-lx  val l2asids = Reg(Vec(l2tlbParams.l2nSets, Vec(l2tlbParams.l2nWays, UInt(AsidLength.W))))
1636d5ddbceSLemover  def getl2vSet(vpn: UInt) = {
1645854c1edSLemover    require(log2Up(l2tlbParams.l2nWays) == log2Down(l2tlbParams.l2nWays))
1656d5ddbceSLemover    val set = genPtwL2SetIdx(vpn)
1665854c1edSLemover    require(set.getWidth == log2Up(l2tlbParams.l2nSets))
1675854c1edSLemover    val l2vVec = l2v.asTypeOf(Vec(l2tlbParams.l2nSets, UInt(l2tlbParams.l2nWays.W)))
1686d5ddbceSLemover    l2vVec(set)
1696d5ddbceSLemover  }
17045f497a4Shappy-lx  def getl2asidSet(vpn: UInt) = {
17145f497a4Shappy-lx    require(log2Up(l2tlbParams.l2nWays) == log2Down(l2tlbParams.l2nWays))
17245f497a4Shappy-lx    val set = genPtwL2SetIdx(vpn)
17345f497a4Shappy-lx    require(set.getWidth == log2Up(l2tlbParams.l2nSets))
17445f497a4Shappy-lx    l2asids(set)
17545f497a4Shappy-lx  }
1766d5ddbceSLemover
1776d5ddbceSLemover  // l3: level 2 leaf pte of 4KB pages
1786d5ddbceSLemover  val l3 = Module(new SRAMTemplate(
1797196f5a2SLemover    l3EntryType,
1805854c1edSLemover    set = l2tlbParams.l3nSets,
1815854c1edSLemover    way = l2tlbParams.l3nWays,
1825854c1edSLemover    singlePort = sramSinglePort
1836d5ddbceSLemover  ))
1845854c1edSLemover  val l3v = RegInit(0.U((l2tlbParams.l3nSets * l2tlbParams.l3nWays).W))
1855854c1edSLemover  val l3g = Reg(UInt((l2tlbParams.l3nSets * l2tlbParams.l3nWays).W))
18645f497a4Shappy-lx  val l3asids = Reg(Vec(l2tlbParams.l3nSets, Vec(l2tlbParams.l3nWays, UInt(AsidLength.W))))
1876d5ddbceSLemover  def getl3vSet(vpn: UInt) = {
1885854c1edSLemover    require(log2Up(l2tlbParams.l3nWays) == log2Down(l2tlbParams.l3nWays))
1896d5ddbceSLemover    val set = genPtwL3SetIdx(vpn)
1905854c1edSLemover    require(set.getWidth == log2Up(l2tlbParams.l3nSets))
1915854c1edSLemover    val l3vVec = l3v.asTypeOf(Vec(l2tlbParams.l3nSets, UInt(l2tlbParams.l3nWays.W)))
1926d5ddbceSLemover    l3vVec(set)
1936d5ddbceSLemover  }
19445f497a4Shappy-lx  def getl3asidSet(vpn: UInt) = {
19545f497a4Shappy-lx    require(log2Up(l2tlbParams.l3nWays) == log2Down(l2tlbParams.l3nWays))
19645f497a4Shappy-lx    val set = genPtwL3SetIdx(vpn)
19745f497a4Shappy-lx    require(set.getWidth == log2Up(l2tlbParams.l3nSets))
19845f497a4Shappy-lx    l3asids(set)
19945f497a4Shappy-lx  }
2006d5ddbceSLemover
2016d5ddbceSLemover  // sp: level 0/1 leaf pte of 1GB/2MB super pages
2025854c1edSLemover  val sp = Reg(Vec(l2tlbParams.spSize, new PtwEntry(tagLen = SPTagLen, hasPerm = true, hasLevel = true)))
2035854c1edSLemover  val spv = RegInit(0.U(l2tlbParams.spSize.W))
2045854c1edSLemover  val spg = Reg(UInt(l2tlbParams.spSize.W))
20545f497a4Shappy-lx  val spasids = Reg(Vec(l2tlbParams.spSize, UInt(AsidLength.W)))
2066d5ddbceSLemover
2076d5ddbceSLemover  // Access Perf
2085854c1edSLemover  val l1AccessPerf = Wire(Vec(l2tlbParams.l1Size, Bool()))
2095854c1edSLemover  val l2AccessPerf = Wire(Vec(l2tlbParams.l2nWays, Bool()))
2105854c1edSLemover  val l3AccessPerf = Wire(Vec(l2tlbParams.l3nWays, Bool()))
2115854c1edSLemover  val spAccessPerf = Wire(Vec(l2tlbParams.spSize, Bool()))
2126d5ddbceSLemover  l1AccessPerf.map(_ := false.B)
2136d5ddbceSLemover  l2AccessPerf.map(_ := false.B)
2146d5ddbceSLemover  l3AccessPerf.map(_ := false.B)
2156d5ddbceSLemover  spAccessPerf.map(_ := false.B)
2166d5ddbceSLemover
2173889e11eSLemover
2181f4a7c0cSLemover
2191f4a7c0cSLemover  def vpn_match(vpn1: UInt, vpn2: UInt, level: Int) = {
2201f4a7c0cSLemover    vpn1(vpnnLen*3-1, vpnnLen*(2-level)+3) === vpn2(vpnnLen*3-1, vpnnLen*(2-level)+3)
2211f4a7c0cSLemover  }
2221f4a7c0cSLemover  // NOTE: not actually bypassed, just check if hit, re-access the page cache
2231f4a7c0cSLemover  def refill_bypass(vpn: UInt, level: Int) = {
2247797f035SbugGenerator    io.refill.valid && (level.U === io.refill.bits.level_dup(0)) && vpn_match(io.refill.bits.req_info_dup(0).vpn, vpn, level),
2251f4a7c0cSLemover  }
2261f4a7c0cSLemover
2276d5ddbceSLemover  // l1
2285854c1edSLemover  val ptwl1replace = ReplacementPolicy.fromString(l2tlbParams.l1Replacer, l2tlbParams.l1Size)
229bc063562SLemover  val (l1Hit, l1HitPPN, l1Pre) = {
2307797f035SbugGenerator    val hitVecT = l1.zipWithIndex.map { case (e, i) => e.hit(stageReq.bits.req_info.vpn, io.csr_dup(0).satp.asid) && l1v(i) }
2316c4dcc2dSLemover    val hitVec = hitVecT.map(RegEnable(_, stageReq.fire))
2321f4a7c0cSLemover
2331f4a7c0cSLemover    // stageDelay, but check for l1
2349c503409SLemover    val hitPPN = DataHoldBypass(ParallelPriorityMux(hitVec zip l1.map(_.ppn)), stageDelay_valid_1cycle)
2359c503409SLemover    val hitPre = DataHoldBypass(ParallelPriorityMux(hitVec zip l1.map(_.prefetch)), stageDelay_valid_1cycle)
2361f4a7c0cSLemover    val hit = DataHoldBypass(ParallelOR(hitVec), stageDelay_valid_1cycle)
2376d5ddbceSLemover
2386c4dcc2dSLemover    when (hit && stageDelay_valid_1cycle) { ptwl1replace.access(OHToUInt(hitVec)) }
2396d5ddbceSLemover
2406c4dcc2dSLemover    l1AccessPerf.zip(hitVec).map{ case (l, h) => l := h && stageDelay_valid_1cycle}
2415854c1edSLemover    for (i <- 0 until l2tlbParams.l1Size) {
2427797f035SbugGenerator      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")
2436d5ddbceSLemover    }
2446c4dcc2dSLemover    XSDebug(stageReq.fire, p"[l1] l1v:${Binary(l1v)} hitVecT:${Binary(VecInit(hitVecT).asUInt)}\n")
2456c4dcc2dSLemover    XSDebug(stageDelay(0).valid, p"[l1] l1Hit:${hit} l1HitPPN:0x${Hexadecimal(hitPPN)} hitVec:${VecInit(hitVec).asUInt}\n")
2466d5ddbceSLemover
2476d5ddbceSLemover    VecInit(hitVecT).suggestName(s"l1_hitVecT")
2486d5ddbceSLemover    VecInit(hitVec).suggestName(s"l1_hitVec")
2496d5ddbceSLemover
2506c4dcc2dSLemover    // synchronize with other entries with RegEnable
2516c4dcc2dSLemover    (RegEnable(hit, stageDelay(1).fire),
2526c4dcc2dSLemover     RegEnable(hitPPN, stageDelay(1).fire),
2536c4dcc2dSLemover     RegEnable(hitPre, stageDelay(1).fire))
2546d5ddbceSLemover  }
2556d5ddbceSLemover
2566d5ddbceSLemover  // l2
2575854c1edSLemover  val ptwl2replace = ReplacementPolicy.fromString(l2tlbParams.l2Replacer,l2tlbParams.l2nWays,l2tlbParams.l2nSets)
258bc063562SLemover  val (l2Hit, l2HitPPN, l2Pre, l2eccError) = {
2596c4dcc2dSLemover    val ridx = genPtwL2SetIdx(stageReq.bits.req_info.vpn)
2606c4dcc2dSLemover    l2.io.r.req.valid := stageReq.fire
2616d5ddbceSLemover    l2.io.r.req.bits.apply(setIdx = ridx)
2627797f035SbugGenerator    val vVec_req = getl2vSet(stageReq.bits.req_info.vpn)
2636c4dcc2dSLemover
2646c4dcc2dSLemover    // delay one cycle after sram read
2657797f035SbugGenerator    val delay_vpn = stageDelay(0).bits.req_info.vpn
2666c4dcc2dSLemover    val data_resp = DataHoldBypass(l2.io.r.resp.data, stageDelay_valid_1cycle)
2677797f035SbugGenerator    val vVec_delay = RegEnable(vVec_req, stageReq.fire)
2687797f035SbugGenerator    val hitVec_delay = VecInit(data_resp.zip(vVec_delay.asBools).map { case (wayData, v) =>
2697797f035SbugGenerator      wayData.entries.hit(delay_vpn, io.csr_dup(1).satp.asid) && v })
2706c4dcc2dSLemover
2716c4dcc2dSLemover    // check hit and ecc
2726c4dcc2dSLemover    val check_vpn = stageCheck(0).bits.req_info.vpn
2736c4dcc2dSLemover    val ramDatas = RegEnable(data_resp, stageDelay(1).fire)
2748a0e4b2fSLemover    val vVec = RegEnable(vVec_delay, stageDelay(1).fire).asBools()
2756c4dcc2dSLemover
2767797f035SbugGenerator    val hitVec = RegEnable(hitVec_delay, stageDelay(1).fire)
2777196f5a2SLemover    val hitWayEntry = ParallelPriorityMux(hitVec zip ramDatas)
2787196f5a2SLemover    val hitWayData = hitWayEntry.entries
2796c4dcc2dSLemover    val hit = ParallelOR(hitVec)
280f3034303SHaoyuan Feng    val hitWay = ParallelPriorityMux(hitVec zip (0 until l2tlbParams.l2nWays).map(_.U(log2Up(l2tlbParams.l2nWays).W)))
2813889e11eSLemover    val eccError = hitWayEntry.decode()
2827196f5a2SLemover
2836d5ddbceSLemover    ridx.suggestName(s"l2_ridx")
2846d5ddbceSLemover    ramDatas.suggestName(s"l2_ramDatas")
2856d5ddbceSLemover    hitVec.suggestName(s"l2_hitVec")
2866d5ddbceSLemover    hitWayData.suggestName(s"l2_hitWayData")
2876d5ddbceSLemover    hitWay.suggestName(s"l2_hitWay")
2886d5ddbceSLemover
2896c4dcc2dSLemover    when (hit && stageCheck_valid_1cycle) { ptwl2replace.access(genPtwL2SetIdx(check_vpn), hitWay) }
2906d5ddbceSLemover
2916c4dcc2dSLemover    l2AccessPerf.zip(hitVec).map{ case (l, h) => l := h && stageCheck_valid_1cycle }
2926c4dcc2dSLemover    XSDebug(stageDelay_valid_1cycle, p"[l2] ridx:0x${Hexadecimal(ridx)}\n")
2935854c1edSLemover    for (i <- 0 until l2tlbParams.l2nWays) {
2946c4dcc2dSLemover      XSDebug(stageCheck_valid_1cycle, p"[l2] ramDatas(${i.U}) ${ramDatas(i)}  l2v:${vVec(i)}  hit:${hit}\n")
2956d5ddbceSLemover    }
2966c4dcc2dSLemover    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")
2976d5ddbceSLemover
2986c4dcc2dSLemover    (hit, hitWayData.ppns(genPtwL2SectorIdx(check_vpn)), hitWayData.prefetch, eccError)
2996d5ddbceSLemover  }
3006d5ddbceSLemover
3016d5ddbceSLemover  // l3
3025854c1edSLemover  val ptwl3replace = ReplacementPolicy.fromString(l2tlbParams.l3Replacer,l2tlbParams.l3nWays,l2tlbParams.l3nSets)
303bc063562SLemover  val (l3Hit, l3HitData, l3Pre, l3eccError) = {
3046c4dcc2dSLemover    val ridx = genPtwL3SetIdx(stageReq.bits.req_info.vpn)
3056c4dcc2dSLemover    l3.io.r.req.valid := stageReq.fire
3066d5ddbceSLemover    l3.io.r.req.bits.apply(setIdx = ridx)
3077797f035SbugGenerator    val vVec_req = getl3vSet(stageReq.bits.req_info.vpn)
3086c4dcc2dSLemover
3096c4dcc2dSLemover    // delay one cycle after sram read
3107797f035SbugGenerator    val delay_vpn = stageDelay(0).bits.req_info.vpn
3116c4dcc2dSLemover    val data_resp = DataHoldBypass(l3.io.r.resp.data, stageDelay_valid_1cycle)
3127797f035SbugGenerator    val vVec_delay = RegEnable(vVec_req, stageReq.fire)
3137797f035SbugGenerator    val hitVec_delay = VecInit(data_resp.zip(vVec_delay.asBools).map { case (wayData, v) =>
3147797f035SbugGenerator      wayData.entries.hit(delay_vpn, io.csr_dup(2).satp.asid) && v })
3156c4dcc2dSLemover
3166c4dcc2dSLemover    // check hit and ecc
3176c4dcc2dSLemover    val check_vpn = stageCheck(0).bits.req_info.vpn
3186c4dcc2dSLemover    val ramDatas = RegEnable(data_resp, stageDelay(1).fire)
3198a0e4b2fSLemover    val vVec = RegEnable(vVec_delay, stageDelay(1).fire).asBools()
3206c4dcc2dSLemover
3217797f035SbugGenerator    val hitVec = RegEnable(hitVec_delay, stageDelay(1).fire)
3227196f5a2SLemover    val hitWayEntry = ParallelPriorityMux(hitVec zip ramDatas)
3237196f5a2SLemover    val hitWayData = hitWayEntry.entries
3247196f5a2SLemover    val hitWayEcc = hitWayEntry.ecc
3256c4dcc2dSLemover    val hit = ParallelOR(hitVec)
326f3034303SHaoyuan Feng    val hitWay = ParallelPriorityMux(hitVec zip (0 until l2tlbParams.l3nWays).map(_.U(log2Up(l2tlbParams.l3nWays).W)))
3273889e11eSLemover    val eccError = hitWayEntry.decode()
3286d5ddbceSLemover
3296c4dcc2dSLemover    when (hit && stageCheck_valid_1cycle) { ptwl3replace.access(genPtwL3SetIdx(check_vpn), hitWay) }
3307196f5a2SLemover
3316c4dcc2dSLemover    l3AccessPerf.zip(hitVec).map{ case (l, h) => l := h && stageCheck_valid_1cycle }
3326c4dcc2dSLemover    XSDebug(stageReq.fire, p"[l3] ridx:0x${Hexadecimal(ridx)}\n")
3335854c1edSLemover    for (i <- 0 until l2tlbParams.l3nWays) {
3346c4dcc2dSLemover      XSDebug(stageCheck_valid_1cycle, p"[l3] ramDatas(${i.U}) ${ramDatas(i)}  l3v:${vVec(i)}  hit:${hitVec(i)}\n")
3356d5ddbceSLemover    }
3366c4dcc2dSLemover    XSDebug(stageCheck_valid_1cycle, p"[l3] l3Hit:${hit} l3HitData:${hitWayData} hitVec:${Binary(hitVec.asUInt)} hitWay:${hitWay} v:${vVec}\n")
3376d5ddbceSLemover
3386d5ddbceSLemover    ridx.suggestName(s"l3_ridx")
3396d5ddbceSLemover    ramDatas.suggestName(s"l3_ramDatas")
3406d5ddbceSLemover    hitVec.suggestName(s"l3_hitVec")
3416d5ddbceSLemover    hitWay.suggestName(s"l3_hitWay")
3426d5ddbceSLemover
3433889e11eSLemover    (hit, hitWayData, hitWayData.prefetch, eccError)
3446d5ddbceSLemover  }
3456c4dcc2dSLemover  val l3HitPPN = l3HitData.ppns(genPtwL3SectorIdx(stageCheck(0).bits.req_info.vpn))
3466c4dcc2dSLemover  val l3HitPerm = l3HitData.perms.getOrElse(0.U.asTypeOf(Vec(PtwL3SectorSize, new PtePermBundle)))(genPtwL3SectorIdx(stageCheck(0).bits.req_info.vpn))
3471f4a7c0cSLemover  val l3HitValid = l3HitData.vs(genPtwL3SectorIdx(stageCheck(0).bits.req_info.vpn))
3486d5ddbceSLemover
3496d5ddbceSLemover  // super page
3505854c1edSLemover  val spreplace = ReplacementPolicy.fromString(l2tlbParams.spReplacer, l2tlbParams.spSize)
3518d8ac704SLemover  val (spHit, spHitData, spPre, spValid) = {
3527797f035SbugGenerator    val hitVecT = sp.zipWithIndex.map { case (e, i) => e.hit(stageReq.bits.req_info.vpn, io.csr_dup(0).satp.asid) && spv(i) }
3536c4dcc2dSLemover    val hitVec = hitVecT.map(RegEnable(_, stageReq.fire))
3546d5ddbceSLemover    val hitData = ParallelPriorityMux(hitVec zip sp)
3556c4dcc2dSLemover    val hit = ParallelOR(hitVec)
3566d5ddbceSLemover
3576c4dcc2dSLemover    when (hit && stageDelay_valid_1cycle) { spreplace.access(OHToUInt(hitVec)) }
3586d5ddbceSLemover
3596c4dcc2dSLemover    spAccessPerf.zip(hitVec).map{ case (s, h) => s := h && stageDelay_valid_1cycle }
3605854c1edSLemover    for (i <- 0 until l2tlbParams.spSize) {
3617797f035SbugGenerator      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")
3626d5ddbceSLemover    }
3636c4dcc2dSLemover    XSDebug(stageDelay_valid_1cycle, p"[sp] spHit:${hit} spHitData:${hitData} hitVec:${Binary(VecInit(hitVec).asUInt)}\n")
3646d5ddbceSLemover
3656d5ddbceSLemover    VecInit(hitVecT).suggestName(s"sp_hitVecT")
3666d5ddbceSLemover    VecInit(hitVec).suggestName(s"sp_hitVec")
3676d5ddbceSLemover
3686c4dcc2dSLemover    (RegEnable(hit, stageDelay(1).fire),
3696c4dcc2dSLemover     RegEnable(hitData, stageDelay(1).fire),
3706c4dcc2dSLemover     RegEnable(hitData.prefetch, stageDelay(1).fire),
3716c4dcc2dSLemover     RegEnable(hitData.v, stageDelay(1).fire()))
3726d5ddbceSLemover  }
3736d5ddbceSLemover  val spHitPerm = spHitData.perm.getOrElse(0.U.asTypeOf(new PtePermBundle))
3746d5ddbceSLemover  val spHitLevel = spHitData.level.getOrElse(0.U)
3756d5ddbceSLemover
3766c4dcc2dSLemover  val check_res = Wire(new PageCacheRespBundle)
3776c4dcc2dSLemover  check_res.l1.apply(l1Hit, l1Pre, l1HitPPN)
3786c4dcc2dSLemover  check_res.l2.apply(l2Hit, l2Pre, l2HitPPN, ecc = l2eccError)
3791f4a7c0cSLemover  check_res.l3.apply(l3Hit, l3Pre, l3HitPPN, l3HitPerm, l3eccError, valid = l3HitValid)
3806c4dcc2dSLemover  check_res.sp.apply(spHit, spPre, spHitData.ppn, spHitPerm, false.B, spHitLevel, spValid)
3816d5ddbceSLemover
3826c4dcc2dSLemover  val resp_res = Reg(new PageCacheRespBundle)
3836c4dcc2dSLemover  when (stageCheck(1).fire) { resp_res := check_res }
3843889e11eSLemover
3851f4a7c0cSLemover  // stageResp bypass
3861f4a7c0cSLemover  val bypassed = Wire(Vec(3, Bool()))
3871f4a7c0cSLemover  bypassed.indices.foreach(i =>
3881f4a7c0cSLemover    bypassed(i) := stageResp.bits.bypassed(i) ||
3891f4a7c0cSLemover      ValidHoldBypass(refill_bypass(stageResp.bits.req_info.vpn, i),
3901f4a7c0cSLemover        OneCycleValid(stageCheck(1).fire, false.B) || io.refill.valid)
3911f4a7c0cSLemover  )
3921f4a7c0cSLemover
3936c4dcc2dSLemover  io.resp.bits.req_info   := stageResp.bits.req_info
3946c4dcc2dSLemover  io.resp.bits.isFirst  := stageResp.bits.isFirst
3956c4dcc2dSLemover  io.resp.bits.hit      := resp_res.l3.hit || resp_res.sp.hit
3961f4a7c0cSLemover  io.resp.bits.bypassed := bypassed(2) || (bypassed(1) && !resp_res.l2.hit) || (bypassed(0) && !resp_res.l1.hit)
3976c4dcc2dSLemover  io.resp.bits.prefetch := resp_res.l3.pre && resp_res.l3.hit || resp_res.sp.pre && resp_res.sp.hit
3986c4dcc2dSLemover  io.resp.bits.toFsm.l1Hit := resp_res.l1.hit
3996c4dcc2dSLemover  io.resp.bits.toFsm.l2Hit := resp_res.l2.hit
4006c4dcc2dSLemover  io.resp.bits.toFsm.ppn   := Mux(resp_res.l2.hit, resp_res.l2.ppn, resp_res.l1.ppn)
4016c4dcc2dSLemover  io.resp.bits.toTlb.tag   := stageResp.bits.req_info.vpn
4027797f035SbugGenerator  io.resp.bits.toTlb.asid  := io.csr_dup(0).satp.asid // DontCare
4036c4dcc2dSLemover  io.resp.bits.toTlb.ppn   := Mux(resp_res.l3.hit, resp_res.l3.ppn, resp_res.sp.ppn)
4046c4dcc2dSLemover  io.resp.bits.toTlb.perm.map(_ := Mux(resp_res.l3.hit, resp_res.l3.perm, resp_res.sp.perm))
4056c4dcc2dSLemover  io.resp.bits.toTlb.level.map(_ := Mux(resp_res.l3.hit, 2.U, resp_res.sp.level))
4066c4dcc2dSLemover  io.resp.bits.toTlb.prefetch := from_pre(stageResp.bits.req_info.source)
4076c4dcc2dSLemover  io.resp.bits.toTlb.v := Mux(resp_res.sp.hit, resp_res.sp.v, resp_res.l3.v)
4086c4dcc2dSLemover  io.resp.valid := stageResp.valid
4096c4dcc2dSLemover  XSError(stageResp.valid && resp_res.l3.hit && resp_res.sp.hit, "normal page and super page both hit")
4101f4a7c0cSLemover  XSError(stageResp.valid && io.resp.bits.hit && bypassed(2), "page cache, bypassed but hit")
4116d5ddbceSLemover
4126d5ddbceSLemover  // refill Perf
4135854c1edSLemover  val l1RefillPerf = Wire(Vec(l2tlbParams.l1Size, Bool()))
4145854c1edSLemover  val l2RefillPerf = Wire(Vec(l2tlbParams.l2nWays, Bool()))
4155854c1edSLemover  val l3RefillPerf = Wire(Vec(l2tlbParams.l3nWays, Bool()))
4165854c1edSLemover  val spRefillPerf = Wire(Vec(l2tlbParams.spSize, Bool()))
4176d5ddbceSLemover  l1RefillPerf.map(_ := false.B)
4186d5ddbceSLemover  l2RefillPerf.map(_ := false.B)
4196d5ddbceSLemover  l3RefillPerf.map(_ := false.B)
4206d5ddbceSLemover  spRefillPerf.map(_ := false.B)
4216d5ddbceSLemover
4226d5ddbceSLemover  // refill
4236d5ddbceSLemover  l2.io.w.req <> DontCare
4246d5ddbceSLemover  l3.io.w.req <> DontCare
4256d5ddbceSLemover  l2.io.w.req.valid := false.B
4266d5ddbceSLemover  l3.io.w.req.valid := false.B
4276d5ddbceSLemover
4286d5ddbceSLemover  val memRdata = refill.ptes
4295854c1edSLemover  val memPtes = (0 until (l2tlbParams.blockBytes/(XLEN/8))).map(i => memRdata((i+1)*XLEN-1, i*XLEN).asTypeOf(new PteBundle))
4307797f035SbugGenerator  val memSelData = io.refill.bits.sel_pte_dup
4317797f035SbugGenerator  val memPte = memSelData.map(a => a.asTypeOf(new PteBundle))
432b848eea5SLemover
4336d5ddbceSLemover  // TODO: handle sfenceLatch outsize
4347797f035SbugGenerator  when (!flush_dup(0) && refill.levelOH.l1 && !memPte(0).isLeaf() && !memPte(0).isPf(refill.level_dup(0))) {
4355854c1edSLemover    // val refillIdx = LFSR64()(log2Up(l2tlbParams.l1Size)-1,0) // TODO: may be LRU
4366d5ddbceSLemover    val refillIdx = replaceWrapper(l1v, ptwl1replace.way)
4376d5ddbceSLemover    refillIdx.suggestName(s"PtwL1RefillIdx")
4386d5ddbceSLemover    val rfOH = UIntToOH(refillIdx)
43945f497a4Shappy-lx    l1(refillIdx).refill(
4407797f035SbugGenerator      refill.req_info_dup(0).vpn,
4417797f035SbugGenerator      io.csr_dup(0).satp.asid,
4427797f035SbugGenerator      memSelData(0),
44345f497a4Shappy-lx      0.U,
4447797f035SbugGenerator      refill_prefetch_dup(0)
44545f497a4Shappy-lx    )
4466d5ddbceSLemover    ptwl1replace.access(refillIdx)
4476d5ddbceSLemover    l1v := l1v | rfOH
4487797f035SbugGenerator    l1g := (l1g & ~rfOH) | Mux(memPte(0).perm.g, rfOH, 0.U)
4496d5ddbceSLemover
4505854c1edSLemover    for (i <- 0 until l2tlbParams.l1Size) {
4516d5ddbceSLemover      l1RefillPerf(i) := i.U === refillIdx
4526d5ddbceSLemover    }
4536d5ddbceSLemover
4547797f035SbugGenerator    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")
4557797f035SbugGenerator    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")
4566d5ddbceSLemover
4576d5ddbceSLemover    refillIdx.suggestName(s"l1_refillIdx")
4586d5ddbceSLemover    rfOH.suggestName(s"l1_rfOH")
4596d5ddbceSLemover  }
4606d5ddbceSLemover
4617797f035SbugGenerator  when (!flush_dup(1) && refill.levelOH.l2 && !memPte(1).isLeaf() && !memPte(1).isPf(refill.level_dup(1))) {
4627797f035SbugGenerator    val refillIdx = genPtwL2SetIdx(refill.req_info_dup(1).vpn)
4637797f035SbugGenerator    val victimWay = replaceWrapper(getl2vSet(refill.req_info_dup(1).vpn), ptwl2replace.way(refillIdx))
4646d5ddbceSLemover    val victimWayOH = UIntToOH(victimWay)
4656d5ddbceSLemover    val rfvOH = UIntToOH(Cat(refillIdx, victimWay))
4667196f5a2SLemover    val wdata = Wire(l2EntryType)
4673889e11eSLemover    wdata.gen(
4687797f035SbugGenerator      vpn = refill.req_info_dup(1).vpn,
4697797f035SbugGenerator      asid = io.csr_dup(1).satp.asid,
47045f497a4Shappy-lx      data = memRdata,
47145f497a4Shappy-lx      levelUInt = 1.U,
4727797f035SbugGenerator      refill_prefetch_dup(1)
47345f497a4Shappy-lx    )
4746d5ddbceSLemover    l2.io.w.apply(
4756d5ddbceSLemover      valid = true.B,
4766d5ddbceSLemover      setIdx = refillIdx,
4777196f5a2SLemover      data = wdata,
4786d5ddbceSLemover      waymask = victimWayOH
4796d5ddbceSLemover    )
4806d5ddbceSLemover    ptwl2replace.access(refillIdx, victimWay)
4816d5ddbceSLemover    l2v := l2v | rfvOH
4826d5ddbceSLemover    l2g := l2g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U)
4836d5ddbceSLemover
4845854c1edSLemover    for (i <- 0 until l2tlbParams.l2nWays) {
4856d5ddbceSLemover      l2RefillPerf(i) := i.U === victimWay
4866d5ddbceSLemover    }
4876d5ddbceSLemover
4886d5ddbceSLemover    XSDebug(p"[l2 refill] refillIdx:0x${Hexadecimal(refillIdx)} victimWay:${victimWay} victimWayOH:${Binary(victimWayOH)} rfvOH(in UInt):${Cat(refillIdx, victimWay)}\n")
48945f497a4Shappy-lx    XSDebug(p"[l2 refill] refilldata:0x${wdata}\n")
4906d5ddbceSLemover    XSDebug(p"[l2 refill] l2v:${Binary(l2v)} -> ${Binary(l2v | rfvOH)}\n")
4916d5ddbceSLemover    XSDebug(p"[l2 refill] l2g:${Binary(l2g)} -> ${Binary(l2g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U))}\n")
4926d5ddbceSLemover
4936d5ddbceSLemover    refillIdx.suggestName(s"l2_refillIdx")
4946d5ddbceSLemover    victimWay.suggestName(s"l2_victimWay")
4956d5ddbceSLemover    victimWayOH.suggestName(s"l2_victimWayOH")
4966d5ddbceSLemover    rfvOH.suggestName(s"l2_rfvOH")
4976d5ddbceSLemover  }
4986d5ddbceSLemover
4997797f035SbugGenerator  when (!flush_dup(2) && refill.levelOH.l3) {
5007797f035SbugGenerator    val refillIdx = genPtwL3SetIdx(refill.req_info_dup(2).vpn)
5017797f035SbugGenerator    val victimWay = replaceWrapper(getl3vSet(refill.req_info_dup(2).vpn), ptwl3replace.way(refillIdx))
5026d5ddbceSLemover    val victimWayOH = UIntToOH(victimWay)
5036d5ddbceSLemover    val rfvOH = UIntToOH(Cat(refillIdx, victimWay))
5047196f5a2SLemover    val wdata = Wire(l3EntryType)
5053889e11eSLemover    wdata.gen(
5067797f035SbugGenerator      vpn = refill.req_info_dup(2).vpn,
5077797f035SbugGenerator      asid = io.csr_dup(2).satp.asid,
50845f497a4Shappy-lx      data = memRdata,
50945f497a4Shappy-lx      levelUInt = 2.U,
5107797f035SbugGenerator      refill_prefetch_dup(2)
51145f497a4Shappy-lx    )
5126d5ddbceSLemover    l3.io.w.apply(
5136d5ddbceSLemover      valid = true.B,
5146d5ddbceSLemover      setIdx = refillIdx,
5157196f5a2SLemover      data = wdata,
5166d5ddbceSLemover      waymask = victimWayOH
5176d5ddbceSLemover    )
5186d5ddbceSLemover    ptwl3replace.access(refillIdx, victimWay)
5196d5ddbceSLemover    l3v := l3v | rfvOH
5206d5ddbceSLemover    l3g := l3g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U)
5216d5ddbceSLemover
5225854c1edSLemover    for (i <- 0 until l2tlbParams.l3nWays) {
5236d5ddbceSLemover      l3RefillPerf(i) := i.U === victimWay
5246d5ddbceSLemover    }
5256d5ddbceSLemover
5266d5ddbceSLemover    XSDebug(p"[l3 refill] refillIdx:0x${Hexadecimal(refillIdx)} victimWay:${victimWay} victimWayOH:${Binary(victimWayOH)} rfvOH(in UInt):${Cat(refillIdx, victimWay)}\n")
52745f497a4Shappy-lx    XSDebug(p"[l3 refill] refilldata:0x${wdata}\n")
5286d5ddbceSLemover    XSDebug(p"[l3 refill] l3v:${Binary(l3v)} -> ${Binary(l3v | rfvOH)}\n")
5296d5ddbceSLemover    XSDebug(p"[l3 refill] l3g:${Binary(l3g)} -> ${Binary(l3g & ~rfvOH | Mux(Cat(memPtes.map(_.perm.g)).andR, rfvOH, 0.U))}\n")
5306d5ddbceSLemover
5316d5ddbceSLemover    refillIdx.suggestName(s"l3_refillIdx")
5326d5ddbceSLemover    victimWay.suggestName(s"l3_victimWay")
5336d5ddbceSLemover    victimWayOH.suggestName(s"l3_victimWayOH")
5346d5ddbceSLemover    rfvOH.suggestName(s"l3_rfvOH")
5356d5ddbceSLemover  }
5367797f035SbugGenerator
5378d8ac704SLemover
5388d8ac704SLemover  // misc entries: super & invalid
5397797f035SbugGenerator  when (!flush_dup(0) && refill.levelOH.sp && (memPte(0).isLeaf() || memPte(0).isPf(refill.level_dup(0)))) {
5405854c1edSLemover    val refillIdx = spreplace.way// LFSR64()(log2Up(l2tlbParams.spSize)-1,0) // TODO: may be LRU
5416d5ddbceSLemover    val rfOH = UIntToOH(refillIdx)
54245f497a4Shappy-lx    sp(refillIdx).refill(
5437797f035SbugGenerator      refill.req_info_dup(0).vpn,
5447797f035SbugGenerator      io.csr_dup(0).satp.asid,
5457797f035SbugGenerator      memSelData(0),
5467797f035SbugGenerator      refill.level_dup(2),
5477797f035SbugGenerator      refill_prefetch_dup(0),
5487797f035SbugGenerator      !memPte(0).isPf(refill.level_dup(0)),
54945f497a4Shappy-lx    )
5506d5ddbceSLemover    spreplace.access(refillIdx)
5516d5ddbceSLemover    spv := spv | rfOH
5527797f035SbugGenerator    spg := spg & ~rfOH | Mux(memPte(0).perm.g, rfOH, 0.U)
5536d5ddbceSLemover
5545854c1edSLemover    for (i <- 0 until l2tlbParams.spSize) {
5556d5ddbceSLemover      spRefillPerf(i) := i.U === refillIdx
5566d5ddbceSLemover    }
5576d5ddbceSLemover
5587797f035SbugGenerator    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")
5597797f035SbugGenerator    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")
5606d5ddbceSLemover
5616d5ddbceSLemover    refillIdx.suggestName(s"sp_refillIdx")
5626d5ddbceSLemover    rfOH.suggestName(s"sp_rfOH")
5636d5ddbceSLemover  }
5646d5ddbceSLemover
5657797f035SbugGenerator  val l2eccFlush = resp_res.l2.ecc && stageResp_valid_1cycle_dup(0) // RegNext(l2eccError, init = false.B)
5667797f035SbugGenerator  val l3eccFlush = resp_res.l3.ecc && stageResp_valid_1cycle_dup(1) // RegNext(l3eccError, init = false.B)
5676c4dcc2dSLemover  val eccVpn = stageResp.bits.req_info.vpn
5687196f5a2SLemover
5696c4dcc2dSLemover  XSError(l2eccFlush, "l2tlb.cache.l2 ecc error. Should not happen at sim stage")
5706c4dcc2dSLemover  XSError(l3eccFlush, "l2tlb.cache.l3 ecc error. Should not happen at sim stage")
5717196f5a2SLemover  when (l2eccFlush) {
5727196f5a2SLemover    val flushSetIdxOH = UIntToOH(genPtwL2SetIdx(eccVpn))
5737196f5a2SLemover    val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l2nWays, a.asUInt) }).asUInt
5747196f5a2SLemover    l2v := l2v & ~flushMask
5757196f5a2SLemover    l2g := l2g & ~flushMask
5767196f5a2SLemover  }
5777196f5a2SLemover
5787196f5a2SLemover  when (l3eccFlush) {
5797196f5a2SLemover    val flushSetIdxOH = UIntToOH(genPtwL3SetIdx(eccVpn))
5807196f5a2SLemover    val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l3nWays, a.asUInt) }).asUInt
5817196f5a2SLemover    l3v := l3v & ~flushMask
5827196f5a2SLemover    l3g := l3g & ~flushMask
5837196f5a2SLemover  }
5847196f5a2SLemover
5856d5ddbceSLemover  // sfence
5867797f035SbugGenerator  when (sfence_dup(3).valid) {
5877797f035SbugGenerator    val sfence_vpn = sfence_dup(3).bits.addr(sfence_dup(3).bits.addr.getWidth-1, offLen)
58845f497a4Shappy-lx
5897797f035SbugGenerator    when (sfence_dup(3).bits.rs1/*va*/) {
5907797f035SbugGenerator      when (sfence_dup(3).bits.rs2) {
5917797f035SbugGenerator        // all va && all asid
5927797f035SbugGenerator        l3v := 0.U
5937797f035SbugGenerator      } .otherwise {
5947797f035SbugGenerator        // all va && specific asid except global
5957797f035SbugGenerator        l3v := l3v & l3g
5967797f035SbugGenerator      }
5977797f035SbugGenerator    } .otherwise {
5987797f035SbugGenerator      // val flushMask = UIntToOH(genTlbL2Idx(sfence.bits.addr(sfence.bits.addr.getWidth-1, offLen)))
5997797f035SbugGenerator      val flushSetIdxOH = UIntToOH(genPtwL3SetIdx(sfence_vpn))
6007797f035SbugGenerator      // val flushMask = VecInit(flushSetIdxOH.asBools.map(Fill(l2tlbParams.l3nWays, _.asUInt))).asUInt
6017797f035SbugGenerator      val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l3nWays, a.asUInt) }).asUInt
6027797f035SbugGenerator      flushSetIdxOH.suggestName(s"sfence_nrs1_flushSetIdxOH")
6037797f035SbugGenerator      flushMask.suggestName(s"sfence_nrs1_flushMask")
6047797f035SbugGenerator
6057797f035SbugGenerator      when (sfence_dup(3).bits.rs2) {
6067797f035SbugGenerator        // specific leaf of addr && all asid
6077797f035SbugGenerator        l3v := l3v & ~flushMask
6087797f035SbugGenerator      } .otherwise {
6097797f035SbugGenerator        // specific leaf of addr && specific asid
6107797f035SbugGenerator        l3v := l3v & (~flushMask | l3g)
6117797f035SbugGenerator      }
6127797f035SbugGenerator    }
6137797f035SbugGenerator  }
6147797f035SbugGenerator
6157797f035SbugGenerator  when (sfence_dup(0).valid) {
6167797f035SbugGenerator    val l1asidhit = VecInit(l1asids.map(_ === sfence_dup(0).bits.asid)).asUInt
6177797f035SbugGenerator    val spasidhit = VecInit(spasids.map(_ === sfence_dup(0).bits.asid)).asUInt
6187797f035SbugGenerator    val sfence_vpn = sfence_dup(0).bits.addr(sfence_dup(0).bits.addr.getWidth-1, offLen)
6197797f035SbugGenerator
6207797f035SbugGenerator    when (sfence_dup(0).bits.rs1/*va*/) {
6217797f035SbugGenerator      when (sfence_dup(0).bits.rs2) {
6226d5ddbceSLemover        // all va && all asid
6236d5ddbceSLemover        l1v := 0.U
6246d5ddbceSLemover        l2v := 0.U
6256d5ddbceSLemover        spv := 0.U
6266d5ddbceSLemover      } .otherwise {
6276d5ddbceSLemover        // all va && specific asid except global
62845f497a4Shappy-lx
62945f497a4Shappy-lx        l1v := l1v & (~l1asidhit | l1g)
6306d5ddbceSLemover        l2v := l2v & l2g
63145f497a4Shappy-lx        spv := spv & (~spasidhit | spg)
6326d5ddbceSLemover      }
6336d5ddbceSLemover    } .otherwise {
6346d5ddbceSLemover      // val flushMask = UIntToOH(genTlbL2Idx(sfence.bits.addr(sfence.bits.addr.getWidth-1, offLen)))
63545f497a4Shappy-lx      val flushSetIdxOH = UIntToOH(genPtwL3SetIdx(sfence_vpn))
6365854c1edSLemover      // val flushMask = VecInit(flushSetIdxOH.asBools.map(Fill(l2tlbParams.l3nWays, _.asUInt))).asUInt
6375854c1edSLemover      val flushMask = VecInit(flushSetIdxOH.asBools.map { a => Fill(l2tlbParams.l3nWays, a.asUInt) }).asUInt
6386d5ddbceSLemover      flushSetIdxOH.suggestName(s"sfence_nrs1_flushSetIdxOH")
6396d5ddbceSLemover      flushMask.suggestName(s"sfence_nrs1_flushMask")
64045f497a4Shappy-lx
6417797f035SbugGenerator      when (sfence_dup(0).bits.rs2) {
6426d5ddbceSLemover        // specific leaf of addr && all asid
643*42a7f20fSbugGenerator        spv := spv & (~VecInit(sp.map(_.hit(sfence_vpn, sfence_dup(0).bits.asid, ignoreAsid = true))).asUInt)
6446d5ddbceSLemover      } .otherwise {
6456d5ddbceSLemover        // specific leaf of addr && specific asid
6467797f035SbugGenerator        spv := spv & (~VecInit(sp.map(_.hit(sfence_vpn, sfence_dup(0).bits.asid))).asUInt | spg)
6476d5ddbceSLemover      }
6486d5ddbceSLemover    }
6496d5ddbceSLemover  }
6506d5ddbceSLemover
6517797f035SbugGenerator  def InsideStageConnect(in: DecoupledIO[PtwCacheReq], out: DecoupledIO[PtwCacheReq], inFire: Bool): Unit = {
6522c86e165SZhangZifei    in.ready := !in.valid || out.ready
6532c86e165SZhangZifei    out.valid := in.valid
6542c86e165SZhangZifei    out.bits := in.bits
6551f4a7c0cSLemover    out.bits.bypassed.zip(in.bits.bypassed).zipWithIndex.map{ case (b, i) =>
6567797f035SbugGenerator      val bypassed_reg = Reg(Bool())
6577797f035SbugGenerator      val bypassed_wire = refill_bypass(in.bits.req_info.vpn, i) && io.refill.valid
6587797f035SbugGenerator      when (inFire) { bypassed_reg := bypassed_wire }
6597797f035SbugGenerator      .elsewhen (io.refill.valid) { bypassed_reg := bypassed_reg || bypassed_wire }
6607797f035SbugGenerator
6617797f035SbugGenerator      b._1 := b._2 || (bypassed_wire || (bypassed_reg && !inFire))
6621f4a7c0cSLemover    }
6632c86e165SZhangZifei  }
6642c86e165SZhangZifei
6656d5ddbceSLemover  // Perf Count
6666c4dcc2dSLemover  val resp_l3 = resp_res.l3.hit
6676c4dcc2dSLemover  val resp_sp = resp_res.sp.hit
6686c4dcc2dSLemover  val resp_l1_pre = resp_res.l1.pre
6696c4dcc2dSLemover  val resp_l2_pre = resp_res.l2.pre
6706c4dcc2dSLemover  val resp_l3_pre = resp_res.l3.pre
6716c4dcc2dSLemover  val resp_sp_pre = resp_res.sp.pre
67245f497a4Shappy-lx  val base_valid_access_0 = !from_pre(io.resp.bits.req_info.source) && io.resp.fire()
673bc063562SLemover  XSPerfAccumulate("access", base_valid_access_0)
674bc063562SLemover  XSPerfAccumulate("l1_hit", base_valid_access_0 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
675bc063562SLemover  XSPerfAccumulate("l2_hit", base_valid_access_0 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
676bc063562SLemover  XSPerfAccumulate("l3_hit", base_valid_access_0 && resp_l3)
677bc063562SLemover  XSPerfAccumulate("sp_hit", base_valid_access_0 && resp_sp)
678bc063562SLemover  XSPerfAccumulate("pte_hit",base_valid_access_0 && io.resp.bits.hit)
679bc063562SLemover
680bc063562SLemover  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)
681bc063562SLemover  XSPerfAccumulate("l2_hit_pre", base_valid_access_0 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
682bc063562SLemover  XSPerfAccumulate("l3_hit_pre", base_valid_access_0 && resp_l3_pre && resp_l3)
683bc063562SLemover  XSPerfAccumulate("sp_hit_pre", base_valid_access_0 && resp_sp_pre && resp_sp)
684bc063562SLemover  XSPerfAccumulate("pte_hit_pre",base_valid_access_0 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
685bc063562SLemover
68645f497a4Shappy-lx  val base_valid_access_1 = from_pre(io.resp.bits.req_info.source) && io.resp.fire()
687bc063562SLemover  XSPerfAccumulate("pre_access", base_valid_access_1)
688bc063562SLemover  XSPerfAccumulate("pre_l1_hit", base_valid_access_1 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
689bc063562SLemover  XSPerfAccumulate("pre_l2_hit", base_valid_access_1 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
690bc063562SLemover  XSPerfAccumulate("pre_l3_hit", base_valid_access_1 && resp_l3)
691bc063562SLemover  XSPerfAccumulate("pre_sp_hit", base_valid_access_1 && resp_sp)
692bc063562SLemover  XSPerfAccumulate("pre_pte_hit",base_valid_access_1 && io.resp.bits.hit)
693bc063562SLemover
694bc063562SLemover  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)
695bc063562SLemover  XSPerfAccumulate("pre_l2_hit_pre", base_valid_access_1 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
696bc063562SLemover  XSPerfAccumulate("pre_l3_hit_pre", base_valid_access_1 && resp_l3_pre && resp_l3)
697bc063562SLemover  XSPerfAccumulate("pre_sp_hit_pre", base_valid_access_1 && resp_sp_pre && resp_sp)
698bc063562SLemover  XSPerfAccumulate("pre_pte_hit_pre",base_valid_access_1 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
699bc063562SLemover
7006c4dcc2dSLemover  val base_valid_access_2 = stageResp.bits.isFirst && !from_pre(io.resp.bits.req_info.source) && io.resp.fire()
701bc063562SLemover  XSPerfAccumulate("access_first", base_valid_access_2)
702bc063562SLemover  XSPerfAccumulate("l1_hit_first", base_valid_access_2 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
703bc063562SLemover  XSPerfAccumulate("l2_hit_first", base_valid_access_2 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
704bc063562SLemover  XSPerfAccumulate("l3_hit_first", base_valid_access_2 && resp_l3)
705bc063562SLemover  XSPerfAccumulate("sp_hit_first", base_valid_access_2 && resp_sp)
706bc063562SLemover  XSPerfAccumulate("pte_hit_first",base_valid_access_2 && io.resp.bits.hit)
707bc063562SLemover
708bc063562SLemover  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)
709bc063562SLemover  XSPerfAccumulate("l2_hit_pre_first", base_valid_access_2 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
710bc063562SLemover  XSPerfAccumulate("l3_hit_pre_first", base_valid_access_2 && resp_l3_pre && resp_l3)
711bc063562SLemover  XSPerfAccumulate("sp_hit_pre_first", base_valid_access_2 && resp_sp_pre && resp_sp)
712bc063562SLemover  XSPerfAccumulate("pte_hit_pre_first",base_valid_access_2 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
713bc063562SLemover
7146c4dcc2dSLemover  val base_valid_access_3 = stageResp.bits.isFirst && from_pre(io.resp.bits.req_info.source) && io.resp.fire()
715bc063562SLemover  XSPerfAccumulate("pre_access_first", base_valid_access_3)
716bc063562SLemover  XSPerfAccumulate("pre_l1_hit_first", base_valid_access_3 && io.resp.bits.toFsm.l1Hit && !io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
717bc063562SLemover  XSPerfAccumulate("pre_l2_hit_first", base_valid_access_3 && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
718bc063562SLemover  XSPerfAccumulate("pre_l3_hit_first", base_valid_access_3 && resp_l3)
719bc063562SLemover  XSPerfAccumulate("pre_sp_hit_first", base_valid_access_3 && resp_sp)
720bc063562SLemover  XSPerfAccumulate("pre_pte_hit_first", base_valid_access_3 && io.resp.bits.hit)
721bc063562SLemover
722bc063562SLemover  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)
723bc063562SLemover  XSPerfAccumulate("pre_l2_hit_pre_first", base_valid_access_3 && resp_l2_pre && io.resp.bits.toFsm.l2Hit && !io.resp.bits.hit)
724bc063562SLemover  XSPerfAccumulate("pre_l3_hit_pre_first", base_valid_access_3 && resp_l3_pre && resp_l3)
725bc063562SLemover  XSPerfAccumulate("pre_sp_hit_pre_first", base_valid_access_3 && resp_sp_pre && resp_sp)
726bc063562SLemover  XSPerfAccumulate("pre_pte_hit_pre_first",base_valid_access_3 && (resp_l3_pre && resp_l3 || resp_sp_pre && resp_sp) && io.resp.bits.hit)
727bc063562SLemover
7286d5ddbceSLemover  XSPerfAccumulate("rwHarzad", io.req.valid && !io.req.ready)
7296d5ddbceSLemover  XSPerfAccumulate("out_blocked", io.resp.valid && !io.resp.ready)
7306d5ddbceSLemover  l1AccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L1AccessIndex${i}", l) }
7316d5ddbceSLemover  l2AccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L2AccessIndex${i}", l) }
7326d5ddbceSLemover  l3AccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L3AccessIndex${i}", l) }
7336d5ddbceSLemover  spAccessPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"SPAccessIndex${i}", l) }
7346d5ddbceSLemover  l1RefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L1RefillIndex${i}", l) }
7356d5ddbceSLemover  l2RefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L2RefillIndex${i}", l) }
7366d5ddbceSLemover  l3RefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"L3RefillIndex${i}", l) }
7376d5ddbceSLemover  spRefillPerf.zipWithIndex.map{ case (l, i) => XSPerfAccumulate(s"SPRefillIndex${i}", l) }
7386d5ddbceSLemover
739bc063562SLemover  XSPerfAccumulate("l1Refill", Cat(l1RefillPerf).orR)
740bc063562SLemover  XSPerfAccumulate("l2Refill", Cat(l2RefillPerf).orR)
741bc063562SLemover  XSPerfAccumulate("l3Refill", Cat(l3RefillPerf).orR)
742bc063562SLemover  XSPerfAccumulate("spRefill", Cat(spRefillPerf).orR)
7437797f035SbugGenerator  XSPerfAccumulate("l1Refill_pre", Cat(l1RefillPerf).orR && refill_prefetch_dup(0))
7447797f035SbugGenerator  XSPerfAccumulate("l2Refill_pre", Cat(l2RefillPerf).orR && refill_prefetch_dup(0))
7457797f035SbugGenerator  XSPerfAccumulate("l3Refill_pre", Cat(l3RefillPerf).orR && refill_prefetch_dup(0))
7467797f035SbugGenerator  XSPerfAccumulate("spRefill_pre", Cat(spRefillPerf).orR && refill_prefetch_dup(0))
747bc063562SLemover
7486d5ddbceSLemover  // debug
7497797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] original v and g vector:\n")
7507797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l1v:${Binary(l1v)}\n")
7517797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l2v:${Binary(l2v)}\n")
7527797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l3v:${Binary(l3v)}\n")
7537797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] l3g:${Binary(l3g)}\n")
7547797f035SbugGenerator  XSDebug(sfence_dup(0).valid, p"[sfence] spv:${Binary(spv)}\n")
7557797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] new v and g vector:\n")
7567797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l1v:${Binary(l1v)}\n")
7577797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l2v:${Binary(l2v)}\n")
7587797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l3v:${Binary(l3v)}\n")
7597797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] l3g:${Binary(l3g)}\n")
7607797f035SbugGenerator  XSDebug(RegNext(sfence_dup(0).valid), p"[sfence] spv:${Binary(spv)}\n")
761cd365d4cSrvcoresjw
762cd365d4cSrvcoresjw  val perfEvents = Seq(
76356be8e20SYinan Xu    ("access           ", base_valid_access_0             ),
764cd365d4cSrvcoresjw    ("l1_hit           ", l1Hit                           ),
765cd365d4cSrvcoresjw    ("l2_hit           ", l2Hit                           ),
766cd365d4cSrvcoresjw    ("l3_hit           ", l3Hit                           ),
767cd365d4cSrvcoresjw    ("sp_hit           ", spHit                           ),
768cd365d4cSrvcoresjw    ("pte_hit          ", l3Hit || spHit                  ),
769cd365d4cSrvcoresjw    ("rwHarzad         ",  io.req.valid && !io.req.ready  ),
770cd365d4cSrvcoresjw    ("out_blocked      ",  io.resp.valid && !io.resp.ready),
771cd365d4cSrvcoresjw  )
7721ca0e4f3SYinan Xu  generatePerfEvent()
7736d5ddbceSLemover}
774