afk.epic: Enum for EPICSubtype & service init v2

Consistently use an enum for EPICSubtype (used later) and support the v2
EPICService intializer protocol used by AOP.

Signed-off-by: Eileen Yoon <eyn@gmx.com>
This commit is contained in:
Eileen Yoon 2024-01-23 19:03:44 +09:00 committed by Hector Martin
parent bf5a3a6e98
commit 6426bdf6a5

View file

@ -23,6 +23,12 @@ EPICCategory = "EPICCategory" / Enum(Int8ul,
COMMAND = 0x30, COMMAND = 0x30,
) )
EPICSubtype = "EPICSubtype" / Enum(Int16ul,
ANNOUNCE = 0x30,
TEARDOWN = 0x32,
STD_SERVICE = 0xc0,
)
EPICHeader = Struct( EPICHeader = Struct(
"channel" / Int32ul, "channel" / Int32ul,
"type" / EPICType, "type" / EPICType,
@ -37,18 +43,30 @@ EPICSubHeader = Struct(
"length" / Int32ul, "length" / Int32ul,
"version" / Default(Int8ul, 4), "version" / Default(Int8ul, 4),
"category" / EPICCategory, "category" / EPICCategory,
"type" / Hex(Int16ul), "type" / EPICSubtype,
"timestamp" / Default(Int64ul, 0), "timestamp" / Default(Int64ul, 0),
"seq" / Int16ul, "seq" / Int16ul,
"unk" / Default(Hex(Int16ul), 0), "unk" / Default(Hex(Int16ul), 0),
"inline_len" / Hex(Int32ul), "inline_len" / Hex(Int32ul),
) )
# dcp's announce
EPICAnnounce = Struct( EPICAnnounce = Struct(
"name" / Padded(32, CString("utf8")), "name" / Padded(32, CString("utf8")),
"props" / Optional(OSSerialize()) "props" / Optional(OSSerialize())
) )
# aop's announce
EPICServiceAnnounce = Struct(
"name" / Padded(20, CString("utf8")),
"unk1" / Hex(Int32ul),
"retcode" / Hex(Int32ul), # 0xE00002C2
"unk3" / Hex(Int32ul),
"channel" / Hex(Int32ul),
"unk5" / Hex(Int32ul),
"unk6" / Hex(Int32ul),
)
EPICSetProp = Struct( EPICSetProp = Struct(
"name_len" / Int32ul, "name_len" / Int32ul,
"name" / Aligned(4, CString("utf8")), "name" / Aligned(4, CString("utf8")),
@ -80,17 +98,17 @@ class EPICService:
self.ready = False self.ready = False
self.chan = None self.chan = None
self.seq = 0 self.seq = 0
def log(self, msg): def log(self, msg):
print(f"[{self.ep.name}.{self.SHORT}] {msg}") print(f"[{self.ep.name}.{self.SHORT}] {msg}")
def init(self, props): def init(self, props):
self.log(f"Init: {props}") self.log(f"Init: {props}")
self.props = props self.props = props
self.rxbuf, self.rxbuf_dva = self.ep.asc.ioalloc(self.RX_BUFSIZE) self.rxbuf, self.rxbuf_dva = self.ep.asc.ioalloc(self.RX_BUFSIZE)
self.txbuf, self.txbuf_dva = self.ep.asc.ioalloc(self.TX_BUFSIZE) self.txbuf, self.txbuf_dva = self.ep.asc.ioalloc(self.TX_BUFSIZE)
self.ready = True self.ready = True
def wait(self): def wait(self):
while not self.ready: while not self.ready:
self.ep.asc.work() self.ep.asc.work()
@ -234,7 +252,7 @@ class EPICEndpoint(AFKRingBufEndpoint):
self.asc.work() self.asc.work()
def handle_report(self, hdr, sub, fd): def handle_report(self, hdr, sub, fd):
if sub.type == 0x30: if sub.type == EPICSubtype.ANNOUNCE: # dcp's announce
init = EPICAnnounce.parse_stream(fd) init = EPICAnnounce.parse_stream(fd)
if init.props is None: if init.props is None:
init.props = {} init.props = {}
@ -253,6 +271,22 @@ class EPICEndpoint(AFKRingBufEndpoint):
self.log(f"New service: {key} on channel {hdr.channel} (short name: {short})") self.log(f"New service: {key} on channel {hdr.channel} (short name: {short})")
else: else:
self.log(f"Unknown service {key} on channel {hdr.channel}") self.log(f"Unknown service {key} on channel {hdr.channel}")
elif sub.type == EPICSubtype.STD_SERVICE: # aop's announce
props = EPICServiceAnnounce.parse_stream(fd)
name = props.name
key = props.name
chan = props.channel # aop uses channel parsed from prop, not from header
if name in self.serv_names:
srv = self.serv_names[name](self)
short = srv.SHORT # aop has no EPICUnit stuff
#setattr(self, short, srv)
srv.init(props)
srv.chan = chan
self.chan_map[chan] = srv
self.serv_map[key] = srv
self.log(f"New service: {key} on channel {chan} (short name: {short})")
else:
self.log(f"Unknown service {key} on channel {chan}")
else: else:
if hdr.channel not in self.chan_map: if hdr.channel not in self.chan_map:
self.log(f"Ignoring report on channel {hdr.channel}") self.log(f"Ignoring report on channel {hdr.channel}")
@ -267,7 +301,7 @@ class EPICEndpoint(AFKRingBufEndpoint):
def handle_cmd(self, hdr, sub, fd): def handle_cmd(self, hdr, sub, fd):
self.chan_map[hdr.channel].handle_cmd(sub.category, sub.type, sub.seq, fd) self.chan_map[hdr.channel].handle_cmd(sub.category, sub.type, sub.seq, fd)
def send_epic(self, chan, ptype, category, type, seq, data, inline_len=0): def send_epic(self, chan, ptype, category, type, seq, data, inline_len=0):
hdr = Container() hdr = Container()
hdr.channel = chan hdr.channel = chan