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

View File

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

View File

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

View File

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