Flags and datalink

2 files changed, 68 insertions, 56 deletions

diff --git a/noncore/net/wellenreiter/libwellenreiter/source/cardmode.cc b/noncore/net/wellenreiter/libwellenreiter/source/cardmode.cc
index def1a4b..1add34c 100644
--- a/noncore/net/wellenreiter/libwellenreiter/source/cardmode.cc
+++ b/noncore/net/wellenreiter/libwellenreiter/source/cardmode.cc
@@ -23,7 +23,7 @@ int card_into_monitormode (pcap_t **orighandle, char *device, int cardtype)
   /* Setting the promiscous and up flag to the interface */
   if (!card_set_promisc_up(device))
   {
-    wl_logerr("Cannot set interface to promisc mode: %s", strerror(errno));
+    wl_logerr("Cannot set interface to promisc mode");
     return 0;
   } 
   wl_loginfo("Interface set to promisc mode");
@@ -64,70 +64,80 @@ int card_into_monitormode (pcap_t **orighandle, char *device, int cardtype)
         return 0;
      }
   }
-   
+
+  /* Setting the promiscous and up flag to the interface */
+  if (!card_check_rfmon_datalink(device))
+  {
+    wl_logerr("Cannot set interface to rfmon mode");
+    return 0;
+  }
+  else 
+  {
+    wl_loginfo("Interface set to rfmon mode");
+  }
   return 1;
 }
 
+/* Check card is in the rfmon mode */
+int card_check_rfmon_datalink (char *device)
+{
+  int datalinktype=0;
+  pcap_t *phandle;
+  phandle = pcap_open_live(device, 65,0,0,NULL);
+  datalinktype = pcap_datalink (phandle);
+
+  if (datalinktype != DLT_IEEE802_11) /* Rawmode is IEEE802_11 */
+    {
+        return 0;
+    }
+  else
+  {
+    wl_loginfo("Your successfully listen on %s in 802.11 raw mode", device);
+    return 1; 
+  }
+}
+
 /* Set card into promisc mode */
 int card_set_promisc_up (const char *device)
 {
-    struct ifconf ifc;
-    struct ifreq ifr_x[50];
-    u_int i;
-    int sockfd, err;
-        err=0;
-        /* opening a socket for issuing the iocalls */
-        sockfd = socket(PF_INET, SOCK_DGRAM, IPPROTO_IP);
- 
-    if (sockfd < 0) 
+    int err;
+    /* First generate a socket to use with iocalls */
+    int fd = socket(AF_INET, SOCK_DGRAM, 0);
+    if (fd < 0)
     {
-            /* In case of an error  - mjm proove that please*/
+        /* In case of an error */
         perror("socket");
-                return 1;
+        return 0;
+    }
+
+    /* Fill an empty an interface structure with the right flags (UP and Promsic) */
+    struct ifreq ifr;
+    strncpy(ifr.ifr_name, device,10);
+    ifr.ifr_flags = IFF_UP + IFF_PROMISC;
+    err = ioctl(fd, SIOCSIFFLAGS, &ifr);
+    if (err < 0)
+    {
+            perror("Could not access the interface, ");
+        return 0;
     }
-        /* Define room for 50 interfaces */
-    ifc.ifc_len = 50 * sizeof(struct ifreq);
-    ifc.ifc_req = ifr_x;
-        /* Get the config of the interfaces */
-    err = ioctl(sockfd, SIOCGIFCONF, &ifc);
-    if (err == -1) return 1;       
     
-    /* For each interface*/
-    for (i = 0; i < ifc.ifc_len / sizeof(struct ifreq); i++) 
-        {
-                /* To complete , should get the IP, if no is assigned, asign one */
-                /*err = ioctl(sockfd, SIOCGIFADDR, &ifr_x[i]);
-                        if (err == -1) perror("SIOCGIFADDR: ");         
-                printf ("Address: %s\n",Sock_ntop_host(ifr_x[i].ifr_addr.sa_family,sizeof(ifr_x[i].ifr_addr.sa_family)));
-                */
-                if(strncmp(ifr_x[i].ifr_name,device,5) == 0)
-                {
-                        /* Get the flags */
-                        err = ioctl(sockfd, SIOCGIFFLAGS, &ifr_x[i]);
-                if (err == -1) 
-                {
-                        perror("SIOCGIFFLAGS: ");
-                        return 1;
-                }
-                        /* Check if the Interface is UP and PROMISC */
-                        if (ifr_x[i].ifr_flags & IFF_PROMISC && ifr_x[i].ifr_flags & IFF_UP)
-                        {
-                                /* only debug text */
-                                printf ("%s is PROMISC and UP \n",ifr_x[i].ifr_name);
-                        }
-                        else
-                        {
-                                /* Set the promisc flag to the interface */
-                                ifr_x[i].ifr_flags=ifr_x[i].ifr_flags+IFF_PROMISC;
-                                err = ioctl(sockfd, SIOCSIFFLAGS, &ifr_x[i]);
-                                if (err == -1) 
-                                {
-                                        /* Could not set the interface into promisc mode */
-                                        perror("SIOCSIFFLAGS: ");
-                                }
-                        }
-                }
-      }
-        /* All is fine */
+    /* Get the informations back from the interface to check if the flags are correct */
+    strncpy(ifr.ifr_name, device,10);
+    ioctl(fd, SIOCGIFFLAGS, &ifr);
+    if (err < 0)
+    {
+        perror("Could not access the interface, ");
         return 0;
+    }
+
+    if(ifr.ifr_flags && IFF_UP)
+    {
+     printf("%s is ok\n", device);
+     return 1;
+    }
+    else
+    {
+     printf("%s flags could not be set", device);
+     return 0;
+    }
 }
diff --git a/noncore/net/wellenreiter/libwellenreiter/source/cardmode.hh b/noncore/net/wellenreiter/libwellenreiter/source/cardmode.hh
index 7750fb6..babb109 100644
--- a/noncore/net/wellenreiter/libwellenreiter/source/cardmode.hh
+++ b/noncore/net/wellenreiter/libwellenreiter/source/cardmode.hh
@@ -10,6 +10,7 @@
 #include <sys/time.h>
 #include <sys/socket.h>
 #include <netinet/in.h>
+#include <arpa/inet.h>
 #include <sys/ioctl.h>
 #include <linux/if.h>
 
@@ -35,6 +36,7 @@ extern "C"
         #define   IWPRIV_PATH    "/sbin/iwpriv"
 
 /* Prototypes */
+int card_check_rfmon_datalink (char *device);
 int card_into_monitormode (pcap_t **, char *, int);
 int card_set_promisc_up (const char *);