4 * Copyright (C)2004 USAGI/WIDE Project
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
25 * Masahide NAKAMURA @USAGI
32 #include <linux/netlink.h>
33 #include <linux/xfrm.h>
36 #include "ip_common.h"
38 //#define NLMSG_FLUSH_BUF_SIZE (4096-512)
39 #define NLMSG_FLUSH_BUF_SIZE 8192
42 * Receiving buffer defines:
44 * data = struct xfrm_userpolicy_info
46 * data = struct xfrm_user_tmpl[]
48 #define NLMSG_BUF_SIZE 4096
49 #define RTA_BUF_SIZE 2048
50 #define XFRM_TMPLS_BUF_SIZE 1024
52 static void usage(void) __attribute__((noreturn));
54 static void usage(void)
56 fprintf(stderr, "Usage: ip xfrm policy { add | update } dir DIR SELECTOR [ index INDEX ] \n");
57 fprintf(stderr, " [ action ACTION ] [ priority PRIORITY ] [ LIMIT-LIST ] [ TMPL-LIST ]\n");
58 fprintf(stderr, "Usage: ip xfrm policy { delete | get } dir DIR [ SELECTOR | index INDEX ]\n");
59 fprintf(stderr, "Usage: ip xfrm policy { flush | list } [ dir DIR ] [ SELECTOR ]\n");
60 fprintf(stderr, " [ index INDEX ] [ action ACTION ] [ priority PRIORITY ]\n");
61 fprintf(stderr, "DIR := [ in | out | fwd ]\n");
63 fprintf(stderr, "SELECTOR := src ADDR[/PLEN] dst ADDR[/PLEN] [ UPSPEC ] [ dev DEV ]\n");
65 fprintf(stderr, "UPSPEC := proto PROTO [ sport PORT ] [ dport PORT ]\n");
67 //fprintf(stderr, "DEV - device name(default=none)\n");
69 fprintf(stderr, "ACTION := [ allow | block ](default=allow)\n");
71 //fprintf(stderr, "PRIORITY - priority value(default=0)\n");
73 fprintf(stderr, "LIMIT-LIST := [ LIMIT-LIST ] | [ limit LIMIT ]\n");
74 fprintf(stderr, "LIMIT := [ [time-soft|time-hard|time-use-soft|time-use-hard] SECONDS ] |\n");
75 fprintf(stderr, " [ [byte-soft|byte-hard] SIZE ] | [ [packet-soft|packet-hard] NUMBER ]\n");
77 fprintf(stderr, "TMPL-LIST := [ TMPL-LIST ] | [ tmpl TMPL ]\n");
78 fprintf(stderr, "TMPL := ID [ mode MODE ] [ reqid REQID ] [ level LEVEL ]\n");
79 fprintf(stderr, "ID := [ src ADDR ] [ dst ADDR ] [ proto XFRM_PROTO ] [ spi SPI ]\n");
81 //fprintf(stderr, "XFRM_PROTO := [ esp | ah | ipcomp ]\n");
82 fprintf(stderr, "XFRM_PROTO := [ ");
83 fprintf(stderr, "%s | ", strxf_proto(IPPROTO_ESP));
84 fprintf(stderr, "%s | ", strxf_proto(IPPROTO_AH));
85 fprintf(stderr, "%s", strxf_proto(IPPROTO_COMP));
86 fprintf(stderr, " ]\n");
88 fprintf(stderr, "MODE := [ transport | tunnel ](default=transport)\n");
89 //fprintf(stderr, "REQID - number(default=0)\n");
90 fprintf(stderr, "LEVEL := [ required | use ](default=required)\n");
95 static int xfrm_policy_dir_parse(__u8 *dir, int *argcp, char ***argvp)
100 if (strcmp(*argv, "in") == 0)
101 *dir = XFRM_POLICY_IN;
102 else if (strcmp(*argv, "out") == 0)
103 *dir = XFRM_POLICY_OUT;
104 else if (strcmp(*argv, "fwd") == 0)
105 *dir = XFRM_POLICY_FWD;
107 invarg("\"DIR\" is invalid", *argv);
115 static int xfrm_tmpl_parse(struct xfrm_user_tmpl *tmpl,
116 int *argcp, char ***argvp)
119 char **argv = *argvp;
123 if (strcmp(*argv, "mode") == 0) {
125 xfrm_mode_parse(&tmpl->mode, &argc, &argv);
126 } else if (strcmp(*argv, "reqid") == 0) {
128 xfrm_reqid_parse(&tmpl->reqid, &argc, &argv);
129 } else if (strcmp(*argv, "level") == 0) {
132 if (strcmp(*argv, "required") == 0)
134 else if (strcmp(*argv, "use") == 0)
137 invarg("\"LEVEL\" is invalid\n", *argv);
141 PREV_ARG(); /* back track */
145 xfrm_id_parse(&tmpl->saddr, &tmpl->id, &tmpl->family,
147 if (preferred_family == AF_UNSPEC)
148 preferred_family = tmpl->family;
165 static int xfrm_policy_modify(int cmd, unsigned flags, int argc, char **argv)
167 struct rtnl_handle rth;
170 struct xfrm_userpolicy_info xpinfo;
171 char buf[RTA_BUF_SIZE];
175 char tmpls_buf[XFRM_TMPLS_BUF_SIZE];
178 memset(&req, 0, sizeof(req));
179 memset(&tmpls_buf, 0, sizeof(tmpls_buf));
181 req.n.nlmsg_len = NLMSG_LENGTH(sizeof(req.xpinfo));
182 req.n.nlmsg_flags = NLM_F_REQUEST|flags;
183 req.n.nlmsg_type = cmd;
184 req.xpinfo.sel.family = preferred_family;
186 req.xpinfo.lft.soft_byte_limit = XFRM_INF;
187 req.xpinfo.lft.hard_byte_limit = XFRM_INF;
188 req.xpinfo.lft.soft_packet_limit = XFRM_INF;
189 req.xpinfo.lft.hard_packet_limit = XFRM_INF;
192 if (strcmp(*argv, "dir") == 0) {
194 duparg("dir", *argv);
198 xfrm_policy_dir_parse(&req.xpinfo.dir, &argc, &argv);
200 filter.dir_mask = XFRM_FILTER_MASK_FULL;
202 } else if (strcmp(*argv, "index") == 0) {
204 if (get_u32(&req.xpinfo.index, *argv, 0))
205 invarg("\"INDEX\" is invalid", *argv);
207 filter.index_mask = XFRM_FILTER_MASK_FULL;
209 } else if (strcmp(*argv, "action") == 0) {
211 if (strcmp(*argv, "allow") == 0)
212 req.xpinfo.action = XFRM_POLICY_ALLOW;
213 else if (strcmp(*argv, "block") == 0)
214 req.xpinfo.action = XFRM_POLICY_BLOCK;
216 invarg("\"action\" value is invalid\n", *argv);
218 filter.action_mask = XFRM_FILTER_MASK_FULL;
220 } else if (strcmp(*argv, "priority") == 0) {
222 if (get_u32(&req.xpinfo.priority, *argv, 0))
223 invarg("\"PRIORITY\" is invalid", *argv);
225 filter.priority_mask = XFRM_FILTER_MASK_FULL;
227 } else if (strcmp(*argv, "limit") == 0) {
229 xfrm_lifetime_cfg_parse(&req.xpinfo.lft, &argc, &argv);
230 } else if (strcmp(*argv, "tmpl") == 0) {
231 struct xfrm_user_tmpl *tmpl;
233 if (tmpls_len + sizeof(*tmpl) > sizeof(tmpls_buf)) {
234 fprintf(stderr, "Too many tmpls: buffer overflow\n");
237 tmpl = (struct xfrm_user_tmpl *)((char *)tmpls_buf + tmpls_len);
239 tmpl->family = preferred_family;
240 tmpl->aalgos = (~(__u32)0);
241 tmpl->ealgos = (~(__u32)0);
242 tmpl->calgos = (~(__u32)0);
245 xfrm_tmpl_parse(tmpl, &argc, &argv);
247 tmpls_len += sizeof(*tmpl);
250 duparg("unknown", *argv);
253 xfrm_selector_parse(&req.xpinfo.sel, &argc, &argv);
254 if (preferred_family == AF_UNSPEC)
255 preferred_family = req.xpinfo.sel.family;
262 fprintf(stderr, "Not enough information: \"DIR\" is required.\n");
267 addattr_l(&req.n, sizeof(req), XFRMA_TMPL,
268 (void *)tmpls_buf, tmpls_len);
271 if (rtnl_open_byproto(&rth, 0, NETLINK_XFRM) < 0)
274 if (req.xpinfo.sel.family == AF_UNSPEC)
275 req.xpinfo.sel.family = AF_INET;
277 if (rtnl_talk(&rth, &req.n, 0, 0, NULL, NULL, NULL) < 0)
285 static int xfrm_policy_filter_match(struct xfrm_userpolicy_info *xpinfo)
290 if ((xpinfo->dir^filter.xpinfo.dir)&filter.dir_mask)
293 if (filter.sel_src_mask) {
294 if (memcmp(&xpinfo->sel.saddr, &filter.xpinfo.sel.saddr,
295 filter.sel_src_mask) != 0)
297 if (xpinfo->sel.prefixlen_s != filter.xpinfo.sel.prefixlen_s)
301 if (filter.sel_dst_mask) {
302 if (memcmp(&xpinfo->sel.daddr, &filter.xpinfo.sel.daddr,
303 filter.sel_dst_mask) != 0)
305 if (xpinfo->sel.prefixlen_d != filter.xpinfo.sel.prefixlen_d)
309 if ((xpinfo->sel.ifindex^filter.xpinfo.sel.ifindex)&filter.sel_dev_mask)
312 if ((xpinfo->sel.proto^filter.xpinfo.sel.proto)&filter.upspec_proto_mask)
315 if (filter.upspec_sport_mask) {
316 if ((xpinfo->sel.sport^filter.xpinfo.sel.sport)&filter.upspec_sport_mask)
320 if (filter.upspec_dport_mask) {
321 if ((xpinfo->sel.dport^filter.xpinfo.sel.dport)&filter.upspec_dport_mask)
325 if ((xpinfo->index^filter.xpinfo.index)&filter.index_mask)
328 if ((xpinfo->action^filter.xpinfo.action)&filter.action_mask)
331 if ((xpinfo->priority^filter.xpinfo.priority)&filter.priority_mask)
337 static int xfrm_policy_print(const struct sockaddr_nl *who,
338 const struct nlmsghdr *n, void *arg)
340 FILE *fp = (FILE*)arg;
341 struct xfrm_userpolicy_info *xpinfo = NLMSG_DATA(n);
342 int len = n->nlmsg_len;
343 struct rtattr * tb[XFRM_MAX_DEPTH];
346 if (n->nlmsg_type != XFRM_MSG_NEWPOLICY &&
347 n->nlmsg_type != XFRM_MSG_DELPOLICY) {
348 fprintf(stderr, "Not a policy: %08x %08x %08x\n",
349 n->nlmsg_len, n->nlmsg_type, n->nlmsg_flags);
353 len -= NLMSG_LENGTH(sizeof(*xpinfo));
355 fprintf(stderr, "BUG: wrong nlmsg len %d\n", len);
359 if (!xfrm_policy_filter_match(xpinfo))
362 memset(tb, 0, sizeof(tb));
363 ntb = parse_rtattr_byindex(tb, XFRM_MAX_DEPTH, XFRMP_RTA(xpinfo), len);
365 if (n->nlmsg_type == XFRM_MSG_DELPOLICY)
366 fprintf(fp, "Deleted ");
368 xfrm_selector_print(&xpinfo->sel, preferred_family, fp, NULL);
372 switch (xpinfo->dir) {
376 case XFRM_POLICY_OUT:
379 case XFRM_POLICY_FWD:
383 fprintf(fp, "%d", xpinfo->dir);
388 switch (xpinfo->action) {
389 case XFRM_POLICY_ALLOW:
391 fprintf(fp, "action allow ");
393 case XFRM_POLICY_BLOCK:
394 fprintf(fp, "action block ");
397 fprintf(fp, "action %d ", xpinfo->action);
402 fprintf(fp, "index %u ", xpinfo->index);
403 fprintf(fp, "priority %u ", xpinfo->priority);
404 if (show_stats > 0) {
405 fprintf(fp, "share %s ", strxf_share(xpinfo->share));
406 fprintf(fp, "flags 0x%s", strxf_flags(xpinfo->flags));
408 fprintf(fp, "%s", _SL_);
411 xfrm_lifetime_print(&xpinfo->lft, &xpinfo->curlft, fp, "\t");
413 xfrm_xfrma_print(tb, ntb, xpinfo->sel.family, fp, "\t");
421 static int xfrm_policy_get_or_delete(int argc, char **argv, int delete,
424 struct rtnl_handle rth;
427 struct xfrm_userpolicy_id xpid;
433 memset(&req, 0, sizeof(req));
435 req.n.nlmsg_len = NLMSG_LENGTH(sizeof(req.xpid));
436 req.n.nlmsg_flags = NLM_F_REQUEST;
437 req.n.nlmsg_type = delete ? XFRM_MSG_DELPOLICY : XFRM_MSG_GETPOLICY;
440 if (strcmp(*argv, "dir") == 0) {
442 duparg("dir", *argv);
446 xfrm_policy_dir_parse(&req.xpid.dir, &argc, &argv);
448 } else if (strcmp(*argv, "index") == 0) {
450 duparg("index", *argv);
454 if (get_u32(&req.xpid.index, *argv, 0))
455 invarg("\"INDEX\" is invalid", *argv);
459 invarg("unknown", *argv);
462 xfrm_selector_parse(&req.xpid.sel, &argc, &argv);
463 if (preferred_family == AF_UNSPEC)
464 preferred_family = req.xpid.sel.family;
472 fprintf(stderr, "Not enough information: \"DIR\" is required.\n");
475 if (!selp && !indexp) {
476 fprintf(stderr, "Not enough information: either \"SELECTOR\" or \"INDEX\" is required.\n");
480 duparg2("SELECTOR", "INDEX");
482 if (rtnl_open_byproto(&rth, 0, NETLINK_XFRM) < 0)
485 if (req.xpid.sel.family == AF_UNSPEC)
486 req.xpid.sel.family = AF_INET;
488 if (rtnl_talk(&rth, &req.n, 0, 0, res_nlbuf, NULL, NULL) < 0)
496 static int xfrm_policy_delete(int argc, char **argv)
498 return xfrm_policy_get_or_delete(argc, argv, 1, NULL);
501 static int xfrm_policy_get(int argc, char **argv)
503 char buf[NLMSG_BUF_SIZE];
504 struct nlmsghdr *n = (struct nlmsghdr *)buf;
506 memset(buf, 0, sizeof(buf));
508 xfrm_policy_get_or_delete(argc, argv, 0, n);
510 if (xfrm_policy_print(NULL, n, (void*)stdout) < 0) {
511 fprintf(stderr, "An error :-)\n");
519 * With an existing policy of nlmsg, make new nlmsg for deleting the policy
520 * and store it to buffer.
522 static int xfrm_policy_keep(const struct sockaddr_nl *who,
523 const struct nlmsghdr *n,
526 struct xfrm_buffer *xb = (struct xfrm_buffer *)arg;
527 struct rtnl_handle *rth = xb->rth;
528 struct xfrm_userpolicy_info *xpinfo = NLMSG_DATA(n);
529 int len = n->nlmsg_len;
530 struct nlmsghdr *new_n;
531 struct xfrm_userpolicy_id *xpid;
533 if (n->nlmsg_type != XFRM_MSG_NEWPOLICY) {
534 fprintf(stderr, "Not a policy: %08x %08x %08x\n",
535 n->nlmsg_len, n->nlmsg_type, n->nlmsg_flags);
539 len -= NLMSG_LENGTH(sizeof(*xpinfo));
541 fprintf(stderr, "BUG: wrong nlmsg len %d\n", len);
545 if (!xfrm_policy_filter_match(xpinfo))
548 if (xb->offset > xb->size) {
549 fprintf(stderr, "Flush buffer overflow\n");
553 new_n = (struct nlmsghdr *)(xb->buf + xb->offset);
554 new_n->nlmsg_len = NLMSG_LENGTH(sizeof(*xpid));
555 new_n->nlmsg_flags = NLM_F_REQUEST;
556 new_n->nlmsg_type = XFRM_MSG_DELPOLICY;
557 new_n->nlmsg_seq = ++rth->seq;
559 xpid = NLMSG_DATA(new_n);
560 memcpy(&xpid->sel, &xpinfo->sel, sizeof(xpid->sel));
561 xpid->dir = xpinfo->dir;
562 xpid->index = xpinfo->index;
564 xb->offset += new_n->nlmsg_len;
570 static int xfrm_policy_list_or_flush(int argc, char **argv, int flush)
573 struct rtnl_handle rth;
577 filter.xpinfo.sel.family = preferred_family;
580 if (strcmp(*argv, "dir") == 0) {
582 xfrm_policy_dir_parse(&filter.xpinfo.dir, &argc, &argv);
584 filter.dir_mask = XFRM_FILTER_MASK_FULL;
586 } else if (strcmp(*argv, "index") == 0) {
588 if (get_u32(&filter.xpinfo.index, *argv, 0))
589 invarg("\"INDEX\" is invalid", *argv);
591 filter.index_mask = XFRM_FILTER_MASK_FULL;
593 } else if (strcmp(*argv, "action") == 0) {
595 if (strcmp(*argv, "allow") == 0)
596 filter.xpinfo.action = XFRM_POLICY_ALLOW;
597 else if (strcmp(*argv, "block") == 0)
598 filter.xpinfo.action = XFRM_POLICY_BLOCK;
600 invarg("\"ACTION\" is invalid\n", *argv);
602 filter.action_mask = XFRM_FILTER_MASK_FULL;
604 } else if (strcmp(*argv, "priority") == 0) {
606 if (get_u32(&filter.xpinfo.priority, *argv, 0))
607 invarg("\"PRIORITY\" is invalid", *argv);
609 filter.priority_mask = XFRM_FILTER_MASK_FULL;
613 invarg("unknown", *argv);
616 xfrm_selector_parse(&filter.xpinfo.sel, &argc, &argv);
617 if (preferred_family == AF_UNSPEC)
618 preferred_family = filter.xpinfo.sel.family;
625 if (rtnl_open_byproto(&rth, 0, NETLINK_XFRM) < 0)
629 struct xfrm_buffer xb;
630 char buf[NLMSG_FLUSH_BUF_SIZE];
634 xb.size = sizeof(buf);
642 fprintf(stderr, "Flush round = %d\n", i);
644 if (rtnl_wilddump_request(&rth, preferred_family, XFRM_MSG_GETPOLICY) < 0) {
645 perror("Cannot send dump request");
649 if (rtnl_dump_filter(&rth, xfrm_policy_keep, &xb, NULL, NULL) < 0) {
650 fprintf(stderr, "Flush terminated\n");
653 if (xb.nlmsg_count == 0) {
655 fprintf(stderr, "Flush completed\n");
659 if (rtnl_send(&rth, xb.buf, xb.offset) < 0) {
660 perror("Failed to send flush request\n");
664 fprintf(stderr, "Flushed nlmsg count = %d\n", xb.nlmsg_count);
670 if (rtnl_wilddump_request(&rth, preferred_family, XFRM_MSG_GETPOLICY) < 0) {
671 perror("Cannot send dump request");
675 if (rtnl_dump_filter(&rth, xfrm_policy_print, stdout, NULL, NULL) < 0) {
676 fprintf(stderr, "Dump terminated\n");
686 static int xfrm_policy_flush_all(void)
688 struct rtnl_handle rth;
693 memset(&req, 0, sizeof(req));
695 req.n.nlmsg_len = NLMSG_LENGTH(0); /* nlmsg data is nothing */
696 req.n.nlmsg_flags = NLM_F_REQUEST;
697 req.n.nlmsg_type = XFRM_MSG_FLUSHPOLICY;
699 if (rtnl_open_byproto(&rth, 0, NETLINK_XFRM) < 0)
703 fprintf(stderr, "Flush all\n");
705 if (rtnl_talk(&rth, &req.n, 0, 0, NULL, NULL, NULL) < 0)
713 int do_xfrm_policy(int argc, char **argv)
716 return xfrm_policy_list_or_flush(0, NULL, 0);
718 if (matches(*argv, "add") == 0)
719 return xfrm_policy_modify(XFRM_MSG_NEWPOLICY, 0,
721 if (matches(*argv, "update") == 0)
722 return xfrm_policy_modify(XFRM_MSG_UPDPOLICY, 0,
724 if (matches(*argv, "delete") == 0 || matches(*argv, "del") == 0)
725 return xfrm_policy_delete(argc-1, argv+1);
726 if (matches(*argv, "list") == 0 || matches(*argv, "show") == 0
727 || matches(*argv, "lst") == 0)
728 return xfrm_policy_list_or_flush(argc-1, argv+1, 0);
729 if (matches(*argv, "get") == 0)
730 return xfrm_policy_get(argc-1, argv+1);
731 if (matches(*argv, "flush") == 0) {
733 return xfrm_policy_flush_all();
735 return xfrm_policy_list_or_flush(argc-1, argv+1, 1);
737 if (matches(*argv, "help") == 0)
739 fprintf(stderr, "Command \"%s\" is unknown, try \"ip xfrm policy help\".\n", *argv);