5 files changed, 187 insertions, 0 deletions

diff --git a/include/applets.h b/include/applets.h
index 504f86a17..9e88f5044 100644
--- a/include/applets.h
+++ b/include/applets.h
@@ -598,6 +598,9 @@
 #ifdef CONFIG_UUENCODE
         APPLET(uuencode, uuencode_main, _BB_DIR_USR_BIN, _BB_SUID_NEVER)
 #endif
+#ifdef CONFIG_VCONFIG
+        APPLET(vconfig, vconfig_main, _BB_DIR_SBIN, _BB_SUID_NEVER)
+#endif
 #ifdef CONFIG_VI
         APPLET(vi, vi_main, _BB_DIR_BIN, _BB_SUID_NEVER)
 #endif
diff --git a/include/usage.h b/include/usage.h
index 077306bdf..d2fb19372 100644
--- a/include/usage.h
+++ b/include/usage.h
@@ -2369,6 +2369,17 @@
         "$ uudecode busybox busybox > busybox.uu\n" \
         "$\n"
 
+#define vconfig_trivial_usage \
+        "COMMAND [OPTIONS] ..."
+
+#define vconfig_full_usage \
+"Usage: add             [interface-name] [vlan_id] \n" \
+"       rem             [vlan-name] \n" \
+"       set_flag        [interface-name] [flag-num]       [0 | 1] \n" \
+"       set_egress_map  [vlan-name]      [skb_priority]   [vlan_qos] \n" \
+"       set_ingress_map [vlan-name]      [skb_priority]   [vlan_qos] \n" \
+"       set_name_type   [name-type] \n" 
+
 #define vi_trivial_usage \
         "[OPTION] [FILE]..."
 #define vi_full_usage \
diff --git a/networking/Config.in b/networking/Config.in
index ebefd600d..22676c085 100644
--- a/networking/Config.in
+++ b/networking/Config.in
@@ -376,6 +376,12 @@ config CONFIG_FEATURE_TRACEROUTE_SO_DEBUG
         help
           Please submit a patch to add help text for this item.
 
+config CONFIG_VCONFIG
+        bool "vconfig"
+        default n
+        help
+          Creates, removes, and configures VLAN interfaces
+
 config CONFIG_WGET
         bool "wget"
         default n
diff --git a/networking/Makefile.in b/networking/Makefile.in
index 144091abc..12fc8ddbd 100644
--- a/networking/Makefile.in
+++ b/networking/Makefile.in
@@ -47,6 +47,7 @@ NETWORKING-$(CONFIG_TELNET)		+= telnet.o
 NETWORKING-$(CONFIG_TELNETD)    += telnetd.o
 NETWORKING-$(CONFIG_TFTP)               += tftp.o
 NETWORKING-$(CONFIG_TRACEROUTE) += traceroute.o
+NETWORKING-$(CONFIG_VCONFIG)            += vconfig.o
 NETWORKING-$(CONFIG_WGET)               += wget.o
 
 libraries-y+=$(NETWORKING_DIR)$(NETWORKING_AR)
diff --git a/networking/vconfig.c b/networking/vconfig.c
new file mode 100644
index 000000000..0ad759e69
--- /dev/null
+++ b/networking/vconfig.c
@@ -0,0 +1,166 @@
+#include <errno.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <strings.h>
+#include <sys/ioctl.h>
+#include <linux/if_vlan.h>
+#include <linux/sockios.h>
+#include <string.h>
+#include <sys/socket.h>
+#include <sys/types.h>
+#include "busybox.h" 
+
+
+
+int vconfig_main(int argc, char** argv) {
+   int fd;
+   struct vlan_ioctl_args if_request;
+   
+   char* cmd = NULL;
+   char* if_name = NULL;
+   unsigned int vid = 0;
+   unsigned int skb_priority;
+   unsigned short vlan_qos;
+   unsigned int nm_type = VLAN_NAME_TYPE_PLUS_VID;
+
+   char* conf_file_name = "/proc/net/vlan/config";
+
+   memset(&if_request, 0, sizeof(struct vlan_ioctl_args));
+   
+   if ((argc < 3) || (argc > 5)) {
+      error_msg_and_die("Expecting argc to be 3-5, inclusive.  Was: %d\n",argc);
+   }
+   else {
+      cmd = argv[1];
+          
+      if (strcasecmp(cmd, "set_name_type") == 0) {
+         if (strcasecmp(argv[2], "VLAN_PLUS_VID") == 0) {
+            nm_type = VLAN_NAME_TYPE_PLUS_VID;
+         }
+         else if (strcasecmp(argv[2], "VLAN_PLUS_VID_NO_PAD") == 0) {
+            nm_type = VLAN_NAME_TYPE_PLUS_VID_NO_PAD;
+         }
+         else if (strcasecmp(argv[2], "DEV_PLUS_VID") == 0) {
+            nm_type = VLAN_NAME_TYPE_RAW_PLUS_VID;
+         }
+         else if (strcasecmp(argv[2], "DEV_PLUS_VID_NO_PAD") == 0) {
+            nm_type = VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD;
+         }
+         else {
+            error_msg_and_die("Invalid name type.\n");
+         }
+         if_request.u.name_type = nm_type;
+      }
+      else {
+         if_name = argv[2];
+         if (strlen(if_name) > 15) {
+            error_msg_and_die("ERROR:  if_name must be 15 characters or less.\n");
+         }
+         strcpy(if_request.device1, if_name);
+      }
+
+      if (argc == 4) {
+         vid = atoi(argv[3]);
+         if_request.u.VID = vid;
+      }
+
+      if (argc == 5) {
+         skb_priority = atoi(argv[3]);
+         vlan_qos = atoi(argv[4]);
+         if_request.u.skb_priority = skb_priority;
+         if_request.vlan_qos = vlan_qos;
+      }
+   }
+   
+   // Open up the /proc/vlan/config
+   if ((fd = open(conf_file_name, O_RDONLY)) < 0) {
+      error_msg("WARNING:  Could not open /proc/net/vlan/config.  Maybe you need to load the 8021q module, or maybe you are not using PROCFS??\n");
+   }
+   else {
+      close(fd);
+   }
+
+   /* We use sockets now, instead of the file descriptor */
+   if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
+      error_msg_and_die("FATAL:  Couldn't open a socket..go figure!\n");
+   }   
+
+   /* add */
+   if (strcasecmp(cmd, "add") == 0) {
+      if_request.cmd = ADD_VLAN_CMD;
+      if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
+         error_msg("ERROR: trying to add VLAN #%u to IF -:%s:-  error: %s\n",
+                    vid, if_name, strerror(errno));                 
+      }
+      else {
+         printf("Added VLAN with VID == %u to IF -:%s:-\n", vid, if_name);
+         if (vid == 1) {
+            error_msg("WARNING:  VLAN 1 does not work with many switches,\nconsider another number if you have problems.\n");
+         }
+      }
+   }//if
+   else if (strcasecmp(cmd, "rem") == 0) {
+      if_request.cmd = DEL_VLAN_CMD;
+      if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
+         error_msg("ERROR: trying to remove VLAN -:%s:- error: %s\n",
+                 if_name, strerror(errno));         
+      }
+      else {
+         printf("Removed VLAN -:%s:-\n", if_name);
+      }
+   }//if
+   else if (strcasecmp(cmd, "set_egress_map") == 0) {
+      if_request.cmd = SET_VLAN_EGRESS_PRIORITY_CMD;
+      if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
+         error_msg("ERROR: trying to set egress map on device -:%s:- error: %s\n",
+                 if_name, strerror(errno));         
+      }
+      else {
+         printf("Set egress mapping on device -:%s:- "
+                 "Should be visible in /proc/net/vlan/%s\n",
+                 if_name, if_name);
+      }
+   }
+   else if (strcasecmp(cmd, "set_ingress_map") == 0) {
+      if_request.cmd = SET_VLAN_INGRESS_PRIORITY_CMD;
+      if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
+         error_msg("ERROR: trying to set ingress map on device -:%s:- error: %s\n",
+                 if_name, strerror(errno));
+      }
+      else {
+         printf("Set ingress mapping on device -:%s:- "
+                 "Should be visible in /proc/net/vlan/%s\n",
+                 if_name, if_name);                
+      }
+   }   
+   else if (strcasecmp(cmd, "set_flag") == 0) {
+      if_request.cmd = SET_VLAN_FLAG_CMD;
+      if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
+         error_msg("ERROR: trying to set flag on device -:%s:- error: %s\n",
+                 if_name, strerror(errno));
+      }
+      else {
+         printf("Set flag on device -:%s:- "
+                 "Should be visible in /proc/net/vlan/%s\n",
+                 if_name, if_name);
+      }
+   }
+   else if (strcasecmp(cmd, "set_name_type") == 0) {
+      if_request.cmd = SET_VLAN_NAME_TYPE_CMD;
+      if (ioctl(fd, SIOCSIFVLAN, &if_request) < 0) {
+         error_msg("ERROR: trying to set name type for VLAN subsystem, error: %s\n",
+                 strerror(errno));         
+      }
+      else {
+         printf("Set name-type for VLAN subsystem."
+                 " Should be visible in /proc/net/vlan/config\n");         
+      }
+   }
+   else {
+      error_msg_and_die("Unknown command -:%s:-\n", cmd);
+   }
+
+   return 0;
+}/* main */