forked from M-Labs/artiq
1
0
Fork 0

rtio/analyzer: message encoder

This commit is contained in:
Sebastien Bourdeauducq 2015-12-14 00:37:08 +08:00
parent eac2e2ad0b
commit b5f2e178f6
2 changed files with 141 additions and 0 deletions

View File

@ -1,2 +1,3 @@
from artiq.gateware.rtio.core import Channel, RTIO
from artiq.gateware.rtio.analyzer import Analyzer
from artiq.gateware.rtio.moninj import MonInj

View File

@ -0,0 +1,140 @@
from migen import *
from migen.genlib.record import Record, layout_len
from misoc.interconnect.csr import *
__all__ = ["Analyzer"]
input_output_layout = [
("message_type", 2),
("channel", 30),
("timestamp", 64),
("rtio_counter", 64),
("address_padding", 32),
("data", 64)
]
exception_layout = [
("message_type", 2),
("channel", 30),
("padding", 64),
("rtio_counter", 64),
("exception_type", 8),
("padding", 88)
]
assert layout_len(input_output_layout) == 256
assert layout_len(exception_layout) == 256
class MessageTypes(AutoCSR):
def __init__(self):
self.output = CSRConstant(0b00)
self.input = CSRConstant(0b01)
self.exception = CSRConstant(0b10)
class ExceptionTypes(AutoCSR):
def __init__(self):
self.reset_rising = CSRConstant(0b000000)
self.reset_falling = CSRConstant(0b000001)
self.reset_phy_rising = CSRConstant(0b000010)
self.reset_phy_falling = CSRConstant(0b000011)
self.o_underflow_reset = CSRConstant(0b010000)
self.o_sequence_error_reset = CSRConstant(0b010001)
self.o_collision_error_reset = CSRConstant(0b010010)
self.i_overflow_reset = CSRConstant(0b100000)
class MessageEncoder(Module, AutoCSR):
def __init__(self, rtio_core):
self.message = Signal(256)
self.stb = Signal()
self.message_types = MessageTypes()
self.exception_types = ExceptionTypes()
# # #
kcsrs = rtio_core.kcsrs
input_output_stb = Signal()
input_output = Record(input_output_layout)
if hasattr(kcsrs, "o_data"):
o_data = kcsrs.o_data.storage
else:
o_data = 0
if hasattr(kcsrs, "o_address"):
o_address = kcsrs.o_address.storage
else:
o_address = 0
if hasattr(kcsrs, "i_data"):
i_data = kcsrs.i_data
else:
i_data = 0
self.comb += [
input_output.channel.eq(kcsrs.chan_sel.storage),
input_output.address_padding.eq(o_address),
input_output.rtio_counter.eq(
rtio_core.counter.value_sys << rtio_core.fine_ts_width),
If(kcsrs.o_we.re,
input_output.message_type.eq(self.message_types.output.value),
input_output.timestamp.eq(kcsrs.o_timestamp.storage),
input_output.data.eq(o_data)
).Else(
input_output.message_type.eq(self.message_types.input.value),
input_output.timestamp.eq(kcsrs.i_timestamp.status),
input_output.data.eq(i_data)
),
input_output_stb.eq(kcsrs.o_we.re | kcsrs.i_re.re)
]
exception_stb = Signal()
exception = Record(exception_layout)
self.comb += [
exception.message_type.eq(self.message_types.exception.value),
exception.channel.eq(kcsrs.chan_sel.storage),
exception.rtio_counter.eq(
rtio_core.counter.value_sys << rtio_core.fine_ts_width),
]
for ename in ("o_underflow_reset", "o_sequence_error_reset",
"o_collision_error_reset", "i_overflow_reset"):
self.comb += \
If(getattr(kcsrs, ename).re,
exception_stb.eq(1),
exception.exception_type.eq(
getattr(self.exception_types, ename).value)
)
for rname in "reset", "reset_phy":
r_d = Signal()
r = getattr(kcsrs, rname).storage
self.sync += r_d.eq(r)
self.comb += [
If(r & ~r_d,
exception_stb.eq(1),
exception.exception_type.eq(
getattr(self.exception_types, rname+"_rising").value)
),
If(~r & r_d,
exception_stb.eq(1),
exception.exception_type.eq(
getattr(self.exception_types, rname+"_falling").value)
)
]
self.sync += [
If(exception_stb,
self.message.eq(exception.raw_bits())
).Else(
self.message.eq(input_output.raw_bits())
),
self.stb.eq(input_output_stb | exception_stb)
]
class Analyzer(Module):
def __init__(self, rtio_core):
pass