尝试速率配平,回环改到phy上

This commit is contained in:
Ruige Lee
2025-05-07 18:12:01 +08:00
parent 19f4140dec
commit b55deb239f
6 changed files with 63 additions and 58 deletions

View File

@@ -114,7 +114,7 @@ trait CDRInAxis{ this: CDRInBase =>
val shiftData = Dualb4b5Decoder(checkSFD(9,0)) val shiftData = Dualb4b5Decoder(checkSFD(9,0))
val payloadLen = Reg(UInt(12.W)) val payloadLen = RegInit(0.U(12.W))
when( byteCnt === 0.U & bitCnt === 9.U & stateCurr === STATE_HEADER ){ when( byteCnt === 0.U & bitCnt === 9.U & stateCurr === STATE_HEADER ){
payloadLen := Cat( shiftData, 0.U(4.W) ) payloadLen := Cat( shiftData, 0.U(4.W) )
} .elsewhen( byteCnt === 1.U & bitCnt === 9.U & stateCurr === STATE_HEADER ){ } .elsewhen( byteCnt === 1.U & bitCnt === 9.U & stateCurr === STATE_HEADER ){
@@ -149,8 +149,8 @@ trait CDRInAxis{ this: CDRInBase =>
byteCnt := Mux( byteCnt =/= (HeaderByte-1).U, byteCnt + 1.U, 0.U ) byteCnt := Mux( byteCnt =/= (HeaderByte-1).U, byteCnt + 1.U, 0.U )
assert( byteCnt <= (HeaderByte-1).U ) assert( byteCnt <= (HeaderByte-1).U )
} .elsewhen( stateCurr === STATE_PAYLOAD ){ } .elsewhen( stateCurr === STATE_PAYLOAD ){
byteCnt := Mux( byteCnt =/= (payloadLen-1.U), byteCnt + 1.U, 0.U ) byteCnt := Mux( byteCnt =/= (payloadLen+ (4-1).U), byteCnt + 1.U, 0.U )
assert( byteCnt <= ( payloadLen-1.U ) ) assert( byteCnt <= ( payloadLen+ (4-1).U ) )
} }
} }
@@ -161,7 +161,7 @@ trait CDRInAxis{ this: CDRInBase =>
val axis_valid = RegInit(false.B) val axis_valid = RegInit(false.B)
val axis_tdata = RegEnable( shiftData, bitCnt === 9.U & ( stateCurr === STATE_HEADER | stateCurr === STATE_PAYLOAD ) ) val axis_tdata = RegEnable( shiftData, bitCnt === 9.U & ( stateCurr === STATE_HEADER | stateCurr === STATE_PAYLOAD ) )
val axis_tuser = false.B val axis_tuser = false.B
val axis_tlast = RegNext( (byteCnt === (payloadLen-1.U) ) & (bitCnt === 9.U), false.B ) val axis_tlast = RegNext( stateCurr === STATE_PAYLOAD & stateNext === STATE_IDLE, false.B )
io.axis.valid := axis_valid io.axis.valid := axis_valid
io.axis.bits.tdata := axis_tdata io.axis.bits.tdata := axis_tdata

View File

@@ -72,9 +72,15 @@ abstract class ShinTopBase extends Module{
upCDRIn.io.overCLK := io.clk8x upCDRIn.io.overCLK := io.clk8x
io.dDatOut := downCDROut.io.serDat io.dDatOut := downCDROut.io.serDat
io.uDatOut := upCDROut.io.serDat io.uDatOut := upCDROut.io.serDat
//override
when( slaveParser.io.isLoop & io.modeSel === false.B){
upCDRIn.io.serDat := downCDROut.io.serDat
io.dDatOut := false.B
}
val smUnit = Seq( val smUnit = Seq(
Module( new SMUnit(depth = 4) ), Module( new SMUnit(depth = 4) ),
Module( new SMUnit(depth = 4) ), Module( new SMUnit(depth = 4) ),

View File

@@ -47,6 +47,7 @@ class SlaveParserIO extends Bundle{
val trigAddr = Input( Vec(8, UInt(15.W)) ) val trigAddr = Input( Vec(8, UInt(15.W)) )
val timeStamp = Input(UInt(64.W)) val timeStamp = Input(UInt(64.W))
val isLoop = Output(Bool())
} }
abstract class SlaveParserBase extends Module{ abstract class SlaveParserBase extends Module{
@@ -169,8 +170,8 @@ abstract class SlaveParserBase extends Module{
val downRecFifo = for( _ <- 0 until 2 ) yield { Module(new Queue(UInt(8.W), 16)) } //子报文负载 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), 16)) } val upRecFifo = for( _ <- 0 until 2 ) yield { Module(new Queue(UInt(8.W), 20)) }
val isDownRecPing = RegInit(false.B) val isDownRecPing = RegInit(false.B)
val isUpRecPing = RegInit(false.B) val isUpRecPing = RegInit(false.B)
@@ -620,9 +621,9 @@ trait SlaveParserSync{ this: SlaveParserBase =>
trait SlaveParserProbe{ this: SlaveParserBase => trait SlaveParserProbe{ this: SlaveParserBase =>
val ProbeRecAim = 31.U // val ProbeRecAim = 511.U
val probeRecCnt = RegInit(0.U(5.W)) val probeRecCnt = RegInit(0.U(9.W))
val isWatchDogOverflow = probeRecCnt === ProbeRecAim val isWatchDogOverflow = probeRecCnt.andR
@@ -679,30 +680,20 @@ trait SlaveParserProbe{ this: SlaveParserBase =>
io.upOut <> Queue( upSendGen.io.send, 16, true, false ) io.upOut <> Queue( upSendGen.io.send, 4, true, false )
io.downIn <> downRecParser.io.rec io.downIn <> downRecParser.io.rec
val tmpFifo = Queue( downSendGen.io.send, 16, true, false ) io.downOut <> Queue( downSendGen.io.send, 4, true, false )
when( isLastDevice & ~isReadyToProbe ){ //最后一个设备且不是探测模式 io.upIn <> upRecParser.io.rec
upRecParser.io.rec <> tmpFifo //axis短接
io.downOut.valid := false.B //对外下级io开路 io.isLoop := isLastDevice & ~isReadyToProbe
io.downOut.bits := 0.U.asTypeOf(new AXIS_Bundle(8))
io.upIn.ready := false.B
} .otherwise{
io.downOut <> tmpFifo when( isLastDevice =/= isLastDevice_Pending & ~downSendGen.io.send.valid & ~io.downOut.valid & ~io.upIn.valid ){
io.upIn <> upRecParser.io.rec
}
when( isLastDevice =/= isLastDevice_Pending & ~downSendGen.io.send.valid & ~tmpFifo.valid & ~io.upIn.valid ){
isLastDevice := isLastDevice_Pending isLastDevice := isLastDevice_Pending
} }
when( isReadyToProbe =/= isReadyToProbe_Pending & ~downSendGen.io.send.valid & ~tmpFifo.valid & ~io.upIn.valid ){ when( isReadyToProbe =/= isReadyToProbe_Pending & ~downSendGen.io.send.valid & ~io.downOut.valid & ~io.upIn.valid ){
isReadyToProbe := isReadyToProbe_Pending isReadyToProbe := isReadyToProbe_Pending
} }
} }

View File

@@ -28,14 +28,7 @@ class SlaveRecParser extends Module{
val STATE_IDLE = 0.U //空闲 val STATE_IDLE = 0.U //空闲
val STATE_HEADER = 1.U //长度/ /保留2bits //包类型 val STATE_HEADER = 1.U //长度/ /保留2bits //包类型
val STATE_SUBMSG_HEADER = 2.U //子报文设备索引 //子报文类型
val STATE_SUBMSG_HEADER = 2.U //子报文设备索引 //子报文类型
// val STATE_PAYLOAD_INDEX_STYLE = 2.U //子报文设备索引 //子报文类型
// val STATE_PAYLOAD_ADDR = 3.U //子报文地址
// val STATE_PAYLOAD_OP_LENGTH = 4.U //子报文命令类型 //子报文长度
// val STATE_PAYLOAD_WORKCNT = 5.U //子报文工作计数
val STATE_PAYLOAD_DATA = 3.U //子报文数据 val STATE_PAYLOAD_DATA = 3.U //子报文数据
val STATE_CRC = 4.U //CRC校验 val STATE_CRC = 4.U //CRC校验
val STATE_ERROR = 5.U // val STATE_ERROR = 5.U //
@@ -48,10 +41,12 @@ class SlaveRecParser extends Module{
io.isError := stateCurr === STATE_ERROR io.isError := stateCurr === STATE_ERROR
io.rec.ready := stateCurr =/= STATE_IDLE io.rec.ready := stateCurr =/= STATE_IDLE
crc.io.isEnable := crc.io.isEnable := io.rec.fire & (
stateCurr === STATE_HEADER | stateCurr === STATE_HEADER |
stateCurr === STATE_SUBMSG_HEADER | stateCurr === STATE_SUBMSG_HEADER |
stateCurr === STATE_PAYLOAD_DATA stateCurr === STATE_PAYLOAD_DATA
)
crc.io.dataIn := io.rec.bits.tdata crc.io.dataIn := io.rec.bits.tdata
@@ -60,7 +55,7 @@ class SlaveRecParser extends Module{
val crcData = Reg(UInt(32.W)) val crcData = Reg(UInt(32.W))
val isCrcPass = crc.io.crc === Cat( crcData(23,0), io.rec.bits.tdata ) val isCrcPass = crc.io.crc === Cat( crcData(23,0), io.rec.bits.tdata )
when( stateCurr === STATE_CRC ){ when( io.rec.fire & stateCurr === STATE_CRC ){
crcData := Cat( crcData(23,0), io.rec.bits.tdata ) crcData := Cat( crcData(23,0), io.rec.bits.tdata )
} }

View File

@@ -48,10 +48,12 @@ class SlaveSendGen extends Module{
io.isError := stateCurr === STATE_ERROR io.isError := stateCurr === STATE_ERROR
crc.io.isEnable := crc.io.isEnable := io.send.fire & (
stateCurr === STATE_FRAME_HEADER | stateCurr === STATE_FRAME_HEADER |
stateCurr === STATE_SUBMSG_HEADER | stateCurr === STATE_SUBMSG_HEADER |
stateCurr === STATE_SUBMSG_DATA stateCurr === STATE_SUBMSG_DATA
)
@@ -84,15 +86,18 @@ class SlaveSendGen extends Module{
val lengthCnt = Reg(UInt(12.W)) val lengthCnt = Reg(UInt(12.W))
val frameLenCnt = Reg(UInt(12.W)) val frameLenCnt = Reg(UInt(12.W))
when( stateCurr === STATE_IDLE || stateCurr === STATE_FRAME_HEADER ){ when( io.send.fire ){
frameLenCnt := 0.U when( stateCurr === STATE_FRAME_HEADER ){
} .elsewhen( stateCurr === STATE_SUBMSG_HEADER || stateCurr === STATE_SUBMSG_DATA ){ frameLenCnt := 0.U
frameLenCnt := frameLenCnt + 1.U } .elsewhen( stateCurr === STATE_SUBMSG_HEADER || stateCurr === STATE_SUBMSG_DATA ){
frameLenCnt := frameLenCnt + 1.U
}
} }
when( stateCurr === STATE_IDLE || stateCurr =/= stateNext ){
when( stateCurr =/= stateNext ){
lengthCnt := 0.U lengthCnt := 0.U
} .otherwise{ } .elsewhen(io.send.fire){
lengthCnt := lengthCnt + 1.U lengthCnt := lengthCnt + 1.U
} }
@@ -109,32 +114,34 @@ class SlaveSendGen extends Module{
stateNext := Mux1H(Seq( stateNext := Mux1H(Seq(
(stateCurr === STATE_IDLE) -> Mux( io.frameReq.fire, STATE_FRAME_HEADER, STATE_IDLE ), (stateCurr === STATE_IDLE) -> Mux( io.frameReq.fire, STATE_FRAME_HEADER, STATE_IDLE ),
(stateCurr === STATE_FRAME_HEADER) -> Mux( lengthCnt === (4-1).U, Mux( (stateCurr === STATE_FRAME_HEADER) -> Mux( io.send.fire, Mux( lengthCnt === (4-1).U, Mux(
frameInfo.frameStyle === FRAME_STYLE_COMMON, frameInfo.frameStyle === FRAME_STYLE_COMMON,
Mux(io.subMsgReq.valid, STATE_SUBMSG_HEADER, STATE_ERROR), Mux(io.subMsgReq.valid, STATE_SUBMSG_HEADER, STATE_ERROR),
STATE_CRC ), STATE_CRC ),
STATE_FRAME_HEADER), STATE_FRAME_HEADER), STATE_FRAME_HEADER ),
(stateCurr === STATE_SUBMSG_HEADER) -> Mux( lengthCnt === (8-1).U, STATE_SUBMSG_DATA, STATE_SUBMSG_HEADER), (stateCurr === STATE_SUBMSG_HEADER) -> Mux( io.send.fire, Mux( lengthCnt === (8-1).U, STATE_SUBMSG_DATA, STATE_SUBMSG_HEADER), STATE_SUBMSG_HEADER),
(stateCurr === STATE_SUBMSG_DATA) -> (stateCurr === STATE_SUBMSG_DATA) -> Mux( io.send.fire,
Mux( lengthCnt === subMsgInfoSel.length-1.U, //已经发送完成该子报文 Mux( lengthCnt === subMsgInfoSel.length-1.U, //已经发送完成该子报文
Mux( frameLenCnt === frameInfo.frameLenAim -1.U, STATE_CRC, //主报文长度达到, 进CRC Mux( frameLenCnt === frameInfo.frameLenAim -1.U, STATE_CRC, //主报文长度达到, 进CRC
Mux( io.subMsgReq.valid, STATE_SUBMSG_HEADER, STATE_ERROR ) ), //主报文长度未到,进下一个子报文 Mux( io.subMsgReq.valid, STATE_SUBMSG_HEADER, STATE_ERROR ) ), //主报文长度未到,进下一个子报文
STATE_SUBMSG_DATA STATE_SUBMSG_DATA
), ), STATE_SUBMSG_DATA ),
(stateCurr === STATE_CRC) -> Mux( lengthCnt === (4-1).U, STATE_IDLE, STATE_CRC), (stateCurr === STATE_CRC) -> Mux( io.send.fire, Mux( lengthCnt === (4-1).U, STATE_IDLE, STATE_CRC ), STATE_CRC),
(stateCurr === STATE_ERROR) -> STATE_IDLE, (stateCurr === STATE_ERROR) -> Mux( io.send.fire, STATE_IDLE, STATE_ERROR),
// (stateCurr === STATE_WAIT) ->
)) ))
io.data(0).ready := (stateCurr === STATE_SUBMSG_DATA) & (subMsgInfoSel.source === 0.U) io.data(0).ready := io.send.fire & (stateCurr === STATE_SUBMSG_DATA) & (subMsgInfoSel.source === 0.U)
io.data(1).ready := (stateCurr === STATE_SUBMSG_DATA) & (subMsgInfoSel.source === 1.U) io.data(1).ready := io.send.fire & (stateCurr === STATE_SUBMSG_DATA) & (subMsgInfoSel.source === 1.U)
assert( ~(io.data(0).ready & ~io.data(0).valid) )
assert( ~(io.data(1).ready & ~io.data(1).valid) )
io.send.valid := io.send.valid :=
(stateCurr === STATE_FRAME_HEADER) | (stateCurr === STATE_FRAME_HEADER) |
(stateCurr === STATE_SUBMSG_HEADER) | (stateCurr === STATE_SUBMSG_HEADER) |
(stateCurr === STATE_SUBMSG_DATA) | (stateCurr === STATE_SUBMSG_DATA & ( (io.data(0).valid & subMsgInfoSel.source === 0.U) | (io.data(1).valid & subMsgInfoSel.source === 1.U) )) |
(stateCurr === STATE_CRC) (stateCurr === STATE_CRC)

View File

@@ -453,7 +453,10 @@ initial begin
// 顺序索引 // 顺序索引
#100000 #50000
#50000
#50000
begin begin
@@ -508,7 +511,10 @@ initial begin
//读写 //读写
#100000 #50000
#50000
#50000
begin begin
dataBuf[0] = 8'h20; dataBuf[0] = 8'h20;