drtio: rt_packet_satellite CRI fixes

This commit is contained in:
Sebastien Bourdeauducq 2018-09-11 22:19:55 +08:00
parent 051bafbfd9
commit 41972d6773
1 changed files with 28 additions and 8 deletions

View File

@ -79,18 +79,25 @@ class RTPacketSatellite(Module):
] ]
# RX FSM # RX FSM
read = Signal() cri_read = Signal()
cri_buffer_space = Signal()
self.comb += [ self.comb += [
self.tsc_load_value.eq( self.tsc_load_value.eq(
rx_dp.packet_as["set_time"].timestamp), rx_dp.packet_as["set_time"].timestamp),
If(load_read_request | read_request_pending, If(cri_read | read_request_pending,
self.cri.chan_sel.eq( self.cri.chan_sel.eq(
rx_dp.packet_as["read_request"].chan_sel), rx_dp.packet_as["read_request"].chan_sel),
self.cri.timestamp.eq( ).Elif(cri_buffer_space,
rx_dp.packet_as["read_request"].timeout) self.cri.chan_sel.eq(
rx_dp.packet_as["buffer_space_request"].destination << 16)
).Else( ).Else(
self.cri.chan_sel.eq( self.cri.chan_sel.eq(
rx_dp.packet_as["write"].chan_sel), rx_dp.packet_as["write"].chan_sel),
),
If(cri_read | read_request_pending,
self.cri.timestamp.eq(
rx_dp.packet_as["read_request"].timeout)
).Else(
self.cri.timestamp.eq( self.cri.timestamp.eq(
rx_dp.packet_as["write"].timestamp) rx_dp.packet_as["write"].timestamp)
), ),
@ -139,8 +146,7 @@ class RTPacketSatellite(Module):
rx_fsm.act("WRITE", rx_fsm.act("WRITE",
If(write_data_buffer_cnt == rx_dp.packet_as["write"].extra_data_cnt, If(write_data_buffer_cnt == rx_dp.packet_as["write"].extra_data_cnt,
self.cri.cmd.eq(cri.commands["write"]), NextState("WRITE_CMD")
NextState("INPUT")
).Else( ).Else(
write_data_buffer_load.eq(1), write_data_buffer_load.eq(1),
If(~rx_dp.frame_r, If(~rx_dp.frame_r,
@ -149,7 +155,17 @@ class RTPacketSatellite(Module):
) )
) )
) )
rx_fsm.act("WRITE_CMD",
self.cri.cmd.eq(cri.commands["write"]),
NextState("INPUT")
)
rx_fsm.act("BUFFER_SPACE_REQUEST", rx_fsm.act("BUFFER_SPACE_REQUEST",
cri_buffer_space.eq(1),
NextState("BUFFER_SPACE_REQUEST_CMD")
)
rx_fsm.act("BUFFER_SPACE_REQUEST_CMD",
cri_buffer_space.eq(1),
self.cri.cmd.eq(cri.commands["get_buffer_space"]), self.cri.cmd.eq(cri.commands["get_buffer_space"]),
NextState("BUFFER_SPACE") NextState("BUFFER_SPACE")
) )
@ -158,8 +174,7 @@ class RTPacketSatellite(Module):
If(timeout_counter.done, If(timeout_counter.done,
self.buffer_space_timeout.eq(1), self.buffer_space_timeout.eq(1),
NextState("INPUT") NextState("INPUT")
), ).Elif(self.cri.o_buffer_space_valid,
If(self.cri.o_buffer_space_valid,
buffer_space_set.eq(1), buffer_space_set.eq(1),
buffer_space_update.eq(1), buffer_space_update.eq(1),
NextState("INPUT") NextState("INPUT")
@ -167,7 +182,12 @@ class RTPacketSatellite(Module):
) )
rx_fsm.act("READ_REQUEST", rx_fsm.act("READ_REQUEST",
cri_read.eq(1),
NextState("READ_REQUEST_CMD")
)
rx_fsm.act("READ_REQUEST_CMD",
load_read_request.eq(1), load_read_request.eq(1),
cri_read.eq(1),
self.cri.cmd.eq(cri.commands["read"]), self.cri.cmd.eq(cri.commands["read"]),
NextState("INPUT") NextState("INPUT")
) )