diff options
| -rw-r--r-- | sysdep/linux/netlink/netlink.c | 150 |
1 files changed, 126 insertions, 24 deletions
diff --git a/sysdep/linux/netlink/netlink.c b/sysdep/linux/netlink/netlink.c index 539686e0..e9b98869 100644 --- a/sysdep/linux/netlink/netlink.c +++ b/sysdep/linux/netlink/netlink.c @@ -12,6 +12,7 @@ #include <net/if.h> #include <sys/socket.h> #include <sys/uio.h> +#include <errno.h> #define LOCAL_DEBUG @@ -75,17 +76,15 @@ nl_open(void) } static void -nl_send(void *rq, int size) +nl_send(struct nlmsghdr *nh) { - struct nlmsghdr *nh = rq; struct sockaddr_nl sa; memset(&sa, 0, sizeof(sa)); sa.nl_family = AF_NETLINK; - nh->nlmsg_len = size; nh->nlmsg_pid = 0; nh->nlmsg_seq = ++nl_sync_seq; - if (sendto(nl_sync_fd, rq, size, 0, (struct sockaddr *)&sa, sizeof(sa)) < 0) + if (sendto(nl_sync_fd, nh, nh->nlmsg_len, 0, (struct sockaddr *)&sa, sizeof(sa)) < 0) die("rtnetlink sendto: %m"); nl_last_hdr = NULL; } @@ -98,9 +97,10 @@ nl_request_dump(int cmd) struct rtgenmsg g; } req; req.nh.nlmsg_type = cmd; + req.nh.nlmsg_len = sizeof(req); req.nh.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP; req.g.rtgen_family = PF_INET; - nl_send(&req, sizeof(req)); + nl_send(&req.nh); } static struct nlmsghdr * @@ -144,14 +144,22 @@ nl_get_reply(void) } } -static char * +static int nl_error(struct nlmsghdr *h) { - struct nlmsgerr *e = NLMSG_DATA(h); + struct nlmsgerr *e; + int ec; + if (h->nlmsg_len < NLMSG_LENGTH(sizeof(struct nlmsgerr))) - return "Error message truncated"; - else - return strerror(-e->error); + { + log(L_WARN "Netlink: Truncated error message received"); + return ENOBUFS; + } + e = (struct nlmsgerr *) NLMSG_DATA(h); + ec = -e->error; + if (ec) + log(L_WARN "Netlink: %s", strerror(ec)); /* FIXME: Shut up? */ + return ec; } static struct nlmsghdr * @@ -163,14 +171,30 @@ nl_get_scan(void) return NULL; if (h->nlmsg_type == NLMSG_ERROR) { - log(L_ERR "Netlink error: %s", nl_error(h)); + nl_error(h); return NULL; } return h; } +static int +nl_exchange(struct nlmsghdr *pkt) +{ + struct nlmsghdr *h; + + nl_send(pkt); + for(;;) + { + h = nl_get_reply(); + if (h->nlmsg_type == NLMSG_ERROR) + break; + log(L_WARN "nl_exchange: Unexpected reply received"); + } + return nl_error(h); +} + /* - * Parsing of Netlink attributes + * Netlink attributes */ static int nl_attr_len; @@ -207,6 +231,37 @@ nl_parse_attrs(struct rtattr *a, struct rtattr **k, int ksize) return 1; } +static void +nl_add_attr_u32(struct nlmsghdr *h, unsigned maxsize, int code, u32 data) +{ + unsigned len = RTA_LENGTH(4); + struct rtattr *a; + + if (NLMSG_ALIGN(h->nlmsg_len) + len > maxsize) + bug("nl_add_attr32: packet buffer overflow"); + a = (struct rtattr *)((char *)h + NLMSG_ALIGN(h->nlmsg_len)); + a->rta_type = code; + a->rta_len = len; + memcpy(RTA_DATA(a), &data, 4); + h->nlmsg_len = NLMSG_ALIGN(h->nlmsg_len) + len; +} + +static void +nl_add_attr_ipa(struct nlmsghdr *h, unsigned maxsize, int code, ip_addr ipa) +{ + unsigned len = RTA_LENGTH(sizeof(ipa)); + struct rtattr *a; + + if (NLMSG_ALIGN(h->nlmsg_len) + len > maxsize) + bug("nl_add_attr_ipa: packet buffer overflow"); + a = (struct rtattr *)((char *)h + NLMSG_ALIGN(h->nlmsg_len)); + a->rta_type = code; + a->rta_len = len; + ipa = ipa_hton(ipa); + memcpy(RTA_DATA(a), &ipa, sizeof(ipa)); + h->nlmsg_len = NLMSG_ALIGN(h->nlmsg_len) + len; +} + /* * Scanning of interfaces */ @@ -390,25 +445,72 @@ krt_capable(rte *e) } static void -krt_delete(rte *e) +nl_send_route(rte *e, int new) { - /* FIXME */ -} + net *net = e->net; + rta *a = e->attrs; + struct { + struct nlmsghdr h; + struct rtmsg r; + char buf[128]; + } r; + struct nlmsghdr *reply; + + bzero(&r.h, sizeof(r.h)); + bzero(&r.r, sizeof(r.r)); + r.h.nlmsg_type = new ? RTM_NEWROUTE : RTM_DELROUTE; + r.h.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg)); + r.h.nlmsg_flags = NLM_F_REQUEST | NLM_F_ACK | (new ? NLM_F_CREATE|NLM_F_REPLACE : 0); + /* FIXME: Do we really need to process ACKs? */ + + r.r.rtm_family = AF_INET; + r.r.rtm_dst_len = net->n.pxlen; + r.r.rtm_tos = 0; /* FIXME: Non-zero TOS? */ + r.r.rtm_table = RT_TABLE_MAIN; /* FIXME: Other tables? */ + r.r.rtm_protocol = RTPROT_BIRD; + r.r.rtm_scope = RT_SCOPE_UNIVERSE; /* FIXME: Other scopes? */ + nl_add_attr_ipa(&r.h, sizeof(r), RTA_DST, net->n.prefix); + switch (a->dest) + { + case RTD_ROUTER: + r.r.rtm_type = RTN_UNICAST; + nl_add_attr_ipa(&r.h, sizeof(r), RTA_GATEWAY, a->gw); + break; + case RTD_DEVICE: + r.r.rtm_type = RTN_UNICAST; + nl_add_attr_u32(&r.h, sizeof(r), RTA_OIF, a->iface->index); + break; + case RTD_BLACKHOLE: + r.r.rtm_type = RTN_BLACKHOLE; + break; + case RTD_UNREACHABLE: + r.r.rtm_type = RTN_UNREACHABLE; + break; + case RTD_PROHIBIT: + r.r.rtm_type = RTN_PROHIBIT; + break; + default: + bug("krt_capable inconsistent with nl_send_route"); + } -static void -krt_insert(rte *e) -{ - /* FIXME */ + nl_exchange(&r.h); } void krt_set_notify(struct proto *p, net *n, rte *new, rte *old) { - /* FIXME: Use route updates if possible */ - if (old) - krt_delete(old); - if (new) - krt_insert(new); + if (old && new && old->attrs->tos == new->attrs->tos) + { + /* FIXME: Priorities should be identical as well, but we don't use them yet. */ + nl_send_route(new, 1); + } + else + { + if (old) + nl_send_route(old, 0); + if (new) + nl_send_route(new, 1); + } } struct iface * |