OSDN Git Service

Add Android.mk
[android-x86/external-wireless-tools.git] / wireless_tools / iwpriv.c
index 32034ba..8ee2029 100644 (file)
 /*
- * Warning : this program need wireless extensions...
+ *     Wireless Tools
+ *
+ *             Jean II - HPLB 97->99 - HPL 99->07
+ *
+ * Main code for "iwconfig". This is the generic tool for most
+ * manipulations...
+ * You need to link this code against "iwlib.c" and "-lm".
+ *
+ * This file is released under the GPL license.
+ *     Copyright (c) 1997-2007 Jean Tourrilhes <jt@hpl.hp.com>
  */
-#include <sys/types.h>
-#include <sys/socket.h>
-#include <sys/ioctl.h>
-#include <linux/netdevice.h>
-#include <linux/if.h>
-#include <linux/if_arp.h>
-#include <linux/if_ether.h>
-#include <linux/ipx.h>
-#include <linux/wireless.h>
-#include <stdio.h>
-#include <errno.h>
-#include <fcntl.h>
-#include <ctype.h>
-#include <stdlib.h>
-#include <string.h>
-#include <unistd.h>
-
-int skfd = -1;                         /* generic raw socket desc.     */
-int ipx_sock = -1;                     /* IPX socket                   */
-int ax25_sock = -1;                    /* AX.25 socket                 */
-int inet_sock = -1;                    /* INET socket                  */
-int ddp_sock = -1;                     /* Appletalk DDP socket         */
-
-static int sockets_open()
+
+#include "iwlib-private.h"             /* Private header */
+
+/************************** DOCUMENTATION **************************/
+
+/*
+ * BASIC PRINCIPLE
+ * ---------------
+ *     Wireless Extension recognise that each wireless device has some
+ * specific features not covered by the standard wireless extensions.
+ * Private wireless ioctls/requests allow a device to export the control
+ * of those device specific features, and allow users to directly interact
+ * with your driver.
+ *     There are many other ways you can implement such functionality :
+ *             o module parameters
+ *             o netlink socket
+ *             o file system (/proc/ or /sysfs/)
+ *             o extra character device (/dev/)
+ *     Private wireless ioctls is one of the simplest implementation,
+ * however it is limited, so you may want to check the alternatives.
+ *
+ *     Like for standard Wireless Extensions, each private wireless
+ * request is identified by an IOCTL NUMBER and carry a certain number
+ * of arguments (SET or GET).
+ *     The driver exports a description of those requests (ioctl number,
+ * request name, set and get arguments). Then, iwpriv uses those request
+ * descriptions to call the appropriate request and handle the
+ * arguments.
+ *
+ * IOCTL RANGES :
+ * ------------
+ *     The initial implementation of iwpriv was using the SIOCDEVPRIVATE
+ * ioctl range (up to 16 ioctls - driver specific). However, this was
+ * causing some compatibility problems with other usages of those
+ * ioctls, and those ioctls are supposed to be removed.
+ *     Therefore, I created a new ioctl range, at SIOCIWFIRSTPRIV. Those
+ * ioctls are specific to Wireless Extensions, so you don't have to
+ * worry about collisions with other usages. On the other hand, in the
+ * new range, the SET convention is enforced (see below).
+ *     The differences are :           SIOCDEVPRIVATE  SIOCIWFIRSTPRIV
+ *             o availability          <= 2.5.X        WE > 11 (>= 2.4.13)
+ *             o collisions            yes             no
+ *             o SET convention        optional        enforced
+ *             o number                16              32
+ *
+ * NEW DRIVER API :
+ * --------------
+ *     Wireless Extension 13 introduces a new driver API. Wireless
+ * Extensions requests can be handled via a iw_handler table instead
+ * of through the regular ioctl handler.
+ *     The new driver API can be handled only with the new ioctl range
+ * and enforces the GET convention (see below).
+ *     The differences are :           old API         new API
+ *             o handler               do_ioctl()      struct iw_handler_def
+ *             o SIOCIWFIRSTPRIV       WE > 11         yes
+ *             o SIOCDEVPRIVATE        yes             no
+ *             o GET convention        optional        enforced
+ *     Note that the new API before Wireless Extension 15 contains bugs
+ * when handling sub-ioctls and addr/float data types.
+ *
+ * INLINING vs. POINTER :
+ * --------------------
+ *     One of the tricky aspect of the old driver API is how the data
+ * is handled, which is how the driver is supposed to extract the data
+ * passed to it by iwpriv.
+ *     1) If the data has a fixed size (private ioctl definition
+ * has the flag IW_PRIV_SIZE_FIXED) and the byte size of the data is
+ * lower than 16 bytes, the data will be inlined. The driver can extract
+ * data in the field 'u.name' of the struct iwreq.
+ *     2) If the if the data doesn't have a fixed size or is larger than
+ * 16 bytes, the data is passed by pointer. struct iwreq contains a
+ * struct iwpoint with a user space pointer to the data. Appropriate
+ * copy_from/to_user() function should be used.
+ *     
+ *     With the new API, this is handled transparently, the data is
+ * always available as the fourth argument of the request handler
+ * (usually called 'extra').
+ *
+ * SET/GET CONVENTION :
+ * ------------------
+ *     Simplistic summary :
+ *     o even numbered ioctls are SET, restricted to root, and should not
+ * return arguments (get_args = 0).
+ *     o odd numbered ioctls are GET, authorised to anybody, and should
+ * not expect any arguments (set_args = 0).
+ *
+ *     The regular Wireless Extensions use the SET/GET convention, where
+ * the low order bit identify a SET (0) or a GET (1) request. The private
+ * Wireless Extension is not as restrictive, but still has some
+ * limitations.
+ *     The new ioctl range enforces the SET convention : SET request will
+ * be available to root only and can't return any arguments. If you don't
+ * like that, just use every other two ioctl.
+ *     The new driver API enforce the GET convention : GET request won't
+ * be able to accept any arguments (except if its fits within (union
+ * iwreq_data)). If you don't like that, you can either use the Token Index
+ * support or the old API (aka the ioctl handler).
+ *     In any case, it's a good idea to not have ioctl with both SET
+ * and GET arguments. If the GET arguments doesn't fit within
+ * (union iwreq_data) and SET do, or vice versa, the current code in iwpriv
+ * won't work. One exception is if both SET and GET arguments fit within
+ * (union iwreq_data), this case should be handled safely in a GET
+ * request.
+ *     If you don't fully understand those limitations, just follow the
+ * rules of the simplistic summary ;-)
+ *
+ * SUB-IOCTLS :
+ * ----------
+ *     Wireless Extension 15 introduces sub-ioctls. For some applications,
+ * 32 ioctls is not enough, and this simple mechanism allows to increase
+ * the number of ioctls by adding a sub-ioctl index to some of the ioctls
+ * (so basically it's a two level addressing).
+ *     One might argue that at the point, some other mechanisms might be
+ * better, like using a real filesystem abstraction (/proc, driverfs, ...),
+ * but sub-ioctls are simple enough and don't have much drawbacks (which
+ * means that it's a quick and dirty hack ;-).
+ *
+ *     There are two slightly different variations of the sub-ioctl scheme :
+ *     1) If the payload fits within (union iwreq_data), the first int
+ * (4 bytes) is reserved as the sub-ioctl number and the regular payload
+ * shifted by 4 bytes. The handler must extract the sub-ioctl number,
+ * increment the data pointer and then use it in the usual way.
+ *     2) If the ioctl uses (struct iw_point), the sub-ioctl number is
+ * set in the flags member of the structure. In this case, the handler
+ * should simply get the sub-ioctl number from the flags and process the
+ * data in the usual way.
+ *
+ *     Sub-ioctls are declared normally in the private definition table,
+ * with cmd (first arg) being the sub-ioctl number. Then, you should
+ * declare the real ioctl, which will process the sub-ioctls, with
+ * the SAME ARGUMENTS and a EMPTY NAME.
+ *     Here's an example of how it could look like :
+ * --------------------------------------------
+       // --- sub-ioctls handlers ---
+       { 0x8BE0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "" },
+       { 0x8BE1, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "" },
+       // --- sub-ioctls definitions ---
+       { 1, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "set_param1" },
+       { 1, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "get_param1" },
+       { 2, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "set_param2" },
+       { 2, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "get_param2" },
+       // --- Raw access to sub-ioctl handlers ---
+       { 0x8BE0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 2, 0, "set_paramN" },
+       { 0x8BE1, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
+         IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "get_paramN" },
+ * --------------------------------------------
+ *     And iwpriv should do the rest for you ;-)
+ *
+ *     Note that versions of iwpriv up to v24 (included) expect at most
+ * 16 ioctls definitions and will likely crash when given more.
+ *     There is no fix that I can see, apart from recommending your users
+ * to upgrade their Wireless Tools. Wireless Extensions 15 will check this
+ * condition, so another workaround is restricting those extra definitions
+ * to WE-15.
+ *
+ *     Another problem is that the new API before Wireless Extension 15
+ * has a bug when passing fixed arguments of 12-15 bytes. It will
+ * try to get them inline instead of by pointer. You can fool the new API
+ * to do the right thing using fake ioctl definitions (but remember that
+ * you will be more likely to hit the limit of 16 ioctl definitions).
+ *     To play safe, use the old-style ioctl handler before v15.
+ *
+ * NEW DATA TYPES (ADDR/FLOAT) :
+ * ---------------------------
+ *     Wireless Tools 25 introduce two new data types, addr and float,
+ * corresponding to struct sockaddr and struct iwfreq.
+ *     Those types are properly handled with Wireless Extensions 15.
+ * However, the new API before v15 won't handle them properly.
+ *
+ *     The first problem is that the new API won't know their size, so
+ * it won't copy them. This can be workaround with a fake ioctl definition.
+ *     The second problem is that a fixed single addr won't be inlined
+ * in struct iwreq and will be passed as a pointer. This is due to an
+ * off-by-one error, where all fixed data of 16 bytes is considered too
+ * big to fit in struct iwreq.
+ *
+ *     For those reasons, I would recommend to use the ioctl handler
+ * before v15 when manipulating those data.
+ *
+ * TOKEN INDEX :
+ * -----------
+ *     Token index is very similar to sub-ioctl. It allows the user
+ * to specify an integer index in front of a bunch of other arguments
+ * (addresses, strings, ...). It's specified in square brackets on the
+ * iwpriv command line before other arguments.
+ *             > iwpriv eth0 [index] args...
+ *     Token index works only when the data is passed as pointer, and
+ * is otherwise ignored. If your data would fit within struct iwreq, you
+ * should declare the command *without* IW_PRIV_SIZE_FIXED to force
+ * this to happen (and check arg number yourself).
+ * --------------------------------------------
+       // --- Commands that would fit in struct iwreq ---
+       { 0x8BE0, IW_PRIV_TYPE_ADDR | 1, 0, "set_param_with_token" },
+       // --- No problem here (bigger than struct iwreq) ---
+       { 0x8BE1, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 2, 0, "again" },
+ * --------------------------------------------
+ *     The token index feature is pretty transparent, the token index
+ * will just be in the flags member of (struct iw_point). Default value
+ * (if the user doesn't specify it) will be 0. Token index itself will
+ * work with any version of Wireless Extensions.
+ *     Token index is not compatible with sub-ioctl (both use the same
+ * field of struct iw_point). However, the token index can be used to offer
+ * raw access to the sub-ioctl handlers (if it uses struct iw_point) :
+ * --------------------------------------------
+       // --- sub-ioctls handler ---
+       { 0x8BE0, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "" },
+       // --- sub-ioctls definitions ---
+       { 0, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "setaddr" },
+       { 1, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "deladdr" },
+       // --- raw access with token index (+ iwreq workaround) ---
+       { 0x8BE0, IW_PRIV_TYPE_ADDR | 1, 0, "rawaddr" },
+ * --------------------------------------------
+ *
+ * Jean II
+ */
+
+/**************************** CONSTANTS ****************************/
+
+static const char *    argtype[] = {
+  "     ", "byte ", "char ", "", "int  ", "float", "addr " };
+
+/************************* MISC SUBROUTINES **************************/
+
+/*------------------------------------------------------------------*/
+/*
+ * Print usage string
+ */
+static void
+iw_usage(void)
 {
-       inet_sock=socket(AF_INET, SOCK_DGRAM, 0);
-       ipx_sock=socket(AF_IPX, SOCK_DGRAM, 0);
-       ax25_sock=socket(AF_AX25, SOCK_DGRAM, 0);
-       ddp_sock=socket(AF_APPLETALK, SOCK_DGRAM, 0);
-       /*
-        *      Now pick any (exisiting) useful socket family for generic queries
-        */
-       if(inet_sock!=-1)
-               return inet_sock;
-       if(ipx_sock!=-1)
-               return ipx_sock;
-       if(ax25_sock!=-1)
-               return ax25_sock;
-       /*
-        *      If this is -1 we have no known network layers and its time to jump.
-        */
-        
-       return ddp_sock;
+  fprintf(stderr, "Usage: iwpriv interface [private-command [private-arguments]]\n");
 }
 
-int
-byte_size(args)
+/************************* SETTING ROUTINES **************************/
+
+/*------------------------------------------------------------------*/
+/*
+ * Execute a private command on the interface
+ */
+static int
+set_private_cmd(int            skfd,           /* Socket */
+               char *          args[],         /* Command line args */
+               int             count,          /* Args count */
+               char *          ifname,         /* Dev name */
+               char *          cmdname,        /* Command name */
+               iwprivargs *    priv,           /* Private ioctl description */
+               int             priv_num)       /* Number of descriptions */
 {
-  int  ret = args & IW_PRIV_SIZE_MASK;
+  struct iwreq wrq;
+  u_char       buffer[4096];   /* Only that big in v25 and later */
+  int          i = 0;          /* Start with first command arg */
+  int          k;              /* Index in private description table */
+  int          temp;
+  int          subcmd = 0;     /* sub-ioctl index */
+  int          offset = 0;     /* Space for sub-ioctl index */
+
+  /* Check if we have a token index.
+   * Do it now so that sub-ioctl takes precedence, and so that we
+   * don't have to bother with it later on... */
+  if((count >= 1) && (sscanf(args[0], "[%i]", &temp) == 1))
+    {
+      subcmd = temp;
+      args++;
+      count--;
+    }
 
-  if(((args & IW_PRIV_TYPE_MASK) == IW_PRIV_TYPE_INT) ||
-     ((args & IW_PRIV_TYPE_MASK) == IW_PRIV_TYPE_FLOAT))
-    ret <<= 2;
+  /* Search the correct ioctl */
+  k = -1;
+  while((++k < priv_num) && strcmp(priv[k].name, cmdname));
 
-  if((args & IW_PRIV_TYPE_MASK) == IW_PRIV_TYPE_NONE)
-    return 0;
+  /* If not found... */
+  if(k == priv_num)
+    {
+      fprintf(stderr, "Invalid command : %s\n", cmdname);
+      return(-1);
+    }
+         
+  /* Watch out for sub-ioctls ! */
+  if(priv[k].cmd < SIOCDEVPRIVATE)
+    {
+      int      j = -1;
 
-  return ret;
-}
+      /* Find the matching *real* ioctl */
+      while((++j < priv_num) && ((priv[j].name[0] != '\0') ||
+                                (priv[j].set_args != priv[k].set_args) ||
+                                (priv[j].get_args != priv[k].get_args)));
 
-int
-main(int       argc,
-     char **   argv)
-{
-  struct iwreq         wrq;
-  char *               ifname = argv[1];
-  struct iw_priv_args  priv[16];
-  int                  k;
+      /* If not found... */
+      if(j == priv_num)
+       {
+         fprintf(stderr, "Invalid private ioctl definition for : %s\n",
+                 cmdname);
+         return(-1);
+       }
 
-  if(argc < 2)
-    exit(0);
+      /* Save sub-ioctl number */
+      subcmd = priv[k].cmd;
+      /* Reserve one int (simplify alignment issues) */
+      offset = sizeof(__u32);
+      /* Use real ioctl definition from now on */
+      k = j;
+
+#if 0
+      printf("<mapping sub-ioctl %s to cmd 0x%X-%d>\n", cmdname,
+            priv[k].cmd, subcmd);
+#endif
+    }
 
-  /* Create a channel to the NET kernel. */
-  if((skfd = sockets_open()) < 0)
+  /* If we have to set some data */
+  if((priv[k].set_args & IW_PRIV_TYPE_MASK) &&
+     (priv[k].set_args & IW_PRIV_SIZE_MASK))
     {
-      perror("socket");
-      exit(-1);
+      switch(priv[k].set_args & IW_PRIV_TYPE_MASK)
+       {
+       case IW_PRIV_TYPE_BYTE:
+         /* Number of args to fetch */
+         wrq.u.data.length = count;
+         if(wrq.u.data.length > (priv[k].set_args & IW_PRIV_SIZE_MASK))
+           wrq.u.data.length = priv[k].set_args & IW_PRIV_SIZE_MASK;
+
+         /* Fetch args */
+         for(; i < wrq.u.data.length; i++) {
+           sscanf(args[i], "%i", &temp);
+           buffer[i] = (char) temp;
+         }
+         break;
+
+       case IW_PRIV_TYPE_INT:
+         /* Number of args to fetch */
+         wrq.u.data.length = count;
+         if(wrq.u.data.length > (priv[k].set_args & IW_PRIV_SIZE_MASK))
+           wrq.u.data.length = priv[k].set_args & IW_PRIV_SIZE_MASK;
+
+         /* Fetch args */
+         for(; i < wrq.u.data.length; i++) {
+           sscanf(args[i], "%i", &temp);
+           ((__s32 *) buffer)[i] = (__s32) temp;
+         }
+         break;
+
+       case IW_PRIV_TYPE_CHAR:
+         if(i < count)
+           {
+             /* Size of the string to fetch */
+             wrq.u.data.length = strlen(args[i]) + 1;
+             if(wrq.u.data.length > (priv[k].set_args & IW_PRIV_SIZE_MASK))
+               wrq.u.data.length = priv[k].set_args & IW_PRIV_SIZE_MASK;
+
+             /* Fetch string */
+             memcpy(buffer, args[i], wrq.u.data.length);
+             buffer[sizeof(buffer) - 1] = '\0';
+             i++;
+           }
+         else
+           {
+             wrq.u.data.length = 1;
+             buffer[0] = '\0';
+           }
+         break;
+
+       case IW_PRIV_TYPE_FLOAT:
+         /* Number of args to fetch */
+         wrq.u.data.length = count;
+         if(wrq.u.data.length > (priv[k].set_args & IW_PRIV_SIZE_MASK))
+           wrq.u.data.length = priv[k].set_args & IW_PRIV_SIZE_MASK;
+
+         /* Fetch args */
+         for(; i < wrq.u.data.length; i++) {
+           double              freq;
+           if(sscanf(args[i], "%lg", &(freq)) != 1)
+             {
+               printf("Invalid float [%s]...\n", args[i]);
+               return(-1);
+             }    
+           if(strchr(args[i], 'G')) freq *= GIGA;
+           if(strchr(args[i], 'M')) freq *= MEGA;
+           if(strchr(args[i], 'k')) freq *= KILO;
+           sscanf(args[i], "%i", &temp);
+           iw_float2freq(freq, ((struct iw_freq *) buffer) + i);
+         }
+         break;
+
+       case IW_PRIV_TYPE_ADDR:
+         /* Number of args to fetch */
+         wrq.u.data.length = count;
+         if(wrq.u.data.length > (priv[k].set_args & IW_PRIV_SIZE_MASK))
+           wrq.u.data.length = priv[k].set_args & IW_PRIV_SIZE_MASK;
+
+         /* Fetch args */
+         for(; i < wrq.u.data.length; i++) {
+           if(iw_in_addr(skfd, ifname, args[i],
+                         ((struct sockaddr *) buffer) + i) < 0)
+             {
+               printf("Invalid address [%s]...\n", args[i]);
+               return(-1);
+             }
+         }
+         break;
+
+       default:
+         fprintf(stderr, "Not implemented...\n");
+         return(-1);
+       }
+         
+      if((priv[k].set_args & IW_PRIV_SIZE_FIXED) &&
+        (wrq.u.data.length != (priv[k].set_args & IW_PRIV_SIZE_MASK)))
+       {
+         printf("The command %s needs exactly %d argument(s)...\n",
+                cmdname, priv[k].set_args & IW_PRIV_SIZE_MASK);
+         return(-1);
+       }
+    }  /* if args to set */
+  else
+    {
+      wrq.u.data.length = 0L;
     }
 
   strncpy(wrq.ifr_name, ifname, IFNAMSIZ);
-  wrq.u.data.pointer = (caddr_t) priv;
-  wrq.u.data.length = 0;
-  wrq.u.data.flags = 0;
-  if(ioctl(skfd, SIOCGIWPRIV, &wrq) < 0)
+
+  /* Those two tests are important. They define how the driver
+   * will have to handle the data */
+  if((priv[k].set_args & IW_PRIV_SIZE_FIXED) &&
+      ((iw_get_priv_size(priv[k].set_args) + offset) <= IFNAMSIZ))
+    {
+      /* First case : all SET args fit within wrq */
+      if(offset)
+       wrq.u.mode = subcmd;
+      memcpy(wrq.u.name + offset, buffer, IFNAMSIZ - offset);
+    }
+  else
+    {
+      if((priv[k].set_args == 0) &&
+        (priv[k].get_args & IW_PRIV_SIZE_FIXED) &&
+        (iw_get_priv_size(priv[k].get_args) <= IFNAMSIZ))
+       {
+         /* Second case : no SET args, GET args fit within wrq */
+         if(offset)
+           wrq.u.mode = subcmd;
+       }
+      else
+       {
+         /* Third case : args won't fit in wrq, or variable number of args */
+         wrq.u.data.pointer = (caddr_t) buffer;
+         wrq.u.data.flags = subcmd;
+       }
+    }
+
+  /* Perform the private ioctl */
+  if(ioctl(skfd, priv[k].cmd, &wrq) < 0)
     {
-      fprintf(stderr, "Interface doesn't provide private interface info...\n");
-      fprintf(stderr, "SIOCGIWPRIV: %s\n", strerror(errno));
+      fprintf(stderr, "Interface doesn't accept private ioctl...\n");
+      fprintf(stderr, "%s (%X): %s\n", cmdname, priv[k].cmd, strerror(errno));
       return(-1);
     }
 
-  /* If no args... */
-  if(argc < 3)
+  /* If we have to get some data */
+  if((priv[k].get_args & IW_PRIV_TYPE_MASK) &&
+     (priv[k].get_args & IW_PRIV_SIZE_MASK))
+    {
+      int      j;
+      int      n = 0;          /* number of args */
+
+      printf("%-8.16s  %s:", ifname, cmdname);
+
+      /* Check where is the returned data */
+      if((priv[k].get_args & IW_PRIV_SIZE_FIXED) &&
+        (iw_get_priv_size(priv[k].get_args) <= IFNAMSIZ))
+       {
+         memcpy(buffer, wrq.u.name, IFNAMSIZ);
+         n = priv[k].get_args & IW_PRIV_SIZE_MASK;
+       }
+      else
+       n = wrq.u.data.length;
+
+      switch(priv[k].get_args & IW_PRIV_TYPE_MASK)
+       {
+       case IW_PRIV_TYPE_BYTE:
+         /* Display args */
+         for(j = 0; j < n; j++)
+           printf("%d  ", buffer[j]);
+         printf("\n");
+         break;
+
+       case IW_PRIV_TYPE_INT:
+         /* Display args */
+         for(j = 0; j < n; j++)
+           printf("%d  ", ((__s32 *) buffer)[j]);
+         printf("\n");
+         break;
+
+       case IW_PRIV_TYPE_CHAR:
+         /* Display args */
+         buffer[n] = '\0';
+         printf("%s\n", buffer);
+         break;
+
+       case IW_PRIV_TYPE_FLOAT:
+         {
+           double              freq;
+           /* Display args */
+           for(j = 0; j < n; j++)
+             {
+               freq = iw_freq2float(((struct iw_freq *) buffer) + j);
+               if(freq >= GIGA)
+                 printf("%gG  ", freq / GIGA);
+               else
+                 if(freq >= MEGA)
+                 printf("%gM  ", freq / MEGA);
+               else
+                 printf("%gk  ", freq / KILO);
+             }
+           printf("\n");
+         }
+         break;
+
+       case IW_PRIV_TYPE_ADDR:
+         {
+           char                scratch[128];
+           struct sockaddr *   hwa;
+           /* Display args */
+           for(j = 0; j < n; j++)
+             {
+               hwa = ((struct sockaddr *) buffer) + j;
+               if(j)
+                 printf("           %.*s", 
+                        (int) strlen(cmdname), "                ");
+               printf("%s\n", iw_saether_ntop(hwa, scratch));
+             }
+         }
+         break;
+
+       default:
+         fprintf(stderr, "Not yet implemented...\n");
+         return(-1);
+       }
+    }  /* if args to set */
+
+  return(0);
+}
+
+/*------------------------------------------------------------------*/
+/*
+ * Execute a private command on the interface
+ */
+static inline int
+set_private(int                skfd,           /* Socket */
+           char *      args[],         /* Command line args */
+           int         count,          /* Args count */
+           char *      ifname)         /* Dev name */
+{
+  iwprivargs * priv;
+  int          number;         /* Max of private ioctl */
+  int          ret;
+
+  /* Read the private ioctls */
+  number = iw_get_priv_info(skfd, ifname, &priv);
+
+  /* Is there any ? */
+  if(number <= 0)
     {
-      char *   argtype[] = { "    ", "byte", "char", "", "int", "float" };
+      /* Should I skip this message ? */
+      fprintf(stderr, "%-8.16s  no private ioctls.\n\n",
+             ifname);
+      if(priv)
+       free(priv);
+      return(-1);
+    }
+
+  /* Do it */
+  ret = set_private_cmd(skfd, args + 1, count - 1, ifname, args[0],
+                       priv, number);
+
+  free(priv);
+  return(ret);
+}
+
+/************************ CATALOG FUNCTIONS ************************/
 
-      printf("Available private ioctl :\n");
-      for(k = 0; k < wrq.u.data.length; k++)
-       printf("%s (%lX) : set %3d %s & get %3d %s\n",
-              priv[k].name, priv[k].cmd,
-              priv[k].set_args & IW_PRIV_SIZE_MASK,
-              argtype[(priv[k].set_args & IW_PRIV_TYPE_MASK) >> 12],
-              priv[k].get_args & IW_PRIV_SIZE_MASK,
-              argtype[(priv[k].get_args & IW_PRIV_TYPE_MASK) >> 12]);
+/*------------------------------------------------------------------*/
+/*
+ * Print on the screen in a neat fashion the list of private ioctls
+ * for the device.
+ */
+static int
+print_priv_info(int            skfd,
+               char *          ifname,
+               char *          args[],
+               int             count)
+{
+  int          k;
+  iwprivargs * priv;
+  int          n;
+
+  /* Avoid "Unused parameter" warning */
+  args = args; count = count;
+
+  /* Read the private ioctls */
+  n = iw_get_priv_info(skfd, ifname, &priv);
+
+  /* Is there any ? */
+  if(n <= 0)
+    {
+      /* Should I skip this message ? */
+      fprintf(stderr, "%-8.16s  no private ioctls.\n\n",
+             ifname);
     }
   else
     {
-      u_char   buffer[1024];
+      printf("%-8.16s  Available private ioctls :\n", ifname);
+      /* Print them all */
+      for(k = 0; k < n; k++)
+       if(priv[k].name[0] != '\0')
+         printf("          %-16.16s (%.4X) : set %3d %s & get %3d %s\n",
+                priv[k].name, priv[k].cmd,
+                priv[k].set_args & IW_PRIV_SIZE_MASK,
+                argtype[(priv[k].set_args & IW_PRIV_TYPE_MASK) >> 12],
+                priv[k].get_args & IW_PRIV_SIZE_MASK,
+                argtype[(priv[k].get_args & IW_PRIV_TYPE_MASK) >> 12]);
+      printf("\n");
+    }
 
-      /* Seach the correct ioctl */
-      k = -1;
-      while((++k < wrq.u.data.length) && strcmp(priv[k].name, argv[2]))
-       ;
-      /* If not found... */
-      if(k == wrq.u.data.length)
-       fprintf(stderr, "Invalid argument : %s\n", argv[2]);
+  /* Cleanup */
+  if(priv)
+    free(priv);
+  return(0);
+}
 
-      /* If we have to set some data */
-      if((priv[k].set_args & IW_PRIV_TYPE_MASK) &&
-        (priv[k].set_args & IW_PRIV_SIZE_MASK))
-       {
-         int   i;
+/*------------------------------------------------------------------*/
+/*
+ * Print on the screen in a neat fashion the list of private GET ioctl
+ * data for the device and data returned by those.
+ */
+static int
+print_priv_all(int             skfd,
+              char *           ifname,
+              char *           args[],
+              int              count)
+{
+  int          k;
+  iwprivargs * priv;
+  int          n;
 
-         /* Warning : we may have no args to set... */
+  /* Avoid "Unused parameter" warning */
+  args = args; count = count;
 
-         switch(priv[k].set_args & IW_PRIV_TYPE_MASK)
-           {
-           case IW_PRIV_TYPE_BYTE:
-             /* Number of args to fetch */
-             wrq.u.data.length = argc - 3;
-             if(wrq.u.data.length > (priv[k].set_args & IW_PRIV_SIZE_MASK))
-               wrq.u.data.length = priv[k].set_args & IW_PRIV_SIZE_MASK;
+  /* Read the private ioctls */
+  n = iw_get_priv_info(skfd, ifname, &priv);
 
-             /* Fetch args */
-             for(i = 0; i < wrq.u.data.length; i++)
-               sscanf(argv[i + 3], "%d", buffer + i);
-             break;
+  /* Is there any ? */
+  if(n <= 0)
+    {
+      /* Should I skip this message ? */
+      fprintf(stderr, "%-8.16s  no private ioctls.\n\n",
+             ifname);
+    }
+  else
+    {
+      printf("%-8.16s  Available read-only private ioctl :\n", ifname);
+      /* Print them all */
+      for(k = 0; k < n; k++)
+       /* We call all ioctls that don't have a null name, don't require
+        * args and return some (avoid triggering "reset" commands) */
+       if((priv[k].name[0] != '\0') && (priv[k].set_args == 0) &&
+          (priv[k].get_args != 0))
+         set_private_cmd(skfd, NULL, 0, ifname, priv[k].name,
+                         priv, n);
+      printf("\n");
+    }
 
-           case IW_PRIV_TYPE_INT:
-             /* Number of args to fetch */
-             wrq.u.data.length = argc - 3;
-             if(wrq.u.data.length > (priv[k].set_args & IW_PRIV_SIZE_MASK))
-               wrq.u.data.length = priv[k].set_args & IW_PRIV_SIZE_MASK;
+  /* Cleanup */
+  if(priv)
+    free(priv);
+  return(0);
+}
 
-             /* Fetch args */
-             for(i = 0; i < wrq.u.data.length; i++)
-               sscanf(argv[i + 3], "%d", ((u_int *) buffer) + i);
-             break;
+/********************** PRIVATE IOCTLS MANIPS ***********************/
+/*
+ * Convenient access to some private ioctls of some devices
+ */
 
-           default:
-             fprintf(stderr, "Not yet implemented...\n");
-             return(-1);
-           }
+#if 0
+/*------------------------------------------------------------------*/
+/*
+ * Set roaming mode on and off
+ * Found in wavelan_cs driver
+ * Note : this is obsolete, most 802.11 devices should use the
+ * SIOCSIWAP request.
+ */
+static int
+set_roaming(int                skfd,           /* Socket */
+           char *      args[],         /* Command line args */
+           int         count,          /* Args count */
+           char *      ifname)         /* Dev name */
+{
+  u_char       buffer[1024];
+  struct iwreq         wrq;
+  int          i = 0;          /* Start with first arg */
+  int          k;
+  iwprivargs * priv;
+  int          number;
+  int          roamcmd;
+  char         RoamState;              /* buffer to hold new roam state */
+  char         ChangeRoamState=0;      /* whether or not we are going to
+                                          change roam states */
+
+  /* Read the private ioctls */
+  number = iw_get_priv_info(skfd, ifname, &priv);
+
+  /* Is there any ? */
+  if(number <= 0)
+    {
+      /* Should I skip this message ? */
+      fprintf(stderr, "%-8.16s  no private ioctls.\n\n",
+             ifname);
+      if(priv)
+       free(priv);
+      return(-1);
+    }
 
-         if((priv[k].set_args & IW_PRIV_SIZE_FIXED) &&
-            (wrq.u.data.length != (priv[k].set_args & IW_PRIV_SIZE_MASK)))
-           {
-             printf("The command %s need exactly %d argument...\n",
-                    priv[k].name, priv[k].set_args & IW_PRIV_SIZE_MASK);
-             return(-1);
-           }
-       }       /* if args to set */
-      else
+  /* Get the ioctl number */
+  k = -1;
+  while((++k < number) && strcmp(priv[k].name, "setroam"));
+  if(k == number)
+    {
+      fprintf(stderr, "This device doesn't support roaming\n");
+      free(priv);
+      return(-1);
+    }
+  roamcmd = priv[k].cmd;
+
+  /* Cleanup */
+  free(priv);
+
+  if(count != 1)
+    {
+      iw_usage();
+      return(-1);
+    }
+
+  if(!strcasecmp(args[i], "on"))
+    {
+      printf("%-8.16s  enable roaming\n", ifname);
+      if(!number)
        {
-         wrq.u.data.length = 0L;
+         fprintf(stderr, "This device doesn't support roaming\n");
+         return(-1);
        }
-
+      ChangeRoamState=1;
+      RoamState=1;
+    }
+  else
+    if(!strcasecmp(args[i], "off"))
+      {
+       i++;
+       printf("%-8.16s  disable roaming\n",  ifname);
+       if(!number)
+         {
+           fprintf(stderr, "This device doesn't support roaming\n");
+           return(-1);
+         }
+       ChangeRoamState=1;
+       RoamState=0;
+      }
+    else
+      {
+       iw_usage();
+       return(-1);
+      }
+
+  if(ChangeRoamState)
+    {
       strncpy(wrq.ifr_name, ifname, IFNAMSIZ);
 
-      if((priv[k].set_args & IW_PRIV_SIZE_FIXED) &&
-        (byte_size(priv[k].set_args) < IFNAMSIZ))
-       memcpy(wrq.u.name, buffer, IFNAMSIZ);
-      else
+      buffer[0]=RoamState;
+
+      memcpy(wrq.u.name, &buffer, IFNAMSIZ);
+
+      if(ioctl(skfd, roamcmd, &wrq) < 0)
        {
-         wrq.u.data.pointer = (caddr_t) buffer;
-         wrq.u.data.flags = 0;
+         fprintf(stderr, "Roaming support is broken.\n");
+         return(-1);
        }
+    }
 
-      if(ioctl(skfd, priv[k].cmd, &wrq) < 0)
+  return(0);
+}
+
+/*------------------------------------------------------------------*/
+/*
+ * Get and set the port type
+ * Found in wavelan2_cs and wvlan_cs drivers
+ * TODO : Add support for HostAP ?
+ */
+static int
+port_type(int          skfd,           /* Socket */
+         char *        args[],         /* Command line args */
+         int           count,          /* Args count */
+         char *        ifname)         /* Dev name */
+{
+  struct iwreq wrq;
+  int          i = 0;          /* Start with first arg */
+  int          k;
+  iwprivargs * priv;
+  int          number;
+  char         ptype = 0;
+  char *       modes[] = { "invalid", "managed (BSS)", "reserved", "ad-hoc" };
+
+  /* Read the private ioctls */
+  number = iw_get_priv_info(skfd, ifname, &priv);
+
+  /* Is there any ? */
+  if(number <= 0)
+    {
+      /* Should I skip this message ? */
+      fprintf(stderr, "%-8.16s  no private ioctls.\n\n", ifname);
+      if(priv)
+       free(priv);
+      return(-1);
+    }
+
+  /* Arguments ? */
+  if(count == 0)
+    {
+      /* So, we just want to see the current value... */
+      k = -1;
+      while((++k < number) && strcmp(priv[k].name, "gport_type") &&
+            strcmp(priv[k].name, "get_port"));
+      if(k == number)
        {
-         fprintf(stderr, "Interface doesn't accept private ioctl...\n");
-         fprintf(stderr, "%X: %s\n", priv[k].cmd, strerror(errno));
-         return(-1);
+         fprintf(stderr, "This device doesn't support getting port type\n");
+         goto err;
        }
+      strncpy(wrq.ifr_name, ifname, IFNAMSIZ);
 
-      /* If we have to get some data */
-      if((priv[k].get_args & IW_PRIV_TYPE_MASK) &&
-        (priv[k].get_args & IW_PRIV_SIZE_MASK))
+      /* Get it */
+      if(ioctl(skfd, priv[k].cmd, &wrq) < 0)
        {
-         int   i;
-         int   n;              /* number of args */
+         fprintf(stderr, "Port type support is broken.\n");
+         goto err;
+       }
+      ptype = *wrq.u.name;
 
-         if((priv[k].get_args & IW_PRIV_SIZE_FIXED) &&
-            (byte_size(priv[k].get_args) < IFNAMSIZ))
-           {
-             memcpy(buffer, wrq.u.name, IFNAMSIZ);
-             n = priv[k].get_args & IW_PRIV_SIZE_MASK;
-           }
-         else
-           n = wrq.u.data.length;
+      /* Display it */
+      printf("%-8.16s  Current port mode is %s <port type is %d>.\n\n",
+            ifname, modes[(int) ptype], ptype);
 
-         switch(priv[k].get_args & IW_PRIV_TYPE_MASK)
-           {
-           case IW_PRIV_TYPE_BYTE:
-             /* Display args */
-             for(i = 0; i < n; i++)
-               printf("%d  ", buffer[i]);
-             printf("\n");
-             break;
-
-           case IW_PRIV_TYPE_INT:
-             /* Display args */
-             for(i = 0; i < n; i++)
-               printf("%d  ", ((u_int *) buffer)[i]);
-             printf("\n");
-             break;
-
-           default:
-             fprintf(stderr, "Not yet implemented...\n");
-             return(-1);
-           }
+      free(priv);
+      return(0);
+    }
+
+  if(count != 1)
+    {
+      iw_usage();
+      goto err;
+    }
+
+  /* Read it */
+  /* As a string... */
+  k = 0;
+  while((k < 4) && strncasecmp(args[i], modes[k], 2))
+    k++;
+  if(k < 4)
+    ptype = k;
+  else
+    /* ...or as an integer */
+    if(sscanf(args[i], "%i", (int *) &ptype) != 1)
+      {
+       iw_usage();
+       goto err;
+      }
+  
+  k = -1;
+  while((++k < number) && strcmp(priv[k].name, "sport_type") &&
+       strcmp(priv[k].name, "set_port"));
+  if(k == number)
+    {
+      fprintf(stderr, "This device doesn't support setting port type\n");
+      goto err;
+    }
+  strncpy(wrq.ifr_name, ifname, IFNAMSIZ);
 
-       }       /* if args to set */
+  *(wrq.u.name) = ptype;
 
-    }  /* if ioctl list else ioctl exec */
+  if(ioctl(skfd, priv[k].cmd, &wrq) < 0)
+    {
+      fprintf(stderr, "Invalid port type (or setting not allowed)\n");
+      goto err;
+    }
+
+  free(priv);
+  return(0);
+
+ err:
+  free(priv);
+  return(-1);
+}
+#endif
+
+/******************************* MAIN ********************************/
+
+/*------------------------------------------------------------------*/
+/*
+ * The main !
+ */
+int
+main(int       argc,
+     char **   argv)
+{
+  int skfd;            /* generic raw socket desc.     */
+  int goterr = 0;
+
+  /* Create a channel to the NET kernel. */
+  if((skfd = iw_sockets_open()) < 0)
+    {
+      perror("socket");
+      return(-1);
+    }
+
+  /* No argument : show the list of all devices + ioctl list */
+  if(argc == 1)
+    iw_enum_devices(skfd, &print_priv_info, NULL, 0);
+  else
+    /* Special cases take one... */
+    /* All */
+    if((!strncmp(argv[1], "-a", 2)) || (!strcmp(argv[1], "--all")))
+      iw_enum_devices(skfd, &print_priv_all, NULL, 0);
+    else
+      /* Help */
+      if((!strncmp(argv[1], "-h", 2)) || (!strcmp(argv[1], "--help")))
+       iw_usage();
+      else
+       /* Version */
+       if (!strcmp(argv[1], "-v") || !strcmp(argv[1], "--version"))
+         goterr = iw_print_version_info("iwpriv");
+       else
+         /* The device name must be the first argument */
+         /* Name only : show for that device only */
+         if(argc == 2)
+           print_priv_info(skfd, argv[1], NULL, 0);
+         else
+           /* Special cases take two... */
+           /* All */
+           if((!strncmp(argv[2], "-a", 2)) ||
+              (!strcmp(argv[2], "--all")))
+             print_priv_all(skfd, argv[1], NULL, 0);
+           else
+#if 0
+             /* Roaming */
+             if(!strncmp(argv[2], "roam", 4))
+               goterr = set_roaming(skfd, argv + 3, argc - 3, argv[1]);
+             else
+               /* Port type */
+               if(!strncmp(argv[2], "port", 4))
+                 goterr = port_type(skfd, argv + 3, argc - 3, argv[1]);
+               else
+#endif
+                 /*-------------*/
+                 /* Otherwise, it's a private ioctl */
+                 goterr = set_private(skfd, argv + 2, argc - 2, argv[1]);
 
   /* Close the socket. */
-  close(skfd);
+  iw_sockets_close(skfd);
 
-  return(1);
+  return(goterr);
 }