Hardware
/
litex
mirror of https://github.com/enjoy-digital/litex.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

transport: merge cmd and data Sink/Source, will be easier

This commit is contained in:
Florent Kermarrec 2014-12-12 14:31:00 +01:00
parent 9ae703efbe
commit b9a9e075fd
3 changed files with 70 additions and 85 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
lib/sata/std.py
View File

@ -48,7 +48,7 @@ def link_layout(dw):
]
return EndpointDescription(layout, packetized=True)
def transport_cmd_tx_layout():
def transport_tx_layout(dw):
layout = [
("type", 8),
("pm_port", 4),
@ -66,10 +66,11 @@ def transport_cmd_tx_layout():
("dma_buffer_id", 64),
("dma_buffer_offset", 32),
("dma_transfer_count", 32),
("data", dw)
]
return EndpointDescription(layout, packetized=False)
return EndpointDescription(layout, packetized=True)
def transport_cmd_rx_layout():
def transport_rx_layout(dw):
layout = [
("type", 8),
("pm_port", 4),
@ -85,12 +86,7 @@ def transport_cmd_rx_layout():
("transfer_count", 16),
("dma_buffer_id", 64),
("dma_buffer_offset", 32),
("dma_transfer_count", 32)
]
return EndpointDescription(layout, packetized=False)
def transport_data_layout(dw):
layout = [
("d", dw)
("dma_transfer_count", 32),
("data", dw)
]
return EndpointDescription(layout, packetized=True)

39
lib/sata/test/transport_tb.py
View File

@ -21,32 +21,35 @@ class TB(Module):
def gen_simulation(self, selfp):
for i in range(100):
yield
selfp.transport.tx.cmd.stb = 1
selfp.transport.tx.cmd.type = fis_types["REG_H2D"]
selfp.transport.tx.cmd.lba = 0x0123456789
selfp.transport.sink.stb = 1
selfp.transport.sink.sop = 1
selfp.transport.sink.eop = 1
selfp.transport.sink.type = fis_types["REG_H2D"]
selfp.transport.sink.lba = 0x0123456789
yield
while selfp.transport.tx.cmd.ack == 0:
while selfp.transport.sink.ack == 0:
yield
selfp.transport.tx.cmd.stb = 1
selfp.transport.tx.cmd.type = fis_types["DMA_SETUP"]
selfp.transport.tx.cmd.dma_buffer_id = 0x0123456789ABCDEF
selfp.transport.sink.stb = 1
selfp.transport.sink.sop = 1
selfp.transport.sink.eop = 1
selfp.transport.sink.type = fis_types["DMA_SETUP"]
selfp.transport.sink.dma_buffer_id = 0x0123456789ABCDEF
yield
while selfp.transport.tx.cmd.ack == 0:
while selfp.transport.sink.ack == 0:
yield
selfp.transport.tx.cmd.stb = 1
selfp.transport.tx.cmd.type = fis_types["DATA"]
yield
for i in range(32):
selfp.transport.tx.data.stb = 1
#selfp.transport.tx.data.sop = (i==0)
selfp.transport.tx.data.eop = (i==31)
selfp.transport.tx.data.d = i
if selfp.transport.tx.data.ack == 1:
selfp.transport.sink.stb = 1
selfp.transport.sink.sop = (i==0)
selfp.transport.sink.eop = (i==31)
selfp.transport.sink.type = fis_types["DATA"]
selfp.transport.sink.data = i
if selfp.transport.sink.ack == 1:
yield
else:
while selfp.transport.tx.data.ack == 0:
while selfp.transport.sink.ack == 0:
yield
selfp.transport.tx.cmd.stb = 0
selfp.transport.sink.stb = 0
if __name__ == "__main__":
run_simulation(TB(), ncycles=512, vcd_name="my.vcd", keep_files=True)

100
lib/sata/transport/__init__.py
View File

@ -20,8 +20,7 @@ def _encode_cmd(obj, layout, signal):
class SATATransportLayerTX(Module):
def __init__(self, link):
self.cmd = cmd = Sink(transport_cmd_tx_layout())
self.data = data = Sink(transport_data_layout(32))
self.sink = sink = Sink(transport_tx_layout(32))
###
@ -38,17 +37,16 @@ class SATATransportLayerTX(Module):
cmd_send = Signal()
data_send = Signal()
cmd_done = Signal()
data_done = Signal()
def test_type(name):
return cmd.type == fis_types[name]
return sink.type == fis_types[name]
fsm = FSM(reset_state="IDLE")
self.submodules += fsm
fsm.act("IDLE",
clr_cnt.eq(1),
If(cmd.stb,
If(sink.stb & sink.sop,
If(test_type("REG_H2D"),
NextState("SEND_REG_H2D_CMD")
).Elif(test_type("DMA_SETUP"),
@ -56,29 +54,32 @@ class SATATransportLayerTX(Module):
).Elif(test_type("DATA"),
NextState("SEND_DATA_CMD")
).Else(
# XXX: Generate error to command layer?
cmd.ack.eq(1)
sink.ack.eq(1)
)
).Else(
sink.ack.eq(1)
)
)
fsm.act("SEND_REG_H2D_CMD",
_encode_cmd(self.cmd, fis_reg_h2d_layout, encoded_cmd),
_encode_cmd(sink, fis_reg_h2d_layout, encoded_cmd),
cmd_len.eq(fis_reg_h2d_cmd_len),
cmd_send.eq(1),
If(cmd_done,
NextState("ACK")
sink.ack.eq(1),
NextState("IDLE")
)
)
fsm.act("SEND_DMA_SETUP_CMD",
_encode_cmd(self.cmd, fis_dma_setup_layout, encoded_cmd),
_encode_cmd(sink, fis_dma_setup_layout, encoded_cmd),
cmd_len.eq(fis_dma_setup_cmd_len),
cmd_send.eq(1),
If(cmd_done,
NextState("ACK")
sink.ack.eq(1),
NextState("IDLE")
)
)
fsm.act("SEND_DATA_CMD",
_encode_cmd(self.cmd, fis_data_layout, encoded_cmd),
_encode_cmd(sink, fis_data_layout, encoded_cmd),
cmd_len.eq(fis_data_cmd_len),
cmd_with_data.eq(1),
cmd_send.eq(1),
@ -88,14 +89,12 @@ class SATATransportLayerTX(Module):
)
fsm.act("SEND_DATA",
data_send.eq(1),
If(data_done,
NextState("ACK")
sink.ack.eq(link.sink.ack),
If(sink.stb & sink.eop & sink.ack,
NextState("IDLE")
)
)
fsm.act("ACK",
cmd.ack.eq(1),
NextState("IDLE")
)
cmd_cases = {}
for i in range(cmd_ndwords):
@ -110,12 +109,10 @@ class SATATransportLayerTX(Module):
inc_cnt.eq(link.sink.ack),
cmd_done.eq(cnt==cmd_len)
).Elif(data_send,
link.sink.stb.eq(data.stb),
link.sink.stb.eq(sink.stb),
link.sink.sop.eq(0),
link.sink.eop.eq(data.eop),
link.sink.d.eq(data.d),
data.ack.eq(link.sink.ack),
data_done.eq(data.eop & data.ack)
link.sink.eop.eq(sink.eop),
link.sink.d.eq(sink.data),
)
self.sync += \
@ -141,8 +138,7 @@ def _decode_cmd(signal, layout, obj):
class SATATransportLayerRX(Module):
def __init__(self, link):
self.cmd = cmd = Source(transport_cmd_rx_layout())
self.data = data = Source(transport_data_layout(32))
self.source = source = Source(transport_rx_layout(32))
###
@ -195,9 +191,9 @@ class SATATransportLayerRX(Module):
)
)
fsm.act("PRESENT_REG_D2H_CMD",
cmd.stb.eq(1),
_decode_cmd(encoded_cmd, fis_reg_d2h_layout ,cmd),
If(cmd.ack,
source.stb.eq(1),
_decode_cmd(encoded_cmd, fis_reg_d2h_layout, source),
If(source.ack,
NextState("IDLE")
)
)
@ -209,9 +205,9 @@ class SATATransportLayerRX(Module):
)
)
fsm.act("PRESENT_DMA_ACTIVATE_D2H_CMD",
cmd.stb.eq(1),
_decode_cmd(encoded_cmd, fis_dma_activate_d2h_layout ,cmd),
If(cmd.ack,
source.stb.eq(1),
_decode_cmd(encoded_cmd, fis_dma_activate_d2h_layout, source),
If(source.ack,
NextState("IDLE")
)
)
@ -223,9 +219,9 @@ class SATATransportLayerRX(Module):
)
)
fsm.act("PRESENT_DMA_SETUP_CMD",
cmd.stb.eq(1),
_decode_cmd(encoded_cmd, fis_pio_setup_d2h_layout ,cmd),
If(cmd.ack,
source.stb.eq(1),
_decode_cmd(encoded_cmd, fis_pio_setup_d2h_layout, source),
If(source.ack,
NextState("IDLE")
)
)
@ -233,19 +229,17 @@ class SATATransportLayerRX(Module):
cmd_len.eq(fis_data_cmd_len),
cmd_receive.eq(1),
If(cmd_done,
NextState("RECEIVE_DATA")
NextState("PRESENT_DATA")
)
)
fsm.act("RECEIVE_DATA",
fsm.act("PRESENT_DATA",
data_receive.eq(1),
If(data_done,
NextState("PRESENT_DATA_CMD")
)
)
fsm.act("PRESENT_DATA_CMD",
cmd.stb.eq(1),
_decode_cmd(encoded_cmd, fis_data_layout ,cmd),
If(cmd.ack,
source.stb.eq(link.source.stb),
_decode_cmd(encoded_cmd, fis_data_layout, source),
source.sop.eq(0), # XXX
source.eop.eq(link.source.eop),
source.d.eq(link.source.d),
If(source.stb & source.eop & source.ack,
NextState("IDLE")
)
)
@ -257,9 +251,9 @@ class SATATransportLayerRX(Module):
)
)
fsm.act("PRESENT_PIO_SETUP_D2H_CMD",
cmd.stb.eq(1),
_decode_cmd(encoded_cmd, fis_pio_setup_d2h_layout ,cmd),
If(cmd.ack,
source.stb.eq(1),
_decode_cmd(encoded_cmd, fis_pio_setup_d2h_layout, source),
If(source.ack,
NextState("IDLE")
)
)
@ -278,18 +272,10 @@ class SATATransportLayerRX(Module):
)
)
self.comb += cmd_done.eq(cnt==cmd_len)
self.comb += \
If(data_receive,
data.stb.eq(link.source.stb),
data.sop.eq(0), # XXX
data.eop.eq(link.source.eop),
data.d.eq(link.source.d),
data_done.eq(link.source.stb & link.source.eop)
)
self.comb += link.source.ack.eq(cmd_receive | (data_receive & data.ack))
self.comb += link.source.ack.eq(cmd_receive | (data_receive & source.ack))
class SATATransportLayer(Module):
def __init__(self, link):
self.submodules.tx = SATATransportLayerTX(link)
self.submodules.rx = SATATransportLayerRX(link)
self.sink, self.source = self.tx.sink, self.rx.source