2 * parse.c - parsing of pcap packages
4 * author: hackbard@hackdaworld.dyndns.org
11 /* all the parsing stuff will go here
13 * different protocols should get to seperated files though ...
16 unsigned int int_s(unsigned int val) {
20 swapped=(val&0x000000ff)<<24;
21 swapped|=(val&0x0000ff00)<<8;
22 swapped|=(val&0x00ff0000)>>8;
23 swapped|=(val&0xff000000)>>24;
28 int switch_active_state(char *state) {
48 void parse_package(unsigned char *ptr,const struct pcap_pkthdr *pcap_header,const unsigned char *pkg) {
54 unsigned char *package=NULL;
57 //t_frame2_hdr *f2hdr;
58 //t_frame1_hdr *f1hdr;
59 t_beacon_fb *beacon_fb;
61 t_prism_hdr *prismhdr=NULL;
63 char string[MESSAGE_MAX];
64 char sc[MAX_SYSCALL_CHARS];
72 memset(&new_sta,0,sizeof(t_sta));
76 if(info->dump_fd!=0) {
77 ret=write(info->dump_fd,pcap_header,sizeof(struct pcap_pkthdr));
78 if(ret!=sizeof(struct pcap_pkthdr))
79 display_console(info,"warning, pcap header write failed!");
80 ret=write(info->dump_fd,package,pcap_header->caplen);
81 if(ret!=pcap_header->caplen)
82 display_console(info,"warning, package write failed!");
85 /* prism or ieee802.11 header ? */
86 if(info->mode&MODE_IEEE80211) {
87 package=(unsigned char *)pkg;
90 else if(info->mode&MODE_PRISM) {
91 package=(unsigned char *)pkg+sizeof(t_prism_hdr);
92 prismhdr=(t_prism_hdr *)pkg;
96 if(FCTL_TYPE(package[0])==FCTL_TYPE_MGMT) {
100 if(FCTL_STYPE(package[0])==FCTL_STYPE_BEACON) {
101 f3hdr=(t_frame3_hdr *)package;
102 beacon_fb=(t_beacon_fb *)(package+sizeof(t_frame3_hdr));
104 memcpy(new_sta.addr,f3hdr->addr2,ADDR_LEN);
105 ret=list_search_data(&(info->sniffed_sta),&new_sta,ADDR_LEN);
106 if((ret==L_EMPTY_LIST)|(ret==L_NO_SUCH_ELEMENT)) {
107 list_add_element(&(info->sniffed_sta),&new_sta,sizeof(t_sta));
108 sta=(t_sta *)info->sniffed_sta.current->data;
111 else sta=(t_sta *)info->sniffed_sta.current->data;
113 memcpy(sta->ssid,beacon_fb->ssid,beacon_fb->ssid_length);
114 if((CAP_INFO_ESS(beacon_fb->cap_info))&
115 (CAP_INFO_IBSS(beacon_fb->cap_info)==0)) sta->ap=AP;
116 if(CAP_INFO_PRIVACY(beacon_fb->cap_info)) sta->wep=WEP;
118 switch_active_state(&(sta->active));
119 if(info->mode&MODE_IEEE80211) sta->sq=0;
120 else if(info->mode&MODE_PRISM)
121 sta->sq=(prismhdr->signal.data)-(prismhdr->noise.data);
122 strncpy(string,"last: beacon, source: ",MESSAGE_MAX);
123 for(i=0;i<ADDR_LEN;i++)
124 snprintf(&string[22+3*i],4,"%02x%c",sta->addr[i],
125 (i==ADDR_LEN-1)?'.':':');
126 string[22+3*ADDR_LEN+1]=0;
127 display_console(info,string);
129 snprintf(sc,MAX_SYSCALL_CHARS,
130 "flite 'access point found: %s'",
133 if(sta->wep&WEP) strncpy(sc,"flite ' crypted'",MAX_SYSCALL_CHARS);
134 else strncpy(sc,"flite 'not crypted'",MAX_SYSCALL_CHARS);
142 else if(FCTL_TYPE(package[0])==FCTL_TYPE_CTRL) {
144 display_console(info,"last: got control frame");
148 else if(FCTL_TYPE(package[0])==FCTL_TYPE_DATA) {
151 //if(FCTL_STYPE(package[0])==FCTL_STYPE_DATA) {
152 if(FCTL_TODS(package[0])&FCTL_FROMDS(package[0])) {
153 f4hdr=(t_frame4_hdr *)package;
154 data=package+sizeof(t_frame4_hdr);
155 memcpy(new_sta.addr,f4hdr->addr4,ADDR_LEN);
159 f3hdr=(t_frame3_hdr *)package;
160 data=package+sizeof(t_frame3_hdr);
161 if(FCTL_TODS(package[0])) {
162 memcpy(new_sta.addr,f3hdr->addr2,ADDR_LEN);
163 memcpy(new_sta.bssid,f3hdr->addr1,ADDR_LEN);
165 else if(FCTL_FROMDS(package[0])) {
166 memcpy(new_sta.addr,f3hdr->addr3,ADDR_LEN);
167 memcpy(new_sta.bssid,f3hdr->addr2,ADDR_LEN);
170 memcpy(new_sta.addr,f3hdr->addr2,ADDR_LEN);
171 memcpy(new_sta.bssid,f3hdr->addr3,ADDR_LEN);
174 ret=list_search_data(&(info->sniffed_sta),&new_sta,ADDR_LEN);
175 if((ret==L_EMPTY_LIST)|(ret==L_NO_SUCH_ELEMENT)) {
176 list_add_element(&(info->sniffed_sta),&new_sta,sizeof(t_sta));
177 sta=(t_sta *)info->sniffed_sta.current->data;
180 else sta=(t_sta *)info->sniffed_sta.current->data;
183 switch_active_state(&(sta->active));
184 if(info->mode&MODE_IEEE80211) sta->sq=0;
185 else if(info->mode&MODE_PRISM)
186 sta->sq=(prismhdr->signal.data)-(prismhdr->noise.data);
188 strcpy(sc,"flite 'new station. data package'");
193 strcpy(sc,"flite 'wds package'");
196 memcpy(sta->snap,data,6);
199 display_console(info,"last: got data frame");