networking/vconfig.c

   1 /* vi: set sw=4 ts=4: */
   2 /*
   3  * vconfig implementation for busybox
   4  *
   5  * Copyright (C) 2001  Manuel Novoa III  <mjn3@codepoet.org>
   6  *
   7  * Licensed under GPLv2 or later, see file LICENSE in this source tree.
   8  */
   9 //config:config VCONFIG
  10 //config:       bool "vconfig (2.3 kb)"
  11 //config:       default y
  12 //config:       select PLATFORM_LINUX
  13 //config:       help
  14 //config:       Creates, removes, and configures VLAN interfaces
  15
  16 //applet:IF_VCONFIG(APPLET_NOEXEC(vconfig, vconfig, BB_DIR_SBIN, BB_SUID_DROP, vconfig))
  17
  18 //kbuild:lib-$(CONFIG_VCONFIG) += vconfig.o
  19
  20 //usage:#define vconfig_trivial_usage
  21 //usage:       "COMMAND [OPTIONS]"
  22 //usage:#define vconfig_full_usage "\n\n"
  23 //usage:       "Create and remove virtual ethernet devices\n"
  24 //usage:     "\n        add             IFACE VLAN_ID"
  25 //usage:     "\n        rem             VLAN_NAME"
  26 //usage:     "\n        set_flag        IFACE 0|1 VLAN_QOS"
  27 //usage:     "\n        set_egress_map  VLAN_NAME SKB_PRIO VLAN_QOS"
  28 //usage:     "\n        set_ingress_map VLAN_NAME SKB_PRIO VLAN_QOS"
  29 //usage:     "\n        set_name_type   NAME_TYPE"
  30
  31 #include "libbb.h"
  32 #include <net/if.h>
  33
  34 /* BB_AUDIT SUSv3 N/A */
  35
  36 /* Stuff from linux/if_vlan.h, kernel version 2.4.23 */
  37 enum vlan_ioctl_cmds {
  38         ADD_VLAN_CMD,
  39         DEL_VLAN_CMD,
  40         SET_VLAN_INGRESS_PRIORITY_CMD,
  41         SET_VLAN_EGRESS_PRIORITY_CMD,
  42         GET_VLAN_INGRESS_PRIORITY_CMD,
  43         GET_VLAN_EGRESS_PRIORITY_CMD,
  44         SET_VLAN_NAME_TYPE_CMD,
  45         SET_VLAN_FLAG_CMD
  46 };
  47 enum vlan_name_types {
  48         VLAN_NAME_TYPE_PLUS_VID, /* Name will look like:  vlan0005 */
  49         VLAN_NAME_TYPE_RAW_PLUS_VID, /* name will look like:  eth1.0005 */
  50         VLAN_NAME_TYPE_PLUS_VID_NO_PAD, /* Name will look like:  vlan5 */
  51         VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, /* Name will look like:  eth0.5 */
  52         VLAN_NAME_TYPE_HIGHEST
  53 };
  54
  55 struct vlan_ioctl_args {
  56         int cmd; /* Should be one of the vlan_ioctl_cmds enum above. */
  57         char device1[24];
  58
  59         union {
  60                 char device2[24];
  61                 int VID;
  62                 unsigned int skb_priority;
  63                 unsigned int name_type;
  64                 unsigned int bind_type;
  65                 unsigned int flag; /* Matches vlan_dev_info flags */
  66         } u;
  67
  68         short vlan_qos;
  69 };
  70
  71 #define VLAN_GROUP_ARRAY_LEN  4096
  72 #define SIOCSIFVLAN           0x8983  /* Set 802.1Q VLAN options */
  73
  74 /* On entry, table points to the length of the current string
  75  * plus NUL terminator plus data length for the subsequent entry.
  76  * The return value is the last data entry for the matching string. */
  77 static const char *xfind_str(const char *table, const char *str)
  78 {
  79         while (strcasecmp(str, table + 1) != 0) {
  80                 if (!table[0])
  81                         bb_show_usage();
  82                 table += table[0];
  83         }
  84         return table - 1;
  85 }
  86
  87 static const char cmds[] ALIGN1 = {
  88         4, ADD_VLAN_CMD, 7,
  89         'a','d','d',0,
  90         3, DEL_VLAN_CMD, 7,
  91         'r','e','m',0,
  92         3, SET_VLAN_NAME_TYPE_CMD, 17,
  93         's','e','t','_','n','a','m','e','_','t','y','p','e',0,
  94         5, SET_VLAN_FLAG_CMD, 12,
  95         's','e','t','_','f','l','a','g',0,
  96         5, SET_VLAN_EGRESS_PRIORITY_CMD, 18,
  97         's','e','t','_','e','g','r','e','s','s','_','m','a','p',0,
  98         5, SET_VLAN_INGRESS_PRIORITY_CMD, 0,
  99         's','e','t','_','i','n','g','r','e','s','s','_','m','a','p',0,
 100 };
 101
 102 static const char name_types[] ALIGN1 = {
 103         VLAN_NAME_TYPE_PLUS_VID, 16,
 104         'V','L','A','N','_','P','L','U','S','_','V','I','D',0,
 105         VLAN_NAME_TYPE_PLUS_VID_NO_PAD, 22,
 106         'V','L','A','N','_','P','L','U','S','_','V','I','D','_','N','O','_','P','A','D',0,
 107         VLAN_NAME_TYPE_RAW_PLUS_VID, 15,
 108         'D','E','V','_','P','L','U','S','_','V','I','D',0,
 109         VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, 0,
 110         'D','E','V','_','P','L','U','S','_','V','I','D','_','N','O','_','P','A','D',0,
 111 };
 112
 113 int vconfig_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
 114 int vconfig_main(int argc, char **argv)
 115 {
 116         struct vlan_ioctl_args ifr;
 117         const char *p;
 118         int fd;
 119
 120         memset(&ifr, 0, sizeof(ifr));
 121
 122         ++argv;
 123         if (!argv[0])
 124                 bb_show_usage();
 125         p = xfind_str(cmds + 2, argv[0]);
 126         ifr.cmd = *p;
 127         if (argc != p[-1])
 128                 bb_show_usage();
 129
 130         if (ifr.cmd == SET_VLAN_NAME_TYPE_CMD) {
 131                 /* set_name_type */
 132                 ifr.u.name_type = *xfind_str(name_types + 1, argv[1]);
 133         } else {
 134                 strncpy_IFNAMSIZ(ifr.device1, argv[1]);
 135                 p = argv[2];
 136
 137                 /* I suppose one could try to combine some of the function calls below,
 138                  * since ifr.u.flag, ifr.u.VID, and ifr.u.skb_priority are all same-sized
 139                  * (unsigned) int members of a unions.  But because of the range checking,
 140                  * doing so wouldn't save that much space and would also make maintenance
 141                  * more of a pain.
 142                  */
 143                 if (ifr.cmd == SET_VLAN_FLAG_CMD) {
 144                         /* set_flag */
 145                         ifr.u.flag = xatou_range(p, 0, 1);
 146                         /* DM: in order to set reorder header, qos must be set */
 147                         ifr.vlan_qos = xatou_range(argv[3], 0, 7);
 148                 } else if (ifr.cmd == ADD_VLAN_CMD) {
 149                         /* add */
 150                         ifr.u.VID = xatou_range(p, 0, VLAN_GROUP_ARRAY_LEN - 1);
 151                 } else if (ifr.cmd != DEL_VLAN_CMD) {
 152                         /* set_{egress|ingress}_map */
 153                         ifr.u.skb_priority = xatou(p);
 154                         ifr.vlan_qos = xatou_range(argv[3], 0, 7);
 155                 }
 156         }
 157
 158         fd = xsocket(AF_INET, SOCK_STREAM, 0);
 159         ioctl_or_perror_and_die(fd, SIOCSIFVLAN, &ifr,
 160                                                 "ioctl error for %s", argv[0]);
 161
 162         return 0;
 163 }