[Listener] Reorganise implicit/explicit code
Reorganise read_packet() code for detection of implicit/explicit requests. Quite buggy, it was. Word of the day: OMG GOTOZ LOL111
This commit is contained in:
parent
2e16e62c44
commit
8474fef520
|
@ -492,6 +492,7 @@ void read_packet(u_char *args, const struct pcap_pkthdr *header,
|
|||
BOOL is_explicit_packet = TRUE ; // Is the packet an explicit request?
|
||||
int i ; // Iterator
|
||||
|
||||
bzero(couple.mobile_ip_addr_bytes, 4) ; // Blank the IP
|
||||
|
||||
/* Common treatements */
|
||||
|
||||
|
@ -505,53 +506,44 @@ void read_packet(u_char *args, const struct pcap_pkthdr *header,
|
|||
// is the packet type (beacon or not):
|
||||
raw_packet_type = data[rtap_bytes] ;
|
||||
|
||||
if (raw_packet_type == RAW_PACKET_TYPE_DATA) // Data packet
|
||||
if (raw_packet_type != RAW_PACKET_TYPE_DATA) // Data packet?
|
||||
goto not_explicit_packet ;
|
||||
|
||||
// Get the packet type (protocol, 2 bytes) from the LLC header:
|
||||
memcpy((unsigned char*) &llc_packet_type,
|
||||
&data[rtap_bytes + IEEE80211_HEADER_SIZE + 6], 2) ;
|
||||
llc_packet_type = ntohs(llc_packet_type) ;
|
||||
|
||||
if (llc_packet_type != ETH_P_IP) // IP packet?
|
||||
goto not_explicit_packet ;
|
||||
|
||||
packet_ip_header = (struct iphdr *)
|
||||
&data[rtap_bytes + IEEE80211_HEADER_SIZE + LLC_HEADER_SIZE] ;
|
||||
// Get the source IP:
|
||||
memcpy(couple.mobile_ip_addr_bytes, &packet_ip_header->saddr, 4) ;
|
||||
|
||||
if (GET_MODE() != MODE_PASSIVE) // If mode is active or mixed
|
||||
{
|
||||
// Get the packet type (protocol, 2 bytes) from the LLC header:
|
||||
memcpy((unsigned char*) &llc_packet_type,
|
||||
&data[rtap_bytes + IEEE80211_HEADER_SIZE + 6], 2) ;
|
||||
llc_packet_type = ntohs(llc_packet_type) ;
|
||||
// Protocol for an explicit request is UDP
|
||||
if (packet_ip_header->protocol != IPPROTO_UDP)
|
||||
goto not_explicit_packet ;
|
||||
|
||||
if (llc_packet_type == ETH_P_IP) // IP packet
|
||||
{
|
||||
packet_ip_header = (struct iphdr *)
|
||||
&data[rtap_bytes + IEEE80211_HEADER_SIZE + LLC_HEADER_SIZE] ;
|
||||
// Get the source IP:
|
||||
memcpy(couple.mobile_ip_addr_bytes, &packet_ip_header->saddr, 4) ;
|
||||
|
||||
if (GET_MODE() != MODE_PASSIVE) // If mode is active or mixed
|
||||
{
|
||||
// Protocol for an explicit request is UDP
|
||||
if (packet_ip_header->protocol == IPPROTO_UDP)
|
||||
{ // Check destination port:
|
||||
packet_udp_header = (struct udphdr *)
|
||||
&data[rtap_bytes + IEEE80211_HEADER_SIZE +
|
||||
LLC_HEADER_SIZE + sizeof(struct iphdr)] ;
|
||||
if (ntohs(packet_udp_header->dest) !=
|
||||
GET_LISTENING_PORT())
|
||||
{
|
||||
if (GET_MODE() == MODE_ACTIVE)
|
||||
return ;
|
||||
is_explicit_packet = FALSE ;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (GET_MODE() != MODE_ACTIVE) // Passive or mixed mode
|
||||
{
|
||||
is_explicit_packet = FALSE ;
|
||||
bzero(couple.mobile_ip_addr_bytes, 4) ; // Blank the IP
|
||||
}
|
||||
else // Active mode and not an IP packet, so it is not a request
|
||||
return ;
|
||||
// Check destination port:
|
||||
packet_udp_header = (struct udphdr *)
|
||||
&data[rtap_bytes + IEEE80211_HEADER_SIZE +
|
||||
LLC_HEADER_SIZE + sizeof(struct iphdr)] ;
|
||||
if (ntohs(packet_udp_header->dest) != GET_LISTENING_PORT())
|
||||
goto not_explicit_packet ;
|
||||
}
|
||||
|
||||
else // Packet is not data, so it is not a localisation request
|
||||
{
|
||||
if (GET_MODE() == MODE_ACTIVE)
|
||||
return ;
|
||||
is_explicit_packet = FALSE ;
|
||||
}
|
||||
goto process_packet ;
|
||||
|
||||
not_explicit_packet :
|
||||
if (GET_MODE() == MODE_ACTIVE)
|
||||
return ;
|
||||
is_explicit_packet = FALSE ;
|
||||
|
||||
process_packet :
|
||||
|
||||
// Get 802.11 flags from the 802.11 header:
|
||||
raw_packet_flags = data[rtap_bytes+1] ;
|
||||
|
|
Loading…
Reference in New Issue