Files
eb001/src/main/scala/backBoard/shin/SlaveRecParser.scala

209 lines
7.3 KiB
Scala
Raw Normal View History

2025-04-07 17:39:44 +08:00
package BACK
import chisel3._
import chisel3.util._
class SlaveRecParserIO extends Bundle{
2025-04-07 17:39:44 +08:00
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)
val STATE_IDLE = 0.U //空闲
val STATE_HEADER = 1.U //长度/ /保留2bits //包类型
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 = 6.U //子报文数据
val STATE_CRC = 7.U //CRC校验
val STATE_ERROR = 8.U //
val STATE_WAIT = 9.U
val stateNext = Wire(UInt(4.W)); io.stateNext := stateNext
val stateCurr = RegNext(stateNext, STATE_IDLE); io.stateCurr := stateCurr
io.isError := stateCurr === STATE_ERROR
2025-04-14 16:43:10 +08:00
io.rec.ready := stateCurr =/= STATE_IDLE
2025-04-09 17:29:57 +08:00
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(23,0), io.rec.bits.tdata )
2025-04-09 17:29:57 +08:00
when( stateCurr === STATE_CRC ){
crcData := Cat( crcData(23,0), io.rec.bits.tdata )
2025-04-09 17:29:57 +08:00
}
2025-04-07 17:39:44 +08:00
val FRAME_STYLE_COMMON = 0.U
val FRAME_STYLE_PROBE = 1.U
2025-04-07 17:39:44 +08:00
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 //接收长度小于预期
2025-04-29 17:48:57 +08:00
io.frameReq.valid := (stateCurr === STATE_HEADER) & (stateNext =/= STATE_HEADER)
2025-04-14 16:43:10 +08:00
val frameHeader = Reg(new FrameHeader)
io.frameReq.bits.frameLenAim := frameHeader.frameLenAim
2025-04-24 17:31:44 +08:00
io.frameReq.bits.frameStyle := frameHeader.frameStyle
io.frameReq.bits.frameInfo := frameHeader.frameInfo | io.rec.bits.tdata
2025-04-09 17:29:57 +08:00
io.subMsgReq.valid := (stateCurr === STATE_PAYLOAD_WORKCNT) & (stateNext === STATE_PAYLOAD_DATA)
2025-04-14 16:43:10 +08:00
val subMsgHeader = Reg(new SubMsgHeader)
io.subMsgReq.bits.devIndex := subMsgHeader.devIndex
io.subMsgReq.bits.style := subMsgHeader.style
io.subMsgReq.bits.address := subMsgHeader.address
io.subMsgReq.bits.operator := subMsgHeader.operator
io.subMsgReq.bits.length := subMsgHeader.length
io.subMsgReq.bits.workCnt := subMsgHeader.workCnt | io.rec.bits.tdata(7,0)
2025-04-09 17:29:57 +08:00
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.tdata
2025-04-14 16:43:10 +08:00
assert( ~(io.data.valid & ~io.data.ready), "Assert Failed! Receive Data was rejected by fifo!" )
2025-04-09 17:29:57 +08:00
2025-04-07 17:39:44 +08:00
when( stateCurr === STATE_HEADER & lengthCnt === 0.U ){
frameHeader.frameLenAim := io.rec.bits.tdata << 4
2025-04-07 17:39:44 +08:00
} .elsewhen( stateCurr === STATE_HEADER & lengthCnt === 1.U ){
frameHeader.frameLenAim := frameHeader.frameLenAim | io.rec.bits.tdata(7,4)
frameHeader.frameStyle := io.rec.bits.tdata(1,0)
2025-04-22 17:32:05 +08:00
} .elsewhen( stateCurr === STATE_HEADER & lengthCnt === 2.U ){
frameHeader.frameInfo := io.rec.bits.tdata << 8
} .elsewhen( stateCurr === STATE_HEADER & lengthCnt === 3.U ){
frameHeader.frameInfo := frameHeader.frameInfo | io.rec.bits.tdata
2025-04-07 17:39:44 +08:00
}
when( stateCurr === STATE_PAYLOAD_INDEX_STYLE & lengthCnt === 0.U ){
subMsgHeader.devIndex := io.rec.bits.tdata << 6
2025-04-07 17:39:44 +08:00
} .elsewhen( stateCurr === STATE_PAYLOAD_INDEX_STYLE & lengthCnt === 1.U ){
subMsgHeader.devIndex := subMsgHeader.devIndex | io.rec.bits.tdata(7,2)
subMsgHeader.style := io.rec.bits.tdata(1,0)
2025-04-07 17:39:44 +08:00
}
when( stateCurr === STATE_PAYLOAD_ADDR & lengthCnt === 0.U ){
subMsgHeader.address := io.rec.bits.tdata << 8
2025-04-07 17:39:44 +08:00
} .elsewhen( stateCurr === STATE_PAYLOAD_ADDR & lengthCnt === 1.U ){
subMsgHeader.address := subMsgHeader.address | io.rec.bits.tdata
2025-04-07 17:39:44 +08:00
}
when( stateCurr === STATE_PAYLOAD_OP_LENGTH & lengthCnt === 0.U ){
subMsgHeader.operator := io.rec.bits.tdata(7,4)
subMsgHeader.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 ){
subMsgHeader.length := subMsgHeader.length | io.rec.bits.tdata(7,0)
2025-04-07 17:39:44 +08:00
}
when( stateCurr === STATE_PAYLOAD_WORKCNT & lengthCnt === 0.U ){
subMsgHeader.workCnt := io.rec.bits.tdata(7,0) << 8
2025-04-07 17:39:44 +08:00
} .elsewhen( stateCurr === STATE_PAYLOAD_WORKCNT & lengthCnt === 1.U ){
subMsgHeader.workCnt := subMsgHeader.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.valid, STATE_HEADER, STATE_IDLE ),
2025-04-07 17:39:44 +08:00
( stateCurr === STATE_HEADER ) -> Mux( isShortRx, STATE_ERROR,
2025-04-22 17:32:05 +08:00
Mux( lengthCnt =/= (4-1).U, STATE_HEADER,
2025-04-07 17:39:44 +08:00
MuxCase( STATE_ERROR, Array(
2025-04-29 17:48:57 +08:00
( frameHeader.frameStyle === FRAME_STYLE_COMMON ) -> STATE_PAYLOAD_INDEX_STYLE,
( frameHeader.frameStyle === FRAME_STYLE_PROBE ) -> STATE_CRC,
2025-04-07 17:39:44 +08:00
))
)
),
( stateCurr === STATE_PAYLOAD_INDEX_STYLE ) -> Mux( isShortRx, STATE_ERROR,
Mux( lengthCnt === 0.U, STATE_PAYLOAD_INDEX_STYLE, STATE_PAYLOAD_ADDR )
2025-04-07 17:39:44 +08:00
),
( stateCurr === STATE_PAYLOAD_ADDR ) -> Mux( isShortRx, STATE_ERROR,
Mux( lengthCnt === 0.U, STATE_PAYLOAD_ADDR, STATE_PAYLOAD_OP_LENGTH )
2025-04-07 17:39:44 +08:00
),
( stateCurr === STATE_PAYLOAD_OP_LENGTH ) -> Mux( isShortRx, STATE_ERROR,
Mux( lengthCnt === 0.U, STATE_PAYLOAD_OP_LENGTH, STATE_PAYLOAD_WORKCNT )
2025-04-07 17:39:44 +08:00
),
( 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 === ( subMsgHeader.length - 1.U),
2025-04-14 16:43:10 +08:00
Mux( frameLenCnt === frameHeader.frameLenAim - 1.U, STATE_CRC, STATE_PAYLOAD_INDEX_STYLE
2025-04-07 17:39:44 +08:00
), 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
))
}