2 * Copyright (C) 2010 Felix Fietkau <nbd@openwrt.org>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License v2 as published by
6 * the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
13 * You should have received a copy of the GNU General Public License
14 * along with this program; if not, write to the Free Software
15 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
18 #include <sys/socket.h>
27 static struct uloop_fd rtnl_sock;
28 static unsigned int rtnl_seq, rtnl_dump_seq;
30 static void rtnl_flush(void)
34 fd = open("/proc/sys/net/ipv4/route/flush", O_WRONLY);
42 static void rtnl_route_set(struct relayd_host *host, bool add)
57 memset(&req, 0, sizeof(req));
59 req.nl.nlmsg_len = sizeof(req);
60 req.rt.rtm_family = AF_INET;
61 req.rt.rtm_dst_len = 32;
63 req.dst.rta.rta_type = RTA_DST;
64 req.dst.rta.rta_len = sizeof(req.dst);
65 memcpy(req.dst.ipaddr, host->ipaddr, sizeof(req.dst.ipaddr));
67 req.dev.rta.rta_type = RTA_OIF;
68 req.dev.rta.rta_len = sizeof(req.dev);
69 req.dev.ifindex = host->rif->sll.sll_ifindex;
71 req.nl.nlmsg_flags = NLM_F_REQUEST;
72 req.rt.rtm_table = RT_TABLE_MAIN;
74 req.nl.nlmsg_type = RTM_NEWROUTE;
75 req.nl.nlmsg_flags |= NLM_F_CREATE | NLM_F_REPLACE;
77 req.rt.rtm_protocol = RTPROT_BOOT;
78 req.rt.rtm_scope = RT_SCOPE_LINK;
79 req.rt.rtm_type = RTN_UNICAST;
81 req.nl.nlmsg_type = RTM_DELROUTE;
82 req.rt.rtm_scope = RT_SCOPE_NOWHERE;
85 send(rtnl_sock.fd, &req, sizeof(req), 0);
89 void relayd_add_route(struct relayd_host *host)
91 rtnl_route_set(host, true);
94 void relayd_del_route(struct relayd_host *host)
96 rtnl_route_set(host, false);
101 ((struct rtattr*)(((char*)(r)) + NLMSG_ALIGN(sizeof(struct ndmsg))))
104 static void rtnl_parse_newneigh(struct nlmsghdr *h)
106 struct relayd_interface *rif = NULL;
107 struct ndmsg *r = NLMSG_DATA(h);
108 const uint8_t *lladdr = NULL;
109 const uint8_t *ipaddr = NULL;
113 if (r->ndm_family != AF_INET)
116 list_for_each_entry(rif, &interfaces, list) {
117 if (rif->sll.sll_ifindex == r->ndm_ifindex)
118 goto found_interface;
123 len = h->nlmsg_len - NLMSG_LENGTH(sizeof(*r));
124 for (rta = NDA_RTA(r); RTA_OK(rta, len); rta = RTA_NEXT(rta, len)) {
125 switch(rta->rta_type) {
127 lladdr = RTA_DATA(rta);
130 ipaddr = RTA_DATA(rta);
137 if (!lladdr || !ipaddr || (r->ndm_state & (NUD_INCOMPLETE|NUD_FAILED)))
140 if (!memcmp(lladdr, "\x00\x00\x00\x00\x00\x00", ETH_ALEN))
143 DPRINTF(1, "%s: Found ARP cache entry for host "IP_FMT" ("MAC_FMT")\n",
144 rif->ifname, IP_BUF(ipaddr), MAC_BUF(lladdr));
145 relayd_refresh_host(rif, lladdr, ipaddr);
148 static void rtnl_parse_packet(void *data, int len)
152 for (h = data; NLMSG_OK(h, len); h = NLMSG_NEXT(h, len)) {
153 if (h->nlmsg_type == NLMSG_DONE ||
154 h->nlmsg_type == NLMSG_ERROR)
157 if (h->nlmsg_seq != rtnl_dump_seq)
160 if (h->nlmsg_type == RTM_NEWNEIGH)
161 rtnl_parse_newneigh(h);
165 static void rtnl_cb(struct uloop_fd *fd, unsigned int events)
167 struct sockaddr_nl nladdr;
168 static uint8_t buf[16384];
171 .iov_len = sizeof(buf),
173 struct msghdr msg = {
175 .msg_namelen = sizeof(nladdr),
183 len = recvmsg(rtnl_sock.fd, &msg, 0);
194 if (nladdr.nl_pid != 0)
197 rtnl_parse_packet(buf, len);
201 int relayd_rtnl_init(void)
203 struct sockaddr_nl snl_local;
209 .nlmsg_len = sizeof(req),
210 .nlmsg_type = RTM_GETNEIGH,
211 .nlmsg_flags = NLM_F_ROOT|NLM_F_MATCH|NLM_F_REQUEST,
214 .g.rtgen_family = AF_INET,
217 rtnl_sock.fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE);
218 if (rtnl_sock.fd < 0) {
219 perror("socket(AF_NETLINK)");
223 snl_local.nl_family = AF_NETLINK;
225 if (bind(rtnl_sock.fd, (struct sockaddr *) &snl_local, sizeof(struct sockaddr_nl)) < 0) {
231 rtnl_sock.cb = rtnl_cb;
232 uloop_fd_add(&rtnl_sock, ULOOP_READ | ULOOP_EDGE_TRIGGER);
234 rtnl_seq = time(NULL);
235 rtnl_dump_seq = rtnl_seq;
236 req.nlh.nlmsg_seq = rtnl_seq;
237 send(rtnl_sock.fd, &req, sizeof(req), 0);
242 void relayd_rtnl_done(void)
244 uloop_fd_delete(&rtnl_sock);