blob: 424a5b6ffe8f02ce125ffcdab5825529781e3e24 [file] [log] [blame]
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +00001/*
2 * libnetlink.c RTnetlink service routines.
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
10 *
11 */
12
13#include <stdio.h>
14#include <stdlib.h>
15#include <unistd.h>
16#include <syslog.h>
17#include <fcntl.h>
18#include <net/if_arp.h>
19#include <sys/socket.h>
20#include <netinet/in.h>
21#include <string.h>
22#include <errno.h>
23#include <time.h>
24#include <sys/uio.h>
25
26#include "libnetlink.h"
27
Nicolas Dichtel449b8242015-05-20 16:20:00 +020028#ifndef SOL_NETLINK
29#define SOL_NETLINK 270
30#endif
31
Patrick McHardy7f031912009-10-28 20:50:48 +010032int rcvbuf = 1024 * 1024;
33
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000034void rtnl_close(struct rtnl_handle *rth)
35{
Stephen Hemminger3bfa73f2006-09-26 10:41:57 -070036 if (rth->fd >= 0) {
37 close(rth->fd);
38 rth->fd = -1;
39 }
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000040}
41
shemminger8ed63ab2005-09-21 19:33:17 +000042int rtnl_open_byproto(struct rtnl_handle *rth, unsigned subscriptions,
43 int protocol)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000044{
shemmingerf332d162005-07-05 22:37:15 +000045 socklen_t addr_len;
osdl.net!shemminger007d3a32004-08-13 23:54:55 +000046 int sndbuf = 32768;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000047
Stephen Hemmingerb16621c2007-05-10 19:33:21 -070048 memset(rth, 0, sizeof(*rth));
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000049
vadimk8a4025f2014-12-04 12:32:58 +020050 rth->proto = protocol;
Andrey Vaginbcb9d402013-06-04 12:01:14 +040051 rth->fd = socket(AF_NETLINK, SOCK_RAW | SOCK_CLOEXEC, protocol);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000052 if (rth->fd < 0) {
53 perror("Cannot open netlink socket");
54 return -1;
55 }
56
osdl.net!shemminger007d3a32004-08-13 23:54:55 +000057 if (setsockopt(rth->fd,SOL_SOCKET,SO_SNDBUF,&sndbuf,sizeof(sndbuf)) < 0) {
58 perror("SO_SNDBUF");
59 return -1;
60 }
61
62 if (setsockopt(rth->fd,SOL_SOCKET,SO_RCVBUF,&rcvbuf,sizeof(rcvbuf)) < 0) {
63 perror("SO_RCVBUF");
64 return -1;
65 }
66
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000067 memset(&rth->local, 0, sizeof(rth->local));
68 rth->local.nl_family = AF_NETLINK;
69 rth->local.nl_groups = subscriptions;
70
71 if (bind(rth->fd, (struct sockaddr*)&rth->local, sizeof(rth->local)) < 0) {
72 perror("Cannot bind netlink socket");
73 return -1;
74 }
75 addr_len = sizeof(rth->local);
76 if (getsockname(rth->fd, (struct sockaddr*)&rth->local, &addr_len) < 0) {
77 perror("Cannot getsockname");
78 return -1;
79 }
80 if (addr_len != sizeof(rth->local)) {
81 fprintf(stderr, "Wrong address length %d\n", addr_len);
82 return -1;
83 }
84 if (rth->local.nl_family != AF_NETLINK) {
85 fprintf(stderr, "Wrong address family %d\n", rth->local.nl_family);
86 return -1;
87 }
88 rth->seq = time(NULL);
89 return 0;
90}
91
net[shemminger]!shemmingerc7699872004-07-07 17:05:56 +000092int rtnl_open(struct rtnl_handle *rth, unsigned subscriptions)
93{
94 return rtnl_open_byproto(rth, subscriptions, NETLINK_ROUTE);
95}
96
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +000097int rtnl_wilddump_request(struct rtnl_handle *rth, int family, int type)
98{
Vlad Yasevich9eff0e52013-02-28 10:04:05 +000099 return rtnl_wilddump_req_filter(rth, family, type, RTEXT_FILTER_VF);
100}
101
102int rtnl_wilddump_req_filter(struct rtnl_handle *rth, int family, int type,
103 __u32 filt_mask)
104{
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000105 struct {
106 struct nlmsghdr nlh;
Alexander Duyck63338dc2013-04-25 12:07:10 +0000107 struct ifinfomsg ifm;
Lutz Jaenicke257422f2012-08-30 05:01:34 +0000108 /* attribute has to be NLMSG aligned */
109 struct rtattr ext_req __attribute__ ((aligned(NLMSG_ALIGNTO)));
Rose, Gregory Vbd886eb2012-02-21 10:43:09 +0000110 __u32 ext_filter_mask;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000111 } req;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000112
shemminger8ed63ab2005-09-21 19:33:17 +0000113 memset(&req, 0, sizeof(req));
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000114 req.nlh.nlmsg_len = sizeof(req);
115 req.nlh.nlmsg_type = type;
Masatake YAMATOaa38c3e2012-01-19 14:16:12 -0800116 req.nlh.nlmsg_flags = NLM_F_DUMP|NLM_F_REQUEST;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000117 req.nlh.nlmsg_pid = 0;
118 req.nlh.nlmsg_seq = rth->dump = ++rth->seq;
Alexander Duyck63338dc2013-04-25 12:07:10 +0000119 req.ifm.ifi_family = family;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000120
Rose, Gregory Vbd886eb2012-02-21 10:43:09 +0000121 req.ext_req.rta_type = IFLA_EXT_MASK;
122 req.ext_req.rta_len = RTA_LENGTH(sizeof(__u32));
Vlad Yasevich9eff0e52013-02-28 10:04:05 +0000123 req.ext_filter_mask = filt_mask;
Rose, Gregory Vbd886eb2012-02-21 10:43:09 +0000124
Stephen Hemmingerf31a37f2008-01-31 21:38:58 -0800125 return send(rth->fd, (void*)&req, sizeof(req), 0);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000126}
127
Stephen Hemminger6cf83982011-12-23 10:40:04 -0800128int rtnl_send(struct rtnl_handle *rth, const void *buf, int len)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000129{
Stephen Hemmingerf31a37f2008-01-31 21:38:58 -0800130 return send(rth->fd, buf, len, 0);
131}
132
Stephen Hemminger6cf83982011-12-23 10:40:04 -0800133int rtnl_send_check(struct rtnl_handle *rth, const void *buf, int len)
Stephen Hemmingerf31a37f2008-01-31 21:38:58 -0800134{
Stephen Hemminger54bb35c2008-01-26 11:09:42 -0800135 struct nlmsghdr *h;
136 int status;
137 char resp[1024];
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000138
Stephen Hemmingerf31a37f2008-01-31 21:38:58 -0800139 status = send(rth->fd, buf, len, 0);
Stephen Hemminger54bb35c2008-01-26 11:09:42 -0800140 if (status < 0)
141 return status;
142
Stephen Hemminger2d8240f2009-07-13 10:15:23 -0700143 /* Check for immediate errors */
144 status = recv(rth->fd, resp, sizeof(resp), MSG_DONTWAIT|MSG_PEEK);
Stephen Hemminger54bb35c2008-01-26 11:09:42 -0800145 if (status < 0) {
146 if (errno == EAGAIN)
147 return 0;
148 return -1;
149 }
150
151 for (h = (struct nlmsghdr *)resp; NLMSG_OK(h, status);
152 h = NLMSG_NEXT(h, status)) {
153 if (h->nlmsg_type == NLMSG_ERROR) {
154 struct nlmsgerr *err = (struct nlmsgerr*)NLMSG_DATA(h);
155 if (h->nlmsg_len < NLMSG_LENGTH(sizeof(struct nlmsgerr)))
156 fprintf(stderr, "ERROR truncated\n");
157 else
158 errno = -err->error;
Sven Anders24f38182009-11-10 09:07:26 -0800159 return -1;
Stephen Hemminger54bb35c2008-01-26 11:09:42 -0800160 }
Stephen Hemminger54bb35c2008-01-26 11:09:42 -0800161 }
162
163 return 0;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000164}
165
166int rtnl_dump_request(struct rtnl_handle *rth, int type, void *req, int len)
167{
168 struct nlmsghdr nlh;
Stephen Hemminger6cf83982011-12-23 10:40:04 -0800169 struct sockaddr_nl nladdr = { .nl_family = AF_NETLINK };
shemminger8ed63ab2005-09-21 19:33:17 +0000170 struct iovec iov[2] = {
171 { .iov_base = &nlh, .iov_len = sizeof(nlh) },
172 { .iov_base = req, .iov_len = len }
173 };
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000174 struct msghdr msg = {
shemminger8ed63ab2005-09-21 19:33:17 +0000175 .msg_name = &nladdr,
176 .msg_namelen = sizeof(nladdr),
177 .msg_iov = iov,
178 .msg_iovlen = 2,
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000179 };
180
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000181 nlh.nlmsg_len = NLMSG_LENGTH(len);
182 nlh.nlmsg_type = type;
Masatake YAMATOaa38c3e2012-01-19 14:16:12 -0800183 nlh.nlmsg_flags = NLM_F_DUMP|NLM_F_REQUEST;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000184 nlh.nlmsg_pid = 0;
185 nlh.nlmsg_seq = rth->dump = ++rth->seq;
186
187 return sendmsg(rth->fd, &msg, 0);
188}
189
Simon Hormanb49240e2009-12-03 12:08:27 +1100190int rtnl_dump_filter_l(struct rtnl_handle *rth,
191 const struct rtnl_dump_filter_arg *arg)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000192{
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000193 struct sockaddr_nl nladdr;
shemminger8ed63ab2005-09-21 19:33:17 +0000194 struct iovec iov;
195 struct msghdr msg = {
196 .msg_name = &nladdr,
197 .msg_namelen = sizeof(nladdr),
198 .msg_iov = &iov,
199 .msg_iovlen = 1,
200 };
201 char buf[16384];
Nicolas Dichtel16f02e12013-03-22 06:34:02 +0000202 int dump_intr = 0;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000203
shemminger8ed63ab2005-09-21 19:33:17 +0000204 iov.iov_base = buf;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000205 while (1) {
206 int status;
Simon Hormanb49240e2009-12-03 12:08:27 +1100207 const struct rtnl_dump_filter_arg *a;
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700208 int found_done = 0;
209 int msglen = 0;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000210
shemminger8ed63ab2005-09-21 19:33:17 +0000211 iov.iov_len = sizeof(buf);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000212 status = recvmsg(rth->fd, &msg, 0);
213
214 if (status < 0) {
Stephen Hemmingeraa8032e2008-01-25 15:39:09 -0800215 if (errno == EINTR || errno == EAGAIN)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000216 continue;
Stephen Hemmingeraa8032e2008-01-25 15:39:09 -0800217 fprintf(stderr, "netlink receive error %s (%d)\n",
218 strerror(errno), errno);
219 return -1;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000220 }
shemminger8ed63ab2005-09-21 19:33:17 +0000221
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000222 if (status == 0) {
223 fprintf(stderr, "EOF on netlink\n");
224 return -1;
225 }
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000226
Vadim Kochan486ccd92014-12-26 04:26:27 +0200227 if (rth->dump_fp)
228 fwrite(buf, 1, NLMSG_ALIGN(status), rth->dump_fp);
229
Simon Hormanb49240e2009-12-03 12:08:27 +1100230 for (a = arg; a->filter; a++) {
231 struct nlmsghdr *h = (struct nlmsghdr*)buf;
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700232 msglen = status;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000233
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700234 while (NLMSG_OK(h, msglen)) {
Vadim Kochan486ccd92014-12-26 04:26:27 +0200235 int err = 0;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000236
Simon Hormanb49240e2009-12-03 12:08:27 +1100237 if (nladdr.nl_pid != 0 ||
238 h->nlmsg_pid != rth->local.nl_pid ||
Stephen Hemmingercd70f3f2011-12-28 10:37:12 -0800239 h->nlmsg_seq != rth->dump)
Simon Hormanb49240e2009-12-03 12:08:27 +1100240 goto skip_it;
Simon Hormanb49240e2009-12-03 12:08:27 +1100241
Nicolas Dichtel16f02e12013-03-22 06:34:02 +0000242 if (h->nlmsg_flags & NLM_F_DUMP_INTR)
243 dump_intr = 1;
244
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700245 if (h->nlmsg_type == NLMSG_DONE) {
246 found_done = 1;
247 break; /* process next filter */
248 }
Simon Hormanb49240e2009-12-03 12:08:27 +1100249 if (h->nlmsg_type == NLMSG_ERROR) {
250 struct nlmsgerr *err = (struct nlmsgerr*)NLMSG_DATA(h);
251 if (h->nlmsg_len < NLMSG_LENGTH(sizeof(struct nlmsgerr))) {
252 fprintf(stderr,
253 "ERROR truncated\n");
254 } else {
255 errno = -err->error;
vadimk8a4025f2014-12-04 12:32:58 +0200256 if (rth->proto == NETLINK_SOCK_DIAG &&
Vadim Kochan486ccd92014-12-26 04:26:27 +0200257 (errno == ENOENT ||
258 errno == EOPNOTSUPP))
vadimk8a4025f2014-12-04 12:32:58 +0200259 return -1;
260
Simon Hormanb49240e2009-12-03 12:08:27 +1100261 perror("RTNETLINK answers");
262 }
263 return -1;
264 }
Vadim Kochan486ccd92014-12-26 04:26:27 +0200265
266 if (!rth->dump_fp) {
267 err = a->filter(&nladdr, h, a->arg1);
268 if (err < 0)
269 return err;
270 }
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000271
272skip_it:
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700273 h = NLMSG_NEXT(h, msglen);
Simon Hormanb49240e2009-12-03 12:08:27 +1100274 }
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700275 }
276
Nicolas Dichtel16f02e12013-03-22 06:34:02 +0000277 if (found_done) {
278 if (dump_intr)
279 fprintf(stderr,
280 "Dump was interrupted and may be inconsistent.\n");
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700281 return 0;
Nicolas Dichtel16f02e12013-03-22 06:34:02 +0000282 }
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700283
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000284 if (msg.msg_flags & MSG_TRUNC) {
285 fprintf(stderr, "Message truncated\n");
286 continue;
287 }
Ben Greear3bc1c4f2010-08-16 10:00:08 -0700288 if (msglen) {
289 fprintf(stderr, "!!!Remnant of size %d\n", msglen);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000290 exit(1);
291 }
292 }
293}
294
Simon Hormanb49240e2009-12-03 12:08:27 +1100295int rtnl_dump_filter(struct rtnl_handle *rth,
296 rtnl_filter_t filter,
Stephen Hemmingercd70f3f2011-12-28 10:37:12 -0800297 void *arg1)
Simon Hormanb49240e2009-12-03 12:08:27 +1100298{
299 const struct rtnl_dump_filter_arg a[2] = {
Stephen Hemmingercd70f3f2011-12-28 10:37:12 -0800300 { .filter = filter, .arg1 = arg1, },
301 { .filter = NULL, .arg1 = NULL, },
Simon Hormanb49240e2009-12-03 12:08:27 +1100302 };
303
304 return rtnl_dump_filter_l(rth, a);
305}
306
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000307int rtnl_talk(struct rtnl_handle *rtnl, struct nlmsghdr *n, pid_t peer,
Stephen Hemmingercd70f3f2011-12-28 10:37:12 -0800308 unsigned groups, struct nlmsghdr *answer)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000309{
310 int status;
311 unsigned seq;
312 struct nlmsghdr *h;
313 struct sockaddr_nl nladdr;
shemmingerfb229752005-10-04 23:15:32 +0000314 struct iovec iov = {
315 .iov_base = (void*) n,
316 .iov_len = n->nlmsg_len
317 };
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000318 struct msghdr msg = {
shemminger8ed63ab2005-09-21 19:33:17 +0000319 .msg_name = &nladdr,
320 .msg_namelen = sizeof(nladdr),
321 .msg_iov = &iov,
322 .msg_iovlen = 1,
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000323 };
shemminger8ed63ab2005-09-21 19:33:17 +0000324 char buf[16384];
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000325
326 memset(&nladdr, 0, sizeof(nladdr));
327 nladdr.nl_family = AF_NETLINK;
328 nladdr.nl_pid = peer;
329 nladdr.nl_groups = groups;
330
331 n->nlmsg_seq = seq = ++rtnl->seq;
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000332
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000333 if (answer == NULL)
334 n->nlmsg_flags |= NLM_F_ACK;
335
336 status = sendmsg(rtnl->fd, &msg, 0);
337
338 if (status < 0) {
339 perror("Cannot talk to rtnetlink");
340 return -1;
341 }
342
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000343 memset(buf,0,sizeof(buf));
344
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000345 iov.iov_base = buf;
346
347 while (1) {
348 iov.iov_len = sizeof(buf);
349 status = recvmsg(rtnl->fd, &msg, 0);
350
351 if (status < 0) {
Stephen Hemmingeraa8032e2008-01-25 15:39:09 -0800352 if (errno == EINTR || errno == EAGAIN)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000353 continue;
Stephen Hemmingeraa8032e2008-01-25 15:39:09 -0800354 fprintf(stderr, "netlink receive error %s (%d)\n",
355 strerror(errno), errno);
356 return -1;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000357 }
358 if (status == 0) {
359 fprintf(stderr, "EOF on netlink\n");
360 return -1;
361 }
362 if (msg.msg_namelen != sizeof(nladdr)) {
363 fprintf(stderr, "sender address length == %d\n", msg.msg_namelen);
364 exit(1);
365 }
366 for (h = (struct nlmsghdr*)buf; status >= sizeof(*h); ) {
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000367 int len = h->nlmsg_len;
368 int l = len - sizeof(*h);
369
Stephen Hemmingercd70f3f2011-12-28 10:37:12 -0800370 if (l < 0 || len>status) {
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000371 if (msg.msg_flags & MSG_TRUNC) {
372 fprintf(stderr, "Truncated message\n");
373 return -1;
374 }
375 fprintf(stderr, "!!!malformed message: len=%d\n", len);
376 exit(1);
377 }
378
org[shemminger]!shemminger10f57ef2004-06-07 22:04:04 +0000379 if (nladdr.nl_pid != peer ||
380 h->nlmsg_pid != rtnl->local.nl_pid ||
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000381 h->nlmsg_seq != seq) {
shemminger4cca16f2006-03-10 23:31:46 +0000382 /* Don't forget to skip that message. */
383 status -= NLMSG_ALIGN(len);
384 h = (struct nlmsghdr*)((char*)h + NLMSG_ALIGN(len));
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000385 continue;
386 }
387
388 if (h->nlmsg_type == NLMSG_ERROR) {
389 struct nlmsgerr *err = (struct nlmsgerr*)NLMSG_DATA(h);
390 if (l < sizeof(struct nlmsgerr)) {
391 fprintf(stderr, "ERROR truncated\n");
392 } else {
Pavel Emelyanovb8cf1e92012-08-20 12:08:40 +0400393 if (!err->error) {
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000394 if (answer)
395 memcpy(answer, h, h->nlmsg_len);
396 return 0;
397 }
Pavel Emelyanovb8cf1e92012-08-20 12:08:40 +0400398
399 fprintf(stderr, "RTNETLINK answers: %s\n", strerror(-err->error));
400 errno = -err->error;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000401 }
402 return -1;
403 }
404 if (answer) {
405 memcpy(answer, h, h->nlmsg_len);
406 return 0;
407 }
408
409 fprintf(stderr, "Unexpected reply!!!\n");
410
411 status -= NLMSG_ALIGN(len);
412 h = (struct nlmsghdr*)((char*)h + NLMSG_ALIGN(len));
413 }
414 if (msg.msg_flags & MSG_TRUNC) {
415 fprintf(stderr, "Message truncated\n");
416 continue;
417 }
418 if (status) {
419 fprintf(stderr, "!!!Remnant of size %d\n", status);
420 exit(1);
421 }
422 }
423}
424
Nicolas Dichtel449b8242015-05-20 16:20:00 +0200425int rtnl_listen_all_nsid(struct rtnl_handle *rth)
426{
427 unsigned int on = 1;
428
429 if (setsockopt(rth->fd, SOL_NETLINK, NETLINK_LISTEN_ALL_NSID, &on,
430 sizeof(on)) < 0) {
431 perror("NETLINK_LISTEN_ALL_NSID");
432 return -1;
433 }
434 rth->flags |= RTNL_HANDLE_F_LISTEN_ALL_NSID;
435 return 0;
436}
437
shemminger8ed63ab2005-09-21 19:33:17 +0000438int rtnl_listen(struct rtnl_handle *rtnl,
Nicolas Dichtel0628cdd2015-05-20 16:19:58 +0200439 rtnl_listen_filter_t handler,
osdl.net!shemminger6dc9f012004-08-31 17:45:21 +0000440 void *jarg)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000441{
442 int status;
443 struct nlmsghdr *h;
444 struct sockaddr_nl nladdr;
445 struct iovec iov;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000446 struct msghdr msg = {
shemminger8ed63ab2005-09-21 19:33:17 +0000447 .msg_name = &nladdr,
448 .msg_namelen = sizeof(nladdr),
449 .msg_iov = &iov,
450 .msg_iovlen = 1,
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000451 };
Eric Dumazete5572122014-10-11 09:43:13 -0700452 char buf[16384];
Nicolas Dichtel449b8242015-05-20 16:20:00 +0200453 char cmsgbuf[BUFSIZ];
454
455 if (rtnl->flags & RTNL_HANDLE_F_LISTEN_ALL_NSID) {
456 msg.msg_control = &cmsgbuf;
457 msg.msg_controllen = sizeof(cmsgbuf);
458 }
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000459
460 memset(&nladdr, 0, sizeof(nladdr));
461 nladdr.nl_family = AF_NETLINK;
462 nladdr.nl_pid = 0;
463 nladdr.nl_groups = 0;
464
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000465 iov.iov_base = buf;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000466 while (1) {
Nicolas Dichtel449b8242015-05-20 16:20:00 +0200467 struct rtnl_ctrl_data ctrl;
468 struct cmsghdr *cmsg;
469
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000470 iov.iov_len = sizeof(buf);
471 status = recvmsg(rtnl->fd, &msg, 0);
472
473 if (status < 0) {
Stephen Hemmingeraa8032e2008-01-25 15:39:09 -0800474 if (errno == EINTR || errno == EAGAIN)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000475 continue;
Stephen Hemmingeraa8032e2008-01-25 15:39:09 -0800476 fprintf(stderr, "netlink receive error %s (%d)\n",
477 strerror(errno), errno);
Patrick McHardy7f031912009-10-28 20:50:48 +0100478 if (errno == ENOBUFS)
479 continue;
Stephen Hemmingeraa8032e2008-01-25 15:39:09 -0800480 return -1;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000481 }
482 if (status == 0) {
483 fprintf(stderr, "EOF on netlink\n");
484 return -1;
485 }
486 if (msg.msg_namelen != sizeof(nladdr)) {
487 fprintf(stderr, "Sender address length == %d\n", msg.msg_namelen);
488 exit(1);
489 }
Nicolas Dichtel449b8242015-05-20 16:20:00 +0200490
491 if (rtnl->flags & RTNL_HANDLE_F_LISTEN_ALL_NSID) {
492 memset(&ctrl, 0, sizeof(ctrl));
493 ctrl.nsid = -1;
494 for (cmsg = CMSG_FIRSTHDR(&msg); cmsg;
495 cmsg = CMSG_NXTHDR(&msg, cmsg))
496 if (cmsg->cmsg_level == SOL_NETLINK &&
497 cmsg->cmsg_type == NETLINK_LISTEN_ALL_NSID &&
498 cmsg->cmsg_len == CMSG_LEN(sizeof(int))) {
499 int *data = (int *)CMSG_DATA(cmsg);
500
501 ctrl.nsid = *data;
502 }
503 }
504
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000505 for (h = (struct nlmsghdr*)buf; status >= sizeof(*h); ) {
506 int err;
507 int len = h->nlmsg_len;
508 int l = len - sizeof(*h);
509
510 if (l<0 || len>status) {
511 if (msg.msg_flags & MSG_TRUNC) {
512 fprintf(stderr, "Truncated message\n");
513 return -1;
514 }
515 fprintf(stderr, "!!!malformed message: len=%d\n", len);
516 exit(1);
517 }
518
Nicolas Dichtel449b8242015-05-20 16:20:00 +0200519 err = handler(&nladdr, &ctrl, h, jarg);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000520 if (err < 0)
521 return err;
522
523 status -= NLMSG_ALIGN(len);
524 h = (struct nlmsghdr*)((char*)h + NLMSG_ALIGN(len));
525 }
526 if (msg.msg_flags & MSG_TRUNC) {
527 fprintf(stderr, "Message truncated\n");
528 continue;
529 }
530 if (status) {
531 fprintf(stderr, "!!!Remnant of size %d\n", status);
532 exit(1);
533 }
534 }
535}
536
Nicolas Dichtel0628cdd2015-05-20 16:19:58 +0200537int rtnl_from_file(FILE *rtnl, rtnl_listen_filter_t handler,
osdl.net!shemminger6dc9f012004-08-31 17:45:21 +0000538 void *jarg)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000539{
540 int status;
541 struct sockaddr_nl nladdr;
Eric Dumazete5572122014-10-11 09:43:13 -0700542 char buf[16384];
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000543 struct nlmsghdr *h = (void*)buf;
544
545 memset(&nladdr, 0, sizeof(nladdr));
546 nladdr.nl_family = AF_NETLINK;
547 nladdr.nl_pid = 0;
548 nladdr.nl_groups = 0;
549
550 while (1) {
Stephen Hemminger2dd9f8e2011-06-20 14:34:46 -0700551 int err, len;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000552 int l;
553
554 status = fread(&buf, 1, sizeof(*h), rtnl);
555
556 if (status < 0) {
557 if (errno == EINTR)
558 continue;
559 perror("rtnl_from_file: fread");
560 return -1;
561 }
562 if (status == 0)
563 return 0;
564
565 len = h->nlmsg_len;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000566 l = len - sizeof(*h);
567
568 if (l<0 || len>sizeof(buf)) {
569 fprintf(stderr, "!!!malformed message: len=%d @%lu\n",
570 len, ftell(rtnl));
571 return -1;
572 }
573
574 status = fread(NLMSG_DATA(h), 1, NLMSG_ALIGN(l), rtnl);
575
576 if (status < 0) {
577 perror("rtnl_from_file: fread");
578 return -1;
579 }
580 if (status < l) {
581 fprintf(stderr, "rtnl-from_file: truncated message\n");
582 return -1;
583 }
584
Nicolas Dichtel0628cdd2015-05-20 16:19:58 +0200585 err = handler(&nladdr, NULL, h, jarg);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000586 if (err < 0)
587 return err;
588 }
589}
590
Stephen Hemminger2aa3dd22011-12-23 10:43:54 -0800591int addattr(struct nlmsghdr *n, int maxlen, int type)
592{
593 return addattr_l(n, maxlen, type, NULL, 0);
594}
595
596int addattr8(struct nlmsghdr *n, int maxlen, int type, __u8 data)
597{
598 return addattr_l(n, maxlen, type, &data, sizeof(__u8));
599}
600
601int addattr16(struct nlmsghdr *n, int maxlen, int type, __u16 data)
602{
603 return addattr_l(n, maxlen, type, &data, sizeof(__u16));
604}
605
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000606int addattr32(struct nlmsghdr *n, int maxlen, int type, __u32 data)
607{
Stephen Hemminger2aa3dd22011-12-23 10:43:54 -0800608 return addattr_l(n, maxlen, type, &data, sizeof(__u32));
609}
610
611int addattr64(struct nlmsghdr *n, int maxlen, int type, __u64 data)
612{
613 return addattr_l(n, maxlen, type, &data, sizeof(__u64));
614}
615
616int addattrstrz(struct nlmsghdr *n, int maxlen, int type, const char *str)
617{
618 return addattr_l(n, maxlen, type, str, strlen(str)+1);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000619}
620
shemminger8ed63ab2005-09-21 19:33:17 +0000621int addattr_l(struct nlmsghdr *n, int maxlen, int type, const void *data,
osdl.net!shemminger6dc9f012004-08-31 17:45:21 +0000622 int alen)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000623{
624 int len = RTA_LENGTH(alen);
625 struct rtattr *rta;
626
net[shemminger]!shemminger3dabdbb2005-03-30 18:18:12 +0000627 if (NLMSG_ALIGN(n->nlmsg_len) + RTA_ALIGN(len) > maxlen) {
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000628 fprintf(stderr, "addattr_l ERROR: message exceeded bound of %d\n",maxlen);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000629 return -1;
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000630 }
6!tgraf07f94362005-01-18 13:58:49 +0000631 rta = NLMSG_TAIL(n);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000632 rta->rta_type = type;
633 rta->rta_len = len;
634 memcpy(RTA_DATA(rta), data, alen);
net[shemminger]!shemminger3dabdbb2005-03-30 18:18:12 +0000635 n->nlmsg_len = NLMSG_ALIGN(n->nlmsg_len) + RTA_ALIGN(len);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000636 return 0;
637}
638
6!tgraf07f94362005-01-18 13:58:49 +0000639int addraw_l(struct nlmsghdr *n, int maxlen, const void *data, int len)
640{
641 if (NLMSG_ALIGN(n->nlmsg_len) + NLMSG_ALIGN(len) > maxlen) {
642 fprintf(stderr, "addraw_l ERROR: message exceeded bound of %d\n",maxlen);
643 return -1;
644 }
645
646 memcpy(NLMSG_TAIL(n), data, len);
647 memset((void *) NLMSG_TAIL(n) + len, 0, NLMSG_ALIGN(len) - len);
648 n->nlmsg_len = NLMSG_ALIGN(n->nlmsg_len) + NLMSG_ALIGN(len);
649 return 0;
650}
651
Patrick McHardy2f90c9c2007-08-14 11:21:19 -0700652struct rtattr *addattr_nest(struct nlmsghdr *n, int maxlen, int type)
653{
654 struct rtattr *nest = NLMSG_TAIL(n);
655
656 addattr_l(n, maxlen, type, NULL, 0);
657 return nest;
658}
659
660int addattr_nest_end(struct nlmsghdr *n, struct rtattr *nest)
661{
662 nest->rta_len = (void *)NLMSG_TAIL(n) - (void *)nest;
663 return n->nlmsg_len;
664}
665
666struct rtattr *addattr_nest_compat(struct nlmsghdr *n, int maxlen, int type,
667 const void *data, int len)
668{
669 struct rtattr *start = NLMSG_TAIL(n);
670
671 addattr_l(n, maxlen, type, data, len);
672 addattr_nest(n, maxlen, type);
673 return start;
674}
675
676int addattr_nest_compat_end(struct nlmsghdr *n, struct rtattr *start)
677{
678 struct rtattr *nest = (void *)start + NLMSG_ALIGN(start->rta_len);
679
680 start->rta_len = (void *)NLMSG_TAIL(n) - (void *)start;
681 addattr_nest_end(n, nest);
682 return n->nlmsg_len;
683}
684
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000685int rta_addattr32(struct rtattr *rta, int maxlen, int type, __u32 data)
686{
687 int len = RTA_LENGTH(4);
688 struct rtattr *subrta;
689
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000690 if (RTA_ALIGN(rta->rta_len) + len > maxlen) {
691 fprintf(stderr,"rta_addattr32: Error! max allowed bound %d exceeded\n",maxlen);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000692 return -1;
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000693 }
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000694 subrta = (struct rtattr*)(((char*)rta) + RTA_ALIGN(rta->rta_len));
695 subrta->rta_type = type;
696 subrta->rta_len = len;
697 memcpy(RTA_DATA(subrta), &data, 4);
698 rta->rta_len = NLMSG_ALIGN(rta->rta_len) + len;
699 return 0;
700}
701
shemminger8ed63ab2005-09-21 19:33:17 +0000702int rta_addattr_l(struct rtattr *rta, int maxlen, int type,
osdl.net!shemminger6dc9f012004-08-31 17:45:21 +0000703 const void *data, int alen)
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000704{
705 struct rtattr *subrta;
706 int len = RTA_LENGTH(alen);
707
net[shemminger]!shemminger3dabdbb2005-03-30 18:18:12 +0000708 if (RTA_ALIGN(rta->rta_len) + RTA_ALIGN(len) > maxlen) {
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000709 fprintf(stderr,"rta_addattr_l: Error! max allowed bound %d exceeded\n",maxlen);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000710 return -1;
osdl.net!shemminger007d3a32004-08-13 23:54:55 +0000711 }
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000712 subrta = (struct rtattr*)(((char*)rta) + RTA_ALIGN(rta->rta_len));
713 subrta->rta_type = type;
714 subrta->rta_len = len;
715 memcpy(RTA_DATA(subrta), data, alen);
net[shemminger]!shemminger3dabdbb2005-03-30 18:18:12 +0000716 rta->rta_len = NLMSG_ALIGN(rta->rta_len) + RTA_ALIGN(len);
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000717 return 0;
718}
719
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000720int parse_rtattr(struct rtattr *tb[], int max, struct rtattr *rta, int len)
721{
Vlad Yasevichb1b7ce02013-03-15 10:01:28 -0700722 return parse_rtattr_flags(tb, max, rta, len, 0);
723}
724
725int parse_rtattr_flags(struct rtattr *tb[], int max, struct rtattr *rta,
726 int len, unsigned short flags)
727{
728 unsigned short type;
729
osdl.net!shemminger175e2442005-02-07 18:17:38 +0000730 memset(tb, 0, sizeof(struct rtattr *) * (max + 1));
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000731 while (RTA_OK(rta, len)) {
Vlad Yasevichb1b7ce02013-03-15 10:01:28 -0700732 type = rta->rta_type & ~flags;
733 if ((type <= max) && (!tb[type]))
734 tb[type] = rta;
osdl.org!shemmingeraba5acd2004-04-15 20:56:59 +0000735 rta = RTA_NEXT(rta,len);
736 }
737 if (len)
738 fprintf(stderr, "!!!Deficit %d, rta_len=%d\n", len, rta->rta_len);
739 return 0;
740}
net[shemminger]!shemmingerc7699872004-07-07 17:05:56 +0000741
742int parse_rtattr_byindex(struct rtattr *tb[], int max, struct rtattr *rta, int len)
743{
744 int i = 0;
osdl.net!shemminger175e2442005-02-07 18:17:38 +0000745
746 memset(tb, 0, sizeof(struct rtattr *) * max);
net[shemminger]!shemmingerc7699872004-07-07 17:05:56 +0000747 while (RTA_OK(rta, len)) {
osdl.net!shemminger175e2442005-02-07 18:17:38 +0000748 if (rta->rta_type <= max && i < max)
net[shemminger]!shemmingerc7699872004-07-07 17:05:56 +0000749 tb[i++] = rta;
750 rta = RTA_NEXT(rta,len);
751 }
752 if (len)
753 fprintf(stderr, "!!!Deficit %d, rta_len=%d\n", len, rta->rta_len);
754 return i;
755}
Patrick McHardy2f90c9c2007-08-14 11:21:19 -0700756
Jiri Pirkodecbb432015-01-06 17:23:45 +0100757struct rtattr *parse_rtattr_one(int type, struct rtattr *rta, int len)
758{
759 while (RTA_OK(rta, len)) {
760 if (rta->rta_type == type)
761 return rta;
762 rta = RTA_NEXT(rta, len);
763 }
764 if (len)
765 fprintf(stderr, "!!!Deficit %d, rta_len=%d\n", len, rta->rta_len);
766 return NULL;
767}
768
Patrick McHardy2f90c9c2007-08-14 11:21:19 -0700769int __parse_rtattr_nested_compat(struct rtattr *tb[], int max, struct rtattr *rta,
770 int len)
771{
772 if (RTA_PAYLOAD(rta) < len)
773 return -1;
774 if (RTA_PAYLOAD(rta) >= RTA_ALIGN(len) + sizeof(struct rtattr)) {
775 rta = RTA_DATA(rta) + RTA_ALIGN(len);
776 return parse_rtattr_nested(tb, max, rta);
777 }
Stephen Hemminger037c6352007-12-10 11:34:40 -0800778 memset(tb, 0, sizeof(struct rtattr *) * (max + 1));
Patrick McHardy2f90c9c2007-08-14 11:21:19 -0700779 return 0;
780}