git.maemo.org Git - busybox4maemo/blob - networking/libiproute/iptunnel.c

   1 /* vi: set sw=4 ts=4: */
   2 /*
   3  * iptunnel.c          "ip tunnel"
   4  *
   5  * Licensed under the GPL v2 or later, see the file LICENSE in this tarball.
   6  *
   7  * Authors:     Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
   8  *
   9  *
  10  * Changes:
  11  *
  12  * Rani Assaf <rani@magic.metawire.com> 980929: resolve addresses
  13  * Rani Assaf <rani@magic.metawire.com> 980930: do not allow key for ipip/sit
  14  * Phil Karn <karn@ka9q.ampr.org>       990408: "pmtudisc" flag
  15  */
  16
  17 #include <netinet/ip.h>
  18 #include <net/if.h>
  19 #include <net/if_arp.h>
  20 #include <asm/types.h>
  21 #ifndef __constant_htons
  22 #define __constant_htons htons
  23 #endif
  24 #include <linux/if_tunnel.h>
  25
  26 #include "ip_common.h"  /* #include "libbb.h" is inside */
  27 #include "rt_names.h"
  28 #include "utils.h"
  29
  30
  31 /* Dies on error */
  32 static int do_ioctl_get_ifindex(char *dev)
  33 {
  34         struct ifreq ifr;
  35         int fd;
  36
  37         strncpy(ifr.ifr_name, dev, sizeof(ifr.ifr_name));
  38         fd = xsocket(AF_INET, SOCK_DGRAM, 0);
  39         xioctl(fd, SIOCGIFINDEX, &ifr);
  40         close(fd);
  41         return ifr.ifr_ifindex;
  42 }
  43
  44 static int do_ioctl_get_iftype(char *dev)
  45 {
  46         struct ifreq ifr;
  47         int fd;
  48         int err;
  49
  50         strncpy(ifr.ifr_name, dev, sizeof(ifr.ifr_name));
  51         fd = xsocket(AF_INET, SOCK_DGRAM, 0);
  52         err = ioctl_or_warn(fd, SIOCGIFHWADDR, &ifr);
  53         close(fd);
  54         return err ? -1 : ifr.ifr_addr.sa_family;
  55 }
  56
  57 static char *do_ioctl_get_ifname(int idx)
  58 {
  59         struct ifreq ifr;
  60         int fd;
  61         int err;
  62
  63         ifr.ifr_ifindex = idx;
  64         fd = xsocket(AF_INET, SOCK_DGRAM, 0);
  65         err = ioctl_or_warn(fd, SIOCGIFNAME, &ifr);
  66         close(fd);
  67         return err ? NULL : xstrndup(ifr.ifr_name, sizeof(ifr.ifr_name));
  68 }
  69
  70 static int do_get_ioctl(const char *basedev, struct ip_tunnel_parm *p)
  71 {
  72         struct ifreq ifr;
  73         int fd;
  74         int err;
  75
  76         strncpy(ifr.ifr_name, basedev, sizeof(ifr.ifr_name));
  77         ifr.ifr_ifru.ifru_data = (void*)p;
  78         fd = xsocket(AF_INET, SOCK_DGRAM, 0);
  79         err = ioctl_or_warn(fd, SIOCGETTUNNEL, &ifr);
  80         close(fd);
  81         return err;
  82 }
  83
  84 /* Dies on error, otherwise returns 0 */
  85 static int do_add_ioctl(int cmd, const char *basedev, struct ip_tunnel_parm *p)
  86 {
  87         struct ifreq ifr;
  88         int fd;
  89
  90         if (cmd == SIOCCHGTUNNEL && p->name[0]) {
  91                 strncpy(ifr.ifr_name, p->name, sizeof(ifr.ifr_name));
  92         } else {
  93                 strncpy(ifr.ifr_name, basedev, sizeof(ifr.ifr_name));
  94         }
  95         ifr.ifr_ifru.ifru_data = (void*)p;
  96         fd = xsocket(AF_INET, SOCK_DGRAM, 0);
  97 #if ENABLE_IOCTL_HEX2STR_ERROR
  98         /* #define magic will turn ioctl# into string */
  99         if (cmd == SIOCCHGTUNNEL)
 100                 xioctl(fd, SIOCCHGTUNNEL, &ifr);
 101         else
 102                 xioctl(fd, SIOCADDTUNNEL, &ifr);
 103 #else
 104         xioctl(fd, cmd, &ifr);
 105 #endif
 106         close(fd);
 107         return 0;
 108 }
 109
 110 /* Dies on error, otherwise returns 0 */
 111 static int do_del_ioctl(const char *basedev, struct ip_tunnel_parm *p)
 112 {
 113         struct ifreq ifr;
 114         int fd;
 115
 116         if (p->name[0]) {
 117                 strncpy(ifr.ifr_name, p->name, sizeof(ifr.ifr_name));
 118         } else {
 119                 strncpy(ifr.ifr_name, basedev, sizeof(ifr.ifr_name));
 120         }
 121         ifr.ifr_ifru.ifru_data = (void*)p;
 122         fd = xsocket(AF_INET, SOCK_DGRAM, 0);
 123         xioctl(fd, SIOCDELTUNNEL, &ifr);
 124         close(fd);
 125         return 0;
 126 }
 127
 128 /* Dies on error */
 129 static void parse_args(char **argv, int cmd, struct ip_tunnel_parm *p)
 130 {
 131         static const char keywords[] ALIGN1 =
 132                 "mode\0""ipip\0""ip/ip\0""gre\0""gre/ip\0""sit\0""ipv6/ip\0"
 133                 "key\0""ikey\0""okey\0""seq\0""iseq\0""oseq\0"
 134                 "csum\0""icsum\0""ocsum\0""nopmtudisc\0""pmtudisc\0"
 135                 "remote\0""any\0""local\0""dev\0"
 136                 "ttl\0""inherit\0""tos\0""dsfield\0"
 137                 "name\0";
 138         enum {
 139                 ARG_mode, ARG_ipip, ARG_ip_ip, ARG_gre, ARG_gre_ip, ARG_sit, ARG_ip6_ip,
 140                 ARG_key, ARG_ikey, ARG_okey, ARG_seq, ARG_iseq, ARG_oseq,
 141                 ARG_csum, ARG_icsum, ARG_ocsum, ARG_nopmtudisc, ARG_pmtudisc,
 142                 ARG_remote, ARG_any, ARG_local, ARG_dev,
 143                 ARG_ttl, ARG_inherit, ARG_tos, ARG_dsfield,
 144                 ARG_name
 145         };
 146         int count = 0;
 147         char medium[IFNAMSIZ];
 148         int key;
 149
 150         memset(p, 0, sizeof(*p));
 151         memset(&medium, 0, sizeof(medium));
 152
 153         p->iph.version = 4;
 154         p->iph.ihl = 5;
 155 #ifndef IP_DF
 156 #define IP_DF 0x4000  /* Flag: "Don't Fragment" */
 157 #endif
 158         p->iph.frag_off = htons(IP_DF);
 159
 160         while (*argv) {
 161                 key = index_in_strings(keywords, *argv);
 162                 if (key == ARG_mode) {
 163                         NEXT_ARG();
 164                         key = index_in_strings(keywords, *argv);
 165                         if (key == ARG_ipip ||
 166                             key == ARG_ip_ip) {
 167                                 if (p->iph.protocol && p->iph.protocol != IPPROTO_IPIP) {
 168                                         bb_error_msg_and_die("you managed to ask for more than one tunnel mode");
 169                                 }
 170                                 p->iph.protocol = IPPROTO_IPIP;
 171                         } else if (key == ARG_gre ||
 172                                    key == ARG_gre_ip) {
 173                                 if (p->iph.protocol && p->iph.protocol != IPPROTO_GRE) {
 174                                         bb_error_msg_and_die("you managed to ask for more than one tunnel mode");
 175                                 }
 176                                 p->iph.protocol = IPPROTO_GRE;
 177                         } else if (key == ARG_sit ||
 178                                    key == ARG_ip6_ip) {
 179                                 if (p->iph.protocol && p->iph.protocol != IPPROTO_IPV6) {
 180                                         bb_error_msg_and_die("you managed to ask for more than one tunnel mode");
 181                                 }
 182                                 p->iph.protocol = IPPROTO_IPV6;
 183                         } else {
 184                                 bb_error_msg_and_die("cannot guess tunnel mode");
 185                         }
 186                 } else if (key == ARG_key) {
 187                         unsigned uval;
 188                         NEXT_ARG();
 189                         p->i_flags |= GRE_KEY;
 190                         p->o_flags |= GRE_KEY;
 191                         if (strchr(*argv, '.'))
 192                                 p->i_key = p->o_key = get_addr32(*argv);
 193                         else {
 194                                 if (get_unsigned(&uval, *argv, 0)<0) {
 195                                         bb_error_msg_and_die("invalid value of \"key\"");
 196                                 }
 197                                 p->i_key = p->o_key = htonl(uval);
 198                         }
 199                 } else if (key == ARG_ikey) {
 200                         unsigned uval;
 201                         NEXT_ARG();
 202                         p->i_flags |= GRE_KEY;
 203                         if (strchr(*argv, '.'))
 204                                 p->o_key = get_addr32(*argv);
 205                         else {
 206                                 if (get_unsigned(&uval, *argv, 0)<0) {
 207                                         bb_error_msg_and_die("invalid value of \"ikey\"");
 208                                 }
 209                                 p->i_key = htonl(uval);
 210                         }
 211                 } else if (key == ARG_okey) {
 212                         unsigned uval;
 213                         NEXT_ARG();
 214                         p->o_flags |= GRE_KEY;
 215                         if (strchr(*argv, '.'))
 216                                 p->o_key = get_addr32(*argv);
 217                         else {
 218                                 if (get_unsigned(&uval, *argv, 0)<0) {
 219                                         bb_error_msg_and_die("invalid value of \"okey\"");
 220                                 }
 221                                 p->o_key = htonl(uval);
 222                         }
 223                 } else if (key == ARG_seq) {
 224                         p->i_flags |= GRE_SEQ;
 225                         p->o_flags |= GRE_SEQ;
 226                 } else if (key == ARG_iseq) {
 227                         p->i_flags |= GRE_SEQ;
 228                 } else if (key == ARG_oseq) {
 229                         p->o_flags |= GRE_SEQ;
 230                 } else if (key == ARG_csum) {
 231                         p->i_flags |= GRE_CSUM;
 232                         p->o_flags |= GRE_CSUM;
 233                 } else if (key == ARG_icsum) {
 234                         p->i_flags |= GRE_CSUM;
 235                 } else if (key == ARG_ocsum) {
 236                         p->o_flags |= GRE_CSUM;
 237                 } else if (key == ARG_nopmtudisc) {
 238                         p->iph.frag_off = 0;
 239                 } else if (key == ARG_pmtudisc) {
 240                         p->iph.frag_off = htons(IP_DF);
 241                 } else if (key == ARG_remote) {
 242                         NEXT_ARG();
 243                         key = index_in_strings(keywords, *argv);
 244                         if (key != ARG_any)
 245                                 p->iph.daddr = get_addr32(*argv);
 246                 } else if (key == ARG_local) {
 247                         NEXT_ARG();
 248                         key = index_in_strings(keywords, *argv);
 249                         if (key != ARG_any)
 250                                 p->iph.saddr = get_addr32(*argv);
 251                 } else if (key == ARG_dev) {
 252                         NEXT_ARG();
 253                         strncpy(medium, *argv, IFNAMSIZ-1);
 254                 } else if (key == ARG_ttl) {
 255                         unsigned uval;
 256                         NEXT_ARG();
 257                         key = index_in_strings(keywords, *argv);
 258                         if (key != ARG_inherit) {
 259                                 if (get_unsigned(&uval, *argv, 0))
 260                                         invarg(*argv, "TTL");
 261                                 if (uval > 255)
 262                                         invarg(*argv, "TTL must be <=255");
 263                                 p->iph.ttl = uval;
 264                         }
 265                 } else if (key == ARG_tos ||
 266                            key == ARG_dsfield) {
 267                         uint32_t uval;
 268                         NEXT_ARG();
 269                         key = index_in_strings(keywords, *argv);
 270                         if (key != ARG_inherit) {
 271                                 if (rtnl_dsfield_a2n(&uval, *argv))
 272                                         invarg(*argv, "TOS");
 273                                 p->iph.tos = uval;
 274                         } else
 275                                 p->iph.tos = 1;
 276                 } else {
 277                         if (key == ARG_name) {
 278                                 NEXT_ARG();
 279                         }
 280                         if (p->name[0])
 281                                 duparg2("name", *argv);
 282                         strncpy(p->name, *argv, IFNAMSIZ);
 283                         if (cmd == SIOCCHGTUNNEL && count == 0) {
 284                                 struct ip_tunnel_parm old_p;
 285                                 memset(&old_p, 0, sizeof(old_p));
 286                                 if (do_get_ioctl(*argv, &old_p))
 287                                         exit(1);
 288                                 *p = old_p;
 289                         }
 290                 }
 291                 count++;
 292                 argv++;
 293         }
 294
 295         if (p->iph.protocol == 0) {
 296                 if (memcmp(p->name, "gre", 3) == 0)
 297                         p->iph.protocol = IPPROTO_GRE;
 298                 else if (memcmp(p->name, "ipip", 4) == 0)
 299                         p->iph.protocol = IPPROTO_IPIP;
 300                 else if (memcmp(p->name, "sit", 3) == 0)
 301                         p->iph.protocol = IPPROTO_IPV6;
 302         }
 303
 304         if (p->iph.protocol == IPPROTO_IPIP || p->iph.protocol == IPPROTO_IPV6) {
 305                 if ((p->i_flags & GRE_KEY) || (p->o_flags & GRE_KEY)) {
 306                         bb_error_msg_and_die("keys are not allowed with ipip and sit");
 307                 }
 308         }
 309
 310         if (medium[0]) {
 311                 p->link = do_ioctl_get_ifindex(medium);
 312         }
 313
 314         if (p->i_key == 0 && IN_MULTICAST(ntohl(p->iph.daddr))) {
 315                 p->i_key = p->iph.daddr;
 316                 p->i_flags |= GRE_KEY;
 317         }
 318         if (p->o_key == 0 && IN_MULTICAST(ntohl(p->iph.daddr))) {
 319                 p->o_key = p->iph.daddr;
 320                 p->o_flags |= GRE_KEY;
 321         }
 322         if (IN_MULTICAST(ntohl(p->iph.daddr)) && !p->iph.saddr) {
 323                 bb_error_msg_and_die("broadcast tunnel requires a source address");
 324         }
 325 }
 326
 327
 328 /* Return value becomes exitcode. It's okay to not return at all */
 329 static int do_add(int cmd, char **argv)
 330 {
 331         struct ip_tunnel_parm p;
 332
 333         parse_args(argv, cmd, &p);
 334
 335         if (p.iph.ttl && p.iph.frag_off == 0) {
 336                 bb_error_msg_and_die("ttl != 0 and noptmudisc are incompatible");
 337         }
 338
 339         switch (p.iph.protocol) {
 340         case IPPROTO_IPIP:
 341                 return do_add_ioctl(cmd, "tunl0", &p);
 342         case IPPROTO_GRE:
 343                 return do_add_ioctl(cmd, "gre0", &p);
 344         case IPPROTO_IPV6:
 345                 return do_add_ioctl(cmd, "sit0", &p);
 346         default:
 347                 bb_error_msg_and_die("cannot determine tunnel mode (ipip, gre or sit)");
 348         }
 349 }
 350
 351 /* Return value becomes exitcode. It's okay to not return at all */
 352 static int do_del(char **argv)
 353 {
 354         struct ip_tunnel_parm p;
 355
 356         parse_args(argv, SIOCDELTUNNEL, &p);
 357
 358         switch (p.iph.protocol) {
 359         case IPPROTO_IPIP:
 360                 return do_del_ioctl("tunl0", &p);
 361         case IPPROTO_GRE:
 362                 return do_del_ioctl("gre0", &p);
 363         case IPPROTO_IPV6:
 364                 return do_del_ioctl("sit0", &p);
 365         default:
 366                 return do_del_ioctl(p.name, &p);
 367         }
 368 }
 369
 370 static void print_tunnel(struct ip_tunnel_parm *p)
 371 {
 372         char s1[256];
 373         char s2[256];
 374         char s3[64];
 375         char s4[64];
 376
 377         format_host(AF_INET, 4, &p->iph.daddr, s1, sizeof(s1));
 378         format_host(AF_INET, 4, &p->iph.saddr, s2, sizeof(s2));
 379         inet_ntop(AF_INET, &p->i_key, s3, sizeof(s3));
 380         inet_ntop(AF_INET, &p->o_key, s4, sizeof(s4));
 381
 382         printf("%s: %s/ip  remote %s  local %s ",
 383                p->name,
 384                p->iph.protocol == IPPROTO_IPIP ? "ip" :
 385                (p->iph.protocol == IPPROTO_GRE ? "gre" :
 386                 (p->iph.protocol == IPPROTO_IPV6 ? "ipv6" : "unknown")),
 387                p->iph.daddr ? s1 : "any", p->iph.saddr ? s2 : "any");
 388         if (p->link) {
 389                 char *n = do_ioctl_get_ifname(p->link);
 390                 if (n) {
 391                         printf(" dev %s ", n);
 392                         free(n);
 393                 }
 394         }
 395         if (p->iph.ttl)
 396                 printf(" ttl %d ", p->iph.ttl);
 397         else
 398                 printf(" ttl inherit ");
 399         if (p->iph.tos) {
 400                 SPRINT_BUF(b1);
 401                 printf(" tos");
 402                 if (p->iph.tos & 1)
 403                         printf(" inherit");
 404                 if (p->iph.tos & ~1)
 405                         printf("%c%s ", p->iph.tos & 1 ? '/' : ' ',
 406                                rtnl_dsfield_n2a(p->iph.tos & ~1, b1, sizeof(b1)));
 407         }
 408         if (!(p->iph.frag_off & htons(IP_DF)))
 409                 printf(" nopmtudisc");
 410
 411         if ((p->i_flags & GRE_KEY) && (p->o_flags & GRE_KEY) && p->o_key == p->i_key)
 412                 printf(" key %s", s3);
 413         else if ((p->i_flags | p->o_flags) & GRE_KEY) {
 414                 if (p->i_flags & GRE_KEY)
 415                         printf(" ikey %s ", s3);
 416                 if (p->o_flags & GRE_KEY)
 417                         printf(" okey %s ", s4);
 418         }
 419
 420         if (p->i_flags & GRE_SEQ)
 421                 printf("%c  Drop packets out of sequence.\n", _SL_);
 422         if (p->i_flags & GRE_CSUM)
 423                 printf("%c  Checksum in received packet is required.", _SL_);
 424         if (p->o_flags & GRE_SEQ)
 425                 printf("%c  Sequence packets on output.", _SL_);
 426         if (p->o_flags & GRE_CSUM)
 427                 printf("%c  Checksum output packets.", _SL_);
 428 }
 429
 430 static void do_tunnels_list(struct ip_tunnel_parm *p)
 431 {
 432         char name[IFNAMSIZ];
 433         unsigned long rx_bytes, rx_packets, rx_errs, rx_drops,
 434                 rx_fifo, rx_frame,
 435                 tx_bytes, tx_packets, tx_errs, tx_drops,
 436                 tx_fifo, tx_colls, tx_carrier, rx_multi;
 437         int type;
 438         struct ip_tunnel_parm p1;
 439         char buf[512];
 440         FILE *fp = fopen_or_warn("/proc/net/dev", "r");
 441
 442         if (fp == NULL) {
 443                 return;
 444         }
 445
 446         fgets(buf, sizeof(buf), fp);
 447         fgets(buf, sizeof(buf), fp);
 448
 449         while (fgets(buf, sizeof(buf), fp) != NULL) {
 450                 char *ptr;
 451
 452                 /*buf[sizeof(buf) - 1] = 0; - fgets is safe anyway */
 453                 ptr = strchr(buf, ':');
 454                 if (ptr == NULL ||
 455                     (*ptr++ = 0, sscanf(buf, "%s", name) != 1)) {
 456                         bb_error_msg("wrong format of /proc/net/dev");
 457                         return;
 458                 }
 459                 if (sscanf(ptr, "%lu%lu%lu%lu%lu%lu%lu%*d%lu%lu%lu%lu%lu%lu%lu",
 460                            &rx_bytes, &rx_packets, &rx_errs, &rx_drops,
 461                            &rx_fifo, &rx_frame, &rx_multi,
 462                            &tx_bytes, &tx_packets, &tx_errs, &tx_drops,
 463                            &tx_fifo, &tx_colls, &tx_carrier) != 14)
 464                         continue;
 465                 if (p->name[0] && strcmp(p->name, name))
 466                         continue;
 467                 type = do_ioctl_get_iftype(name);
 468                 if (type == -1) {
 469                         bb_error_msg("cannot get type of [%s]", name);
 470                         continue;
 471                 }
 472                 if (type != ARPHRD_TUNNEL && type != ARPHRD_IPGRE && type != ARPHRD_SIT)
 473                         continue;
 474                 memset(&p1, 0, sizeof(p1));
 475                 if (do_get_ioctl(name, &p1))
 476                         continue;
 477                 if ((p->link && p1.link != p->link) ||
 478                     (p->name[0] && strcmp(p1.name, p->name)) ||
 479                     (p->iph.daddr && p1.iph.daddr != p->iph.daddr) ||
 480                     (p->iph.saddr && p1.iph.saddr != p->iph.saddr) ||
 481                     (p->i_key && p1.i_key != p->i_key))
 482                         continue;
 483                 print_tunnel(&p1);
 484                 bb_putchar('\n');
 485         }
 486 }
 487
 488 /* Return value becomes exitcode. It's okay to not return at all */
 489 static int do_show(char **argv)
 490 {
 491         int err;
 492         struct ip_tunnel_parm p;
 493
 494         parse_args(argv, SIOCGETTUNNEL, &p);
 495
 496         switch (p.iph.protocol) {
 497         case IPPROTO_IPIP:
 498                 err = do_get_ioctl(p.name[0] ? p.name : "tunl0", &p);
 499                 break;
 500         case IPPROTO_GRE:
 501                 err = do_get_ioctl(p.name[0] ? p.name : "gre0", &p);
 502                 break;
 503         case IPPROTO_IPV6:
 504                 err = do_get_ioctl(p.name[0] ? p.name : "sit0", &p);
 505                 break;
 506         default:
 507                 do_tunnels_list(&p);
 508                 return 0;
 509         }
 510         if (err)
 511                 return -1;
 512
 513         print_tunnel(&p);
 514         bb_putchar('\n');
 515         return 0;
 516 }
 517
 518 /* Return value becomes exitcode. It's okay to not return at all */
 519 int do_iptunnel(char **argv)
 520 {
 521         static const char keywords[] ALIGN1 =
 522                 "add\0""change\0""delete\0""show\0""list\0""lst\0";
 523         enum { ARG_add = 0, ARG_change, ARG_del, ARG_show, ARG_list, ARG_lst };
 524         int key;
 525
 526         if (*argv) {
 527                 key = index_in_substrings(keywords, *argv);
 528                 if (key < 0)
 529                         bb_error_msg_and_die(bb_msg_invalid_arg, *argv, applet_name);
 530                 argv++;
 531                 if (key == ARG_add)
 532                         return do_add(SIOCADDTUNNEL, argv);
 533                 if (key == ARG_change)
 534                         return do_add(SIOCCHGTUNNEL, argv);
 535                 if (key == ARG_del)
 536                         return do_del(argv);
 537         }
 538         return do_show(argv);
 539 }