forked from M-Labs/artiq
parent
f8e6b4f4e3
commit
e8d4db1ccf
|
@ -344,6 +344,55 @@ class SPIMasterHandler(WishboneHandler):
|
||||||
raise ValueError("bad address %d", address)
|
raise ValueError("bad address %d", address)
|
||||||
|
|
||||||
|
|
||||||
|
class SPIMaster2Handler(WishboneHandler):
|
||||||
|
def __init__(self, vcd_manager, name):
|
||||||
|
self._reads = []
|
||||||
|
self.channels = {}
|
||||||
|
with vcd_manager.scope("spi2/{}".format(name)):
|
||||||
|
self.stb = vcd_manager.get_channel("{}/{}".format(name, "stb"), 1)
|
||||||
|
for reg_name, reg_width in [
|
||||||
|
("flags", 8),
|
||||||
|
("length", 5),
|
||||||
|
("div", 8),
|
||||||
|
("chip_select", 8),
|
||||||
|
("write", 32),
|
||||||
|
("read", 32)]:
|
||||||
|
self.channels[reg_name] = vcd_manager.get_channel(
|
||||||
|
"{}/{}".format(name, reg_name), reg_width)
|
||||||
|
|
||||||
|
def process_message(self, message):
|
||||||
|
self.stb.set_value("1")
|
||||||
|
self.stb.set_value("0")
|
||||||
|
data = message.data
|
||||||
|
if isinstance(message, OutputMessage):
|
||||||
|
address = message.address
|
||||||
|
if address == 1:
|
||||||
|
logger.debug("SPI config @%d data=0x%08x",
|
||||||
|
message.timestamp, data)
|
||||||
|
self.channels["chip_select"].set_value(
|
||||||
|
"{:08b}".format(data >> 24))
|
||||||
|
self.channels["div"].set_value(
|
||||||
|
"{:08b}".format(data >> 16 & 0xff))
|
||||||
|
self.channels["length"].set_value(
|
||||||
|
"{:08b}".format(data >> 8 & 0x1f))
|
||||||
|
self.channels["flags"].set_value(
|
||||||
|
"{:08b}".format(data & 0xff))
|
||||||
|
elif address == 0:
|
||||||
|
logger.debug("SPI write @%d data=0x%08x",
|
||||||
|
message.timestamp, data)
|
||||||
|
self.channels["write"].set_value("{:032b}".format(data))
|
||||||
|
else:
|
||||||
|
raise ValueError("bad address", address)
|
||||||
|
# process untimed reads and insert them here
|
||||||
|
while self._reads[0].rtio_counter < message.timestamp:
|
||||||
|
read = self._reads.pop(0)
|
||||||
|
logger.debug("SPI read @%d data=0x%08x",
|
||||||
|
read.rtio_counter, read.data)
|
||||||
|
self.channels["read"].set_value("{:032b}".format(read.data))
|
||||||
|
elif isinstance(message, InputMessage):
|
||||||
|
self._reads.append(message)
|
||||||
|
|
||||||
|
|
||||||
def _extract_log_chars(data):
|
def _extract_log_chars(data):
|
||||||
r = ""
|
r = ""
|
||||||
for i in range(4):
|
for i in range(4):
|
||||||
|
@ -448,6 +497,11 @@ def create_channel_handlers(vcd_manager, devices, ref_period,
|
||||||
channel = desc["arguments"]["channel"]
|
channel = desc["arguments"]["channel"]
|
||||||
channel_handlers[channel] = SPIMasterHandler(
|
channel_handlers[channel] = SPIMasterHandler(
|
||||||
vcd_manager, name)
|
vcd_manager, name)
|
||||||
|
if (desc["module"] == "artiq.coredevice.spi2" and
|
||||||
|
desc["class"] == "SPIMaster"):
|
||||||
|
channel = desc["arguments"]["channel"]
|
||||||
|
channel_handlers[channel] = SPIMaster2Handler(
|
||||||
|
vcd_manager, name)
|
||||||
return channel_handlers
|
return channel_handlers
|
||||||
|
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue