FreeCalypso > hg > gsm-codec-lib

annotate pcap/rtp-g711-extr.c @ 190:f387ee919f2c

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
libgsmefr/dec_lag6.c: perf opt
author Mychaela Falconia <falcon@freecalypso.org>
date Tue, 03 Jan 2023 04:04:59 +0000
parents 9bd01faadaed
children 10f11a2d4042
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
15
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
2 * This program reads a pcap file, extracts packets belonging to a
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 * particular RTP stream as identified by a source or destination
175
9bd01faadaed rtp-g711-extr program written
Mychaela Falconia <falcon@freecalypso.org>
parents: 15
diff changeset
4 * IP:port, and verifies that an unbroken RTP stream is present,
9bd01faadaed rtp-g711-extr program written
Mychaela Falconia <falcon@freecalypso.org>
parents: 15
diff changeset
5 * with 160-byte payloads corresponding to timestamp increments
9bd01faadaed rtp-g711-extr program written
Mychaela Falconia <falcon@freecalypso.org>
parents: 15
diff changeset
6 * of 160 units per packet, as expected for a G.711 (PCMU or PCMA)
9bd01faadaed rtp-g711-extr program written
Mychaela Falconia <falcon@freecalypso.org>
parents: 15
diff changeset
7 * RTP stream with 20 ms packetization. The extracted G.711 stream
9bd01faadaed rtp-g711-extr program written
Mychaela Falconia <falcon@freecalypso.org>
parents: 15
diff changeset
8 * is written to a raw binary file.
15
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
9 */
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
10
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 #include <sys/types.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
12 #include <sys/socket.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 #include <netinet/in.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14 #include <arpa/inet.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15 #include <stdio.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
16 #include <stdlib.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
17 #include <string.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
18 #include <strings.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
19 #include <pcap/pcap.h>
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
20
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
21 static pcap_t *pcap;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
22 static in_addr_t match_ip_addr;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
23 static u_short match_udp_port;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
24 static unsigned iphdr_addr_offset, udphdr_port_offset;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
25 static unsigned link_hdr_len, ethertype_offset;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
26 static FILE *outfile;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
27 static int stream_init_flag;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
28 static unsigned last_seq, last_tstamp, stream_ssrc;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
29
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
30 static void
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
31 check_dl_type()
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
32 {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
33 int dltype;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
34
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
35 dltype = pcap_datalink(pcap);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
36 switch (dltype) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
37 case DLT_EN10MB:
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
38 link_hdr_len = 14;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
39 ethertype_offset = 12;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
40 break;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
41 case DLT_RAW:
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
42 link_hdr_len = 0;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
43 break;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
44 case DLT_LINUX_SLL:
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
45 link_hdr_len = 16;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
46 ethertype_offset = 14;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
47 break;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
48 default:
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
49 fprintf(stderr, "error: unsupported data link type %d\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
50 dltype);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
51 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
52 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
53 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
54
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
55 static void
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
56 rtp_stream_logic(rtp_hdr, pkt_idx)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
57 u_char *rtp_hdr;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
58 unsigned pkt_idx;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
59 {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
60 unsigned cur_seq, cur_tstamp, cur_ssrc;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
61
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
62 cur_seq = (rtp_hdr[2] << 8) | rtp_hdr[3];
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
63 cur_tstamp = (rtp_hdr[4] << 24) | (rtp_hdr[5] << 16) |
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
64 (rtp_hdr[6] << 8) | rtp_hdr[7];
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
65 cur_ssrc = (rtp_hdr[8] << 24) | (rtp_hdr[9] << 16) |
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
66 (rtp_hdr[10] << 8) | rtp_hdr[11];
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
67 if (stream_init_flag) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
68 if (cur_ssrc != stream_ssrc) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
69 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
70 "error in packet #%u: SSRC change from 0x%08X to 0x%08X\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
71 pkt_idx, stream_ssrc, cur_ssrc);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
72 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
73 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
74 if (cur_seq != last_seq + 1) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
75 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
76 "error in packet #%u: seq break from 0x%04X to 0x%04X\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
77 pkt_idx, last_seq, cur_seq);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
78 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
79 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
80 if (cur_tstamp != last_tstamp + 160) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
81 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
82 "error in packet #%u: timestamp break from 0x%08X to 0x%08X\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
83 pkt_idx, last_tstamp, cur_tstamp);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
84 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
85 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
86 } else {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
87 stream_init_flag = 1;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
88 stream_ssrc = cur_ssrc;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
89 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
90 last_seq = cur_seq;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
91 last_tstamp = cur_tstamp;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
92 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
93
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
94 static void
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
95 process_packet(pkt, caplen, pkt_idx)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
96 u_char *pkt;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
97 unsigned caplen, pkt_idx;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
98 {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
99 unsigned udplen, payload_len;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
100
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
101 if (caplen < link_hdr_len + 28)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
102 return;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
103 if (link_hdr_len) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
104 if (pkt[ethertype_offset] != 0x08)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
105 return;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
106 if (pkt[ethertype_offset+1] != 0x00)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
107 return;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
108 pkt += link_hdr_len;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
109 caplen -= link_hdr_len;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
110 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
111 /* check IP header */
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
112 if (pkt[0] != 0x45)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
113 return;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
114 if (pkt[9] != 17) /* UDP */
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
115 return;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
116 if (bcmp(pkt + iphdr_addr_offset, &match_ip_addr, 4))
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
117 return;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
118 /* check UDP header */
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
119 if (bcmp(pkt + 20 + udphdr_port_offset, &match_udp_port, 2))
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
120 return;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
121 /* it is our target - now scrutinize it */
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
122 udplen = (pkt[24] << 8) | pkt[25];
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
123 if (caplen < udplen + 20) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
124 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
125 "error: packet #%u is truncated in the capture\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
126 pkt_idx);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
127 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
128 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
129 if (udplen < 20) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
130 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
131 "error in packet #%u: UDP length is too short for RTP header\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
132 pkt_idx);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
133 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
134 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
135 if (pkt[28] != 0x80) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
136 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
137 "error in packet #%u: unsupported RTP header structure\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
138 pkt_idx);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
139 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
140 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
141 rtp_stream_logic(pkt + 28, pkt_idx);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
142 payload_len = udplen - 20;
175
9bd01faadaed rtp-g711-extr program written
Mychaela Falconia <falcon@freecalypso.org>
parents: 15
diff changeset
143 if (payload_len != 160) {
15
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
144 fprintf(stderr, "error in packet #%u: unsupported payload\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
145 pkt_idx);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
146 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
147 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
148 fwrite(pkt + 40, 1, payload_len, outfile);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
149 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
150
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
151 main(argc, argv)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
152 char **argv;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
153 {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
154 char errbuf[PCAP_ERRBUF_SIZE];
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
155 u_char *pkt;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
156 struct pcap_pkthdr pkthdr;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
157 unsigned pkt_idx;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
158
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
159 if (argc != 6) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
160 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
161 "usage: %s pcap-file src|dest ip-addr udp-port outfile\n",
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
162 argv[0]);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
163 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
164 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
165 pcap = pcap_open_offline(argv[1], errbuf);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
166 if (!pcap) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
167 fprintf(stderr, "%s: %s\n", argv[1], errbuf);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
168 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
169 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
170 check_dl_type();
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
171 if (!strcmp(argv[2], "src")) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
172 iphdr_addr_offset = 12;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
173 udphdr_port_offset = 0;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
174 } else if (!strcmp(argv[2], "dest")) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
175 iphdr_addr_offset = 16;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
176 udphdr_port_offset = 2;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
177 } else {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
178 fprintf(stderr,
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
179 "error: direction argument must be \"src\" or \"dest\"\n");
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
180 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
181 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
182 match_ip_addr = inet_addr(argv[3]);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
183 if (match_ip_addr == INADDR_NONE) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
184 fprintf(stderr, "error: IP address argument is invalid\n");
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
185 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
186 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
187 match_udp_port = htons(strtoul(argv[4], 0, 0));
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
188 outfile = fopen(argv[5], "w");
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
189 if (!outfile) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
190 perror(argv[5]);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
191 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
192 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
193 for (pkt_idx = 0; ; pkt_idx++) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
194 pkt = pcap_next(pcap, &pkthdr);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
195 if (!pkt)
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
196 break;
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
197 process_packet(pkt, (unsigned) pkthdr.caplen, pkt_idx);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
198 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
199 if (!stream_init_flag) {
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
200 fprintf(stderr, "error: specified RTP stream not found\n");
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
201 exit(1);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
202 }
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
203 fclose(outfile);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
204 exit(0);
851ca64e38e9 rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
205 }