kenmirrors/freeswitch
1
0
Fork 0
mirror of https://github.com/signalwire/freeswitch.git synced 2025-03-31 02:33:44 +00:00
Code Issues Projects Releases Wiki Activity

A tweak to the PCAP file parsing code in spandsp to allow for 802.1Q headers in

Browse Source 
Ethernet packets.
This commit is contained in:
Steve Underwood 2018-01-08 18:15:47 +00:00
parent 726e522434
commit 78c189bfcc
2 changed files with 27 additions and 20 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
libs/spandsp/tests/g722_tests.c
View File

@ -593,6 +593,7 @@ int main(int argc, char *argv[])
exit(2); exit(2);
} }
} }
dec_state = NULL;
if (decode) if (decode)
{ {
memset(&info, 0, sizeof(info)); memset(&info, 0, sizeof(info));

46
libs/spandsp/tests/pcap_parse.c
View File

@ -37,6 +37,7 @@
#if defined(HAVE_PCAP_H) #if defined(HAVE_PCAP_H)
#include <pcap.h> #include <pcap.h>
#include <pcap/sll.h>
#endif #endif
#include <netinet/in.h> #include <netinet/in.h>
#include <netinet/udp.h> #include <netinet/udp.h>
@ -95,15 +96,6 @@ typedef struct _ether_hdr
uint16_t ether_type; uint16_t ether_type;
} ether_hdr; } ether_hdr;
typedef struct _linux_sll_hdr
{
uint16_t packet_type;
uint16_t arphrd;
uint16_t slink_length;
uint8_t bytes[8];
uint16_t ether_type;
} linux_sll_hdr;
typedef struct _null_hdr typedef struct _null_hdr
{ {
uint32_t pf_type; uint32_t pf_type;
@ -132,12 +124,13 @@ int pcap_scan_pkts(const char *file,
pcap_t *pcap; pcap_t *pcap;
struct pcap_pkthdr *pkthdr; struct pcap_pkthdr *pkthdr;
uint8_t *pktdata; uint8_t *pktdata;
uint8_t *pktptr;
const uint8_t *body; const uint8_t *body;
int body_len; int body_len;
int total_pkts; int total_pkts;
uint32_t pktlen; uint32_t pktlen;
ether_hdr *ethhdr; ether_hdr *ethhdr;
linux_sll_hdr *sllhdr; struct sll_header *sllhdr;
null_hdr *nullhdr; null_hdr *nullhdr;
struct iphdr *iphdr; struct iphdr *iphdr;
#if !defined(__CYGWIN__) #if !defined(__CYGWIN__)
@ -150,9 +143,10 @@ int pcap_scan_pkts(const char *file,
total_pkts = 0; total_pkts = 0;
if ((pcap = pcap_open_offline(file, errbuf)) == NULL) if ((pcap = pcap_open_offline(file, errbuf)) == NULL)
{ {
fprintf(stderr, "Can't open PCAP file '%s'\n", file); fprintf(stderr, "Can't open PCAP file: %s\n", errbuf);
return -1; return -1;
} }
//printf("PCAP file version %d.%d\n", pcap_major_version(pcap), pcap_minor_version(pcap));
datalink = pcap_datalink(pcap); datalink = pcap_datalink(pcap);
/* DLT_EN10MB seems to apply to all forms of ethernet, not just the 10MB kind. */ /* DLT_EN10MB seems to apply to all forms of ethernet, not just the 10MB kind. */
switch (datalink) switch (datalink)
@ -185,11 +179,21 @@ int pcap_scan_pkts(const char *file,
while ((pktdata = (uint8_t *) pcap_next(pcap, pkthdr)) != NULL) while ((pktdata = (uint8_t *) pcap_next(pcap, pkthdr)) != NULL)
{ {
#endif #endif
pktptr = pktdata;
switch (datalink) switch (datalink)
{ {
case DLT_EN10MB: case DLT_EN10MB:
ethhdr = (ether_hdr *) pktdata; ethhdr = (ether_hdr *) pktptr;
packet_type = ntohs(ethhdr->ether_type); packet_type = ntohs(ethhdr->ether_type);
pktptr += sizeof(*ethhdr);
/* Check for a 802.1Q Virtual LAN entry we might need to step over */
if (packet_type == 0x8100)
{
/* Step over the 802.1Q stuff, to get to the next packet type */
pktptr += sizeof(uint16_t);
packet_type = ntohs(*((uint16_t *) pktptr));
pktptr += sizeof(uint16_t);
}
#if !defined(__CYGWIN__) #if !defined(__CYGWIN__)
if (packet_type != 0x0800 /* IPv4 */ if (packet_type != 0x0800 /* IPv4 */
&& &&
@ -200,11 +204,12 @@ int pcap_scan_pkts(const char *file,
{ {
continue; continue;
} }
iphdr = (struct iphdr *) ((uint8_t *) ethhdr + sizeof(*ethhdr)); iphdr = (struct iphdr *) pktptr;
break; break;
case DLT_LINUX_SLL: case DLT_LINUX_SLL:
sllhdr = (linux_sll_hdr *) pktdata; sllhdr = (struct sll_header *) pktptr;
packet_type = ntohs(sllhdr->ether_type); packet_type = ntohs(sllhdr->sll_protocol);
pktptr += sizeof(*sllhdr);
#if !defined(__CYGWIN__) #if !defined(__CYGWIN__)
if (packet_type != 0x0800 /* IPv4 */ if (packet_type != 0x0800 /* IPv4 */
&& &&
@ -215,13 +220,14 @@ int pcap_scan_pkts(const char *file,
{ {
continue; continue;
} }
iphdr = (struct iphdr *) ((uint8_t *) sllhdr + sizeof(*sllhdr)); iphdr = (struct iphdr *) pktptr;
break; break;
case DLT_NULL: case DLT_NULL:
nullhdr = (null_hdr *) pktdata; nullhdr = (null_hdr *) pktptr;
pktptr += sizeof(*nullhdr);
if (nullhdr->pf_type != PF_INET && nullhdr->pf_type != PF_INET6) if (nullhdr->pf_type != PF_INET && nullhdr->pf_type != PF_INET6)
continue; continue;
iphdr = (struct iphdr *) ((uint8_t *) nullhdr + sizeof(*nullhdr)); iphdr = (struct iphdr *) pktptr;
break; break;
default: default:
continue; continue;
@ -239,10 +245,10 @@ int pcap_scan_pkts(const char *file,
if (iphdr && iphdr->version == 6) if (iphdr && iphdr->version == 6)
{ {
/* ipv6 */ /* ipv6 */
pktlen = (uint32_t) pkthdr->len - sizeof(*ethhdr) - sizeof(*ip6hdr);
ip6hdr = (ipv6_hdr *) (void *) iphdr; ip6hdr = (ipv6_hdr *) (void *) iphdr;
if (ip6hdr->nxt_header != IPPROTO_UDP) if (ip6hdr->nxt_header != IPPROTO_UDP)
continue; continue;
pktlen = (uint32_t) pkthdr->len - (pktptr - pktdata) - sizeof(*ip6hdr);
udphdr = (struct udphdr *) ((uint8_t *) ip6hdr + sizeof(*ip6hdr)); udphdr = (struct udphdr *) ((uint8_t *) ip6hdr + sizeof(*ip6hdr));
} }
else else
@ -256,7 +262,7 @@ int pcap_scan_pkts(const char *file,
pktlen = (uint32_t) ntohs(udphdr->uh_ulen); pktlen = (uint32_t) ntohs(udphdr->uh_ulen);
#elif defined ( __HPUX) #elif defined ( __HPUX)
udphdr = (struct udphdr *) ((uint8_t *) iphdr + (iphdr->ihl << 2)); udphdr = (struct udphdr *) ((uint8_t *) iphdr + (iphdr->ihl << 2));
pktlen = (uint32_t) pkthdr->len - sizeof(*ethhdr) - sizeof(*iphdr); pktlen = (uint32_t) pkthdr->len - (pktptr - pktdata) - sizeof(*iphdr);
#else #else
udphdr = (struct udphdr *) ((uint8_t *) iphdr + (iphdr->ihl << 2)); udphdr = (struct udphdr *) ((uint8_t *) iphdr + (iphdr->ihl << 2));
pktlen = (uint32_t) ntohs(udphdr->len); pktlen = (uint32_t) ntohs(udphdr->len);