xref: /XiangShan/src/main/scala/xiangshan/frontend/IFU.scala (revision f6dea16c4305d56b22710cfc675ff13d38fdfd7d)
109c6f1ddSLingrui98/***************************************************************************************
209c6f1ddSLingrui98* Copyright (c) 2020-2021 Institute of Computing Technology, Chinese Academy of Sciences
309c6f1ddSLingrui98* Copyright (c) 2020-2021 Peng Cheng Laboratory
409c6f1ddSLingrui98*
509c6f1ddSLingrui98* XiangShan is licensed under Mulan PSL v2.
609c6f1ddSLingrui98* You can use this software according to the terms and conditions of the Mulan PSL v2.
709c6f1ddSLingrui98* You may obtain a copy of Mulan PSL v2 at:
809c6f1ddSLingrui98*          http://license.coscl.org.cn/MulanPSL2
909c6f1ddSLingrui98*
1009c6f1ddSLingrui98* THIS SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OF ANY KIND,
1109c6f1ddSLingrui98* EITHER EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO NON-INFRINGEMENT,
1209c6f1ddSLingrui98* MERCHANTABILITY OR FIT FOR A PARTICULAR PURPOSE.
1309c6f1ddSLingrui98*
1409c6f1ddSLingrui98* See the Mulan PSL v2 for more details.
1509c6f1ddSLingrui98***************************************************************************************/
1609c6f1ddSLingrui98
1709c6f1ddSLingrui98package xiangshan.frontend
1809c6f1ddSLingrui98
1909c6f1ddSLingrui98import chipsalliance.rocketchip.config.Parameters
2009c6f1ddSLingrui98import chisel3._
2109c6f1ddSLingrui98import chisel3.util._
2209c6f1ddSLingrui98import xiangshan._
2309c6f1ddSLingrui98import xiangshan.cache._
2409c6f1ddSLingrui98import xiangshan.cache.mmu._
2509c6f1ddSLingrui98import chisel3.experimental.verification
2609c6f1ddSLingrui98import utils._
2709c6f1ddSLingrui98
2809c6f1ddSLingrui98trait HasInstrMMIOConst extends HasXSParameter with HasIFUConst{
2909c6f1ddSLingrui98  def mmioBusWidth = 64
3009c6f1ddSLingrui98  def mmioBusBytes = mmioBusWidth /8
3109c6f1ddSLingrui98  def mmioBeats = FetchWidth * 4 * 8 / mmioBusWidth
3209c6f1ddSLingrui98  def mmioMask  = VecInit(List.fill(PredictWidth)(true.B)).asUInt
3309c6f1ddSLingrui98  def mmioBusAligned(pc :UInt): UInt = align(pc, mmioBusBytes)
3409c6f1ddSLingrui98}
3509c6f1ddSLingrui98
3609c6f1ddSLingrui98trait HasIFUConst extends HasXSParameter {
3709c6f1ddSLingrui98  def align(pc: UInt, bytes: Int): UInt = Cat(pc(VAddrBits-1, log2Ceil(bytes)), 0.U(log2Ceil(bytes).W))
3809c6f1ddSLingrui98  // def groupAligned(pc: UInt)  = align(pc, groupBytes)
3909c6f1ddSLingrui98  // def packetAligned(pc: UInt) = align(pc, packetBytes)
4009c6f1ddSLingrui98}
4109c6f1ddSLingrui98
4209c6f1ddSLingrui98class IfuToFtqIO(implicit p:Parameters) extends XSBundle {
4309c6f1ddSLingrui98  val pdWb = Valid(new PredecodeWritebackBundle)
4409c6f1ddSLingrui98}
4509c6f1ddSLingrui98
4609c6f1ddSLingrui98class FtqInterface(implicit p: Parameters) extends XSBundle {
4709c6f1ddSLingrui98  val fromFtq = Flipped(new FtqToIfuIO)
4809c6f1ddSLingrui98  val toFtq   = new IfuToFtqIO
4909c6f1ddSLingrui98}
5009c6f1ddSLingrui98
5109c6f1ddSLingrui98class ICacheInterface(implicit p: Parameters) extends XSBundle {
5209c6f1ddSLingrui98  val toIMeta       = Decoupled(new ICacheReadBundle)
5309c6f1ddSLingrui98  val toIData       = Decoupled(new ICacheReadBundle)
5409c6f1ddSLingrui98  val toMissQueue   = Vec(2,Decoupled(new ICacheMissReq))
5509c6f1ddSLingrui98  val fromIMeta     = Input(new ICacheMetaRespBundle)
5609c6f1ddSLingrui98  val fromIData     = Input(new ICacheDataRespBundle)
5709c6f1ddSLingrui98  val fromMissQueue = Vec(2,Flipped(Decoupled(new ICacheMissResp)))
5809c6f1ddSLingrui98}
5909c6f1ddSLingrui98
6009c6f1ddSLingrui98class NewIFUIO(implicit p: Parameters) extends XSBundle {
6109c6f1ddSLingrui98  val ftqInter        = new FtqInterface
6209c6f1ddSLingrui98  val icacheInter     = new ICacheInterface
6309c6f1ddSLingrui98  val toIbuffer       = Decoupled(new FetchToIBuffer)
6409c6f1ddSLingrui98  val iTLBInter       = Vec(2, new BlockTlbRequestIO)
6509c6f1ddSLingrui98}
6609c6f1ddSLingrui98
6709c6f1ddSLingrui98// record the situation in which fallThruAddr falls into
6809c6f1ddSLingrui98// the middle of an RVI inst
6909c6f1ddSLingrui98class LastHalfInfo(implicit p: Parameters) extends XSBundle {
7009c6f1ddSLingrui98  val valid = Bool()
7109c6f1ddSLingrui98  val middlePC = UInt(VAddrBits.W)
7209c6f1ddSLingrui98  def matchThisBlock(startAddr: UInt) = valid && middlePC === startAddr
7309c6f1ddSLingrui98}
7409c6f1ddSLingrui98
7509c6f1ddSLingrui98class IfuToPreDecode(implicit p: Parameters) extends XSBundle {
7609c6f1ddSLingrui98  val data          = if(HasCExtension) Vec(PredictWidth + 1, UInt(16.W)) else Vec(PredictWidth, UInt(32.W))
7709c6f1ddSLingrui98  val startAddr     = UInt(VAddrBits.W)
7809c6f1ddSLingrui98  val fallThruAddr  = UInt(VAddrBits.W)
7909c6f1ddSLingrui98  val fallThruError = Bool()
8009c6f1ddSLingrui98  val isDoubleLine  = Bool()
8109c6f1ddSLingrui98  val ftqOffset     = Valid(UInt(log2Ceil(PredictWidth).W))
8209c6f1ddSLingrui98  val target        = UInt(VAddrBits.W)
8309c6f1ddSLingrui98  val pageFault     = Vec(2, Bool())
8409c6f1ddSLingrui98  val accessFault   = Vec(2, Bool())
8509c6f1ddSLingrui98  val instValid     = Bool()
8609c6f1ddSLingrui98  val lastHalfMatch = Bool()
8709c6f1ddSLingrui98  val oversize      = Bool()
8809c6f1ddSLingrui98}
8909c6f1ddSLingrui98
9009c6f1ddSLingrui98class NewIFU(implicit p: Parameters) extends XSModule with HasICacheParameters
9109c6f1ddSLingrui98{
9209c6f1ddSLingrui98  println(s"icache ways: ${nWays} sets:${nSets}")
9309c6f1ddSLingrui98  val io = IO(new NewIFUIO)
9409c6f1ddSLingrui98  val (toFtq, fromFtq)    = (io.ftqInter.toFtq, io.ftqInter.fromFtq)
9509c6f1ddSLingrui98  val (toMeta, toData, meta_resp, data_resp) =  (io.icacheInter.toIMeta, io.icacheInter.toIData, io.icacheInter.fromIMeta, io.icacheInter.fromIData)
9609c6f1ddSLingrui98  val (toMissQueue, fromMissQueue) = (io.icacheInter.toMissQueue, io.icacheInter.fromMissQueue)
9709c6f1ddSLingrui98  val (toITLB, fromITLB) = (VecInit(io.iTLBInter.map(_.req)), VecInit(io.iTLBInter.map(_.resp)))
9809c6f1ddSLingrui98
9909c6f1ddSLingrui98  def isCrossLineReq(start: UInt, end: UInt): Bool = start(blockOffBits) ^ end(blockOffBits)
10009c6f1ddSLingrui98
10109c6f1ddSLingrui98  def isLastInCacheline(fallThruAddr: UInt): Bool = fallThruAddr(blockOffBits - 1, 1) === 0.U
10209c6f1ddSLingrui98
10309c6f1ddSLingrui98
10409c6f1ddSLingrui98  //---------------------------------------------
10509c6f1ddSLingrui98  //  Fetch Stage 1 :
10609c6f1ddSLingrui98  //  * Send req to ICache Meta/Data
10709c6f1ddSLingrui98  //  * Check whether need 2 line fetch
10809c6f1ddSLingrui98  //---------------------------------------------
10909c6f1ddSLingrui98
11009c6f1ddSLingrui98  val f0_valid                             = fromFtq.req.valid
11109c6f1ddSLingrui98  val f0_ftq_req                           = fromFtq.req.bits
11209c6f1ddSLingrui98  val f0_situation                         = VecInit(Seq(isCrossLineReq(f0_ftq_req.startAddr, f0_ftq_req.fallThruAddr), isLastInCacheline(f0_ftq_req.fallThruAddr)))
11309c6f1ddSLingrui98  val f0_doubleLine                        = f0_situation(0) || f0_situation(1)
11409c6f1ddSLingrui98  val f0_vSetIdx                           = VecInit(get_idx((f0_ftq_req.startAddr)), get_idx(f0_ftq_req.fallThruAddr))
11509c6f1ddSLingrui98  val f0_fire                              = fromFtq.req.fire()
11609c6f1ddSLingrui98
11709c6f1ddSLingrui98  val f0_flush, f1_flush, f2_flush, f3_flush = WireInit(false.B)
11809c6f1ddSLingrui98  val from_bpu_f0_flush, from_bpu_f1_flush, from_bpu_f2_flush, from_bpu_f3_flush = WireInit(false.B)
11909c6f1ddSLingrui98
12009c6f1ddSLingrui98  from_bpu_f0_flush := fromFtq.flushFromBpu.shouldFlushByStage2(f0_ftq_req.ftqIdx) ||
12109c6f1ddSLingrui98                       fromFtq.flushFromBpu.shouldFlushByStage3(f0_ftq_req.ftqIdx)
12209c6f1ddSLingrui98
12309c6f1ddSLingrui98  val f3_redirect = WireInit(false.B)
12409c6f1ddSLingrui98  f3_flush := fromFtq.redirect.valid
12509c6f1ddSLingrui98  f2_flush := f3_flush || f3_redirect
12609c6f1ddSLingrui98  f1_flush := f2_flush || from_bpu_f1_flush
12709c6f1ddSLingrui98  f0_flush := f1_flush || from_bpu_f0_flush
12809c6f1ddSLingrui98
12909c6f1ddSLingrui98  val f1_ready, f2_ready, f3_ready         = WireInit(false.B)
13009c6f1ddSLingrui98
13109c6f1ddSLingrui98  //fetch: send addr to Meta/TLB and Data simultaneously
13209c6f1ddSLingrui98  val fetch_req = List(toMeta, toData)
13309c6f1ddSLingrui98  for(i <- 0 until 2) {
13409c6f1ddSLingrui98    fetch_req(i).valid := f0_fire
13509c6f1ddSLingrui98    fetch_req(i).bits.isDoubleLine := f0_doubleLine
13609c6f1ddSLingrui98    fetch_req(i).bits.vSetIdx := f0_vSetIdx
13709c6f1ddSLingrui98  }
13809c6f1ddSLingrui98
13909c6f1ddSLingrui98  fromFtq.req.ready := fetch_req(0).ready && fetch_req(1).ready && f1_ready && GTimer() > 500.U
14009c6f1ddSLingrui98
14109c6f1ddSLingrui98  //---------------------------------------------
14209c6f1ddSLingrui98  //  Fetch Stage 2 :
14309c6f1ddSLingrui98  //  * Send req to ITLB and TLB Response (Get Paddr)
14409c6f1ddSLingrui98  //  * ICache Response (Get Meta and Data)
14509c6f1ddSLingrui98  //  * Hit Check (Generate hit signal and hit vector)
14609c6f1ddSLingrui98  //  * Get victim way
14709c6f1ddSLingrui98  //---------------------------------------------
14809c6f1ddSLingrui98
14909c6f1ddSLingrui98  //TODO: handle fetch exceptions
15009c6f1ddSLingrui98
15109c6f1ddSLingrui98  val tlbRespAllValid = WireInit(false.B)
15209c6f1ddSLingrui98
15309c6f1ddSLingrui98  val f1_valid      = RegInit(false.B)
15409c6f1ddSLingrui98  val f1_ftq_req    = RegEnable(next = f0_ftq_req,    enable=f0_fire)
15509c6f1ddSLingrui98  val f1_situation  = RegEnable(next = f0_situation,  enable=f0_fire)
15609c6f1ddSLingrui98  val f1_doubleLine = RegEnable(next = f0_doubleLine, enable=f0_fire)
15709c6f1ddSLingrui98  val f1_vSetIdx    = RegEnable(next = f0_vSetIdx,    enable=f0_fire)
15809c6f1ddSLingrui98  val f1_fire       = f1_valid && tlbRespAllValid && f2_ready
15909c6f1ddSLingrui98
16009c6f1ddSLingrui98  f1_ready := f2_ready && tlbRespAllValid || !f1_valid
16109c6f1ddSLingrui98
16209c6f1ddSLingrui98  from_bpu_f1_flush := fromFtq.flushFromBpu.shouldFlushByStage3(f1_ftq_req.ftqIdx)
16309c6f1ddSLingrui98
16409c6f1ddSLingrui98  val preDecoder      = Module(new PreDecode)
16509c6f1ddSLingrui98  val (preDecoderIn, preDecoderOut)   = (preDecoder.io.in, preDecoder.io.out)
16609c6f1ddSLingrui98
16709c6f1ddSLingrui98  //flush generate and to Ftq
16809c6f1ddSLingrui98  val predecodeOutValid = WireInit(false.B)
16909c6f1ddSLingrui98
17009c6f1ddSLingrui98  when(f1_flush)                  {f1_valid  := false.B}
17109c6f1ddSLingrui98  .elsewhen(f0_fire && !f0_flush) {f1_valid  := true.B}
17209c6f1ddSLingrui98  .elsewhen(f1_fire)              {f1_valid  := false.B}
17309c6f1ddSLingrui98
17409c6f1ddSLingrui98  toITLB(0).valid         := f1_valid
17509c6f1ddSLingrui98  toITLB(0).bits.vaddr    := align(f1_ftq_req.startAddr, blockBytes)
17609c6f1ddSLingrui98  toITLB(0).bits.debug.pc := align(f1_ftq_req.startAddr, blockBytes)
17709c6f1ddSLingrui98
17809c6f1ddSLingrui98  toITLB(1).valid         := f1_valid && f1_doubleLine
17909c6f1ddSLingrui98  toITLB(1).bits.vaddr    := align(f1_ftq_req.fallThruAddr, blockBytes)
18009c6f1ddSLingrui98  toITLB(1).bits.debug.pc := align(f1_ftq_req.fallThruAddr, blockBytes)
18109c6f1ddSLingrui98
18209c6f1ddSLingrui98  toITLB.map{port =>
18309c6f1ddSLingrui98    port.bits.cmd                 := TlbCmd.exec
18409c6f1ddSLingrui98    port.bits.roqIdx              := DontCare
18509c6f1ddSLingrui98    port.bits.debug.isFirstIssue  := DontCare
18609c6f1ddSLingrui98  }
18709c6f1ddSLingrui98
18809c6f1ddSLingrui98  fromITLB.map(_.ready := true.B)
18909c6f1ddSLingrui98
19009c6f1ddSLingrui98  val (tlbRespValid, tlbRespPAddr) = (fromITLB.map(_.valid), VecInit(fromITLB.map(_.bits.paddr)))
19109c6f1ddSLingrui98  val (tlbRespMiss,  tlbRespMMIO)  = (fromITLB.map(port => port.bits.miss && port.valid), fromITLB.map(port => port.bits.mmio && port.valid))
192*f6dea16cSJinYue  val (tlbExcpPF,    tlbExcpAF)    = (fromITLB.map(port => port.bits.excp.pf.instr && port.valid), fromITLB.map(port => (port.bits.excp.af.instr || port.bits.mmio) && port.valid)) //TODO: Temp treat mmio req as access fault
19309c6f1ddSLingrui98
19409c6f1ddSLingrui98  tlbRespAllValid := tlbRespValid(0)  && (tlbRespValid(1) || !f1_doubleLine)
19509c6f1ddSLingrui98
19609c6f1ddSLingrui98  val f1_pAddrs             = tlbRespPAddr   //TODO: Temporary assignment
19703c39bdeSJinYue  val f1_pTags              = VecInit(f1_pAddrs.map(get_phy_tag(_)))
19809c6f1ddSLingrui98  val (f1_tags, f1_cacheline_valid, f1_datas)   = (meta_resp.tags, meta_resp.valid, data_resp.datas)
19909c6f1ddSLingrui98  val bank0_hit_vec         = VecInit(f1_tags(0).zipWithIndex.map{ case(way_tag,i) => f1_cacheline_valid(0)(i) && way_tag ===  f1_pTags(0) })
20009c6f1ddSLingrui98  val bank1_hit_vec         = VecInit(f1_tags(1).zipWithIndex.map{ case(way_tag,i) => f1_cacheline_valid(1)(i) && way_tag ===  f1_pTags(1) })
20109c6f1ddSLingrui98  val (bank0_hit,bank1_hit) = (ParallelOR(bank0_hit_vec) && !tlbExcpPF(0) && !tlbExcpAF(0), ParallelOR(bank1_hit_vec) && !tlbExcpPF(1) && !tlbExcpAF(1))
20209c6f1ddSLingrui98  val f1_hit                = (bank0_hit && bank1_hit && f1_valid && f1_doubleLine) || (f1_valid && !f1_doubleLine && bank0_hit)
20309c6f1ddSLingrui98  val f1_bank_hit_vec       = VecInit(Seq(bank0_hit_vec, bank1_hit_vec))
20409c6f1ddSLingrui98  val f1_bank_hit           = VecInit(Seq(bank0_hit, bank1_hit))
20509c6f1ddSLingrui98
20609c6f1ddSLingrui98  val replacers       = Seq.fill(2)(ReplacementPolicy.fromString(Some("random"),nWays,nSets/2))
20709c6f1ddSLingrui98  val f1_victim_masks = VecInit(replacers.zipWithIndex.map{case (replacer, i) => UIntToOH(replacer.way(f1_vSetIdx(i)))})
20809c6f1ddSLingrui98
20909c6f1ddSLingrui98  val touch_sets = Seq.fill(2)(Wire(Vec(2, UInt(log2Ceil(nSets/2).W))))
21009c6f1ddSLingrui98  val touch_ways = Seq.fill(2)(Wire(Vec(2, Valid(UInt(log2Ceil(nWays).W)))) )
21109c6f1ddSLingrui98
21209c6f1ddSLingrui98  ((replacers zip touch_sets) zip touch_ways).map{case ((r, s),w) => r.access(s,w)}
21309c6f1ddSLingrui98
21409c6f1ddSLingrui98  val f1_hit_data      =  VecInit(f1_datas.zipWithIndex.map { case(bank, i) =>
21509c6f1ddSLingrui98    val bank_hit_data = Mux1H(f1_bank_hit_vec(i).asUInt, bank)
21609c6f1ddSLingrui98    bank_hit_data
21709c6f1ddSLingrui98  })
21809c6f1ddSLingrui98
21909c6f1ddSLingrui98
22009c6f1ddSLingrui98  //---------------------------------------------
22109c6f1ddSLingrui98  //  Fetch Stage 3 :
22209c6f1ddSLingrui98  //  * get data from last stage (hit from f1_hit_data/miss from missQueue response)
22309c6f1ddSLingrui98  //  * if at least one needed cacheline miss, wait for miss queue response (a wait_state machine) THIS IS TOO UGLY!!!
22409c6f1ddSLingrui98  //  * cut cacheline(s) and send to PreDecode
22509c6f1ddSLingrui98  //  * check if prediction is right (branch target and type, jump direction and type , jal target )
22609c6f1ddSLingrui98  //---------------------------------------------
22709c6f1ddSLingrui98  val f2_fetchFinish = Wire(Bool())
22809c6f1ddSLingrui98
22909c6f1ddSLingrui98  val f2_valid        = RegInit(false.B)
23009c6f1ddSLingrui98  val f2_ftq_req      = RegEnable(next = f1_ftq_req,    enable = f1_fire)
23109c6f1ddSLingrui98  val f2_situation    = RegEnable(next = f1_situation,  enable=f1_fire)
23209c6f1ddSLingrui98  val f2_doubleLine   = RegEnable(next = f1_doubleLine, enable=f1_fire)
23309c6f1ddSLingrui98  val f2_fire         = f2_valid && f2_fetchFinish && f3_ready
23409c6f1ddSLingrui98
23509c6f1ddSLingrui98  f2_ready := (f3_ready && f2_fetchFinish) || !f2_valid
23609c6f1ddSLingrui98
23709c6f1ddSLingrui98  when(f2_flush)                  {f2_valid := false.B}
23809c6f1ddSLingrui98  .elsewhen(f1_fire && !f1_flush) {f2_valid := true.B }
23909c6f1ddSLingrui98  .elsewhen(f2_fire)              {f2_valid := false.B}
24009c6f1ddSLingrui98
24109c6f1ddSLingrui98
24209c6f1ddSLingrui98  val f2_pAddrs   = RegEnable(next = f1_pAddrs, enable = f1_fire)
24309c6f1ddSLingrui98  val f2_hit      = RegEnable(next = f1_hit   , enable = f1_fire)
24409c6f1ddSLingrui98  val f2_bank_hit = RegEnable(next = f1_bank_hit, enable = f1_fire)
24509c6f1ddSLingrui98  val f2_miss     = f2_valid && !f2_hit
24609c6f1ddSLingrui98  val (f2_vSetIdx, f2_pTags) = (RegEnable(next = f1_vSetIdx, enable = f1_fire), RegEnable(next = f1_pTags, enable = f1_fire))
24709c6f1ddSLingrui98  val f2_waymask  = RegEnable(next = f1_victim_masks, enable = f1_fire)
24809c6f1ddSLingrui98  //exception information
24909c6f1ddSLingrui98  val f2_except_pf = RegEnable(next = VecInit(tlbExcpPF), enable = f1_fire)
25009c6f1ddSLingrui98  val f2_except_af = RegEnable(next = VecInit(tlbExcpAF), enable = f1_fire)
25109c6f1ddSLingrui98  val f2_except    = VecInit((0 until 2).map{i => f2_except_pf(i) || f2_except_af(i)})
25209c6f1ddSLingrui98  val f2_has_except = f2_valid && (f2_except_af.reduce(_||_) || f2_except_pf.reduce(_||_))
25309c6f1ddSLingrui98
25409c6f1ddSLingrui98  //instruction
25509c6f1ddSLingrui98  val wait_idle :: wait_queue_ready :: wait_send_req  :: wait_two_resp :: wait_0_resp :: wait_1_resp :: wait_one_resp ::wait_finish :: Nil = Enum(8)
25609c6f1ddSLingrui98  val wait_state = RegInit(wait_idle)
25709c6f1ddSLingrui98
25809c6f1ddSLingrui98  fromMissQueue.map{port => port.ready := true.B}
25909c6f1ddSLingrui98
26009c6f1ddSLingrui98  val (miss0_resp, miss1_resp) = (fromMissQueue(0).fire(), fromMissQueue(1).fire())
26109c6f1ddSLingrui98  val (bank0_fix, bank1_fix)   = (miss0_resp  && !f2_bank_hit(0), miss1_resp && f2_doubleLine && !f2_bank_hit(1))
26209c6f1ddSLingrui98
26309c6f1ddSLingrui98  val  only_0_miss = f2_valid && !f2_hit && !f2_doubleLine && !f2_has_except
26409c6f1ddSLingrui98  val (hit_0_miss_1 ,  miss_0_hit_1,  miss_0_miss_1) = (  (f2_valid && !f2_bank_hit(1) && f2_bank_hit(0) && f2_doubleLine  && !f2_has_except),
26509c6f1ddSLingrui98                                                          (f2_valid && !f2_bank_hit(0) && f2_bank_hit(1) && f2_doubleLine  && !f2_has_except),
26609c6f1ddSLingrui98                                                          (f2_valid && !f2_bank_hit(0) && !f2_bank_hit(1) && f2_doubleLine && !f2_has_except),
26709c6f1ddSLingrui98                                                       )
26809c6f1ddSLingrui98
26909c6f1ddSLingrui98  val  hit_0_except_1  = f2_valid && f2_doubleLine &&  !f2_except(0) && f2_except(1)  &&  f2_bank_hit(0)
27009c6f1ddSLingrui98  val  miss_0_except_1 = f2_valid && f2_doubleLine &&  !f2_except(0) && f2_except(1)  && !f2_bank_hit(0)
27109c6f1ddSLingrui98  //val  fetch0_except_1 = hit_0_except_1 || miss_0_except_1
27209c6f1ddSLingrui98  val  except_0        = f2_valid && f2_except(0)
27309c6f1ddSLingrui98
27409c6f1ddSLingrui98  val f2_mq_datas     = Reg(Vec(2, UInt(blockBits.W)))
27509c6f1ddSLingrui98
27609c6f1ddSLingrui98  when(fromMissQueue(0).fire) {f2_mq_datas(0) :=  fromMissQueue(0).bits.data}
27709c6f1ddSLingrui98  when(fromMissQueue(1).fire) {f2_mq_datas(1) :=  fromMissQueue(1).bits.data}
27809c6f1ddSLingrui98
27909c6f1ddSLingrui98  switch(wait_state){
28009c6f1ddSLingrui98    is(wait_idle){
28109c6f1ddSLingrui98      when(miss_0_except_1){
28209c6f1ddSLingrui98        wait_state :=  Mux(toMissQueue(0).ready, wait_queue_ready ,wait_idle )
28309c6f1ddSLingrui98      }.elsewhen( only_0_miss  || miss_0_hit_1){
28409c6f1ddSLingrui98        wait_state :=  Mux(toMissQueue(0).ready, wait_queue_ready ,wait_idle )
28509c6f1ddSLingrui98      }.elsewhen(hit_0_miss_1){
28609c6f1ddSLingrui98        wait_state :=  Mux(toMissQueue(1).ready, wait_queue_ready ,wait_idle )
28709c6f1ddSLingrui98      }.elsewhen( miss_0_miss_1 ){
28809c6f1ddSLingrui98        wait_state := Mux(toMissQueue(0).ready && toMissQueue(1).ready, wait_queue_ready ,wait_idle)
28909c6f1ddSLingrui98      }
29009c6f1ddSLingrui98    }
29109c6f1ddSLingrui98
29209c6f1ddSLingrui98    //TODO: naive logic for wait icache response
29309c6f1ddSLingrui98    is(wait_queue_ready){
29409c6f1ddSLingrui98      wait_state := wait_send_req
29509c6f1ddSLingrui98    }
29609c6f1ddSLingrui98
29709c6f1ddSLingrui98    is(wait_send_req) {
29809c6f1ddSLingrui98      when(miss_0_except_1 || only_0_miss || hit_0_miss_1 || miss_0_hit_1){
29909c6f1ddSLingrui98        wait_state :=  wait_one_resp
30009c6f1ddSLingrui98      }.elsewhen( miss_0_miss_1 ){
30109c6f1ddSLingrui98        wait_state := wait_two_resp
30209c6f1ddSLingrui98      }
30309c6f1ddSLingrui98    }
30409c6f1ddSLingrui98
30509c6f1ddSLingrui98    is(wait_one_resp) {
30609c6f1ddSLingrui98      when( (miss_0_except_1 ||only_0_miss || miss_0_hit_1) && fromMissQueue(0).fire()){
30709c6f1ddSLingrui98        wait_state := wait_finish
30809c6f1ddSLingrui98      }.elsewhen( hit_0_miss_1 && fromMissQueue(1).fire()){
30909c6f1ddSLingrui98        wait_state := wait_finish
31009c6f1ddSLingrui98      }
31109c6f1ddSLingrui98    }
31209c6f1ddSLingrui98
31309c6f1ddSLingrui98    is(wait_two_resp) {
31409c6f1ddSLingrui98      when(fromMissQueue(0).fire() && fromMissQueue(1).fire()){
31509c6f1ddSLingrui98        wait_state := wait_finish
31609c6f1ddSLingrui98      }.elsewhen( !fromMissQueue(0).fire() && fromMissQueue(1).fire() ){
31709c6f1ddSLingrui98        wait_state := wait_0_resp
31809c6f1ddSLingrui98      }.elsewhen(fromMissQueue(0).fire() && !fromMissQueue(1).fire()){
31909c6f1ddSLingrui98        wait_state := wait_1_resp
32009c6f1ddSLingrui98      }
32109c6f1ddSLingrui98    }
32209c6f1ddSLingrui98
32309c6f1ddSLingrui98    is(wait_0_resp) {
32409c6f1ddSLingrui98      when(fromMissQueue(0).fire()){
32509c6f1ddSLingrui98        wait_state := wait_finish
32609c6f1ddSLingrui98      }
32709c6f1ddSLingrui98    }
32809c6f1ddSLingrui98
32909c6f1ddSLingrui98    is(wait_1_resp) {
33009c6f1ddSLingrui98      when(fromMissQueue(1).fire()){
33109c6f1ddSLingrui98        wait_state := wait_finish
33209c6f1ddSLingrui98      }
33309c6f1ddSLingrui98    }
33409c6f1ddSLingrui98
33509c6f1ddSLingrui98    is(wait_finish) {
33609c6f1ddSLingrui98      when(f2_fire) {wait_state := wait_idle }
33709c6f1ddSLingrui98    }
33809c6f1ddSLingrui98  }
33909c6f1ddSLingrui98
34009c6f1ddSLingrui98  when(f2_flush) { wait_state := wait_idle }
34109c6f1ddSLingrui98
34209c6f1ddSLingrui98  (0 until 2).map { i =>
34309c6f1ddSLingrui98    if(i == 1) toMissQueue(i).valid := (hit_0_miss_1 || miss_0_miss_1) && wait_state === wait_queue_ready
34409c6f1ddSLingrui98      else     toMissQueue(i).valid := (only_0_miss || miss_0_hit_1 || miss_0_miss_1) && wait_state === wait_queue_ready
34509c6f1ddSLingrui98    toMissQueue(i).bits.addr    := f2_pAddrs(i)
34609c6f1ddSLingrui98    toMissQueue(i).bits.vSetIdx := f2_vSetIdx(i)
34709c6f1ddSLingrui98    toMissQueue(i).bits.waymask := f2_waymask(i)
34809c6f1ddSLingrui98    toMissQueue(i).bits.clientID :=0.U
34909c6f1ddSLingrui98  }
35009c6f1ddSLingrui98
35109c6f1ddSLingrui98  val miss_all_fix       = (wait_state === wait_finish)
35209c6f1ddSLingrui98
35309c6f1ddSLingrui98  f2_fetchFinish         := ((f2_valid && f2_hit) || miss_all_fix || hit_0_except_1 || except_0)
35409c6f1ddSLingrui98
35509c6f1ddSLingrui98
35609c6f1ddSLingrui98  (touch_ways zip touch_sets).zipWithIndex.map{ case((t_w,t_s), i) =>
35709c6f1ddSLingrui98    t_s(0)         := f1_vSetIdx(i)
35809c6f1ddSLingrui98    t_w(0).valid   := f1_bank_hit(i)
35909c6f1ddSLingrui98    t_w(0).bits    := OHToUInt(f1_bank_hit_vec(i))
36009c6f1ddSLingrui98
36109c6f1ddSLingrui98    t_s(1)         := f2_vSetIdx(i)
36209c6f1ddSLingrui98    t_w(1).valid   := f2_valid && !f2_bank_hit(i)
36309c6f1ddSLingrui98    t_w(1).bits    := OHToUInt(f2_waymask(i))
36409c6f1ddSLingrui98  }
36509c6f1ddSLingrui98
36609c6f1ddSLingrui98  val sec_miss_reg   = RegInit(0.U.asTypeOf(Vec(4, Bool())))
36709c6f1ddSLingrui98  val reservedRefillData = Reg(Vec(2, UInt(blockBits.W)))
36809c6f1ddSLingrui98  val f2_hit_datas    = RegEnable(next = f1_hit_data, enable = f1_fire)
36909c6f1ddSLingrui98  val f2_datas        = Wire(Vec(2, UInt(blockBits.W)))
37009c6f1ddSLingrui98
37109c6f1ddSLingrui98  f2_datas.zipWithIndex.map{case(bank,i) =>
37209c6f1ddSLingrui98    if(i == 0) bank := Mux(f2_bank_hit(i), f2_hit_datas(i),Mux(sec_miss_reg(2),reservedRefillData(1),Mux(sec_miss_reg(0),reservedRefillData(0), f2_mq_datas(i))))
37309c6f1ddSLingrui98    else bank := Mux(f2_bank_hit(i), f2_hit_datas(i),Mux(sec_miss_reg(3),reservedRefillData(1),Mux(sec_miss_reg(1),reservedRefillData(0), f2_mq_datas(i))))
37409c6f1ddSLingrui98  }
37509c6f1ddSLingrui98
37609c6f1ddSLingrui98  val f2_jump_valids          = Fill(PredictWidth, !preDecoderOut.cfiOffset.valid)   | Fill(PredictWidth, 1.U(1.W)) >> (~preDecoderOut.cfiOffset.bits)
37709c6f1ddSLingrui98  val f2_predecode_valids     = VecInit(preDecoderOut.pd.map(instr => instr.valid)).asUInt & f2_jump_valids
37809c6f1ddSLingrui98
37909c6f1ddSLingrui98  def cut(cacheline: UInt, start: UInt) : Vec[UInt] ={
38009c6f1ddSLingrui98    if(HasCExtension){
38109c6f1ddSLingrui98      val result   = Wire(Vec(PredictWidth + 1, UInt(16.W)))
38209c6f1ddSLingrui98      val dataVec  = cacheline.asTypeOf(Vec(blockBytes * 2/ 2, UInt(16.W)))
38309c6f1ddSLingrui98      val startPtr = Cat(0.U(1.W), start(blockOffBits-1, 1))
38409c6f1ddSLingrui98      (0 until PredictWidth + 1).foreach( i =>
38509c6f1ddSLingrui98        result(i) := dataVec(startPtr + i.U)
38609c6f1ddSLingrui98      )
38709c6f1ddSLingrui98      result
38809c6f1ddSLingrui98    } else {
38909c6f1ddSLingrui98      val result   = Wire(Vec(PredictWidth, UInt(32.W)) )
39009c6f1ddSLingrui98      val dataVec  = cacheline.asTypeOf(Vec(blockBytes * 2/ 4, UInt(32.W)))
39109c6f1ddSLingrui98      val startPtr = Cat(0.U(1.W), start(blockOffBits-1, 2))
39209c6f1ddSLingrui98      (0 until PredictWidth).foreach( i =>
39309c6f1ddSLingrui98        result(i) := dataVec(startPtr + i.U)
39409c6f1ddSLingrui98      )
39509c6f1ddSLingrui98      result
39609c6f1ddSLingrui98    }
39709c6f1ddSLingrui98  }
39809c6f1ddSLingrui98
39909c6f1ddSLingrui98  val f2_cut_data = cut( Cat(f2_datas.map(cacheline => cacheline.asUInt ).reverse).asUInt, f2_ftq_req.startAddr )
40009c6f1ddSLingrui98
40109c6f1ddSLingrui98  // deal with secondary miss in f1
40209c6f1ddSLingrui98  val f2_0_f1_0 =   ((f2_valid && !f2_bank_hit(0)) && f1_valid && (get_block_addr(f2_ftq_req.startAddr) === get_block_addr(f1_ftq_req.startAddr)))
40309c6f1ddSLingrui98  val f2_0_f1_1 =   ((f2_valid && !f2_bank_hit(0)) && f1_valid && f1_doubleLine && (get_block_addr(f2_ftq_req.startAddr) === get_block_addr(f1_ftq_req.startAddr + blockBytes.U)))
40409c6f1ddSLingrui98  val f2_1_f1_0 =   ((f2_valid && !f2_bank_hit(1) && f2_doubleLine) && f1_valid && (get_block_addr(f2_ftq_req.startAddr+ blockBytes.U) === get_block_addr(f1_ftq_req.startAddr) ))
40509c6f1ddSLingrui98  val f2_1_f1_1 =   ((f2_valid && !f2_bank_hit(1) && f2_doubleLine) && f1_valid && f1_doubleLine && (get_block_addr(f2_ftq_req.startAddr+ blockBytes.U) === get_block_addr(f1_ftq_req.startAddr + blockBytes.U) ))
40609c6f1ddSLingrui98
40709c6f1ddSLingrui98  val isSameLine = f2_0_f1_0 || f2_0_f1_1 || f2_1_f1_0 || f2_1_f1_1
40809c6f1ddSLingrui98  val sec_miss_sit   = VecInit(Seq(f2_0_f1_0, f2_0_f1_1, f2_1_f1_0, f2_1_f1_1))
40909c6f1ddSLingrui98  val hasSecMiss     = RegInit(false.B)
41009c6f1ddSLingrui98
41109c6f1ddSLingrui98  when(f2_flush){
41209c6f1ddSLingrui98    sec_miss_reg.map(sig => sig := false.B)
41309c6f1ddSLingrui98    hasSecMiss := false.B
41409c6f1ddSLingrui98  }.elsewhen(isSameLine && !f1_flush && f2_fire){
41509c6f1ddSLingrui98    sec_miss_reg.zipWithIndex.map{case(sig, i) => sig := sec_miss_sit(i)}
41609c6f1ddSLingrui98    hasSecMiss := true.B
41709c6f1ddSLingrui98  }.elsewhen((!isSameLine || f1_flush) && hasSecMiss && f2_fire){
41809c6f1ddSLingrui98    sec_miss_reg.map(sig => sig := false.B)
41909c6f1ddSLingrui98    hasSecMiss := false.B
42009c6f1ddSLingrui98  }
42109c6f1ddSLingrui98
42209c6f1ddSLingrui98  when((f2_0_f1_0 || f2_0_f1_1) && f2_fire){
42309c6f1ddSLingrui98    reservedRefillData(0) := f2_mq_datas(0)
42409c6f1ddSLingrui98  }
42509c6f1ddSLingrui98
42609c6f1ddSLingrui98  when((f2_1_f1_0 || f2_1_f1_1) && f2_fire){
42709c6f1ddSLingrui98    reservedRefillData(1) := f2_mq_datas(1)
42809c6f1ddSLingrui98  }
42909c6f1ddSLingrui98
43009c6f1ddSLingrui98
43109c6f1ddSLingrui98  //---------------------------------------------
43209c6f1ddSLingrui98  //  Fetch Stage 4 :
43309c6f1ddSLingrui98  //  * get data from last stage (hit from f1_hit_data/miss from missQueue response)
43409c6f1ddSLingrui98  //  * if at least one needed cacheline miss, wait for miss queue response (a wait_state machine) THIS IS TOO UGLY!!!
43509c6f1ddSLingrui98  //  * cut cacheline(s) and send to PreDecode
43609c6f1ddSLingrui98  //  * check if prediction is right (branch target and type, jump direction and type , jal target )
43709c6f1ddSLingrui98  //---------------------------------------------
43809c6f1ddSLingrui98  val f3_valid          = RegInit(false.B)
43909c6f1ddSLingrui98  val f3_ftq_req        = RegEnable(next = f2_ftq_req,    enable=f2_fire)
44009c6f1ddSLingrui98  val f3_situation      = RegEnable(next = f2_situation,  enable=f2_fire)
44109c6f1ddSLingrui98  val f3_doubleLine     = RegEnable(next = f2_doubleLine, enable=f2_fire)
44209c6f1ddSLingrui98  val f3_fire           = io.toIbuffer.fire()
44309c6f1ddSLingrui98
44409c6f1ddSLingrui98  when(f3_flush)                  {f3_valid := false.B}
44509c6f1ddSLingrui98  .elsewhen(f2_fire && !f2_flush) {f3_valid := true.B }
44609c6f1ddSLingrui98  .elsewhen(io.toIbuffer.fire())  {f3_valid := false.B}
44709c6f1ddSLingrui98
44809c6f1ddSLingrui98  f3_ready := io.toIbuffer.ready || !f2_valid
44909c6f1ddSLingrui98
45009c6f1ddSLingrui98  val f3_cut_data       = RegEnable(next = f2_cut_data, enable=f2_fire)
45109c6f1ddSLingrui98  val f3_except_pf      = RegEnable(next = f2_except_pf, enable = f2_fire)
45209c6f1ddSLingrui98  val f3_except_af      = RegEnable(next = f2_except_af, enable = f2_fire)
45309c6f1ddSLingrui98  val f3_hit            = RegEnable(next = f2_hit   , enable = f2_fire)
45409c6f1ddSLingrui98
45509c6f1ddSLingrui98  val f3_lastHalf       = RegInit(0.U.asTypeOf(new LastHalfInfo))
45609c6f1ddSLingrui98  val f3_lastHalfMatch  = f3_lastHalf.matchThisBlock(f3_ftq_req.startAddr)
45709c6f1ddSLingrui98  val f3_except         = VecInit((0 until 2).map{i => f3_except_pf(i) || f3_except_af(i)})
45809c6f1ddSLingrui98  val f3_has_except     = f3_valid && (f3_except_af.reduce(_||_) || f3_except_pf.reduce(_||_))
45909c6f1ddSLingrui98
46009c6f1ddSLingrui98
46109c6f1ddSLingrui98  preDecoderIn.instValid     :=  f3_valid && !f3_has_except
46209c6f1ddSLingrui98  preDecoderIn.data          :=  f3_cut_data
46309c6f1ddSLingrui98  preDecoderIn.startAddr     :=  f3_ftq_req.startAddr
46409c6f1ddSLingrui98  preDecoderIn.fallThruAddr  :=  f3_ftq_req.fallThruAddr
46509c6f1ddSLingrui98  preDecoderIn.fallThruError :=  f3_ftq_req.fallThruError
46609c6f1ddSLingrui98  preDecoderIn.isDoubleLine  :=  f3_doubleLine
46709c6f1ddSLingrui98  preDecoderIn.ftqOffset     :=  f3_ftq_req.ftqOffset
46809c6f1ddSLingrui98  preDecoderIn.target        :=  f3_ftq_req.target
46909c6f1ddSLingrui98  preDecoderIn.oversize      :=  f3_ftq_req.oversize
47009c6f1ddSLingrui98  preDecoderIn.lastHalfMatch :=  f3_lastHalfMatch
47109c6f1ddSLingrui98  preDecoderIn.pageFault     :=  f3_except_pf
47209c6f1ddSLingrui98  preDecoderIn.accessFault   :=  f3_except_af
47309c6f1ddSLingrui98
47409c6f1ddSLingrui98
47509c6f1ddSLingrui98  // TODO: What if next packet does not match?
47609c6f1ddSLingrui98  when (f3_flush) {
47709c6f1ddSLingrui98    f3_lastHalf.valid := false.B
47809c6f1ddSLingrui98  }.elsewhen (io.toIbuffer.fire()) {
47909c6f1ddSLingrui98    f3_lastHalf.valid := preDecoderOut.hasLastHalf
48009c6f1ddSLingrui98    f3_lastHalf.middlePC := preDecoderOut.realEndPC
48109c6f1ddSLingrui98  }
48209c6f1ddSLingrui98
48309c6f1ddSLingrui98  val f3_predecode_range = VecInit(preDecoderOut.pd.map(inst => inst.valid)).asUInt
48409c6f1ddSLingrui98
48509c6f1ddSLingrui98  io.toIbuffer.valid          := f3_valid
48609c6f1ddSLingrui98  io.toIbuffer.bits.instrs    := preDecoderOut.instrs
48709c6f1ddSLingrui98  io.toIbuffer.bits.valid     := f3_predecode_range & preDecoderOut.instrRange.asUInt
48809c6f1ddSLingrui98  io.toIbuffer.bits.pd        := preDecoderOut.pd
48909c6f1ddSLingrui98  io.toIbuffer.bits.ftqPtr    := f3_ftq_req.ftqIdx
49009c6f1ddSLingrui98  io.toIbuffer.bits.pc        := preDecoderOut.pc
49109c6f1ddSLingrui98  io.toIbuffer.bits.ftqOffset.zipWithIndex.map{case(a, i) => a.bits := i.U; a.valid := preDecoderOut.takens(i)}
49209c6f1ddSLingrui98  io.toIbuffer.bits.foldpc    := preDecoderOut.pc.map(i => XORFold(i(VAddrBits-1,1), MemPredPCWidth))
49309c6f1ddSLingrui98  io.toIbuffer.bits.ipf       := preDecoderOut.pageFault
49409c6f1ddSLingrui98  io.toIbuffer.bits.acf       := preDecoderOut.accessFault
49509c6f1ddSLingrui98  io.toIbuffer.bits.crossPageIPFFix := preDecoderOut.crossPageIPF
49609c6f1ddSLingrui98
49709c6f1ddSLingrui98  //Write back to Ftq
49809c6f1ddSLingrui98  val finishFetchMaskReg = RegNext(f3_valid && !(f2_fire && !f2_flush))
49909c6f1ddSLingrui98
50009c6f1ddSLingrui98  toFtq.pdWb.valid           := !finishFetchMaskReg && f3_valid
50109c6f1ddSLingrui98  toFtq.pdWb.bits.pc         := preDecoderOut.pc
50209c6f1ddSLingrui98  toFtq.pdWb.bits.pd         := preDecoderOut.pd
50309c6f1ddSLingrui98  toFtq.pdWb.bits.pd.zipWithIndex.map{case(instr,i) => instr.valid :=  f3_predecode_range(i)}
50409c6f1ddSLingrui98  toFtq.pdWb.bits.ftqIdx     := f3_ftq_req.ftqIdx
50509c6f1ddSLingrui98  toFtq.pdWb.bits.ftqOffset  := f3_ftq_req.ftqOffset.bits
50609c6f1ddSLingrui98  toFtq.pdWb.bits.misOffset  := preDecoderOut.misOffset
50709c6f1ddSLingrui98  toFtq.pdWb.bits.cfiOffset  := preDecoderOut.cfiOffset
50809c6f1ddSLingrui98  toFtq.pdWb.bits.target     := preDecoderOut.target
50909c6f1ddSLingrui98  toFtq.pdWb.bits.jalTarget  := preDecoderOut.jalTarget
51009c6f1ddSLingrui98  toFtq.pdWb.bits.instrRange := preDecoderOut.instrRange
51109c6f1ddSLingrui98
51209c6f1ddSLingrui98  val predecodeFlush     = preDecoderOut.misOffset.valid && f3_valid
51309c6f1ddSLingrui98  val predecodeFlushReg  = RegNext(predecodeFlush && !(f2_fire && !f2_flush))
51409c6f1ddSLingrui98
51509c6f1ddSLingrui98  f3_redirect := !predecodeFlushReg && predecodeFlush
51609c6f1ddSLingrui98
51709c6f1ddSLingrui98  // Performance Counter
51809c6f1ddSLingrui98  XSPerfAccumulate("req",   io.toIbuffer.fire() )
51909c6f1ddSLingrui98  XSPerfAccumulate("miss",  io.toIbuffer.fire() && !f3_hit )
52009c6f1ddSLingrui98  XSPerfAccumulate("frontendFlush",  f3_redirect )
52109c6f1ddSLingrui98  XSPerfAccumulate("only_0_miss",   only_0_miss )
52209c6f1ddSLingrui98  XSPerfAccumulate("hit_0_miss_1",  hit_0_miss_1 )
52309c6f1ddSLingrui98  XSPerfAccumulate("miss_0_hit_1",  miss_0_hit_1 )
52409c6f1ddSLingrui98  XSPerfAccumulate("miss_0_miss_1", miss_0_miss_1 )
52509c6f1ddSLingrui98  XSPerfAccumulate("crossLine", io.toIbuffer.fire() && f3_situation(0) )
52609c6f1ddSLingrui98  XSPerfAccumulate("lastInLin", io.toIbuffer.fire() && f3_situation(1) )
52709c6f1ddSLingrui98}
528