770 lines
26 KiB
Scala
770 lines
26 KiB
Scala
package BACK
|
||
|
||
import chisel3._
|
||
import chisel3.util._
|
||
|
||
|
||
class FrameHeader extends Bundle{
|
||
val frameLenAim = UInt(12.W) //帧长度目标
|
||
val frameStyle = UInt(2.W) //包类型
|
||
val frameInfo = UInt(16.W) //其它信息，如probe
|
||
}
|
||
|
||
class SubMsgHeader extends Bundle{
|
||
val devIndex = UInt(14.W) // 子报文中设备索引
|
||
val style = UInt(2.W) // 子报文类型
|
||
val address = UInt(16.W) //子报文地址
|
||
val operator = UInt(4.W) //子报文命令类型
|
||
val length = UInt(12.W) //子报文负载长度
|
||
val workCnt = UInt(16.W) //子报文工作计数
|
||
}
|
||
|
||
|
||
|
||
// class ShareSRAMIO extends Bundle{
|
||
// val addr = Input(UInt(15.W))
|
||
// val dataw = Input( UInt(8.W) )
|
||
// val datar = Output( UInt(8.W) )
|
||
// val enw = Input(Bool())
|
||
// val enr = Input(Bool())
|
||
// }
|
||
|
||
|
||
|
||
class SlaveParserIO extends Bundle{
|
||
val downIn = Flipped( Decoupled(new AXIS_Bundle(8)) )
|
||
val downOut = Decoupled(new AXIS_Bundle(8))
|
||
|
||
val upIn = Flipped( Decoupled(new AXIS_Bundle(8)) )
|
||
val upOut = Decoupled(new AXIS_Bundle(8))
|
||
|
||
val sram_w = Vec( 4, Flipped(new SRAM2kWRIO))
|
||
val sram_r = Vec( 4, Flipped(new SRAM2kRDIO))
|
||
|
||
val dSMenq = Output( Vec(4, Bool()) )
|
||
val uSMdeq = Output( Vec(4, Bool()) )
|
||
|
||
val trigAddr = Input( Vec(8, UInt(15.W)) )
|
||
|
||
|
||
val localDevIndex = Output(UInt(16.W))
|
||
|
||
//开放链路寄存器组给interface
|
||
// val isDevOnLeft = Output(UInt(2.W))
|
||
val isDevOnLeftModify = Output(Bool())
|
||
val indexOfLeftDev = Output(UInt(14.W))
|
||
val isDevOnRight = Output(UInt(2.W))
|
||
val isDevOnRightModify = Output(Bool())
|
||
val indexOfRightDev = Output(UInt(14.W))
|
||
|
||
|
||
val mstDeltaTimeStamp = Output(UInt(32.W))
|
||
val slvDeltaTime = Output(UInt(32.W))
|
||
val deltaFinal = Output(UInt(32.W))
|
||
|
||
val isLoop = Output(Bool())
|
||
|
||
val cReg = Input(new CommonRegisterBundle)
|
||
|
||
val lvds = new RegAccessInterfaceIO
|
||
}
|
||
|
||
abstract class SlaveParserBase extends Module{
|
||
val io: SlaveParserIO = IO(new SlaveParserIO)
|
||
|
||
|
||
|
||
val FRAME_STYLE_COMMON = 0.U
|
||
val FRAME_STYLE_PROBE = 1.U
|
||
|
||
|
||
val STATE_IDLE = 0.U //空闲
|
||
val STATE_HEADER = 1.U //长度/ /保留2bits //包类型
|
||
val STATE_SUBMSG_HEADER = 2.U //子报文头
|
||
val STATE_PAYLOAD_DATA = 3.U //子报文数据
|
||
val STATE_CRC = 4.U //CRC校验
|
||
val STATE_ERROR = 5.U //
|
||
val STATE_WAIT = 6.U
|
||
|
||
|
||
|
||
val downRecParser = Module(new SlaveRecParser)
|
||
val upRecParser = Module(new SlaveRecParser)
|
||
val downSendGen = Module(new SlaveSendGen)
|
||
val upSendGen = Module(new SlaveSendGen)
|
||
|
||
val isReadyToProbe = RegInit(false.B)
|
||
val isAckProbe = RegInit(false.B)
|
||
val isLastDevice: Bool = RegInit(true.B)
|
||
|
||
// val isDevOnLeft = RegInit(0.U(2.W)); io.isDevOnLeft := isDevOnLeft
|
||
val isDevOnLeftModify = RegInit(false.B); io.isDevOnLeftModify := isDevOnLeftModify
|
||
val indexOfLeftDev = RegInit(0.U(14.W)); io.indexOfLeftDev := indexOfLeftDev
|
||
io.isDevOnRight := Mux( isLastDevice, "b00".U, "b01".U )
|
||
val isDevOnRightModify = RegInit(false.B); io.isDevOnRightModify := isDevOnRightModify
|
||
val indexOfRightDev = RegInit(0.U(14.W)); io.indexOfRightDev := indexOfRightDev
|
||
|
||
// val isDeviceModified: Bool = RegInit(true.B)
|
||
|
||
val localDevIndex = RegInit(0.U(14.W)); io.localDevIndex := localDevIndex //当前设备索引
|
||
// dontTouch(localDevIndex)
|
||
|
||
|
||
|
||
// 认为只有下行到下行，上行到上行模式，探针是独立发起操作
|
||
// val downSinkSel = Reg(Bool())
|
||
// val upSinkSel = Reg(Bool())
|
||
|
||
val downFrameInfo = Reg(new FrameHeader) //下行大包头
|
||
val upFrameInfo = Reg(new FrameHeader) //上行大包头
|
||
|
||
// val isDownSendBusy = downSendGen.io.frameReq.ready
|
||
// val isUpSendBusy = upSendGen.io.frameReq.ready
|
||
|
||
val isDownSendPend = RegInit(false.B)
|
||
val isUpSendPend = RegInit(false.B)
|
||
|
||
// val isUpProbePending
|
||
|
||
//处理主报文
|
||
|
||
when( downSendGen.io.frameReq.fire ){
|
||
isDownSendPend := false.B
|
||
} .elsewhen( downRecParser.io.frameReq.fire & downRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_COMMON ){//下行来了一个普通包
|
||
isDownSendPend := true.B
|
||
downFrameInfo := downRecParser.io.frameReq.bits
|
||
} .elsewhen( downRecParser.io.frameReq.fire & downRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){//下行来了一个嗅探包
|
||
isDownSendPend := true.B
|
||
downFrameInfo := downRecParser.io.frameReq.bits
|
||
}
|
||
|
||
when( upSendGen.io.frameReq.fire ){
|
||
isUpSendPend := false.B
|
||
} .elsewhen( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_COMMON ){ //上行来了一个普通包
|
||
isUpSendPend := true.B
|
||
upFrameInfo := upRecParser.io.frameReq.bits
|
||
}
|
||
|
||
|
||
downSendGen.io.frameReq.valid :=
|
||
isDownSendPend & downFrameInfo.frameStyle === FRAME_STYLE_COMMON & downRecParser.io.subMsgReq.fire | //下行转发
|
||
isDownSendPend & downFrameInfo.frameStyle === FRAME_STYLE_PROBE //下行探针
|
||
|
||
// assert( OneHot(isDownSendPend, isDownSendProbe) )
|
||
|
||
downSendGen.io.frameReq.bits := Mux1H(Seq(
|
||
isDownSendPend -> downFrameInfo, //下行转发
|
||
//isDownSendProbe -> probeFrame, //下行探针
|
||
))
|
||
|
||
|
||
val upFrameProbeInfo: FrameHeader = Wire(new FrameHeader)
|
||
upFrameProbeInfo.frameLenAim := 0.U //帧长度目标
|
||
upFrameProbeInfo.frameStyle := FRAME_STYLE_PROBE //包类型
|
||
upFrameProbeInfo.frameInfo := localDevIndex //其它信息，如probe
|
||
|
||
upSendGen.io.frameReq.valid :=
|
||
isUpSendPend & upRecParser.io.subMsgReq.fire | //上行转发
|
||
isAckProbe // 上行探针
|
||
|
||
assert( ~(isUpSendPend & isAckProbe), "Assert Failed, Check Softwave, Probe is Sent while transfering!\n" )
|
||
|
||
upSendGen.io.frameReq.bits := Mux1H(Seq(
|
||
isUpSendPend -> upFrameInfo, //上行转发
|
||
isAckProbe -> upFrameProbeInfo, //上行探针
|
||
))
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
////////////////////////////////////////
|
||
|
||
//子报文
|
||
val isDownSubMsgValid = for( _ <- 0 until 2 ) yield { RegInit(false.B) }
|
||
val isUpSubMsgValid = for( _ <- 0 until 2 ) yield { RegInit(false.B) }
|
||
|
||
|
||
|
||
|
||
|
||
//接收子报文
|
||
|
||
val downSubMsgInfo = for( _ <- 0 until 2 ) yield { Reg(new SubMsgTxInfo) } //子报文头
|
||
val upSubMsgInfo = for( _ <- 0 until 2 ) yield { Reg(new SubMsgTxInfo) }
|
||
|
||
|
||
|
||
val downRecFifo = for( _ <- 0 until 2 ) yield { Module(new Queue(UInt(8.W), 20)) } //子报文负载
|
||
val upRecFifo = for( _ <- 0 until 2 ) yield { Module(new Queue(UInt(8.W), 20)) }
|
||
|
||
val isDownRecPing = RegInit(false.B)
|
||
val isUpRecPing = RegInit(false.B)
|
||
|
||
|
||
|
||
//下行接收
|
||
when( downRecParser.io.subMsgReq.fire ){
|
||
when( isDownRecPing ){
|
||
downSubMsgInfo(0).devIndex := downRecParser.io.subMsgReq.bits.devIndex
|
||
downSubMsgInfo(0).style := downRecParser.io.subMsgReq.bits.style
|
||
downSubMsgInfo(0).address := downRecParser.io.subMsgReq.bits.address
|
||
downSubMsgInfo(0).operator := downRecParser.io.subMsgReq.bits.operator
|
||
downSubMsgInfo(0).length := downRecParser.io.subMsgReq.bits.length
|
||
downSubMsgInfo(0).workCnt := downRecParser.io.subMsgReq.bits.workCnt
|
||
downSubMsgInfo(0).source := 0.U
|
||
} .otherwise{ //pong
|
||
downSubMsgInfo(1).devIndex := downRecParser.io.subMsgReq.bits.devIndex
|
||
downSubMsgInfo(1).style := downRecParser.io.subMsgReq.bits.style
|
||
downSubMsgInfo(1).address := downRecParser.io.subMsgReq.bits.address
|
||
downSubMsgInfo(1).operator := downRecParser.io.subMsgReq.bits.operator
|
||
downSubMsgInfo(1).length := downRecParser.io.subMsgReq.bits.length
|
||
downSubMsgInfo(1).workCnt := downRecParser.io.subMsgReq.bits.workCnt
|
||
downSubMsgInfo(1).source := 1.U
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
when( ~isDownRecPing ){ //req fire 后 已经反相
|
||
downRecFifo(0).io.enq.valid := downRecParser.io.data.valid
|
||
downRecFifo(0).io.enq.bits := downRecParser.io.data.bits
|
||
downRecParser.io.data.ready := downRecFifo(0).io.enq.ready
|
||
|
||
downRecFifo(1).io.enq.valid := false.B
|
||
downRecFifo(1).io.enq.bits := 0.U
|
||
|
||
} .otherwise{
|
||
downRecFifo(0).io.enq.valid := false.B
|
||
downRecFifo(0).io.enq.bits := 0.U
|
||
|
||
downRecFifo(1).io.enq.valid := downRecParser.io.data.valid
|
||
downRecFifo(1).io.enq.bits := downRecParser.io.data.bits
|
||
downRecParser.io.data.ready := downRecFifo(1).io.enq.ready
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
//上行接收
|
||
when( upRecParser.io.subMsgReq.fire ){
|
||
when( isUpRecPing ){
|
||
upSubMsgInfo(0).devIndex := upRecParser.io.subMsgReq.bits.devIndex
|
||
upSubMsgInfo(0).style := upRecParser.io.subMsgReq.bits.style
|
||
upSubMsgInfo(0).address := upRecParser.io.subMsgReq.bits.address
|
||
upSubMsgInfo(0).operator := upRecParser.io.subMsgReq.bits.operator
|
||
upSubMsgInfo(0).length := upRecParser.io.subMsgReq.bits.length
|
||
upSubMsgInfo(0).workCnt := upRecParser.io.subMsgReq.bits.workCnt
|
||
upSubMsgInfo(0).source := 0.U
|
||
} .otherwise{
|
||
upSubMsgInfo(1).devIndex := upRecParser.io.subMsgReq.bits.devIndex
|
||
upSubMsgInfo(1).style := upRecParser.io.subMsgReq.bits.style
|
||
upSubMsgInfo(1).address := upRecParser.io.subMsgReq.bits.address
|
||
upSubMsgInfo(1).operator := upRecParser.io.subMsgReq.bits.operator
|
||
upSubMsgInfo(1).length := upRecParser.io.subMsgReq.bits.length
|
||
upSubMsgInfo(1).workCnt := upRecParser.io.subMsgReq.bits.workCnt
|
||
upSubMsgInfo(1).source := 1.U
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
//子报文下行发送
|
||
|
||
val isDownSendPing = RegInit(false.B)
|
||
val isUpSendPing = RegInit(false.B)
|
||
|
||
|
||
|
||
downSendGen.io.subMsgReq.valid :=
|
||
( isDownSendPing & isDownSubMsgValid(0) ) | (~isDownSendPing & isDownSubMsgValid(1))
|
||
|
||
downSendGen.io.subMsgReq.bits := Mux( isDownSendPing, downSubMsgInfo(0), downSubMsgInfo(1) )
|
||
|
||
when( downSendGen.io.subMsgReq.fire ){ //ready
|
||
isDownSendPing := ~isDownSendPing
|
||
when( isDownSendPing ){
|
||
assert( isDownSubMsgValid(0) )
|
||
isDownSubMsgValid(0) := false.B
|
||
} .otherwise{
|
||
assert( isDownSubMsgValid(1) )
|
||
isDownSubMsgValid(1) := false.B
|
||
}
|
||
} .elsewhen( downRecParser.io.subMsgReq.fire ){
|
||
isDownRecPing := ~isDownRecPing
|
||
when( isDownRecPing ){
|
||
assert( ~isDownSubMsgValid(0) )
|
||
isDownSubMsgValid(0) := true.B
|
||
} .otherwise{
|
||
assert( ~isDownSubMsgValid(1) )
|
||
isDownSubMsgValid(1) := true.B
|
||
}
|
||
}
|
||
|
||
|
||
downRecFifo(0).io.deq <> downSendGen.io.data(0)
|
||
downRecFifo(1).io.deq <> downSendGen.io.data(1)
|
||
|
||
downRecParser.io.resp := ( downRecParser.io.stateCurr === STATE_WAIT ) & (~isDownSubMsgValid(0) & ~isDownSubMsgValid(1))
|
||
|
||
|
||
//子报文上行发送
|
||
|
||
|
||
upSendGen.io.subMsgReq.valid :=
|
||
( isUpSendPing & isUpSubMsgValid(0) ) |
|
||
( ~isUpSendPing & isUpSubMsgValid(1) )
|
||
|
||
upSendGen.io.subMsgReq.bits := Mux( isUpSendPing, upSubMsgInfo(0), upSubMsgInfo(1) )
|
||
|
||
when( upSendGen.io.subMsgReq.fire ){ //ready
|
||
isUpSendPing := ~isUpSendPing
|
||
when( isUpSendPing ){
|
||
assert( isUpSubMsgValid(0) )
|
||
isUpSubMsgValid(0) := false.B
|
||
} .otherwise{
|
||
assert( isUpSubMsgValid(1) )
|
||
isUpSubMsgValid(1) := false.B
|
||
}
|
||
}.elsewhen( upRecParser.io.subMsgReq.fire ){
|
||
isUpRecPing := ~isUpRecPing
|
||
when( isUpRecPing ){
|
||
assert( ~isUpSubMsgValid(0) )
|
||
isUpSubMsgValid(0) := true.B
|
||
} .otherwise{
|
||
assert( ~isUpSubMsgValid(1) )
|
||
isUpSubMsgValid(1) := true.B
|
||
}
|
||
}
|
||
|
||
upRecFifo(0).io.deq <> upSendGen.io.data(0)
|
||
upRecFifo(1).io.deq <> upSendGen.io.data(1)
|
||
|
||
upRecParser.io.resp := ( upRecParser.io.stateCurr === STATE_WAIT ) & (~isUpSubMsgValid(0) & ~isUpSubMsgValid(1))
|
||
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
trait SlaveParserIndex{ this: SlaveParserBase =>
|
||
//下行接收
|
||
when( downRecParser.io.subMsgReq.fire &
|
||
downRecParser.io.subMsgReq.bits.devIndex === 0.U &
|
||
downRecParser.io.subMsgReq.bits.style === 0.U &
|
||
downRecParser.io.subMsgReq.bits.operator === "hd".U ){ //设置顺序地址
|
||
localDevIndex := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
isDevOnLeftModify := false.B
|
||
indexOfLeftDev := downRecParser.io.subMsgReq.bits.workCnt
|
||
indexOfRightDev := Mux(isLastDevice, 0.U, downRecParser.io.subMsgReq.bits.workCnt + 2.U)
|
||
|
||
isDevOnRightModify := false.B
|
||
when( isDownRecPing ){
|
||
downSubMsgInfo(0).workCnt := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
} .otherwise{ //pong
|
||
downSubMsgInfo(1).workCnt := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
}
|
||
|
||
|
||
//上行接收 获取右侧索引号
|
||
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
trait SlaveParserRW{ this: SlaveParserBase =>
|
||
|
||
|
||
//下行接收
|
||
when( downRecParser.io.subMsgReq.fire ){
|
||
when( isDownRecPing ){
|
||
//override
|
||
when( downRecParser.io.subMsgReq.bits.devIndex === localDevIndex & ( (downRecParser.io.subMsgReq.bits.operator === 1.U) | (downRecParser.io.subMsgReq.bits.operator === 2.U) ) ) { //自身包//写操作或读写操作)
|
||
downSubMsgInfo(0).workCnt := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
|
||
} .otherwise{ //pong
|
||
//override
|
||
when( downRecParser.io.subMsgReq.bits.devIndex === localDevIndex & ( (downRecParser.io.subMsgReq.bits.operator === 1.U) | (downRecParser.io.subMsgReq.bits.operator === 2.U) )) { //自身包//写操作或读写操作 )
|
||
downSubMsgInfo(1).workCnt := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
|
||
//写入 SM或寄存器空间
|
||
|
||
val addrw = Reg(UInt(15.W))
|
||
|
||
val isWRReg = (addrw(14,11) === "b0000".U)
|
||
val isWRSM0 = (addrw(14,11) === "b0001".U)
|
||
val isWRSM2 = (addrw(14,11) === "b0011".U)
|
||
val isWRSM4 = (addrw(14,11) === "b0101".U)
|
||
val isWRSM6 = (addrw(14,11) === "b0111".U)
|
||
|
||
|
||
val isWrite = (downRecParser.io.stateCurr === STATE_PAYLOAD_DATA) & ( //req fire 后 已经反相
|
||
( ~isDownRecPing & (downSubMsgInfo(0).devIndex === localDevIndex) & ( (downSubMsgInfo(0).operator === 1.U) | (downSubMsgInfo(0).operator === 2.U) )) |
|
||
( isDownRecPing & (downSubMsgInfo(1).devIndex === localDevIndex) & ( (downSubMsgInfo(1).operator === 1.U) | (downSubMsgInfo(1).operator === 2.U) ))
|
||
)
|
||
|
||
when( downRecParser.io.subMsgReq.fire & downRecParser.io.subMsgReq.bits.devIndex === localDevIndex ){
|
||
addrw := downRecParser.io.subMsgReq.bits.address
|
||
} .elsewhen( isWrite & downRecParser.io.data.fire ){
|
||
addrw := addrw + 1.U
|
||
}
|
||
|
||
|
||
io.lvds.isEnW := isWrite & isWRReg & downRecParser.io.data.fire
|
||
io.lvds.dataw := downRecParser.io.data.bits
|
||
|
||
io.sram_w(0).enw := isWrite & isWRSM0 & downRecParser.io.data.fire
|
||
io.sram_w(0).addrw := addrw(10,0)
|
||
io.sram_w(0).dataw := downRecParser.io.data.bits
|
||
|
||
io.sram_w(1).enw := isWrite & isWRSM2 & downRecParser.io.data.fire
|
||
io.sram_w(1).addrw := addrw(10,0)
|
||
io.sram_w(1).dataw := downRecParser.io.data.bits
|
||
|
||
io.sram_w(2).enw := isWrite & isWRSM4 & downRecParser.io.data.fire
|
||
io.sram_w(2).addrw := addrw(10,0)
|
||
io.sram_w(2).dataw := downRecParser.io.data.bits
|
||
|
||
io.sram_w(3).enw := isWrite & isWRSM6 & downRecParser.io.data.fire
|
||
io.sram_w(3).addrw := addrw(10,0)
|
||
io.sram_w(3).dataw := downRecParser.io.data.bits
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
//上行接收
|
||
when( upRecParser.io.subMsgReq.fire ){
|
||
when( isUpRecPing ){
|
||
//override
|
||
when( upRecParser.io.subMsgReq.bits.devIndex === localDevIndex & ( (upRecParser.io.subMsgReq.bits.operator === 0.U) || (upRecParser.io.subMsgReq.bits.operator === 2.U) ) ){ //自身包//读或读写
|
||
upSubMsgInfo(0).workCnt := upRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
} .otherwise{
|
||
//override
|
||
when( upRecParser.io.subMsgReq.bits.devIndex === localDevIndex & ( (upRecParser.io.subMsgReq.bits.operator === 0.U) || (upRecParser.io.subMsgReq.bits.operator === 2.U) )){ //自身包//读或读写 )
|
||
upSubMsgInfo(1).workCnt := upRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
//读出uSM
|
||
val isRead =
|
||
((upRecParser.io.stateCurr === STATE_PAYLOAD_DATA) & (
|
||
(~isUpRecPing & upSubMsgInfo(0).devIndex === localDevIndex & (upSubMsgInfo(0).operator === 0.U | upSubMsgInfo(0).operator === 2.U)) |
|
||
( isUpRecPing & upSubMsgInfo(1).devIndex === localDevIndex & (upSubMsgInfo(1).operator === 0.U | upSubMsgInfo(1).operator === 2.U))
|
||
) |
|
||
((upRecParser.io.stateNext === STATE_PAYLOAD_DATA) & (upRecParser.io.subMsgReq.bits.devIndex === localDevIndex) & (upRecParser.io.subMsgReq.bits.operator === 0.U | upRecParser.io.subMsgReq.bits.operator === 2.U))
|
||
)
|
||
|
||
val addrr = Reg(UInt(15.W))
|
||
val readSMAddr = Mux1H(Seq(
|
||
( upRecParser.io.stateCurr === STATE_SUBMSG_HEADER ) -> upRecParser.io.subMsgReq.bits.address,
|
||
( upRecParser.io.stateCurr === STATE_PAYLOAD_DATA ) -> addrr,
|
||
))
|
||
|
||
|
||
|
||
val isRDReg = (readSMAddr(14,11) === "b0000".U)
|
||
val isRDSM1 = (readSMAddr(14,11) === "b0010".U)
|
||
val isRDSM3 = (readSMAddr(14,11) === "b0100".U)
|
||
val isRDSM5 = (readSMAddr(14,11) === "b0110".U)
|
||
val isRDSM7 = (readSMAddr(14,11) === "b1000".U)
|
||
|
||
when( upRecParser.io.subMsgReq.fire & upRecParser.io.subMsgReq.bits.devIndex === localDevIndex ){
|
||
addrr := upRecParser.io.subMsgReq.bits.address + 1.U
|
||
} .elsewhen( isRead & upRecParser.io.data.fire ){
|
||
addrr := addrr + 1.U
|
||
}
|
||
|
||
val upStreamData = Mux1H(Seq(
|
||
isRDReg -> io.lvds.datar,
|
||
isRDSM1 -> io.sram_r(0).datar,
|
||
isRDSM3 -> io.sram_r(1).datar,
|
||
isRDSM5 -> io.sram_r(2).datar,
|
||
isRDSM7 -> io.sram_r(3).datar,
|
||
))
|
||
|
||
when( ~isUpRecPing ){ //req fire 后 已经反相
|
||
upRecFifo(0).io.enq.valid := upRecParser.io.data.valid
|
||
upRecFifo(0).io.enq.bits :=
|
||
Mux( upSubMsgInfo(0).devIndex === localDevIndex & (upSubMsgInfo(0).operator === 0.U | upSubMsgInfo(0).operator === 2.U),
|
||
upStreamData, upRecParser.io.data.bits)
|
||
upRecParser.io.data.ready := upRecFifo(0).io.enq.ready
|
||
|
||
upRecFifo(1).io.enq.valid := false.B
|
||
upRecFifo(1).io.enq.bits := 0.U
|
||
} .otherwise{
|
||
upRecFifo(0).io.enq.valid := false.B
|
||
upRecFifo(0).io.enq.bits := 0.U
|
||
|
||
upRecFifo(1).io.enq.valid := upRecParser.io.data.valid
|
||
upRecFifo(1).io.enq.bits :=
|
||
Mux( upSubMsgInfo(1).devIndex === localDevIndex & (upSubMsgInfo(1).operator === 0.U | upSubMsgInfo(1).operator === 2.U),
|
||
upStreamData, upRecParser.io.data.bits)
|
||
upRecParser.io.data.ready := upRecFifo(1).io.enq.ready
|
||
|
||
}
|
||
|
||
io.lvds.isEnR := isRead & isRDReg & ( upRecParser.io.subMsgReq.fire | upRecParser.io.data.fire )
|
||
io.lvds.addrSel := Mux1H(Seq(
|
||
isRead -> readSMAddr(10,0),
|
||
isWrite -> addrw(10,0),
|
||
))
|
||
assert( ~(isRead & isWrite) )
|
||
|
||
|
||
|
||
|
||
io.sram_r(0).enr := isRead & isRDSM1 & ( upRecParser.io.subMsgReq.fire | upRecParser.io.data.fire )
|
||
io.sram_r(1).enr := isRead & isRDSM3 & ( upRecParser.io.subMsgReq.fire | upRecParser.io.data.fire )
|
||
io.sram_r(2).enr := isRead & isRDSM5 & ( upRecParser.io.subMsgReq.fire | upRecParser.io.data.fire )
|
||
io.sram_r(3).enr := isRead & isRDSM7 & ( upRecParser.io.subMsgReq.fire | upRecParser.io.data.fire )
|
||
|
||
io.sram_r(0).addrr := readSMAddr(10,0)
|
||
io.sram_r(1).addrr := readSMAddr(10,0)
|
||
io.sram_r(2).addrr := readSMAddr(10,0)
|
||
io.sram_r(3).addrr := readSMAddr(10,0)
|
||
|
||
|
||
io.dSMenq(0) := isWrite & isWRSM0 & io.trigAddr(0) === addrw(10,0)
|
||
io.uSMdeq(0) := isRead & isRDSM1 & io.trigAddr(1) === readSMAddr(10,0)
|
||
io.dSMenq(1) := isWrite & isWRSM2 & io.trigAddr(2) === addrw(10,0)
|
||
io.uSMdeq(1) := isRead & isRDSM3 & io.trigAddr(3) === readSMAddr(10,0)
|
||
io.dSMenq(2) := isWrite & isWRSM4 & io.trigAddr(4) === addrw(10,0)
|
||
io.uSMdeq(2) := isRead & isRDSM5 & io.trigAddr(5) === readSMAddr(10,0)
|
||
io.dSMenq(3) := isWrite & isWRSM6 & io.trigAddr(6) === addrw(10,0)
|
||
io.uSMdeq(3) := isRead & isRDSM7 & io.trigAddr(7) === readSMAddr(10,0)
|
||
|
||
|
||
}
|
||
|
||
|
||
trait SlaveParserSync{ this: SlaveParserBase =>
|
||
val downTimeStamp = Reg(UInt(64.W)) //下行本地时间戳寄存器
|
||
val upTimeStamp = Reg(UInt(64.W)) //上行本地时间戳寄存器
|
||
val mstTimeStamp = Reg(UInt(64.W)) //主站时间戳
|
||
val mstDeltaTimeStamp = Reg(UInt(32.W)); io.mstDeltaTimeStamp := mstDeltaTimeStamp //主站时间戳差值
|
||
val slvDeltaTimeStamp = Reg(UInt(32.W)); io.slvDeltaTime := slvDeltaTimeStamp //从站时间戳差值
|
||
|
||
val mstSlvDeltaTimeStamp = Reg(UInt(32.W)) //主发从接时间差(中间变量)
|
||
val deltaMstSlvDeltaTimeStamp = Reg(UInt(32.W)) //主差从差时间差(中间变量)
|
||
val deltaFinal = Reg(UInt(32.W)); io.deltaFinal := deltaFinal //当前时间戳与主站时间差
|
||
|
||
|
||
// val recoTimeStamp = Reg(UInt(64.W)) //时钟补偿寄存器
|
||
|
||
// dontTouch(recoTimeStamp)
|
||
|
||
// recoTimeStamp = io.timeStamp + deltaFinal
|
||
// recoTimeStamp = io.timeStamp + mstSlvDeltaTimeStamp + deltaMstSlvDeltaTimeStamp
|
||
// recoTimeStamp = io.timeStamp + mstTimeStamp - downTimeStamp + (mstDeltaTimeStamp - slvDeltaTimeStamp ) >> 1
|
||
// recoTimeStamp = io.timeStamp + mstTimeStamp - downTimeStamp + (mstDeltaTimeStamp - (upTimeStamp - downTimeStamp)) >> 1
|
||
|
||
|
||
//更新下行本地时间戳寄存器
|
||
when( downRecParser.io.frameReq.fire ){
|
||
downTimeStamp := io.cReg.timeStamp
|
||
}
|
||
|
||
//更新上行本地时间戳寄存器
|
||
when( upRecParser.io.frameReq.fire ){
|
||
upTimeStamp := io.cReg.timeStamp
|
||
slvDeltaTimeStamp := io.cReg.timeStamp - downTimeStamp
|
||
}
|
||
|
||
//下行接收
|
||
val isSync = (downRecParser.io.stateCurr === STATE_PAYLOAD_DATA) & ( //req fire 后 已经反相
|
||
( ~isDownRecPing & downSubMsgInfo(0).devIndex === 0.U & downSubMsgInfo(0).operator === "he".U ) |
|
||
( isDownRecPing & downSubMsgInfo(1).devIndex === 0.U & downSubMsgInfo(1).operator === "he".U )
|
||
)
|
||
|
||
val syncCnt = Reg(UInt(4.W))
|
||
|
||
when( downRecParser.io.rec.fire ){
|
||
when( isSync ){
|
||
syncCnt := syncCnt + 1.U
|
||
} .otherwise{
|
||
syncCnt := 0.U
|
||
}
|
||
}
|
||
|
||
|
||
when( isSync & downRecParser.io.rec.fire ){
|
||
when( syncCnt === 0.U ){
|
||
mstTimeStamp := Cat( mstTimeStamp(63, 8), downRecParser.io.data.bits )
|
||
} .elsewhen( syncCnt === 1.U ){
|
||
mstTimeStamp := Cat( mstTimeStamp(63,16), downRecParser.io.data.bits, mstTimeStamp(7,0) )
|
||
} .elsewhen( syncCnt === 2.U ){
|
||
mstTimeStamp := Cat( mstTimeStamp(63,24), downRecParser.io.data.bits, mstTimeStamp(15,0) )
|
||
} .elsewhen( syncCnt === 3.U ){
|
||
mstTimeStamp := Cat( mstTimeStamp(63,32), downRecParser.io.data.bits, mstTimeStamp(23,0) )
|
||
} .elsewhen( syncCnt === 4.U ){
|
||
mstTimeStamp := Cat( mstTimeStamp(63,40), downRecParser.io.data.bits, mstTimeStamp(31,0) )
|
||
} .elsewhen( syncCnt === 5.U ){
|
||
mstTimeStamp := Cat( mstTimeStamp(63,48), downRecParser.io.data.bits, mstTimeStamp(39,0) )
|
||
} .elsewhen( syncCnt === 6.U ){
|
||
mstTimeStamp := Cat( mstTimeStamp(63,56), downRecParser.io.data.bits, mstTimeStamp(47,0) )
|
||
} .elsewhen( syncCnt === 7.U ){
|
||
mstTimeStamp := Cat( downRecParser.io.data.bits, mstTimeStamp(55,0) )
|
||
} .elsewhen( syncCnt === 8.U ){
|
||
mstSlvDeltaTimeStamp := mstTimeStamp - downTimeStamp
|
||
mstDeltaTimeStamp := Cat( mstDeltaTimeStamp(31, 8), downRecParser.io.data.bits )
|
||
} .elsewhen( syncCnt === 9.U ){
|
||
mstDeltaTimeStamp := Cat( mstDeltaTimeStamp(31,16), downRecParser.io.data.bits, mstDeltaTimeStamp(7,0) )
|
||
} .elsewhen( syncCnt === 10.U ){
|
||
mstDeltaTimeStamp := Cat( mstDeltaTimeStamp(31,24), downRecParser.io.data.bits, mstDeltaTimeStamp(15,0) )
|
||
} .elsewhen( syncCnt === 11.U ){
|
||
mstDeltaTimeStamp := Cat( downRecParser.io.data.bits, mstDeltaTimeStamp(23, 0) )
|
||
} .otherwise{
|
||
assert(false.B, "Wrong Sync SubMsg!\n")
|
||
}
|
||
}
|
||
|
||
when( RegNext(isSync) & ~isSync ){
|
||
deltaMstSlvDeltaTimeStamp := (mstDeltaTimeStamp - slvDeltaTimeStamp) >> 1
|
||
} .elsewhen( RegNext(RegNext(isSync)) & ~RegNext(isSync) ){
|
||
deltaFinal := mstSlvDeltaTimeStamp + deltaMstSlvDeltaTimeStamp
|
||
}
|
||
|
||
|
||
}
|
||
|
||
trait SlaveParserProbe{ this: SlaveParserBase =>
|
||
|
||
|
||
// val ProbeRecAim = 511.U
|
||
val probeRecCnt = RegInit(0.U(9.W))
|
||
val isWatchDogOverflow = probeRecCnt.andR
|
||
|
||
|
||
|
||
|
||
|
||
val isReadyToProbe_Pending = RegInit(false.B)
|
||
|
||
when( downRecParser.io.frameReq.fire & downRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //下行来了一个嗅探包
|
||
isReadyToProbe_Pending := true.B
|
||
} .elsewhen( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行来了一个嗅探包
|
||
isReadyToProbe_Pending := false.B
|
||
} .elsewhen( isWatchDogOverflow ){
|
||
isReadyToProbe_Pending := false.B
|
||
}
|
||
|
||
when( downRecParser.io.frameReq.fire & downRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //下行来了一个嗅探包
|
||
isAckProbe := true.B
|
||
} .elsewhen( upSendGen.io.frameReq.fire & upSendGen.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行发送回复嗅探包
|
||
isAckProbe := false.B
|
||
}
|
||
|
||
|
||
|
||
val isLastDevice_Pending = RegInit(true.B)
|
||
|
||
when( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行来了一个嗅探包
|
||
isLastDevice_Pending := false.B
|
||
} .elsewhen( isWatchDogOverflow ){
|
||
isLastDevice_Pending := true.B
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
when( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行来了一个嗅探包
|
||
probeRecCnt := 0.U
|
||
} .elsewhen( isWatchDogOverflow ){
|
||
probeRecCnt := 0.U
|
||
} .elsewhen( isReadyToProbe ){
|
||
probeRecCnt := probeRecCnt + 1.U
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
when( downRecParser.io.frameReq.fire & downRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //下行来了一个嗅探包
|
||
when( downRecParser.io.frameReq.bits.frameInfo =/= localDevIndex - 1.U ){ //索引不对
|
||
isDevOnLeftModify := true.B
|
||
indexOfLeftDev := downRecParser.io.frameReq.bits.frameInfo
|
||
}
|
||
}
|
||
|
||
when( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行来了一个嗅探包
|
||
when( upRecParser.io.frameReq.bits.frameInfo =/= localDevIndex + 1.U ){ //索引不对
|
||
isDevOnRightModify := true.B
|
||
indexOfRightDev := upRecParser.io.frameReq.bits.frameInfo
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
io.upOut <> Queue( upSendGen.io.send, 4, true, false )
|
||
io.downIn <> downRecParser.io.rec
|
||
|
||
io.downOut <> Queue( downSendGen.io.send, 4, true, false )
|
||
io.upIn <> upRecParser.io.rec
|
||
|
||
io.isLoop := isLastDevice & ~isReadyToProbe
|
||
|
||
|
||
when( isLastDevice =/= isLastDevice_Pending & ~downSendGen.io.send.valid & ~io.downOut.valid & ~io.upIn.valid ){
|
||
isLastDevice := isLastDevice_Pending
|
||
}
|
||
|
||
when( isReadyToProbe =/= isReadyToProbe_Pending & ~downSendGen.io.send.valid & ~io.downOut.valid & ~io.upIn.valid ){
|
||
isReadyToProbe := isReadyToProbe_Pending
|
||
}
|
||
}
|
||
|
||
class SlaveParser extends SlaveParserBase
|
||
with SlaveParserIndex
|
||
with SlaveParserRW
|
||
with SlaveParserSync
|
||
with SlaveParserProbe
|
||
|
||
|
||
|
||
|