fc
[my-code/hdw-sniff.git] / hdw-sniff.c
index 94830b7..3aa657b 100644 (file)
@@ -120,21 +120,22 @@ void pcap_process(u_char *info,const struct pcap_pkthdr *pcap_header,
                        const u_char *package) {
        
        /* local variables */
+       char tmp_buf[20];
        struct linux_wlan_ng_prism_hdr *prism_hdr;
        struct ieee802_11_hdr *w_hdr;
        struct ethhdr *e_hdr;
-       struct ip *ip_hdr;
+       struct iphdr *ip_hdr;
        struct info_struct *my_info_struct;
        int i,p_o,w_o,e_o,i_o;
        
-       /* cache offsets */
-       p_o=sizeof(struct linux_wlan_ng_prism_hdr);
-       w_o=sizeof(struct ieee802_11_hdr);
-       e_o=sizeof(struct ethhdr);
-       i_o=sizeof(struct ip);
-
        my_info_struct=(struct info_struct *)info;
        ++(my_info_struct->count);
+       
+       /* cache offsets */
+       p_o=((strncmp(my_info_struct->dev,"wlan",4)==0)?sizeof(struct linux_wlan_ng_prism_hdr):0);
+       w_o=((strncmp(my_info_struct->dev,"wlan",4)==0)?sizeof(struct ieee802_11_hdr):0);
+       e_o=sizeof(struct ethhdr);
+       i_o=sizeof(struct iphdr);
 
        printf("\n");
        printf("---> package %d ---- %s",my_info_struct->count,
@@ -142,40 +143,43 @@ void pcap_process(u_char *info,const struct pcap_pkthdr *pcap_header,
        printf("pcap header:\n");
        printf("capture_length: %d (dec.)\t",pcap_header->caplen);
        printf("length(off wire): %d (dec.)\n",pcap_header->len);
-       
+
+       /* wireless stuff */
        /* prism wlan ng headers */
        if((my_info_struct->mmode-0x30==1) && 
                (strncmp(my_info_struct->dev,"wlan",4)==0)) {
        printf("prism header: (%d bytes)\n",p_o);
        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);
-       /* skip wlan_ng_prism header */
-       // package=package+p_o;
-
+       printf("| message code/length: %d/%d |\t",prism_hdr->msgcode,
+                                               prism_hdr->msglen);
+       printf("device: %s |\n",prism_hdr->devname);
        /* ieee802.11 header */
        printf("ieee802.11 header: (%d bytes)\n",w_o);
        w_hdr=(struct ieee802_11_hdr *)(package+p_o);
        
-       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("fc: ");
+       for(i=0;i<16;i++)
+               printf("%s%d%s",(i==0?"|":""),
+                               (((w_hdr->frame_ctl) & (1<<i))>0?1:0),
+                               (i==15?"|\n":"|"));
+       printf("    | v | t |  s-t  |t|f|m|r|p|m|w|o|\n");
+       printf("debug: %d\n",(w_hdr->frame_ctl)<<15);
+       if((w_hdr->frame_ctl & IEEE802_11_STYPE_BEACON)>0) strcpy(tmp_buf,"beacon");
+       else strcpy(tmp_buf,"unknown");
+
+       printf("=> %s\n",tmp_buf);
+       
+       printf("duration/id: %x\n",w_hdr->duration_id);
        printf("version check ... %s\n",
-       ((ntohs(w_hdr->frame_ctl) & IEEE802_11_FCTL_VERS)==0x00)?
+       ((w_hdr->frame_ctl & IEEE802_11_FCTL_VERS)==0x00)?
                                                        "ok":"unknown");
-       // printf("type: 
-       /* skip ieee802.11 header */
-       // package=package+w_o;
        }
 
        /* ieee802.3 */
        /* ethernet */
-       printf("ethernet:\n");
+       if((strncmp(my_info_struct->dev,"eth",3)==0) | 
+               ((w_hdr->frame_ctl & IEEE802_11_FTYPE_DATA)>0)) {
+       printf("ethernet: (%d bytes)\n",e_o);
        e_hdr=(struct ethhdr *)(package+p_o+w_o);
        /* what types ? */
        printf("type = ");
@@ -186,38 +190,55 @@ void pcap_process(u_char *info,const struct pcap_pkthdr *pcap_header,
        printf(" src_addr = ");
        for(i=0;i<ETH_ALEN;i++)
        printf("%x%s",*(e_hdr->h_source+i),((i==ETH_ALEN-1)?"\n":":"));
+
                /* IP ? */
        if(ntohs(e_hdr->h_proto)==ETH_P_IP) {
-               printf("ip protocol: ");
-               ip_hdr=(struct ip *)(package+p_o+w_o+e_o);
-               printf("version = %x ",ntohs(ip_hdr->ip_v));
-               printf("header_length = %x \n",ntohs(ip_hdr->ip_hl));
-               printf("service = %x ",ntohs(ip_hdr->ip_tos));
-               printf("total_length(dec.) = %d \n",ntohs(ip_hdr->ip_len));
-               printf("ip_addresses: source = ");
-               printf("%s\tdestination = %s\n",inet_ntoa(ip_hdr->ip_src),
-                                               inet_ntoa(ip_hdr->ip_dst));
-               printf("ip_id = %x ",ntohs(ip_hdr->ip_id));
-               printf("ip_offset = %x \n",ntohs(ip_hdr->ip_off));
-               printf("time2live = %x ip_proto = %x\n",ntohs(ip_hdr->ip_ttl),
-                                               ntohs(ip_hdr->ip_p));
-               printf("chksum: %x\n",ntohs(ip_hdr->ip_sum));
+               printf("ip protocol: (%d bytes)\n",i_o);
+               ip_hdr=(struct iphdr *)(package+p_o+w_o+e_o);
+               printf("version = %x ",ntohs(ip_hdr->version));
+               printf("header_length = %x \n",ntohs(ip_hdr->ihl));
+               printf("service = %x ",ntohs(ip_hdr->tos));
+               printf("total_length(dec.) = %d \n",ntohs(ip_hdr->tot_len));
+               printf("source_ip: ");
+               for(i=3;i>=0;--i) {
+                       printf("%d%s",
+                       ip_hdr->saddr&0xff<<i,
+                       (i==0?"\n":"."));
+               }
+               printf("destination_ip: ");
+               for(i=3;i>=0;--i) {
+                       printf("%d%s",
+                       ip_hdr->daddr&0xff<<i,
+                       (i==0?"\n":"."));
+               }
+               printf("ip_id = %x ",ntohs(ip_hdr->id));
+               printf("ip_offset = %x \n",ntohs(ip_hdr->frag_off));
+               printf("time2live = %x ip_proto = %x\n",ntohs(ip_hdr->ttl),
+                                               ntohs(ip_hdr->protocol));
+               // printf("chksum: %x\n",ntohs(ip_hdr->ip_sum));
+       }
        }
-       printf("all ethernet dump:\n");
-       for(i=p_o+w_o+e_o;i<pcap_header->caplen;i++)
+
+       /* check what we have ... */
+       printf("all dump: (hex)\n");
+       for(i=p_o+w_o;i<pcap_header->caplen;i++)
                printf("%x ",*(package+i));
        printf("\n");
+       printf("all dump: (char)\n");
+       for(i=p_o+w_o;i<pcap_header->caplen;i++)
+               printf("%c ",*(package+i));
+       printf("\n");
 }
 
 int hop_channel(struct info_struct *info,int foo_fd) {
+       if((info->mmode-0x30==1) && (strncmp(info->dev,"wlan",4)==0)) {
+
        struct iwreq my_iwreq;
 
        if (info->channel>=14) info->channel=1;
 
        memset(&my_iwreq,0,sizeof(my_iwreq));
        strcpy(my_iwreq.ifr_name,info->dev);
-       printf("debug: device = %s\n",my_iwreq.ifr_name);
-       printf("debug: %d\n",foo_fd);
        printf("debug: channel = %d\n",info->channel);
        my_iwreq.u.freq.e=0;
        my_iwreq.u.freq.m=info->channel;
@@ -226,7 +247,7 @@ int hop_channel(struct info_struct *info,int foo_fd) {
                perror("ioctl");
                return -1;
        }
-       printf("debug: hopped to channel %d\n",info->channel);
        ++(info->channel);
+       }
        return 0;
 }