使用4b/5b加跳变时钟选择法升级CDR
This commit is contained in:
RuigeLee
@@ -14,6 +14,7 @@ class CDRInIO extends Bundle{
|
||||
|
||||
abstract class CDRInBase extends Module{
|
||||
def sampleRate: Int = 4
|
||||
require( sampleRate == 4 )
|
||||
|
||||
val io: CDRInIO = IO(new CDRInIO)
|
||||
|
||||
@@ -23,25 +24,60 @@ abstract class CDRInBase extends Module{
|
||||
trait CDRInOverSample{ this: CDRInBase =>
|
||||
val sampleReg = withClockAndReset(io.overCLK.asClock, reset.asBool){ ShiftRegisters( RegNext(io.serDat), sampleRate ) }
|
||||
|
||||
val arbShiftData = for( i <- 0 until sampleRate ) yield { RegInit(0.U(24.W)) }
|
||||
val arbSel = Reg(UInt( log2Ceil(sampleRate).W ))
|
||||
val isArbLock = RegInit(false.B)
|
||||
|
||||
for( i <- 0 until sampleRate ){
|
||||
arbShiftData(i) := Cat( arbShiftData(i)(22,0), RegNext(sampleReg(i)) )
|
||||
when( arbShiftData(i) === "h5A5A5A".U & ~isArbLock ){
|
||||
isArbLock := true.B
|
||||
arbSel := i.U
|
||||
}
|
||||
|
||||
// val arbShiftData = for( i <- 0 until sampleRate ) yield { RegInit(0.U(24.W)) }
|
||||
// val arbSel = Reg(UInt( log2Ceil(sampleRate).W ))
|
||||
// val isArbLock = RegInit(false.B)
|
||||
|
||||
// for( i <- 0 until sampleRate ){
|
||||
// arbShiftData(i) := Cat( arbShiftData(i)(22,0), RegNext(sampleReg(i)) )
|
||||
// when( arbShiftData(i) === "h5A5A5A".U & ~isArbLock ){
|
||||
// isArbLock := true.B
|
||||
// arbSel := i.U
|
||||
// }
|
||||
// }
|
||||
|
||||
// when( ( 0 until sampleRate ).map{ i => (arbShiftData(i) === 0.U) }.reduce(_&_) ){
|
||||
// isArbLock := false.B
|
||||
// }
|
||||
|
||||
// val syncSerDat =
|
||||
// Mux1H( (0 until sampleRate).map{ i => (( arbSel === i.U ) -> ShiftRegister( sampleReg(i), 2) ) } )
|
||||
|
||||
val arbCnt = withClockAndReset(io.overCLK.asClock, reset.asBool){ RegInit("b0001".U(sampleRate.W)); arbCnt := Cat( arbCnt << 1, arbCnt.extract(3) ) }
|
||||
val arbLock = withClockAndReset(io.overCLK.asClock, reset.asBool){ Reg(UInt( sampleRate.W )) }
|
||||
when( sampleReg(0) ^ sampleReg(1) ){
|
||||
arbLock := arbCnt
|
||||
}
|
||||
|
||||
when( ( 0 until sampleRate ).map{ i => (arbShiftData(i) === 0.U) }.reduce(_&_) ){
|
||||
isArbLock := false.B
|
||||
}
|
||||
val asyncSerDat = Mux1H(Seq(
|
||||
(arbLock === "b0001".U & arbCnt === "b0001".U) -> sampleReg(3),
|
||||
(arbLock === "b0001".U & arbCnt === "b0010".U) -> sampleReg(0),
|
||||
(arbLock === "b0001".U & arbCnt === "b0100".U) -> sampleReg(1),
|
||||
(arbLock === "b0001".U & arbCnt === "b1000".U) -> sampleReg(2),
|
||||
|
||||
(arbLock === "b0010".U & arbCnt === "b0001".U) -> sampleReg(2),
|
||||
(arbLock === "b0010".U & arbCnt === "b0010".U) -> sampleReg(3),
|
||||
(arbLock === "b0010".U & arbCnt === "b0100".U) -> sampleReg(0),
|
||||
(arbLock === "b0010".U & arbCnt === "b1000".U) -> sampleReg(1),
|
||||
|
||||
(arbLock === "b0100".U & arbCnt === "b0001".U) -> sampleReg(1),
|
||||
(arbLock === "b0100".U & arbCnt === "b0010".U) -> sampleReg(2),
|
||||
(arbLock === "b0100".U & arbCnt === "b0100".U) -> sampleReg(3),
|
||||
(arbLock === "b0100".U & arbCnt === "b1000".U) -> sampleReg(0),
|
||||
|
||||
(arbLock === "b1000".U & arbCnt === "b0001".U) -> sampleReg(0),
|
||||
(arbLock === "b1000".U & arbCnt === "b0010".U) -> sampleReg(1),
|
||||
(arbLock === "b1000".U & arbCnt === "b0100".U) -> sampleReg(2),
|
||||
(arbLock === "b1000".U & arbCnt === "b1000".U) -> sampleReg(3),
|
||||
))
|
||||
|
||||
|
||||
val syncSerDat = ShiftRegister( asyncSerDat, 2 )
|
||||
|
||||
|
||||
|
||||
val syncSerDat =
|
||||
Mux1H( (0 until sampleRate).map{ i => (( arbSel === i.U ) -> ShiftRegister( sampleReg(i), 2) ) } )
|
||||
|
||||
}
|
||||
|
||||
@@ -50,7 +86,7 @@ trait CDRInAxis{ this: CDRInBase =>
|
||||
|
||||
def HeaderByte: Int = 8
|
||||
|
||||
val ETH_PRE = "h5A".U(8.W)
|
||||
val ETH_PRE = "h55".U(8.W)
|
||||
val ETH_SFD = "hD5".U(8.W)
|
||||
|
||||
val STATE_IDLE = 0.U
|
||||
@@ -68,44 +104,46 @@ trait CDRInAxis{ this: CDRInBase =>
|
||||
val crcOut = crcUnit.io.crc
|
||||
val crcCmp = Reg(UInt(32.W))
|
||||
|
||||
val bitCnt = Reg(UInt(3.W))
|
||||
val bitCnt = Reg(UInt(4.W))
|
||||
val byteCnt = RegInit(0.U(12.W))
|
||||
|
||||
val syncSerDat: Bool
|
||||
val checkSFD = RegInit( 0.U(16.W) ); checkSFD := Cat( checkSFD(14,0), syncSerDat )
|
||||
val checkSFD = RegInit( 0.U(20.W) ); checkSFD := Cat( checkSFD(18,0), syncSerDat )
|
||||
|
||||
val shiftData = checkSFD(7,0) //RegInit(0.U(8.W)); shiftData := Cat(shiftData(6,0), syncSerDat)
|
||||
val shiftData = Dualb4b5Decoder(checkSFD(9,0))
|
||||
|
||||
val payloadLen = Reg(UInt(12.W))
|
||||
when( byteCnt === 0.U & bitCnt === 7.U & stateCurr === STATE_HEADER ){
|
||||
when( byteCnt === 0.U & bitCnt === 9.U & stateCurr === STATE_HEADER ){
|
||||
payloadLen := Cat( shiftData, 0.U(4.W) )
|
||||
} .elsewhen( byteCnt === 1.U & bitCnt === 7.U & stateCurr === STATE_HEADER ){
|
||||
} .elsewhen( byteCnt === 1.U & bitCnt === 9.U & stateCurr === STATE_HEADER ){
|
||||
payloadLen := Cat( payloadLen(11,4), shiftData(7,4) )
|
||||
}
|
||||
|
||||
val isArbLock: Bool
|
||||
|
||||
stateNext :=
|
||||
Mux1H(Seq(
|
||||
(stateCurr === STATE_IDLE) -> ( Mux( isArbLock & checkSFD === Cat(ETH_PRE , ETH_SFD), STATE_HEADER, STATE_IDLE )), //IDLE
|
||||
(stateCurr === STATE_HEADER) -> ( Mux( (byteCnt === (HeaderByte-1).U) & (bitCnt === 7.U), STATE_PAYLOAD, STATE_HEADER ) ),
|
||||
(stateCurr === STATE_PAYLOAD) -> ( Mux( (byteCnt === (payloadLen-1.U) ) & (bitCnt === 7.U), STATE_CRC, STATE_PAYLOAD )), // PAYLOAD
|
||||
(stateCurr === STATE_CRC) -> ( Mux( (byteCnt === 3.U) & (bitCnt === 7.U), STATE_IDLE, STATE_CRC )), //CRC
|
||||
(stateCurr === STATE_IDLE) -> ( Mux( checkSFD === Cat(Dualb4b5Encoder(ETH_PRE) , Dualb4b5Encoder(ETH_SFD)), STATE_HEADER, STATE_IDLE )), //IDLE
|
||||
(stateCurr === STATE_HEADER) -> ( Mux( (byteCnt === (HeaderByte-1).U) & (bitCnt === 9.U), STATE_PAYLOAD, STATE_HEADER ) ),
|
||||
(stateCurr === STATE_PAYLOAD) -> ( Mux( (byteCnt === (payloadLen-1.U) ) & (bitCnt === 9.U), STATE_CRC, STATE_PAYLOAD )), // PAYLOAD
|
||||
(stateCurr === STATE_CRC) -> ( Mux( (byteCnt === 3.U) & (bitCnt === 9.U), STATE_IDLE, STATE_CRC )), //CRC
|
||||
))
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
when( stateCurr === STATE_IDLE & isArbLock & checkSFD === Cat(ETH_PRE , ETH_SFD) ){ //first align
|
||||
when( stateCurr === STATE_IDLE & ( checkSFD === Cat(Dualb4b5Encoder(ETH_PRE) , Dualb4b5Encoder(ETH_SFD)) ) ){ //first align
|
||||
bitCnt := 0.U
|
||||
} .otherwise{
|
||||
bitCnt := bitCnt + 1.U
|
||||
} .otherwise{
|
||||
when( bitCnt === 9.U ){
|
||||
bitCnt := 0.U
|
||||
} .otherwise{
|
||||
bitCnt := bitCnt + 1.U
|
||||
}
|
||||
}
|
||||
|
||||
when( stateCurr === STATE_IDLE & isArbLock & checkSFD === Cat(ETH_PRE , ETH_SFD) ){ //first align
|
||||
when( stateCurr === STATE_IDLE & ( checkSFD === Cat(Dualb4b5Encoder(ETH_PRE) , Dualb4b5Encoder(ETH_SFD)) ) ){ //first align
|
||||
byteCnt := 0.U
|
||||
} .elsewhen( bitCnt === 7.U ){
|
||||
} .elsewhen( bitCnt === 9.U ){
|
||||
when( stateCurr === STATE_HEADER ){
|
||||
byteCnt := Mux( byteCnt =/= (HeaderByte-1).U, byteCnt + 1.U, 0.U )
|
||||
assert( byteCnt <= (HeaderByte-1).U )
|
||||
@@ -123,9 +161,9 @@ trait CDRInAxis{ this: CDRInBase =>
|
||||
|
||||
|
||||
val axis_valid = RegInit(false.B)
|
||||
val axis_tdata = RegEnable( shiftData, bitCnt === 7.U & ( stateCurr === STATE_HEADER | stateCurr === STATE_PAYLOAD | stateCurr === STATE_CRC ) )
|
||||
val axis_tuser = RegEnable( stateCurr === STATE_CRC & byteCnt === 3.U & (crcOut =/= ~Cat( shiftData, crcCmp(31,8) )), bitCnt === 7.U )
|
||||
val axis_tlast = RegEnable( stateCurr === STATE_CRC & byteCnt === 3.U, bitCnt === 7.U )
|
||||
val axis_tdata = RegEnable( shiftData, bitCnt === 9.U & ( stateCurr === STATE_HEADER | stateCurr === STATE_PAYLOAD | stateCurr === STATE_CRC ) )
|
||||
val axis_tuser = RegEnable( stateCurr === STATE_CRC & byteCnt === 3.U & (crcOut =/= ~Cat( shiftData, crcCmp(31,8) )), bitCnt === 9.U )
|
||||
val axis_tlast = RegEnable( stateCurr === STATE_CRC & byteCnt === 3.U, bitCnt === 9.U )
|
||||
|
||||
io.axis.valid := axis_valid
|
||||
io.axis.bits.tdata := axis_tdata
|
||||
@@ -135,16 +173,16 @@ trait CDRInAxis{ this: CDRInBase =>
|
||||
|
||||
when( io.axis.fire ){
|
||||
axis_valid := false.B
|
||||
} .elsewhen( bitCnt === 7.U & ( stateCurr === STATE_HEADER | stateCurr === STATE_PAYLOAD | stateCurr === STATE_CRC ) ){
|
||||
} .elsewhen( bitCnt === 9.U & ( stateCurr === STATE_HEADER | stateCurr === STATE_PAYLOAD | stateCurr === STATE_CRC ) ){
|
||||
axis_valid := true.B
|
||||
}
|
||||
|
||||
when( stateCurr === STATE_CRC & bitCnt === 7.U ){
|
||||
when( stateCurr === STATE_CRC & bitCnt === 9.U ){
|
||||
crcCmp := Cat( shiftData, crcCmp(31,8) )
|
||||
}
|
||||
|
||||
|
||||
crcUnit.io.isEnable := ((stateCurr === STATE_HEADER ) | (stateCurr === STATE_PAYLOAD )) & ( bitCnt === 7.U )
|
||||
crcUnit.io.isEnable := ((stateCurr === STATE_HEADER ) | (stateCurr === STATE_PAYLOAD )) & ( bitCnt === 9.U )
|
||||
crcUnit.io.dataIn := shiftData
|
||||
|
||||
crcUnit.reset := reset.asBool | ( stateCurr === STATE_IDLE ) //idle
|
||||
|
||||
Reference in New Issue
Block a user