2025-04-07 17:39:44 +08:00
|
|
|
package BACK
|
|
|
|
|
|
|
|
|
|
import chisel3._
|
|
|
|
|
import chisel3.util._
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
class SlaveRecParserIO extends Module{
|
|
|
|
|
val rec = Flipped( Decoupled(new AXIS_Bundle(8)) )
|
|
|
|
|
|
|
|
|
|
val data = Decoupled(UInt(8.W))
|
|
|
|
|
|
|
|
|
|
val stateNext = Output(UInt(4.W))
|
|
|
|
|
val stateCurr = Output(UInt(4.W))
|
|
|
|
|
|
2025-04-08 17:29:45 +08:00
|
|
|
val frameReq = Valid( new FrameHeader )
|
|
|
|
|
val subMsgReq = Valid( new SubMsgHeader )
|
2025-04-07 17:39:44 +08:00
|
|
|
|
2025-04-08 17:29:45 +08:00
|
|
|
val resp = Input(Bool())
|
|
|
|
|
val isError = Output(Bool())
|
2025-04-07 17:39:44 +08:00
|
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
class SlaveRecParser extends Module{
|
|
|
|
|
val io: SlaveRecParserIO = IO(new SlaveRecParserIO)
|
|
|
|
|
|
2025-04-09 17:29:57 +08:00
|
|
|
val crc = Module(new crc32_8)
|
|
|
|
|
|
|
|
|
|
crc.io.isEnable :=
|
|
|
|
|
stateCurr === STATE_HEADER |
|
|
|
|
|
stateCurr === STATE_PAYLOAD_INDEX_STYLE |
|
|
|
|
|
stateCurr === STATE_PAYLOAD_ADDR |
|
|
|
|
|
stateCurr === STATE_PAYLOAD_OP_LENGTH |
|
|
|
|
|
stateCurr === STATE_PAYLOAD_WORKCNT |
|
|
|
|
|
stateCurr === STATE_PAYLOAD_DATA
|
|
|
|
|
|
|
|
|
|
crc.io.dataIn := io.rec.bits.tdata
|
|
|
|
|
|
|
|
|
|
crc.reset := reset.asBool | stateCurr === STATE_IDLE
|
|
|
|
|
|
|
|
|
|
val crcData = Reg(UInt(32.W))
|
|
|
|
|
val isCrcPass = crc.io.crc === Cat( crcData << 8, io.rec.bits.tdata )
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_CRC ){
|
|
|
|
|
crcData := Cat( crcData << 8, io.rec.bits.tdata )
|
|
|
|
|
}
|
2025-04-07 17:39:44 +08:00
|
|
|
|
|
|
|
|
val FRAME_STYLE_COMMON = 0.U
|
|
|
|
|
val FRAME_STYLE_PROBE = 1.U
|
|
|
|
|
|
|
|
|
|
|
2025-04-09 17:29:57 +08:00
|
|
|
val STATE_IDLE = 0.U //空闲
|
|
|
|
|
val STATE_HEADER = 1.U //长度/ /保留2bits //包类型
|
|
|
|
|
val STATE_PAYLOAD_INDEX_STYLE = 2.U //子报文设备索引 //子报文类型
|
|
|
|
|
val STATE_PAYLOAD_ADDR = 3.U //子报文地址
|
2025-04-07 17:39:44 +08:00
|
|
|
val STATE_PAYLOAD_OP_LENGTH = 4.U //子报文命令类型 //子报文长度
|
2025-04-09 17:29:57 +08:00
|
|
|
val STATE_PAYLOAD_WORKCNT = 5.U //子报文工作计数
|
|
|
|
|
val STATE_PAYLOAD_DATA = 6.U //子报文数据
|
|
|
|
|
val STATE_CRC = 7.U //CRC校验
|
|
|
|
|
val STATE_ERROR = 8.U //
|
|
|
|
|
val STATE_WAIT = 9.U
|
2025-04-07 17:39:44 +08:00
|
|
|
|
|
|
|
|
|
|
|
|
|
val stateNext = Wire(UInt(4.W)); io.stateNext := stateNext
|
|
|
|
|
val stateCurr = RegNext(stateNext, STATE_IDLE(4.W)); io.stateCurr := stateCurr
|
|
|
|
|
|
|
|
|
|
val lengthCnt = Reg(UInt(11.W)) //动态计数器
|
|
|
|
|
val frameLenCnt = Reg(UInt(12.W)) //帧长度计数
|
|
|
|
|
|
|
|
|
|
|
2025-04-09 17:29:57 +08:00
|
|
|
|
|
|
|
|
val isShortRx = ~io.rec.valid //接收长度小于预期
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
val frameLenAim = Reg(UInt(12.W)); io.frameReq.bits.frameLenAim := frameLenAim //帧长度目标
|
|
|
|
|
val frameStyle = Reg(UInt(2.W)); io.frameReq.bits.frameStyle := frameStyle //包类型
|
|
|
|
|
io.frameReq.valid := (stateCurr === STATE_HEADER) & (stateNext === STATE_PAYLOAD_INDEX_STYLE)
|
|
|
|
|
|
|
|
|
|
val devIndex = Reg(UInt(14.W)); io.subMsgReq.bits.devIndex := devIndex // 子报文中设备索引
|
|
|
|
|
val style = Reg(UInt(2.W)); io.subMsgReq.bits.style := style // 子报文类型
|
|
|
|
|
val address = Reg(UInt(16.W)); io.subMsgReq.bits.address := address //子报文地址
|
|
|
|
|
val operator = Reg(UInt(4.W)); io.subMsgReq.bits.operator := operator //子报文命令类型
|
|
|
|
|
val length = Reg(UInt(12.W)); io.subMsgReq.bits.length := length //子报文负载长度
|
|
|
|
|
val workCnt = Reg(UInt(16.W)); io.subMsgReq.bits.workCnt := workCnt //子报文工作计数
|
|
|
|
|
io.subMsgReq.valid := (stateCurr === STATE_PAYLOAD_WORKCNT) & (stateNext === STATE_PAYLOAD_DATA)
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_IDLE ){
|
|
|
|
|
lengthCnt := 0.U
|
|
|
|
|
} .elsewhen( stateCurr =/= stateNext ){
|
|
|
|
|
lengthCnt := 0.U
|
|
|
|
|
} .otherwise{
|
|
|
|
|
lengthCnt := lengthCnt + 1.U
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_IDLE || stateCurr === STATE_HEADER ){
|
|
|
|
|
frameLenCnt := 0.U
|
|
|
|
|
} .elsewhen(
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_INDEX_STYLE ) ||
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_ADDR ) ||
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_OP_LENGTH ) ||
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_WORKCNT ) ||
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_DATA )
|
|
|
|
|
){
|
|
|
|
|
frameLenCnt := frameLenCnt + 1.U
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
io.data.valid := stateCurr === STATE_PAYLOAD_DATA
|
|
|
|
|
io.data.bits := io.rec.bits
|
|
|
|
|
assert( ~(io.data.valid & ~io.data.ready), "Assert Failed! Receive Data was recected by fifo!" )
|
|
|
|
|
|
|
|
|
|
|
2025-04-07 17:39:44 +08:00
|
|
|
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_HEADER & lengthCnt === 0.U ){
|
|
|
|
|
frameLenAim := io.rec.bits.tdata << 4
|
|
|
|
|
} .elsewhen( stateCurr === STATE_HEADER & lengthCnt === 1.U ){
|
|
|
|
|
frameLenAim := frameLenAim | io.rec.bits.tdata(7,4)
|
|
|
|
|
frameStyle := io.rec.bits.tdata(1,0)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_PAYLOAD_INDEX_STYLE & lengthCnt === 0.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
devIndex := io.rec.bits.tdata << 6
|
2025-04-07 17:39:44 +08:00
|
|
|
} .elsewhen( stateCurr === STATE_PAYLOAD_INDEX_STYLE & lengthCnt === 1.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
devIndex := devIndex | io.rec.bits.tdata(7,2)
|
|
|
|
|
style := io.rec.bits.tdata(1,0)
|
2025-04-07 17:39:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_PAYLOAD_ADDR & lengthCnt === 0.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
address := io.rec.bits.tdata << 8
|
2025-04-07 17:39:44 +08:00
|
|
|
} .elsewhen( stateCurr === STATE_PAYLOAD_ADDR & lengthCnt === 1.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
address := address | io.rec.bits.tdata
|
2025-04-07 17:39:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_PAYLOAD_OP_LENGTH & lengthCnt === 0.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
operator := io.rec.bits.tdata(7,4)
|
|
|
|
|
length := io.rec.bits.tdata(3,0) << 8
|
2025-04-07 17:39:44 +08:00
|
|
|
} .elsewhen( stateCurr === STATE_PAYLOAD_OP_LENGTH & lengthCnt === 1.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
length := length | io.rec.bits.tdata(7,0)
|
2025-04-07 17:39:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
when( stateCurr === STATE_PAYLOAD_WORKCNT & lengthCnt === 0.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
workCnt := io.rec.bits.tdata(7,0) << 8
|
2025-04-07 17:39:44 +08:00
|
|
|
} .elsewhen( stateCurr === STATE_PAYLOAD_WORKCNT & lengthCnt === 1.U ){
|
2025-04-08 17:29:45 +08:00
|
|
|
workCnt := workCnt | io.rec.bits.tdata(7,0)
|
2025-04-07 17:39:44 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
stateNext :=
|
|
|
|
|
Mux1H(Seq(
|
|
|
|
|
//必须使用上升沿触发,以避免前一帧长度超过预期
|
|
|
|
|
( stateCurr === STATE_IDLE ) -> Mux( ~RegNext(io.rec.valid) & io.rec.axis.valid, STATE_HEADER, STATE_IDLE ),
|
|
|
|
|
( stateCurr === STATE_HEADER ) -> Mux( isShortRx, STATE_ERROR,
|
|
|
|
|
Mux( lengthCnt === 0, STATE_HEADER,
|
|
|
|
|
MuxCase( STATE_ERROR, Array(
|
|
|
|
|
( io.rec.bits(1,0) === FRAME_STYLE_COMMON ) -> STATE_PAYLOAD_INDEX_STYLE,
|
|
|
|
|
( io.rec.bits(1,0) === FRAME_STYLE_PROBE ) -> STATE_CRC,
|
|
|
|
|
))
|
|
|
|
|
)
|
|
|
|
|
),
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_INDEX_STYLE ) -> Mux( isShortRx, STATE_ERROR,
|
|
|
|
|
Mux( lengthCnt === 0, STATE_PAYLOAD_INDEX_STYLE, STATE_PAYLOAD_ADDR )
|
|
|
|
|
),
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_ADDR ) -> Mux( isShortRx, STATE_ERROR,
|
|
|
|
|
Mux( lengthCnt === 0, STATE_PAYLOAD_ADDR, STATE_PAYLOAD_OP_LENGTH )
|
|
|
|
|
),
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_OP_LENGTH ) -> Mux( isShortRx, STATE_ERROR,
|
|
|
|
|
Mux( lengthCnt === 0, STATE_PAYLOAD_OP_LENGTH, STATE_PAYLOAD_WORKCNT )
|
|
|
|
|
),
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_WORKCNT ) -> Mux( isShortRx, STATE_ERROR,
|
|
|
|
|
Mux( lengthCnt === 0.U, STATE_PAYLOAD_WORKCNT, STATE_PAYLOAD_DATA )
|
|
|
|
|
),
|
|
|
|
|
( stateCurr === STATE_PAYLOAD_DATA ) -> Mux( isShortRx, STATE_ERROR,
|
|
|
|
|
Mux( lengthCnt === ( subMsgLen - 1.U),
|
|
|
|
|
Mux( frameLenCnt === frameLenAim, STATE_CRC, STATE_PAYLOAD_INDEX_STYLE
|
|
|
|
|
), STATE_PAYLOAD_DATA )
|
|
|
|
|
),
|
2025-04-09 17:29:57 +08:00
|
|
|
( stateCurr === STATE_CRC ) ->
|
|
|
|
|
Mux( lengthCnt === (4 - 1).U, Mux( isCrcPass, STATE_IDLE, STATE_ERROR), Mux( isShortRx, STATE_ERROR, STATE_CRC ) ),
|
2025-04-08 17:29:45 +08:00
|
|
|
( stateCurr === STATE_ERROR ) -> Mux( io.resp, STATE_IDLE, STATE_ERROR ),
|
2025-04-09 17:29:57 +08:00
|
|
|
( stateCurr === STATE_WAIT ) -> Mux( io.resp, STATE_IDLE, STATE_WAIT )
|
2025-04-07 17:39:44 +08:00
|
|
|
))
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|