litex/misoclib/liteeth/core/etherbone/record.py

177 lines
5.4 KiB
Python
Raw Normal View History

from misoclib.liteeth.common import *
from misoclib.liteeth.generic import *
from misoclib.liteeth.generic.depacketizer import LiteEthDepacketizer
from misoclib.liteeth.generic.packetizer import LiteEthPacketizer
class LiteEthEtherboneRecordPacketizer(LiteEthPacketizer):
def __init__(self):
LiteEthPacketizer.__init__(self,
eth_etherbone_record_description(32),
2015-02-11 12:37:59 -05:00
eth_etherbone_packet_user_description(32),
etherbone_record_header,
etherbone_record_header_len)
2015-02-11 12:37:59 -05:00
class LiteEthEtherboneRecordDepacketizer(LiteEthDepacketizer):
def __init__(self):
LiteEthDepacketizer.__init__(self,
eth_etherbone_packet_user_description(32),
eth_etherbone_record_description(32),
etherbone_record_header,
etherbone_record_header_len)
class LiteEthEtherboneRecordReceiver(Module):
2015-02-11 19:12:52 -05:00
def __init__(self, buffer_depth=256):
self.sink = sink = Sink(eth_etherbone_record_description(32))
2015-02-11 19:12:52 -05:00
self.source = source = Source(eth_etherbone_mmap_description(32))
###
2015-02-11 19:12:52 -05:00
fifo = SyncFIFO(eth_etherbone_record_description(32), buffer_depth, buffered=True)
self.submodules += fifo
self.comb += Record.connect(sink, fifo.sink)
2015-02-11 12:37:59 -05:00
self.submodules.base_addr = base_addr = FlipFlop(32)
2015-02-12 06:33:52 -05:00
self.comb += base_addr.d.eq(fifo.source.data)
2015-02-11 12:37:59 -05:00
self.submodules.counter = counter = Counter(max=512)
self.submodules.fsm = fsm = FSM(reset_state="IDLE")
fsm.act("IDLE",
2015-02-11 19:12:52 -05:00
fifo.source.ack.eq(1),
2015-02-11 12:37:59 -05:00
counter.reset.eq(1),
2015-02-11 19:12:52 -05:00
If(fifo.source.stb & fifo.source.sop,
2015-02-11 12:37:59 -05:00
base_addr.ce.eq(1),
2015-02-11 19:12:52 -05:00
If(fifo.source.wcount,
NextState("RECEIVE_WRITES")
2015-02-11 19:12:52 -05:00
).Elif(fifo.source.rcount,
2015-02-11 12:37:59 -05:00
NextState("RECEIVE_READS")
)
)
)
2015-02-11 12:37:59 -05:00
fsm.act("RECEIVE_WRITES",
2015-02-11 19:12:52 -05:00
source.stb.eq(fifo.source.stb),
source.sop.eq(counter.value == 0),
source.eop.eq(counter.value == fifo.source.wcount-1),
source.count.eq(fifo.source.wcount),
source.be.eq(fifo.source.byte_enable),
2015-02-16 17:37:08 -05:00
source.addr.eq(base_addr.q[2:] + counter.value),
2015-02-11 19:12:52 -05:00
source.we.eq(1),
source.data.eq(fifo.source.data),
fifo.source.ack.eq(source.ack),
If(source.stb & source.ack,
2015-02-11 12:37:59 -05:00
counter.ce.eq(1),
2015-02-11 19:12:52 -05:00
If(source.eop,
If(fifo.source.rcount,
2015-02-11 12:37:59 -05:00
NextState("RECEIVE_BASE_RET_ADDR")
).Else(
NextState("IDLE")
)
)
)
)
fsm.act("RECEIVE_BASE_RET_ADDR",
counter.reset.eq(1),
2015-02-11 19:12:52 -05:00
If(fifo.source.stb & fifo.source.sop,
2015-02-11 12:37:59 -05:00
base_addr.ce.eq(1),
NextState("RECEIVE_READS")
)
)
fsm.act("RECEIVE_READS",
2015-02-11 19:12:52 -05:00
source.stb.eq(fifo.source.stb),
source.sop.eq(counter.value == 0),
source.eop.eq(counter.value == fifo.source.rcount-1),
source.count.eq(fifo.source.rcount),
source.base_addr.eq(base_addr.q),
2015-02-16 17:37:08 -05:00
source.addr.eq(fifo.source.data[2:]),
2015-02-11 19:12:52 -05:00
fifo.source.ack.eq(source.ack),
If(source.stb & source.ack,
2015-02-11 12:37:59 -05:00
counter.ce.eq(1),
2015-02-11 19:12:52 -05:00
If(source.eop,
2015-02-11 12:37:59 -05:00
NextState("IDLE")
)
)
)
2015-02-11 12:37:59 -05:00
class LiteEthEtherboneRecordSender(Module):
2015-02-11 19:12:52 -05:00
def __init__(self, buffer_depth=256):
self.sink = sink = Sink(eth_etherbone_mmap_description(32))
self.source = source = Source(eth_etherbone_record_description(32))
###
2015-02-11 19:12:52 -05:00
pbuffer = PacketBuffer(eth_etherbone_mmap_description(32), buffer_depth)
self.submodules += pbuffer
self.comb += Record.connect(sink, pbuffer.sink)
2015-02-11 12:37:59 -05:00
self.submodules.fsm = fsm = FSM(reset_state="IDLE")
fsm.act("IDLE",
2015-02-11 19:12:52 -05:00
pbuffer.source.ack.eq(1),
If(pbuffer.source.stb & pbuffer.source.sop,
pbuffer.source.ack.eq(0),
2015-02-11 12:37:59 -05:00
NextState("SEND_BASE_ADDRESS")
)
)
2015-02-11 12:37:59 -05:00
self.comb += [
2015-02-11 19:12:52 -05:00
source.byte_enable.eq(pbuffer.source.be),
If(pbuffer.source.we,
source.wcount.eq(pbuffer.source.count)
).Else(
source.rcount.eq(pbuffer.source.count)
)
2015-02-11 12:37:59 -05:00
]
fsm.act("SEND_BASE_ADDRESS",
2015-02-11 19:12:52 -05:00
source.stb.eq(pbuffer.source.stb),
2015-02-11 12:37:59 -05:00
source.sop.eq(1),
source.eop.eq(0),
2015-02-11 19:12:52 -05:00
source.data.eq(pbuffer.source.base_addr),
2015-02-11 12:37:59 -05:00
If(source.ack,
NextState("SEND_DATA")
)
)
2015-02-11 12:37:59 -05:00
fsm.act("SEND_DATA",
2015-02-11 19:12:52 -05:00
source.stb.eq(pbuffer.source.stb),
2015-02-11 12:37:59 -05:00
source.sop.eq(0),
2015-02-11 19:12:52 -05:00
source.eop.eq(pbuffer.source.eop),
source.data.eq(pbuffer.source.data),
If(source.stb & source.ack,
2015-02-11 19:12:52 -05:00
pbuffer.source.ack.eq(1),
If(source.eop,
NextState("IDLE")
)
)
)
2015-02-11 19:12:52 -05:00
# Limitation: For simplicity we only support 1 record per packet
class LiteEthEtherboneRecord(Module):
2015-02-11 19:12:52 -05:00
def __init__(self, endianness="big"):
self.sink = sink = Sink(eth_etherbone_packet_user_description(32))
self.source = source = Sink(eth_etherbone_packet_user_description(32))
###
2015-02-11 19:12:52 -05:00
# receive record, decode it and generate mmap stream
2015-02-11 12:37:59 -05:00
self.submodules.depacketizer = depacketizer = LiteEthEtherboneRecordDepacketizer()
self.submodules.receiver = receiver = LiteEthEtherboneRecordReceiver()
self.comb += [
Record.connect(sink, depacketizer.sink),
2015-02-11 19:12:52 -05:00
Record.connect(depacketizer.source, receiver.sink)
2015-02-11 12:37:59 -05:00
]
2015-02-11 19:12:52 -05:00
if endianness is "big":
self.comb += receiver.sink.data.eq(reverse_bytes(depacketizer.source.data))
2015-02-11 12:37:59 -05:00
2015-02-11 19:12:52 -05:00
# save last ip address
last_ip_address = Signal(32)
self.sync += [
If(sink.stb & sink.sop & sink.ack,
2015-02-11 19:12:52 -05:00
last_ip_address.eq(sink.ip_address)
)
]
# receive mmap stream, encode it and send records
2015-02-11 12:37:59 -05:00
self.submodules.sender = sender = LiteEthEtherboneRecordSender()
self.submodules.packetizer = packetizer = LiteEthEtherboneRecordPacketizer()
self.comb += [
Record.connect(sender.source, packetizer.sink),
Record.connect(packetizer.source, source),
2015-02-12 07:24:35 -05:00
source.length.eq(sender.source.wcount*4 + 4 +etherbone_record_header_len), # XXX improve this
2015-02-11 19:12:52 -05:00
source.ip_address.eq(last_ip_address)
2015-02-11 12:37:59 -05:00
]
2015-02-11 19:12:52 -05:00
if endianness is "big":
self.comb += packetizer.sink.data.eq(reverse_bytes(sender.source.data))