ip/ip6tunnel.c

   1 /*
   2  * Copyright (C)2006 USAGI/WIDE Project
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with this program; if not, write to the Free Software
  16  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  17  */
  18 /*
  19  * Author:
  20  *      Masahide NAKAMURA @USAGI
  21  */
  22
  23 #include <stdio.h>
  24 #include <string.h>
  25 #include <stdlib.h>
  26 #include <unistd.h>
  27 #include <sys/types.h>
  28 #include <sys/socket.h>
  29 #include <arpa/inet.h>
  30 #include <sys/ioctl.h>
  31 #include <linux/ip.h>
  32 #include <linux/if.h>
  33 #include <linux/if_arp.h>
  34 #include <linux/if_tunnel.h>
  35 #include <linux/ip6_tunnel.h>
  36
  37 #include "utils.h"
  38 #include "tunnel.h"
  39 #include "ip_common.h"
  40
  41 #define IP6_FLOWINFO_TCLASS     htonl(0x0FF00000)
  42 #define IP6_FLOWINFO_FLOWLABEL  htonl(0x000FFFFF)
  43
  44 #define DEFAULT_TNL_HOP_LIMIT   (64)
  45
  46 static void usage(void) __attribute__((noreturn));
  47
  48 static void usage(void)
  49 {
  50         fprintf(stderr, "Usage: ip -f inet6 tunnel { add | change | del | show } [ NAME ]\n");
  51         fprintf(stderr, "          [ mode { ip6ip6 | ipip6 | any } ]\n");
  52         fprintf(stderr, "          [ remote ADDR local ADDR ] [ dev PHYS_DEV ]\n");
  53         fprintf(stderr, "          [ encaplimit ELIM ]\n");
  54         fprintf(stderr ,"          [ hoplimit TTL ] [ tclass TCLASS ] [ flowlabel FLOWLABEL ]\n");
  55         fprintf(stderr, "          [ dscp inherit ]\n");
  56         fprintf(stderr, "\n");
  57         fprintf(stderr, "Where: NAME      := STRING\n");
  58         fprintf(stderr, "       ADDR      := IPV6_ADDRESS\n");
  59         fprintf(stderr, "       ELIM      := { none | 0..255 }(default=%d)\n",
  60                 IPV6_DEFAULT_TNL_ENCAP_LIMIT);
  61         fprintf(stderr, "       TTL       := 0..255 (default=%d)\n",
  62                 DEFAULT_TNL_HOP_LIMIT);
  63         fprintf(stderr, "       TCLASS    := { 0x0..0xff | inherit }\n");
  64         fprintf(stderr, "       FLOWLABEL := { 0x0..0xfffff | inherit }\n");
  65         exit(-1);
  66 }
  67
  68 static void print_tunnel(struct ip6_tnl_parm *p)
  69 {
  70         char remote[64];
  71         char local[64];
  72
  73         inet_ntop(AF_INET6, &p->raddr, remote, sizeof(remote));
  74         inet_ntop(AF_INET6, &p->laddr, local, sizeof(local));
  75
  76         printf("%s: %s/ipv6 remote %s local %s",
  77                p->name, tnl_strproto(p->proto), remote, local);
  78         if (p->link) {
  79                 const char *n = ll_index_to_name(p->link);
  80                 if (n)
  81                         printf(" dev %s", n);
  82         }
  83
  84         if (p->flags & IP6_TNL_F_IGN_ENCAP_LIMIT)
  85                 printf(" encaplimit none");
  86         else
  87                 printf(" encaplimit %u", p->encap_limit);
  88
  89         printf(" hoplimit %u", p->hop_limit);
  90
  91         if (p->flags & IP6_TNL_F_USE_ORIG_TCLASS)
  92                 printf(" tclass inherit");
  93         else {
  94                 __u32 val = ntohl(p->flowinfo & IP6_FLOWINFO_TCLASS);
  95                 printf(" tclass 0x%02x", (__u8)(val >> 20));
  96         }
  97
  98         if (p->flags & IP6_TNL_F_USE_ORIG_FLOWLABEL)
  99                 printf(" flowlabel inherit");
 100         else
 101                 printf(" flowlabel 0x%05x", ntohl(p->flowinfo & IP6_FLOWINFO_FLOWLABEL));
 102
 103         printf(" (flowinfo 0x%08x)", ntohl(p->flowinfo));
 104
 105         if (p->flags & IP6_TNL_F_RCV_DSCP_COPY)
 106                 printf(" dscp inherit");
 107 }
 108
 109 static int parse_args(int argc, char **argv, int cmd, struct ip6_tnl_parm *p)
 110 {
 111         int count = 0;
 112         char medium[IFNAMSIZ];
 113
 114         memset(medium, 0, sizeof(medium));
 115
 116         while (argc > 0) {
 117                 if (strcmp(*argv, "mode") == 0) {
 118                         NEXT_ARG();
 119                         if (strcmp(*argv, "ipv6/ipv6") == 0 ||
 120                             strcmp(*argv, "ip6ip6") == 0)
 121                                 p->proto = IPPROTO_IPV6;
 122                         else if (strcmp(*argv, "ip/ipv6") == 0 ||
 123                                  strcmp(*argv, "ipv4/ipv6") == 0 ||
 124                                  strcmp(*argv, "ipip6") == 0 ||
 125                                  strcmp(*argv, "ip4ip6") == 0)
 126                                 p->proto = IPPROTO_IPIP;
 127                         else if (strcmp(*argv, "any/ipv6") == 0 ||
 128                                  strcmp(*argv, "any") == 0)
 129                                 p->proto = 0;
 130                         else {
 131                                 fprintf(stderr,"Cannot guess tunnel mode.\n");
 132                                 exit(-1);
 133                         }
 134                 } else if (strcmp(*argv, "remote") == 0) {
 135                         inet_prefix raddr;
 136                         NEXT_ARG();
 137                         get_prefix(&raddr, *argv, preferred_family);
 138                         if (raddr.family == AF_UNSPEC)
 139                                 invarg("\"remote\" address family is AF_UNSPEC", *argv);
 140                         memcpy(&p->raddr, &raddr.data, sizeof(p->raddr));
 141                 } else if (strcmp(*argv, "local") == 0) {
 142                         inet_prefix laddr;
 143                         NEXT_ARG();
 144                         get_prefix(&laddr, *argv, preferred_family);
 145                         if (laddr.family == AF_UNSPEC)
 146                                 invarg("\"local\" address family is AF_UNSPEC", *argv);
 147                         memcpy(&p->laddr, &laddr.data, sizeof(p->laddr));
 148                 } else if (strcmp(*argv, "dev") == 0) {
 149                         NEXT_ARG();
 150                         strncpy(medium, *argv, IFNAMSIZ - 1);
 151                 } else if (strcmp(*argv, "encaplimit") == 0) {
 152                         NEXT_ARG();
 153                         if (strcmp(*argv, "none") == 0) {
 154                                 p->flags |= IP6_TNL_F_IGN_ENCAP_LIMIT;
 155                         } else {
 156                                 __u8 uval;
 157                                 if (get_u8(&uval, *argv, 0) < -1)
 158                                         invarg("invalid ELIM", *argv);
 159                                 p->encap_limit = uval;
 160                                 p->flags &= ~IP6_TNL_F_IGN_ENCAP_LIMIT;
 161                         }
 162                 } else if (strcmp(*argv, "hoplimit") == 0 ||
 163                            strcmp(*argv, "ttl") == 0 ||
 164                            strcmp(*argv, "hlim") == 0) {
 165                         __u8 uval;
 166                         NEXT_ARG();
 167                         if (get_u8(&uval, *argv, 0))
 168                                 invarg("invalid TTL", *argv);
 169                         p->hop_limit = uval;
 170                 } else if (strcmp(*argv, "tclass") == 0 ||
 171                            strcmp(*argv, "tc") == 0 ||
 172                            strcmp(*argv, "tos") == 0 ||
 173                            matches(*argv, "dsfield") == 0) {
 174                         __u8 uval;
 175                         NEXT_ARG();
 176                         p->flowinfo &= ~IP6_FLOWINFO_TCLASS;
 177                         if (strcmp(*argv, "inherit") == 0)
 178                                 p->flags |= IP6_TNL_F_USE_ORIG_TCLASS;
 179                         else {
 180                                 if (get_u8(&uval, *argv, 16))
 181                                         invarg("invalid TClass", *argv);
 182                                 p->flowinfo |= htonl((__u32)uval << 20) & IP6_FLOWINFO_TCLASS;
 183                                 p->flags &= ~IP6_TNL_F_USE_ORIG_TCLASS;
 184                         }
 185                 } else if (strcmp(*argv, "flowlabel") == 0 ||
 186                            strcmp(*argv, "fl") == 0) {
 187                         __u32 uval;
 188                         NEXT_ARG();
 189                         p->flowinfo &= ~IP6_FLOWINFO_FLOWLABEL;
 190                         if (strcmp(*argv, "inherit") == 0)
 191                                 p->flags |= IP6_TNL_F_USE_ORIG_FLOWLABEL;
 192                         else {
 193                                 if (get_u32(&uval, *argv, 16))
 194                                         invarg("invalid Flowlabel", *argv);
 195                                 if (uval > 0xFFFFF)
 196                                         invarg("invalid Flowlabel", *argv);
 197                                 p->flowinfo |= htonl(uval) & IP6_FLOWINFO_FLOWLABEL;
 198                                 p->flags &= ~IP6_TNL_F_USE_ORIG_FLOWLABEL;
 199                         }
 200                 } else if (strcmp(*argv, "dscp") == 0) {
 201                         NEXT_ARG();
 202                         if (strcmp(*argv, "inherit") != 0)
 203                                 invarg("not inherit", *argv);
 204                         p->flags |= IP6_TNL_F_RCV_DSCP_COPY;
 205                 } else {
 206                         if (strcmp(*argv, "name") == 0) {
 207                                 NEXT_ARG();
 208                         }
 209                         if (matches(*argv, "help") == 0)
 210                                 usage();
 211                         if (p->name[0])
 212                                 duparg2("name", *argv);
 213                         strncpy(p->name, *argv, IFNAMSIZ - 1);
 214                         if (cmd == SIOCCHGTUNNEL && count == 0) {
 215                                 struct ip6_tnl_parm old_p;
 216                                 memset(&old_p, 0, sizeof(old_p));
 217                                 if (tnl_get_ioctl(*argv, &old_p))
 218                                         return -1;
 219                                 *p = old_p;
 220                         }
 221                 }
 222                 count++;
 223                 argc--; argv++;
 224         }
 225         if (medium[0]) {
 226                 p->link = ll_name_to_index(medium);
 227                 if (p->link == 0)
 228                         return -1;
 229         }
 230         return 0;
 231 }
 232
 233 static void ip6_tnl_parm_init(struct ip6_tnl_parm *p, int apply_default)
 234 {
 235         memset(p, 0, sizeof(*p));
 236         p->proto = IPPROTO_IPV6;
 237         if (apply_default) {
 238                 p->hop_limit = DEFAULT_TNL_HOP_LIMIT;
 239                 p->encap_limit = IPV6_DEFAULT_TNL_ENCAP_LIMIT;
 240         }
 241 }
 242
 243 /*
 244  * @p1: user specified parameter
 245  * @p2: database entry
 246  */
 247 static int ip6_tnl_parm_match(const struct ip6_tnl_parm *p1,
 248                               const struct ip6_tnl_parm *p2)
 249 {
 250         return ((!p1->link || p1->link == p2->link) &&
 251                 (!p1->name[0] || strcmp(p1->name, p2->name) == 0) &&
 252                 (memcmp(&p1->laddr, &in6addr_any, sizeof(p1->laddr)) == 0 ||
 253                  memcmp(&p1->laddr, &p2->laddr, sizeof(p1->laddr)) == 0) &&
 254                 (memcmp(&p1->raddr, &in6addr_any, sizeof(p1->raddr)) == 0 ||
 255                  memcmp(&p1->raddr, &p2->raddr, sizeof(p1->raddr)) == 0) &&
 256                 (!p1->proto || !p2->proto || p1->proto == p2->proto) &&
 257                 (!p1->encap_limit || p1->encap_limit == p2->encap_limit) &&
 258                 (!p1->hop_limit || p1->hop_limit == p2->hop_limit) &&
 259                 (!(p1->flowinfo & IP6_FLOWINFO_TCLASS) ||
 260                  !((p1->flowinfo ^ p2->flowinfo) & IP6_FLOWINFO_TCLASS)) &&
 261                 (!(p1->flowinfo & IP6_FLOWINFO_FLOWLABEL) ||
 262                  !((p1->flowinfo ^ p2->flowinfo) & IP6_FLOWINFO_FLOWLABEL)) &&
 263                 (!p1->flags || (p1->flags & p2->flags)));
 264 }
 265
 266 static int do_tunnels_list(struct ip6_tnl_parm *p)
 267 {
 268         char buf[512];
 269         int err = -1;
 270         FILE *fp = fopen("/proc/net/dev", "r");
 271         if (fp == NULL) {
 272                 perror("fopen");
 273                 goto end;
 274         }
 275
 276         /* skip two lines at the begenning of the file */
 277         if (!fgets(buf, sizeof(buf), fp) ||
 278             !fgets(buf, sizeof(buf), fp)) {
 279                 fprintf(stderr, "/proc/net/dev read error\n");
 280                 return -1;
 281         }
 282
 283         while (fgets(buf, sizeof(buf), fp) != NULL) {
 284                 char name[IFNAMSIZ];
 285                 int index, type;
 286                 unsigned long rx_bytes, rx_packets, rx_errs, rx_drops,
 287                         rx_fifo, rx_frame,
 288                         tx_bytes, tx_packets, tx_errs, tx_drops,
 289                         tx_fifo, tx_colls, tx_carrier, rx_multi;
 290                 struct ip6_tnl_parm p1;
 291                 char *ptr;
 292
 293                 buf[sizeof(buf) - 1] = '\0';
 294                 if ((ptr = strchr(buf, ':')) == NULL ||
 295                     (*ptr++ = 0, sscanf(buf, "%s", name) != 1)) {
 296                         fprintf(stderr, "Wrong format of /proc/net/dev. Sorry.\n");
 297                         goto end;
 298                 }
 299                 if (sscanf(ptr, "%ld%ld%ld%ld%ld%ld%ld%*d%ld%ld%ld%ld%ld%ld%ld",
 300                            &rx_bytes, &rx_packets, &rx_errs, &rx_drops,
 301                            &rx_fifo, &rx_frame, &rx_multi,
 302                            &tx_bytes, &tx_packets, &tx_errs, &tx_drops,
 303                            &tx_fifo, &tx_colls, &tx_carrier) != 14)
 304                         continue;
 305                 if (p->name[0] && strcmp(p->name, name))
 306                         continue;
 307                 index = ll_name_to_index(name);
 308                 if (index == 0)
 309                         continue;
 310                 type = ll_index_to_type(index);
 311                 if (type == -1) {
 312                         fprintf(stderr, "Failed to get type of [%s]\n", name);
 313                         continue;
 314                 }
 315                 if (type != ARPHRD_TUNNEL6)
 316                         continue;
 317                 memset(&p1, 0, sizeof(p1));
 318                 ip6_tnl_parm_init(&p1, 0);
 319                 strcpy(p1.name, name);
 320                 p1.link = ll_name_to_index(p1.name);
 321                 if (p1.link == 0)
 322                         continue;
 323                 if (tnl_get_ioctl(p1.name, &p1))
 324                         continue;
 325                 if (!ip6_tnl_parm_match(p, &p1))
 326                         continue;
 327                 print_tunnel(&p1);
 328                 if (show_stats) {
 329                         printf("%s", _SL_);
 330                         printf("RX: Packets    Bytes        Errors CsumErrs OutOfSeq Mcasts%s", _SL_);
 331                         printf("    %-10ld %-12ld %-6ld %-8ld %-8ld %-8ld%s",
 332                                rx_packets, rx_bytes, rx_errs, rx_frame, rx_fifo, rx_multi, _SL_);
 333                         printf("TX: Packets    Bytes        Errors DeadLoop NoRoute  NoBufs%s", _SL_);
 334                         printf("    %-10ld %-12ld %-6ld %-8ld %-8ld %-6ld",
 335                                tx_packets, tx_bytes, tx_errs, tx_colls, tx_carrier, tx_drops);
 336                 }
 337                 printf("\n");
 338         }
 339         err = 0;
 340
 341  end:
 342         if (fp)
 343                 fclose(fp);
 344         return err;
 345 }
 346
 347 static int do_show(int argc, char **argv)
 348 {
 349         struct ip6_tnl_parm p;
 350
 351         ll_init_map(&rth);
 352         ip6_tnl_parm_init(&p, 0);
 353         p.proto = 0;  /* default to any */
 354
 355         if (parse_args(argc, argv, SIOCGETTUNNEL, &p) < 0)
 356                 return -1;
 357
 358         if (!p.name[0] || show_stats)
 359                 do_tunnels_list(&p);
 360         else {
 361                 if (tnl_get_ioctl(p.name, &p))
 362                         return -1;
 363                 print_tunnel(&p);
 364                 printf("\n");
 365         }
 366
 367         return 0;
 368 }
 369
 370 static int do_add(int cmd, int argc, char **argv)
 371 {
 372         struct ip6_tnl_parm p;
 373
 374         ip6_tnl_parm_init(&p, 1);
 375
 376         if (parse_args(argc, argv, cmd, &p) < 0)
 377                 return -1;
 378
 379         return tnl_add_ioctl(cmd,
 380                              cmd == SIOCCHGTUNNEL && p.name[0] ?
 381                              p.name : "ip6tnl0", p.name, &p);
 382 }
 383
 384 static int do_del(int argc, char **argv)
 385 {
 386         struct ip6_tnl_parm p;
 387
 388         ip6_tnl_parm_init(&p, 1);
 389
 390         if (parse_args(argc, argv, SIOCDELTUNNEL, &p) < 0)
 391                 return -1;
 392
 393         return tnl_del_ioctl(p.name[0] ? p.name : "ip6tnl0", p.name, &p);
 394 }
 395
 396 int do_ip6tunnel(int argc, char **argv)
 397 {
 398         switch (preferred_family) {
 399         case AF_UNSPEC:
 400                 preferred_family = AF_INET6;
 401                 break;
 402         case AF_INET6:
 403                 break;
 404         default:
 405                 fprintf(stderr, "Unsupported family:%d\n", preferred_family);
 406                 exit(-1);
 407         }
 408
 409         if (argc > 0) {
 410                 if (matches(*argv, "add") == 0)
 411                         return do_add(SIOCADDTUNNEL, argc - 1, argv + 1);
 412                 if (matches(*argv, "change") == 0)
 413                         return do_add(SIOCCHGTUNNEL, argc - 1, argv + 1);
 414                 if (matches(*argv, "delete") == 0)
 415                         return do_del(argc - 1, argv + 1);
 416                 if (matches(*argv, "show") == 0 ||
 417                     matches(*argv, "lst") == 0 ||
 418                     matches(*argv, "list") == 0)
 419                         return do_show(argc - 1, argv + 1);
 420                 if (matches(*argv, "help") == 0)
 421                         usage();
 422         } else
 423                 return do_show(0, NULL);
 424
 425         fprintf(stderr, "Command \"%s\" is unknown, try \"ip -f inet6 tunnel help\".\n", *argv);
 426         exit(-1);
 427 }