X-Git-Url: https://hackdaworld.org/gitweb/?a=blobdiff_plain;f=hdw-sniff.c;h=54e40dbc1ac22bfdc6bb8c39a9aab35dcf89d790;hb=6da514c21607236c5dff3a1395088cbfb3b17a0a;hp=ab67722a20b5565004269f8ebd33dc40664de063;hpb=95e482eef2af91c6bb150d4e92cb73503d6b8fb9;p=my-code%2Fhdw-sniff.git

diff --git a/hdw-sniff.c b/hdw-sniff.c
index ab67722..54e40db 100644
--- a/hdw-sniff.c
+++ b/hdw-sniff.c
@@ -12,6 +12,9 @@
 #include <netinet/in.h>
 #include <arpa/inet.h>
 #include <pcap.h>
+#include <sys/types.h>
+#include <unistd.h>
+#include <sys/ioctl.h>
 
 /* IEEE 802.3 stuff -- i will concentrate on .11 stuff before! */
 #include <netinet/if_ether.h>  /* for ethhdr struct */
@@ -28,6 +31,9 @@ int main(int argc, char *argv[]) {
 
 	char pcap_error[PCAP_ERRBUF_SIZE];
 	pcap_t *pcap_handle;
+	int pcap_fd,foo_fd;
+	fd_set pcap_fd_set;
+	struct timeval fd_set_tv;
 	char sys_call[30];
 	FILE *logfile;
 	struct info_struct my_info_struct;
@@ -69,13 +75,42 @@ int main(int argc, char *argv[]) {
 		printf("%s: %s\n",argv[0],pcap_error);
 		return 1;
 	}
+
+	/* set non blocking */
+	if((pcap_setnonblock(pcap_handle,1,pcap_error))==-1) {
+		printf("%s: %s\n",argv[0],pcap_error);
+		return 1;
+	}
 	
 	/* grab a package until user breaks */
 	my_info_struct.count=0;
 	my_info_struct.mmode=argv[2][0];
 	strcpy(my_info_struct.dev,argv[1]);
+
+	/* prepare for select */
+	pcap_fd=pcap_fileno(pcap_handle);
+
+	/* create file descriptor */
+	if((foo_fd=socket(AF_INET,SOCK_DGRAM,0))==-1) {
+		printf("unable to create socket foo_fd\n");
+		return -1;
+	}
+
 	/* do loopp */
-	pcap_loop(pcap_handle,-1,pcap_process,(u_char *)&my_info_struct);
+	while (1) {
+
+		/* set pcap_fd */
+		FD_ZERO(&pcap_fd_set);
+		FD_SET(pcap_fd,&pcap_fd_set);
+		fd_set_tv.tv_sec=0;
+		fd_set_tv.tv_usec=500000;
+
+		if((select(pcap_fd+1,&pcap_fd_set,NULL,NULL,&fd_set_tv)) && (FD_ISSET(pcap_fd,&pcap_fd_set))) pcap_dispatch(pcap_handle,-1,pcap_process,(u_char *)&my_info_struct);
+		else if((hop_channel(&my_info_struct,foo_fd))==-1) { 
+			printf("channelhopping failed, aborting\n");
+			return -1;
+		}
+	}
 	return 0;
 }
 
@@ -87,8 +122,8 @@ void pcap_process(u_char *info,const struct pcap_pkthdr *pcap_header,
 	/* local variables */
 	struct linux_wlan_ng_prism_hdr *prism_hdr;
 	struct ieee802_11_hdr *w_hdr;
-	struct ip *ip_hdr;
 	struct ethhdr *e_hdr;
+	struct ip *ip_hdr;
 	struct info_struct *my_info_struct;
 	int i;
 
@@ -133,6 +168,7 @@ void pcap_process(u_char *info,const struct pcap_pkthdr *pcap_header,
 
 	/* ieee802.3 */
 	/* ethernet */
+	printf("ethernet:\n");
 	e_hdr=(struct ethhdr *)package;
 	/* what types ? */
 	printf("type = ");
@@ -166,4 +202,24 @@ void pcap_process(u_char *info,const struct pcap_pkthdr *pcap_header,
 	printf("\n");
 }
 
-		
+int hop_channel(struct info_struct *info,int foo_fd) {
+	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;
+	if((ioctl(foo_fd,SIOCSIWFREQ,&my_iwreq))==-1) {
+		printf("unable to hop channels\n");
+		perror("ioctl");
+		return -1;
+	}
+	printf("debug: hopped to channel %d\n",info->channel);
+	++(info->channel);
+	return 0;
+}