mctpd: implement routing table polling

conf/mctpd.conf

@@ -5,6 +5,9 @@ mode = "bus-owner"
 [mctp]
 message_timeout_ms = 30
 
+# Delay between each Get Routing Table message.
+routing_table_polling_interval_ms = 1000
+
 # Specify a UUID: not generally required - mctpd will query the system UUID
 # where available.
 # uuid = "21f0f554-7f7c-4211-9ca1-6d0f000ea9e7"

meson.build

@@ -60,11 +60,13 @@ toml_dep = declare_dependency(
 executable('mctp',
     sources: ['src/mctp.c'] + netlink_sources + util_sources + ops_sources,
     install: true,
+    c_args: ['-DHAVE_LIBSYSTEMD=0'],
 )
 
 mctp_test = executable('test-mctp',
     sources: ['src/mctp.c'] + netlink_sources + util_sources + test_ops_sources,
     include_directories:  include_directories('src'),
+    c_args: ['-DHAVE_LIBSYSTEMD=0'],
 )
 
 executable('mctp-req',
@@ -92,6 +94,7 @@ if libsystemd.found()
         dependencies: [libsystemd, toml_dep],
         install: true,
         install_dir: get_option('sbindir'),
+        c_args: ['-DHAVE_LIBSYSTEMD=1'],
     )
 
     mctpd_test = executable('test-mctpd',
@@ -100,6 +103,7 @@ if libsystemd.found()
         ] + test_ops_sources + netlink_sources + util_sources,
         include_directories:  include_directories('src'),
         dependencies: [libsystemd, toml_dep],
+        c_args: ['-DHAVE_LIBSYSTEMD=1'],
     )
 endif
 

src/mctp-control-spec.h

@@ -413,3 +413,11 @@ enum mctp_phys_binding {
 	MCTP_PHYS_BINDING_UCIE = 0x09,
 	MCTP_PHYS_BINDING_VENDOR = 0xFF,
 };
+
+#define MCTP_GET_ROUTING_TABLE_MSG_PHYSICAL_ADDRESS(entryh) \
+	((void *)((char *)(entryh) + sizeof(struct get_routing_table_entry)))
+#define MCTP_GET_ROUTING_TABLE_MSG_NEXT(entryh)               \
+	((struct get_routing_table_entry                      \
+		  *)((char *)(entryh) +                       \
+		     sizeof(struct get_routing_table_entry) + \
+		     (entryh)->phys_address_size))

src/mctp-ops.c

@@ -9,6 +9,9 @@
 
 #include <unistd.h>
 #include <linux/netlink.h>
+#if HAVE_LIBSYSTEMD
+#include <systemd/sd-event.h>
+#endif
 #include <err.h>
 
 #include "mctp.h"
@@ -74,6 +77,12 @@ const struct mctp_ops mctp_ops = {
 		.recvfrom = mctp_op_recvfrom,
 		.close = mctp_op_close,
 	},
+#if HAVE_LIBSYSTEMD
+	.sd_event = {
+		.add_time_relative = sd_event_add_time_relative,
+		.source_set_time_relative = sd_event_source_set_time_relative,
+	},
+#endif
 	.bug_warn = mctp_bug_warn,
 };
 

src/mctp-ops.h

@@ -7,6 +7,7 @@
  */
 #pragma once
 
+#include <stdint.h>
 #include <sys/socket.h>
 #include <stdarg.h>
 
@@ -24,9 +25,23 @@ struct socket_ops {
 	int (*close)(int sd);
 };
 
+struct sd_event;
+struct sd_event_source;
+struct sd_event_ops {
+	int (*add_time_relative)(struct sd_event *e,
+				 struct sd_event_source **ret, clockid_t clock,
+				 uint64_t usec, uint64_t accuracy,
+				 int (*callback)(struct sd_event_source *s,
+						 uint64_t usec, void *userdata),
+				 void *userdata);
+	int (*source_set_time_relative)(struct sd_event_source *s,
+					uint64_t usec);
+};
+
 struct mctp_ops {
 	struct socket_ops mctp;
 	struct socket_ops nl;
+	struct sd_event_ops sd_event;
 	void (*bug_warn)(const char *fmt, va_list args);
 };