2 #include <sys/socket.h>
4 #include <linux/netlink.h>
5 #include <linux/rtnetlink.h>
11 typedef struct _interface_callback_info {
12 void (*callback)(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterface *i, gpointer userdata);
14 struct _interface_callback_info *next;
15 } interface_callback_info;
17 typedef struct _address_callback_info {
18 void (*callback)(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterfaceAddress *i, gpointer userdata);
20 struct _address_callback_info *next;
21 } address_callback_info;
23 struct _flxInterfaceMonitor {
25 GHashTable *hash_table;
26 interface_callback_info *interface_callbacks;
27 address_callback_info *address_callbacks;
28 flxInterface *interfaces;
29 guint query_addr_seq, query_link_seq;
30 enum { LIST_IFACE, LIST_ADDR, LIST_DONE } list;
33 static void run_interface_callbacks(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterface *i) {
34 interface_callback_info *c;
38 for (c = m->interface_callbacks; c; c = c->next) {
39 g_assert(c->callback);
40 c->callback(m, change, i, c->userdata);
44 static void run_address_callbacks(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterfaceAddress *a) {
45 address_callback_info *c;
49 for (c = m->address_callbacks; c; c = c->next) {
50 g_assert(c->callback);
51 c->callback(m, change, a, c->userdata);
55 static void free_address(flxInterfaceMonitor *m, flxInterfaceAddress *a) {
58 g_assert(a->interface);
60 if (a->address.family == AF_INET)
61 a->interface->n_ipv4_addrs --;
62 else if (a->address.family == AF_INET6)
63 a->interface->n_ipv6_addrs --;
66 a->prev->next = a->next;
68 a->interface->addresses = a->next;
71 a->next->prev = a->prev;
76 static void free_interface(flxInterfaceMonitor *m, flxInterface *i) {
81 free_address(m, i->addresses);
83 g_assert(i->n_ipv6_addrs == 0);
84 g_assert(i->n_ipv4_addrs == 0);
87 i->prev->next = i->next;
89 m->interfaces = i->next;
92 i->next->prev = i->prev;
94 g_hash_table_remove(m->hash_table, &i->index);
100 static flxInterfaceAddress* get_address(flxInterfaceMonitor *m, flxInterface *i, const flxAddress *raddr) {
101 flxInterfaceAddress *ia;
107 for (ia = i->addresses; ia; ia = ia->next) {
108 if (flx_address_cmp(&ia->address, raddr) == 0)
115 static int netlink_list_items(flxNetlink *nl, guint16 type, guint *ret_seq) {
117 struct rtgenmsg *gen;
120 memset(&req, 0, sizeof(req));
121 n = (struct nlmsghdr*) req;
122 n->nlmsg_len = NLMSG_LENGTH(sizeof(struct rtgenmsg));
123 n->nlmsg_type = type;
124 n->nlmsg_flags = NLM_F_ROOT|NLM_F_MATCH|NLM_F_REQUEST;
128 memset(gen, 0, sizeof(struct rtgenmsg));
129 gen->rtgen_family = AF_UNSPEC;
131 return flx_netlink_send(nl, n, ret_seq);
134 static void callback(flxNetlink *nl, struct nlmsghdr *n, gpointer userdata) {
135 flxInterfaceMonitor *m = userdata;
139 g_assert(m->netlink == nl);
141 if (n->nlmsg_type == RTM_NEWLINK) {
142 struct ifinfomsg *ifinfomsg = NLMSG_DATA(n);
144 struct rtattr *a = NULL;
148 if (ifinfomsg->ifi_family != AF_UNSPEC)
151 if ((i = (flxInterface*) flx_interface_monitor_get_interface(m, ifinfomsg->ifi_index)))
154 i = g_new(flxInterface, 1);
156 i->index = ifinfomsg->ifi_index;
158 i->n_ipv4_addrs = i->n_ipv6_addrs = 0;
159 if ((i->next = m->interfaces))
163 g_hash_table_insert(m->hash_table, &i->index, i);
167 i->flags = ifinfomsg->ifi_flags;
169 l = NLMSG_PAYLOAD(n, sizeof(struct ifinfomsg));
170 a = IFLA_RTA(ifinfomsg);
172 while (RTA_OK(a, l)) {
173 switch(a->rta_type) {
176 i->name = g_strndup(RTA_DATA(a), RTA_PAYLOAD(a));
186 run_interface_callbacks(m, changed ? FLX_INTERFACE_CHANGE : FLX_INTERFACE_NEW, i);
188 } else if (n->nlmsg_type == RTM_DELLINK) {
189 struct ifinfomsg *ifinfomsg = NLMSG_DATA(n);
191 flxInterfaceAddress *a;
193 if (ifinfomsg->ifi_family != AF_UNSPEC)
196 if (!(i = (flxInterface*) flx_interface_monitor_get_interface(m, ifinfomsg->ifi_index)))
199 for (a = i->addresses; a; a = a->next)
200 run_address_callbacks(m, FLX_INTERFACE_REMOVE, a);
202 run_interface_callbacks(m, FLX_INTERFACE_REMOVE, i);
204 free_interface(m, i);
206 } else if (n->nlmsg_type == RTM_NEWADDR || n->nlmsg_type == RTM_DELADDR) {
208 struct ifaddrmsg *ifaddrmsg = NLMSG_DATA(n);
210 struct rtattr *a = NULL;
216 if (ifaddrmsg->ifa_family != AF_INET && ifaddrmsg->ifa_family != AF_INET6)
219 if (!(i = (flxInterface*) flx_interface_monitor_get_interface(m, ifaddrmsg->ifa_index)))
222 raddr.family = ifaddrmsg->ifa_family;
224 l = NLMSG_PAYLOAD(n, sizeof(struct ifinfomsg));
225 a = IFA_RTA(ifaddrmsg);
227 while (RTA_OK(a, l)) {
228 switch(a->rta_type) {
230 if ((raddr.family == AF_INET6 && RTA_PAYLOAD(a) != 16) ||
231 (raddr.family == AF_INET && RTA_PAYLOAD(a) != 4))
234 memcpy(raddr.data, RTA_DATA(a), RTA_PAYLOAD(a));
250 if (n->nlmsg_type == RTM_NEWADDR) {
251 flxInterfaceAddress *addr;
253 if ((addr = get_address(m, i, &raddr)))
256 addr = g_new(flxInterfaceAddress, 1);
257 addr->address = raddr;
259 if (raddr.family == AF_INET)
261 else if (raddr.family == AF_INET6)
265 if ((addr->next = i->addresses))
266 addr->next->prev = addr;
273 addr->flags = ifaddrmsg->ifa_flags;
274 addr->scope = ifaddrmsg->ifa_scope;
276 run_address_callbacks(m, changed ? FLX_INTERFACE_CHANGE : FLX_INTERFACE_NEW, addr);
278 flxInterfaceAddress *addr;
280 if (!(addr = get_address(m, i, &raddr)))
283 run_address_callbacks(m, FLX_INTERFACE_REMOVE, addr);
284 free_address(m, addr);
287 } else if (n->nlmsg_type == NLMSG_DONE) {
289 if (m->list == LIST_IFACE) {
292 if (netlink_list_items(m->netlink, RTM_GETADDR, &m->query_addr_seq) < 0) {
293 g_warning("NETLINK: Failed to list addrs: %s", strerror(errno));
299 } else if (n->nlmsg_type == NLMSG_ERROR && (n->nlmsg_seq == m->query_link_seq || n->nlmsg_seq == m->query_addr_seq)) {
300 struct nlmsgerr *e = NLMSG_DATA (n);
303 g_warning("NETLINK: Failed to browse: %s", strerror(-e->error));
307 flxInterfaceMonitor *flx_interface_monitor_new(GMainContext *c) {
308 flxInterfaceMonitor *m = NULL;
310 m = g_new0(flxInterfaceMonitor, 1);
311 if (!(m->netlink = flx_netlink_new(c, RTMGRP_LINK|RTMGRP_IPV4_IFADDR|RTMGRP_IPV6_IFADDR, callback, m)))
314 m->hash_table = g_hash_table_new(g_int_hash, g_int_equal);
315 m->interface_callbacks = NULL;
316 m->address_callbacks = NULL;
317 m->interfaces = NULL;
319 if (netlink_list_items(m->netlink, RTM_GETLINK, &m->query_link_seq) < 0)
322 m->list = LIST_IFACE;
327 flx_interface_monitor_free(m);
331 void flx_interface_monitor_free(flxInterfaceMonitor *m) {
335 flx_netlink_free(m->netlink);
338 g_hash_table_destroy(m->hash_table);
340 while (m->interface_callbacks) {
341 interface_callback_info *c = m->interface_callbacks;
342 m->interface_callbacks = c->next;
346 while (m->address_callbacks) {
347 address_callback_info *c = m->address_callbacks;
348 m->address_callbacks = c->next;
356 const flxInterface* flx_interface_monitor_get_interface(flxInterfaceMonitor *m, gint index) {
360 return g_hash_table_lookup(m->hash_table, &index);
363 void flx_interface_monitor_add_interface_callback(
364 flxInterfaceMonitor *m,
365 void (*callback)(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterface *i, gpointer userdata),
368 interface_callback_info *info;
373 info = g_new(interface_callback_info, 1);
374 info->callback = callback;
375 info->userdata = userdata;
376 info->next = m->interface_callbacks;
377 m->interface_callbacks = info;
380 void flx_interface_monitor_remove_interface_callback(
381 flxInterfaceMonitor *m,
382 void (*callback)(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterface *i, gpointer userdata),
385 interface_callback_info *info, *prev;
390 info = m->interface_callbacks;
394 if (info->callback == callback && info->userdata == userdata) {
395 interface_callback_info *c = info;
398 prev->next = c->next;
400 m->interface_callbacks = c->next;
411 void flx_interface_monitor_add_address_callback(
412 flxInterfaceMonitor *m,
413 void (*callback)(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterfaceAddress *a, gpointer userdata),
416 address_callback_info *info;
421 info = g_new(address_callback_info, 1);
422 info->callback = callback;
423 info->userdata = userdata;
424 info->next = m->address_callbacks;
425 m->address_callbacks = info;
429 void flx_interface_monitor_remove_address_callback(
430 flxInterfaceMonitor *m,
431 void (*callback)(flxInterfaceMonitor *m, flxInterfaceChange change, const flxInterfaceAddress *a, gpointer userdata),
434 address_callback_info *info, *prev;
439 info = m->address_callbacks;
443 if (info->callback == callback && info->userdata == userdata) {
444 address_callback_info *c = info;
447 prev->next = c->next;
449 m->address_callbacks = c->next;
461 const flxInterface* flx_interface_monitor_get_first(flxInterfaceMonitor *m) {
463 return m->interfaces;