introduced prism wlan ng header members
[my-code/hdw-sniff.git] / hdw-sniff.c
index a201688..ab67722 100644 (file)
@@ -5,6 +5,12 @@
  */
 
 #include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include <sys/socket.h>
+#include <time.h>
+#include <netinet/in.h>
+#include <arpa/inet.h>
 #include <pcap.h>
 
 /* IEEE 802.3 stuff -- i will concentrate on .11 stuff before! */
@@ -24,8 +30,7 @@ int main(int argc, char *argv[]) {
        pcap_t *pcap_handle;
        char sys_call[30];
        FILE *logfile;
-       int count;
-       int *p_count;
+       struct info_struct my_info_struct;
        
        /* parse the arguments */
        if(argc<3) {
@@ -46,10 +51,13 @@ int main(int argc, char *argv[]) {
        }
                        
        /* setting up device and set monitor mode */
-       if(atoi(argv[2])==1 && (strncmp(argv[1],"wlan",4)==0)) {
-               printf("setting to monitor mode 3\n");
-               sprintf(sys_call,"iwpriv %s monitor 3",argv[1]);
-               system(sys_call);
+       if(atoi(argv[2])==1) {
+               printf("setting to monitor mode\n");
+               if(strncmp(argv[1],"wlan",4)==0)
+                       sprintf(sys_call,"iwpriv %s monitor 3",argv[1]);
+               if(strncmp(argv[1],"eth",3)==0)
+                       sprintf(sys_call,"ifconfig %s promisc",argv[1]);
+       system(sys_call);
        }
        printf("setting up interface\n");
        sprintf(sys_call,"ifconfig %s up",argv[1]);
@@ -63,38 +71,65 @@ int main(int argc, char *argv[]) {
        }
        
        /* grab a package until user breaks */
-       count=0;
-       p_count=&count;
-       pcap_loop(pcap_handle,-1,pcap_process,(u_char *)p_count);
+       my_info_struct.count=0;
+       my_info_struct.mmode=argv[2][0];
+       strcpy(my_info_struct.dev,argv[1]);
+       /* do loopp */
+       pcap_loop(pcap_handle,-1,pcap_process,(u_char *)&my_info_struct);
+       return 0;
 }
 
 
 /* pcap_process callback function */
-void pcap_process(u_char *count,const struct pcap_pkthdr *pcap_header,
+void pcap_process(u_char *info,const struct pcap_pkthdr *pcap_header,
                        const u_char *package) {
        
        /* local variables */
-       struct ethhdr *e_hdr;
-       struct ip *ip_hdr;
+       struct linux_wlan_ng_prism_hdr *prism_hdr;
        struct ieee802_11_hdr *w_hdr;
+       struct ip *ip_hdr;
+       struct ethhdr *e_hdr;
+       struct info_struct *my_info_struct;
        int i;
-       int *p_count;
 
-       p_count=(int *)count;
-       ++(*p_count);
+       my_info_struct=(struct info_struct *)info;
+       ++(my_info_struct->count);
 
        printf("\n");
-       printf("---> package %d ---- %s",*p_count,
+       printf("---> package %d ---- %s",my_info_struct->count,
                        ctime((const time_t*)&(pcap_header->ts.tv_sec)));
-       printf("pcap header: ");
-       printf("capture length=%d ",pcap_header->caplen);
-       printf("length(off wire)=%d\n",pcap_header->len);
+       printf("pcap header:\n");
+       printf("capture_length: %d (dec.)\t",pcap_header->caplen);
+       printf("length(off wire): %d (dec.)\n",pcap_header->len);
        
-       /* is ieee802.11 ? -- we assume yes :) */
-       if(atoi(argv[2])==1 && (strncmp(argv[1],"wlan",4)==0)) {
-       printf("debug: ieee802.11\n");
-       }
+       /* prism wlan ng headers */
+       if((my_info_struct->mmode-0x30==1) && 
+               (strncmp(my_info_struct->dev,"wlan",4)==0)) {
+       printf("prism header:\n");
+       prism_hdr=(struct linux_wlan_ng_prism_hdr *)package;
+       printf("message code/length: %d/%d\n",ntohs(prism_hdr->msgcode),
+                                               ntohs(prism_hdr->msglen));
+       printf("device: %s\n",prism_hdr->devname);
 
+       /* ieee802.11 header */
+       printf("ieee802.11 header:\n");
+       package+=sizeof(struct linux_wlan_ng_prism_hdr);
+       w_hdr=(struct ieee802_11_hdr *)package;
+       
+       printf("debug:\n");
+       for(i=0;i<16;i++) {
+               printf("%x -> ",1<<i);
+               printf("%x\n",(ntohs(w_hdr->frame_ctl) & (1<<i)));
+       }
+       printf("frame_control: %x duration_id: %x\n",ntohs(w_hdr->frame_ctl),
+                                               ntohs(w_hdr->duration_id));
+       printf("version check ... %s\n",
+       ((ntohs(w_hdr->frame_ctl) & IEEE802_11_FCTL_VERS)==0x00)?
+                                                       "ok":"unknown");
+       // printf("type: 
+       /* skip ieee802.11 header */
+       package=package+sizeof(struct ieee802_11_hdr);
+       }
 
        /* ieee802.3 */
        /* ethernet */