804 lines
28 KiB
Scala
804 lines
28 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 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
|
||
|
||
val intHWTrig = Output(Vec(2, Bool()))
|
||
val intHWClr = Input (Vec(2, Bool()))
|
||
}
|
||
|
||
abstract class SlaveParserBase extends Module{
|
||
val io: SlaveParserIO = IO(new SlaveParserIO)
|
||
|
||
|
||
|
||
val FRAME_STYLE_COMMON = 0.U
|
||
val FRAME_STYLE_PROBE = 1.U
|
||
|
||
val SUBMSG_OPERATOR_UNIREAD = 0.U
|
||
val SUBMSG_OPERATOR_UNIWRITE = 1.U
|
||
val SUBMSG_OPERATOR_UNIRDWR = 2.U
|
||
val SUBMSG_OPERATOR_INDEX = "hb".U
|
||
val SUBMSG_OPERATOR_SYNC = "hc".U
|
||
val SUBMSG_OPERATOR_BOARDREAD = "hd".U
|
||
val SUBMSG_OPERATOR_BOARDWRITE = "he".U
|
||
val SUBMSG_OPERATOR_BOARDRDWR = "hf".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 localDevIndex = RegInit(0.U(14.W)); io.localDevIndex := localDevIndex //当前设备索引
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
//处理主报文
|
||
|
||
|
||
downSendGen.io.frameReq.valid := downRecParser.io.frameReq.fire
|
||
assert( ~(downSendGen.io.frameReq.valid & ~downSendGen.io.frameReq.ready) )
|
||
|
||
{
|
||
downSendGen.io.frameReq.bits := downRecParser.io.frameReq.bits
|
||
//voerride
|
||
downSendGen.io.frameReq.bits.frameInfo := localDevIndex
|
||
}
|
||
|
||
|
||
val upFrameProbeInfo: FrameHeader = Wire(new FrameHeader)
|
||
upFrameProbeInfo.frameLenAim := 0.U //帧长度目标
|
||
upFrameProbeInfo.frameStyle := FRAME_STYLE_PROBE //包类型
|
||
upFrameProbeInfo.frameInfo := localDevIndex //其它信息，如probe
|
||
|
||
upSendGen.io.frameReq.valid :=
|
||
(upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_COMMON) |
|
||
isAckProbe
|
||
|
||
assert( ~(upSendGen.io.frameReq.valid & ~upSendGen.io.frameReq.ready) )
|
||
|
||
|
||
assert( ~(upRecParser.io.frameReq.fire & isAckProbe), "Assert Failed, Check Softwave, Probe is Sent while transfering!\n" )
|
||
|
||
upSendGen.io.frameReq.bits := Mux1H(Seq(
|
||
upRecParser.io.frameReq.fire -> upRecParser.io.frameReq.bits, //上行转发
|
||
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 === SUBMSG_OPERATOR_INDEX ){ //设置顺序地址
|
||
localDevIndex := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
indexOfRightDev := Mux(isLastDevice, 0.U, downRecParser.io.subMsgReq.bits.workCnt + 2.U)
|
||
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.operator === SUBMSG_OPERATOR_UNIWRITE) | (downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_UNIRDWR) ) & downRecParser.io.subMsgReq.bits.devIndex === localDevIndex ) |
|
||
( ( (downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDWRITE) | (downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDRDWR) ) )
|
||
) { //自身包//写操作或读写操作)
|
||
downSubMsgInfo(0).workCnt := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
|
||
} .otherwise{ //pong
|
||
//override
|
||
when(
|
||
( ( (downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_UNIWRITE ) | (downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_UNIRDWR ) ) & downRecParser.io.subMsgReq.bits.devIndex === localDevIndex ) |
|
||
( ( (downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDWRITE) | (downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDRDWR) ) )
|
||
) { //自身包//写操作或读写操作 )
|
||
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).operator === SUBMSG_OPERATOR_UNIWRITE) | (downSubMsgInfo(0).operator === SUBMSG_OPERATOR_UNIRDWR ) ) & (downSubMsgInfo(0).devIndex === localDevIndex)) |
|
||
( isDownRecPing & ( (downSubMsgInfo(1).operator === SUBMSG_OPERATOR_UNIWRITE) | (downSubMsgInfo(1).operator === SUBMSG_OPERATOR_UNIRDWR ) ) & (downSubMsgInfo(1).devIndex === localDevIndex)) |
|
||
( ~isDownRecPing & ( (downSubMsgInfo(0).operator === SUBMSG_OPERATOR_BOARDWRITE) | (downSubMsgInfo(0).operator === SUBMSG_OPERATOR_BOARDRDWR) ) ) |
|
||
( isDownRecPing & ( (downSubMsgInfo(1).operator === SUBMSG_OPERATOR_BOARDWRITE) | (downSubMsgInfo(1).operator === SUBMSG_OPERATOR_BOARDRDWR) ) )
|
||
)
|
||
|
||
when( downRecParser.io.subMsgReq.fire & (
|
||
downRecParser.io.subMsgReq.bits.devIndex === localDevIndex |
|
||
downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDWRITE |
|
||
downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDRDWR
|
||
)
|
||
){
|
||
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
|
||
|
||
|
||
|
||
|
||
|
||
// val SUBMSG_OPERATOR_BOARDREAD = "hd".U
|
||
// val SUBMSG_OPERATOR_BOARDWRITE = "he".U
|
||
// val SUBMSG_OPERATOR_BOARDRDWR = "hf".U
|
||
|
||
|
||
//上行接收
|
||
when( upRecParser.io.subMsgReq.fire ){
|
||
when( isUpRecPing ){
|
||
//override
|
||
when(
|
||
( ( (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_UNIREAD ) | (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_UNIRDWR ) ) & upRecParser.io.subMsgReq.bits.devIndex === localDevIndex ) |
|
||
( ( (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDREAD) | (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDRDWR) ) )
|
||
){ //自身包//读或读写
|
||
upSubMsgInfo(0).workCnt := upRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
} .otherwise{
|
||
//override
|
||
when(
|
||
( ( (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_UNIREAD ) | (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_UNIRDWR ) ) & upRecParser.io.subMsgReq.bits.devIndex === localDevIndex ) |
|
||
( ( (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDREAD) | (upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDRDWR) ) )
|
||
){ //自身包//读或读写 )
|
||
upSubMsgInfo(1).workCnt := upRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
//读出uSM
|
||
val isRead =
|
||
((upRecParser.io.stateCurr === STATE_PAYLOAD_DATA) & (
|
||
(~isUpRecPing & (upSubMsgInfo(0).operator === SUBMSG_OPERATOR_UNIREAD | upSubMsgInfo(0).operator === SUBMSG_OPERATOR_UNIRDWR ) & upSubMsgInfo(0).devIndex === localDevIndex) |
|
||
( isUpRecPing & (upSubMsgInfo(1).operator === SUBMSG_OPERATOR_UNIREAD | upSubMsgInfo(1).operator === SUBMSG_OPERATOR_UNIRDWR ) & upSubMsgInfo(1).devIndex === localDevIndex) |
|
||
(~isUpRecPing & (upSubMsgInfo(0).operator === SUBMSG_OPERATOR_BOARDREAD | upSubMsgInfo(0).operator === SUBMSG_OPERATOR_BOARDRDWR ) ) |
|
||
( isUpRecPing & (upSubMsgInfo(1).operator === SUBMSG_OPERATOR_BOARDREAD | upSubMsgInfo(1).operator === SUBMSG_OPERATOR_BOARDRDWR ) )
|
||
)
|
||
)
|
||
|
||
val addrr = Reg(UInt(15.W))
|
||
|
||
val isRDReg = addrr(14,11) === "b0000".U
|
||
val isRDSM1 = addrr(14,11) === "b0010".U
|
||
val isRDSM3 = addrr(14,11) === "b0100".U
|
||
val isRDSM5 = addrr(14,11) === "b0110".U
|
||
val isRDSM7 = addrr(14,11) === "b1000".U
|
||
|
||
val isLvdsEnR = isRead & ( ((RegNext(upRecParser.io.stateCurr) =/= STATE_PAYLOAD_DATA) & (upRecParser.io.stateCurr === STATE_PAYLOAD_DATA)) |
|
||
upRecParser.io.data.fire )
|
||
|
||
when( upRecParser.io.subMsgReq.fire & (
|
||
upRecParser.io.subMsgReq.bits.devIndex === localDevIndex |
|
||
upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDREAD |
|
||
upRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_BOARDRDWR
|
||
)
|
||
){
|
||
addrr := upRecParser.io.subMsgReq.bits.address
|
||
} .elsewhen( isLvdsEnR ){
|
||
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).operator === SUBMSG_OPERATOR_UNIREAD | upSubMsgInfo(0).operator === SUBMSG_OPERATOR_UNIRDWR ) & upSubMsgInfo(0).devIndex === localDevIndex, upStreamData,
|
||
Mux( upSubMsgInfo(0).operator === SUBMSG_OPERATOR_BOARDREAD | upSubMsgInfo(0).operator === SUBMSG_OPERATOR_BOARDRDWR, upStreamData | upRecParser.io.data.bits,
|
||
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).operator === SUBMSG_OPERATOR_UNIREAD | upSubMsgInfo(1).operator === SUBMSG_OPERATOR_UNIRDWR ) & upSubMsgInfo(1).devIndex === localDevIndex, upStreamData,
|
||
Mux( upSubMsgInfo(1).operator === SUBMSG_OPERATOR_BOARDREAD | upSubMsgInfo(1).operator === SUBMSG_OPERATOR_BOARDRDWR, upStreamData | upRecParser.io.data.bits,
|
||
upRecParser.io.data.bits
|
||
)
|
||
)
|
||
upRecParser.io.data.ready := upRecFifo(1).io.enq.ready
|
||
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
io.lvds.addrr := addrr(10,0)
|
||
io.lvds.addrw := addrw(10,0)
|
||
|
||
|
||
// assert( ~(isRead & isWrite) )
|
||
|
||
|
||
|
||
io.lvds.isEnR := isRDReg & isLvdsEnR
|
||
io.sram_r(0).enr := isRDSM1 & isLvdsEnR
|
||
io.sram_r(1).enr := isRDSM3 & isLvdsEnR
|
||
io.sram_r(2).enr := isRDSM5 & isLvdsEnR
|
||
io.sram_r(3).enr := isRDSM7 & isLvdsEnR
|
||
|
||
io.sram_r(0).addrr := addrr(10,0)
|
||
io.sram_r(1).addrr := addrr(10,0)
|
||
io.sram_r(2).addrr := addrr(10,0)
|
||
io.sram_r(3).addrr := addrr(10,0)
|
||
|
||
|
||
io.dSMenq(0) := io.sram_w(0).enw & isWRSM0 & (io.cReg.smTrigLen(0) - 1.U) === addrw(10,0)
|
||
io.uSMdeq(0) := isLvdsEnR & isRDSM1 & (io.cReg.smTrigLen(1) - 1.U + 1.U) === addrr(10,0)
|
||
io.dSMenq(1) := io.sram_w(1).enw & isWRSM2 & (io.cReg.smTrigLen(2) - 1.U) === addrw(10,0)
|
||
io.uSMdeq(1) := isLvdsEnR & isRDSM3 & (io.cReg.smTrigLen(3) - 1.U + 1.U) === addrr(10,0)
|
||
io.dSMenq(2) := io.sram_w(2).enw & isWRSM4 & (io.cReg.smTrigLen(4) - 1.U) === addrw(10,0)
|
||
io.uSMdeq(2) := isLvdsEnR & isRDSM5 & (io.cReg.smTrigLen(5) - 1.U + 1.U) === addrr(10,0)
|
||
io.dSMenq(3) := io.sram_w(3).enw & isWRSM6 & (io.cReg.smTrigLen(6) - 1.U) === addrw(10,0)
|
||
io.uSMdeq(3) := isLvdsEnR & isRDSM7 & (io.cReg.smTrigLen(7) - 1.U + 1.U) === addrr(10,0)
|
||
|
||
|
||
}
|
||
|
||
|
||
trait SlaveParserSync{ this: SlaveParserBase =>
|
||
//下行接收
|
||
when( downRecParser.io.subMsgReq.fire ){
|
||
when( isDownRecPing ){
|
||
//override
|
||
when( downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_SYNC ) { //同步包
|
||
downSubMsgInfo(0).workCnt := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
|
||
} .otherwise{ //pong
|
||
//override
|
||
when( downRecParser.io.subMsgReq.bits.operator === SUBMSG_OPERATOR_SYNC ) { //同步包 )
|
||
downSubMsgInfo(1).workCnt := downRecParser.io.subMsgReq.bits.workCnt + 1.U
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
|
||
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 & downRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_COMMON ){
|
||
downTimeStamp := io.cReg.timeStamp
|
||
}
|
||
|
||
//更新上行本地时间戳寄存器
|
||
when( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_COMMON ){
|
||
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 === SUBMSG_OPERATOR_SYNC ) |
|
||
( isDownRecPing & downSubMsgInfo(1).devIndex === 0.U & downSubMsgInfo(1).operator === SUBMSG_OPERATOR_SYNC )
|
||
)
|
||
|
||
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 ){
|
||
val deltaMstSlvDeltaTimeStamp_org = mstDeltaTimeStamp - slvDeltaTimeStamp
|
||
deltaMstSlvDeltaTimeStamp := Cat( deltaMstSlvDeltaTimeStamp_org.extract(deltaMstSlvDeltaTimeStamp_org.getWidth-1), deltaMstSlvDeltaTimeStamp_org(deltaMstSlvDeltaTimeStamp_org.getWidth-1, 1) ) //(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 := true.B
|
||
when( downSendGen.io.stateCurr =/= STATE_IDLE ){
|
||
printf("Error! downSendGen is busy while a Probe-Frame arrival!\n")
|
||
}
|
||
} .elsewhen( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行来了一个嗅探包
|
||
isReadyToProbe := false.B
|
||
} .elsewhen( isWatchDogOverflow ){
|
||
isReadyToProbe := 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 = RegInit(true.B)
|
||
|
||
when( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行来了一个嗅探包
|
||
isLastDevice := false.B
|
||
} .elsewhen( isWatchDogOverflow ){
|
||
isLastDevice := 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 & io.cReg.wdtEnable.extract(0) ){
|
||
probeRecCnt := probeRecCnt + 1.U
|
||
}
|
||
|
||
|
||
when( upRecParser.io.frameReq.fire & upRecParser.io.frameReq.bits.frameStyle === FRAME_STYLE_PROBE ){ //上行来了一个嗅探包
|
||
indexOfRightDev := upRecParser.io.frameReq.bits.frameInfo
|
||
when( upRecParser.io.frameReq.bits.frameInfo =/= localDevIndex + 1.U ){ //索引不对
|
||
isDevOnRightModify := true.B
|
||
} .otherwise{
|
||
isDevOnRightModify := false.B
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
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{
|
||
io.intHWTrig(0) := downRecParser.io.isError
|
||
io.intHWTrig(1) := upRecParser.io.isError
|
||
|
||
downRecParser.io.resp := io.intHWClr(0)
|
||
upRecParser.io.resp := io.intHWClr(1)
|
||
}
|
||
|
||
|
||
|
||
|