FreeCalypso > hg > rtp-debug-utils
annotate pcap-study/rtp-tw5-extr.c @ 16:1bc144545563
pcap-study: new program rtp-tw5-extr
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 10 Oct 2024 17:40:16 +0000 |
parents | pcap-study/rtp-g711-extr.c@e686bc92c7d8 |
children |
rev | line source |
---|---|
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /* |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 * This program reads a pcap file, extracts packets belonging to a |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 * particular RTP stream as identified by a source or destination |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 * IP:port, and verifies that an unbroken RTP stream is present, |
16
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
5 * with timestamp increments of 160 units per packet. The selected |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
6 * RTP stream is saved in a TW-TS-005 hexadecimal file. |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 */ |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 #include <sys/types.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 #include <sys/socket.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 #include <netinet/in.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 #include <arpa/inet.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 #include <stdio.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 #include <stdlib.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 #include <string.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 #include <strings.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 #include <pcap/pcap.h> |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 static pcap_t *pcap; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 static in_addr_t match_ip_addr; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 static u_short match_udp_port; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 static unsigned iphdr_addr_offset, udphdr_port_offset; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 static unsigned link_hdr_len, ethertype_offset; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 static FILE *outfile; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 static int stream_init_flag; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 static unsigned last_seq, last_tstamp, stream_ssrc; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 static void |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 check_dl_type() |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 int dltype; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 dltype = pcap_datalink(pcap); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 switch (dltype) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
35 case DLT_EN10MB: |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
36 link_hdr_len = 14; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 ethertype_offset = 12; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 break; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39 case DLT_RAW: |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 link_hdr_len = 0; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
41 break; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 case DLT_LINUX_SLL: |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
43 link_hdr_len = 16; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
44 ethertype_offset = 14; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
45 break; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
46 default: |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
47 fprintf(stderr, "error: unsupported data link type %d\n", |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
48 dltype); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
49 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
50 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 static void |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
54 rtp_stream_logic(rtp_hdr, pkt_idx) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55 u_char *rtp_hdr; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 unsigned pkt_idx; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
58 unsigned cur_seq, cur_tstamp, cur_ssrc; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
59 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
60 cur_seq = (rtp_hdr[2] << 8) | rtp_hdr[3]; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
61 cur_tstamp = (rtp_hdr[4] << 24) | (rtp_hdr[5] << 16) | |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
62 (rtp_hdr[6] << 8) | rtp_hdr[7]; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
63 cur_ssrc = (rtp_hdr[8] << 24) | (rtp_hdr[9] << 16) | |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
64 (rtp_hdr[10] << 8) | rtp_hdr[11]; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
65 if (stream_init_flag) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
66 if (cur_ssrc != stream_ssrc) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67 fprintf(stderr, |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 "error in packet #%u: SSRC change from 0x%08X to 0x%08X\n", |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
69 pkt_idx, stream_ssrc, cur_ssrc); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
71 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
72 if (cur_seq != last_seq + 1 && |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
73 (cur_seq != 0 || last_seq != 0xFFFF)) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
74 fprintf(stderr, |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
75 "error in packet #%u: seq break from 0x%04X to 0x%04X\n", |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 pkt_idx, last_seq, cur_seq); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
77 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
79 if (cur_tstamp != last_tstamp + 160) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
80 fprintf(stderr, |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
81 "error in packet #%u: timestamp break from 0x%08X to 0x%08X\n", |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 pkt_idx, last_tstamp, cur_tstamp); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
85 } else { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
86 stream_init_flag = 1; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
87 stream_ssrc = cur_ssrc; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
88 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
89 last_seq = cur_seq; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
90 last_tstamp = cur_tstamp; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
91 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
92 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
93 static void |
16
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
94 emit_hex_frame(frame, nbytes) |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
95 u_char *frame; |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
96 unsigned nbytes; |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
97 { |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
98 unsigned n; |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
99 |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
100 for (n = 0; n < nbytes; n++) |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
101 fprintf(outfile, "%02X", frame[n]); |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
102 putc('\n', outfile); |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
103 } |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
104 |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
105 static void |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
106 process_packet(pkt, caplen, pkt_idx) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
107 u_char *pkt; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
108 unsigned caplen, pkt_idx; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
109 { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
110 unsigned udplen, payload_len; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
111 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
112 if (caplen < link_hdr_len + 28) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
113 return; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
114 if (link_hdr_len) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
115 if (pkt[ethertype_offset] != 0x08) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
116 return; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
117 if (pkt[ethertype_offset+1] != 0x00) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
118 return; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
119 pkt += link_hdr_len; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
120 caplen -= link_hdr_len; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
121 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
122 /* check IP header */ |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
123 if (pkt[0] != 0x45) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
124 return; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
125 if (pkt[9] != 17) /* UDP */ |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
126 return; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
127 if (bcmp(pkt + iphdr_addr_offset, &match_ip_addr, 4)) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
128 return; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
129 /* check UDP header */ |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
130 if (bcmp(pkt + 20 + udphdr_port_offset, &match_udp_port, 2)) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
131 return; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
132 /* it is our target - now scrutinize it */ |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
133 udplen = (pkt[24] << 8) | pkt[25]; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
134 if (caplen < udplen + 20) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
135 fprintf(stderr, |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
136 "error: packet #%u is truncated in the capture\n", |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
137 pkt_idx); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
138 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
139 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
140 if (udplen < 20) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
141 fprintf(stderr, |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
142 "error in packet #%u: UDP length is too short for RTP header\n", |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
143 pkt_idx); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
144 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
145 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
146 if (pkt[28] != 0x80) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
147 fprintf(stderr, |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
148 "error in packet #%u: unsupported RTP header structure\n", |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
149 pkt_idx); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
150 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
151 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
152 rtp_stream_logic(pkt + 28, pkt_idx); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
153 payload_len = udplen - 20; |
16
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
154 if (payload_len > 40) { |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
155 fprintf(stderr, |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
156 "error in packet #%u: payload exceeds TW-TS-005 limit\n", |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
157 pkt_idx); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
158 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
159 } |
16
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
160 if (payload_len) |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
161 emit_hex_frame(pkt + 40, payload_len); |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
162 else |
1bc144545563
pcap-study: new program rtp-tw5-extr
Mychaela Falconia <falcon@freecalypso.org>
parents:
10
diff
changeset
|
163 fputs("NULL\n", outfile); |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
164 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
165 |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
166 main(argc, argv) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
167 char **argv; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
168 { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
169 char errbuf[PCAP_ERRBUF_SIZE]; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
170 u_char *pkt; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
171 struct pcap_pkthdr pkthdr; |
7
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
172 unsigned pkt_idx, skip_num; |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
173 |
7
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
174 if (argc < 6 || argc > 7) { |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
175 fprintf(stderr, |
7
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
176 "usage: %s pcap-file src|dest ip-addr udp-port outfile [skip-count]\n", |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
177 argv[0]); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
178 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
179 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
180 pcap = pcap_open_offline(argv[1], errbuf); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
181 if (!pcap) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
182 fprintf(stderr, "%s: %s\n", argv[1], errbuf); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
183 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
184 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
185 check_dl_type(); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
186 if (!strcmp(argv[2], "src")) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
187 iphdr_addr_offset = 12; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
188 udphdr_port_offset = 0; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
189 } else if (!strcmp(argv[2], "dest")) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
190 iphdr_addr_offset = 16; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
191 udphdr_port_offset = 2; |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
192 } else { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
193 fprintf(stderr, |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
194 "error: direction argument must be \"src\" or \"dest\"\n"); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
195 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
196 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
197 match_ip_addr = inet_addr(argv[3]); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
198 if (match_ip_addr == INADDR_NONE) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
199 fprintf(stderr, "error: IP address argument is invalid\n"); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
200 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
201 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
202 match_udp_port = htons(strtoul(argv[4], 0, 0)); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
203 outfile = fopen(argv[5], "w"); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
204 if (!outfile) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
205 perror(argv[5]); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
206 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
207 } |
7
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
208 if (argv[6]) |
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
209 skip_num = strtoul(argv[6], 0, 0); |
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
210 else |
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
211 skip_num = 0; |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
212 for (pkt_idx = 0; ; pkt_idx++) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
213 pkt = pcap_next(pcap, &pkthdr); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
214 if (!pkt) |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
215 break; |
7
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
216 if (pkt_idx < skip_num) |
9b0613775cf6
rtp-g711-extr: add ability to skip some number of packets,
Mychaela Falconia <falcon@freecalypso.org>
parents:
0
diff
changeset
|
217 continue; |
0
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
218 process_packet(pkt, (unsigned) pkthdr.caplen, pkt_idx); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
219 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
220 if (!stream_init_flag) { |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
221 fprintf(stderr, "error: specified RTP stream not found\n"); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
222 exit(1); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
223 } |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
224 fclose(outfile); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
225 exit(0); |
05ff0f7ac977
initial commit: split from gsm-codec-lib
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
226 } |