FreeCalypso > hg > gsm-codec-lib
annotate pcap/rtp-jitter-view.c @ 202:0faf23a9286f
libgsmefr/reorder.c: perf opt
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Wed, 04 Jan 2023 04:54:02 +0000 |
parents | 693a0958a303 |
children | 10f11a2d4042 |
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 |
172
693a0958a303
yet another refactoring of RTP tools:
Mychaela Falconia <falcon@freecalypso.org>
parents:
171
diff
changeset
|
4 * IP:port, checks its continuity at the packet header level |
693a0958a303
yet another refactoring of RTP tools:
Mychaela Falconia <falcon@freecalypso.org>
parents:
171
diff
changeset
|
5 * (verifies that the sequence number always increments by 1 and |
693a0958a303
yet another refactoring of RTP tools:
Mychaela Falconia <falcon@freecalypso.org>
parents:
171
diff
changeset
|
6 * that the timestamp always increments by 160 units) and prints out |
171
75607bc26f57
rtp-cont-check design change: print time deltas instead of
Mychaela Falconia <falcon@freecalypso.org>
parents:
170
diff
changeset
|
7 * the Rx time delta of each stream packet (the capture time of |
75607bc26f57
rtp-cont-check design change: print time deltas instead of
Mychaela Falconia <falcon@freecalypso.org>
parents:
170
diff
changeset
|
8 * the current packet minus the capture time of the previous packet) |
172
693a0958a303
yet another refactoring of RTP tools:
Mychaela Falconia <falcon@freecalypso.org>
parents:
171
diff
changeset
|
9 * on stdout, allowing visual analysis of timing jitter. |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
10 * |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
11 * The codec can be anything, and this program can also be used to |
172
693a0958a303
yet another refactoring of RTP tools:
Mychaela Falconia <falcon@freecalypso.org>
parents:
171
diff
changeset
|
12 * examine the jitter of RTP streams coming from PSTN/SIP, but the |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
13 * core assumption is that packets must arrive every 20 ms, with |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
14 * the timestamp field incrementing by 160 units each time. |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 */ |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 #include <sys/types.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 #include <sys/socket.h> |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
19 #include <sys/time.h> |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 #include <netinet/in.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 #include <arpa/inet.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 #include <stdio.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 #include <stdlib.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 #include <string.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 #include <strings.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26 #include <pcap/pcap.h> |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28 static pcap_t *pcap; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 static in_addr_t match_ip_addr; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 static u_short match_udp_port; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 static unsigned iphdr_addr_offset, udphdr_port_offset; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 static unsigned link_hdr_len, ethertype_offset; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 static int stream_init_flag; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 static unsigned last_seq, last_tstamp, stream_ssrc; |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
35 static struct timeval last_pkt_time; |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
36 |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 static void |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 check_dl_type() |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39 { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 int dltype; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
41 |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 dltype = pcap_datalink(pcap); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
43 switch (dltype) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
44 case DLT_EN10MB: |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
45 link_hdr_len = 14; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
46 ethertype_offset = 12; |
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 case DLT_RAW: |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
49 link_hdr_len = 0; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
50 break; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51 case DLT_LINUX_SLL: |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 link_hdr_len = 16; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 ethertype_offset = 14; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
54 break; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55 default: |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 fprintf(stderr, "error: unsupported data link type %d\n", |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 dltype); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
58 exit(1); |
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 } |
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 static void |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
63 rtp_stream_logic(rtp_hdr, pkt_idx, pkt_time) |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
64 u_char *rtp_hdr; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
65 unsigned pkt_idx; |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
66 struct timeval *pkt_time; |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67 { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 unsigned cur_seq, cur_tstamp, cur_ssrc; |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
69 struct timeval deltat; |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
71 cur_seq = (rtp_hdr[2] << 8) | rtp_hdr[3]; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
72 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
|
73 (rtp_hdr[6] << 8) | rtp_hdr[7]; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
74 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
|
75 (rtp_hdr[10] << 8) | rtp_hdr[11]; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 if (stream_init_flag) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
77 if (cur_ssrc != stream_ssrc) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78 fprintf(stderr, |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
79 "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
|
80 pkt_idx, stream_ssrc, cur_ssrc); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
81 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 if (cur_seq != last_seq + 1) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 fprintf(stderr, |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
85 "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
|
86 pkt_idx, last_seq, cur_seq); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
87 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
88 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
89 if (cur_tstamp != last_tstamp + 160) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
90 fprintf(stderr, |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
91 "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
|
92 pkt_idx, last_tstamp, cur_tstamp); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
93 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
94 } |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
95 if (timercmp(pkt_time, &last_pkt_time, <)) { |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
96 fprintf(stderr, |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
97 "packet #%u timing error: Rx time goes backward\n", |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
98 pkt_idx); |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
99 exit(1); |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
100 } |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
101 timersub(pkt_time, &last_pkt_time, &deltat); |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
102 if (deltat.tv_sec) { |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
103 fprintf(stderr, |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
104 "packet #%u timing error: Rx time gap >= 1 s\n", |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
105 pkt_idx); |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
106 exit(1); |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
107 } |
171
75607bc26f57
rtp-cont-check design change: print time deltas instead of
Mychaela Falconia <falcon@freecalypso.org>
parents:
170
diff
changeset
|
108 printf("Packet #%u: time delta %u us\n", pkt_idx, |
75607bc26f57
rtp-cont-check design change: print time deltas instead of
Mychaela Falconia <falcon@freecalypso.org>
parents:
170
diff
changeset
|
109 (unsigned) deltat.tv_usec); |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
110 } else { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
111 stream_init_flag = 1; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
112 stream_ssrc = cur_ssrc; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
113 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
114 last_seq = cur_seq; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
115 last_tstamp = cur_tstamp; |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
116 bcopy(pkt_time, &last_pkt_time, sizeof(struct timeval)); |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
117 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
118 |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
119 static void |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
120 process_packet(pkt, caplen, pkt_idx, pkt_time) |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
121 u_char *pkt; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
122 unsigned caplen, pkt_idx; |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
123 struct timeval *pkt_time; |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
124 { |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
125 unsigned udplen; |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
126 |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
127 if (caplen < link_hdr_len + 28) |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
128 return; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
129 if (link_hdr_len) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
130 if (pkt[ethertype_offset] != 0x08) |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
131 return; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
132 if (pkt[ethertype_offset+1] != 0x00) |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
133 return; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
134 pkt += link_hdr_len; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
135 caplen -= link_hdr_len; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
136 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
137 /* check IP header */ |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
138 if (pkt[0] != 0x45) |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
139 return; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
140 if (pkt[9] != 17) /* UDP */ |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
141 return; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
142 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
|
143 return; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
144 /* check UDP header */ |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
145 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
|
146 return; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
147 /* it is our target - now scrutinize it */ |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
148 udplen = (pkt[24] << 8) | pkt[25]; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
149 if (caplen < udplen + 20) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
150 fprintf(stderr, |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
151 "error: packet #%u is truncated in the capture\n", |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
152 pkt_idx); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
153 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
154 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
155 if (udplen < 20) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
156 fprintf(stderr, |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
157 "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
|
158 pkt_idx); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
159 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
160 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
161 if (pkt[28] != 0x80) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
162 fprintf(stderr, |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
163 "error in packet #%u: unsupported RTP header structure\n", |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
164 pkt_idx); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
165 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
166 } |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
167 rtp_stream_logic(pkt + 28, pkt_idx, pkt_time); |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
168 } |
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 main(argc, argv) |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
171 char **argv; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
172 { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
173 char errbuf[PCAP_ERRBUF_SIZE]; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
174 u_char *pkt; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
175 struct pcap_pkthdr pkthdr; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
176 unsigned pkt_idx; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
177 |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
178 if (argc != 5) { |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
179 fprintf(stderr, |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
180 "usage: %s pcap-file src|dest ip-addr udp-port\n", |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
181 argv[0]); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
182 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
183 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
184 pcap = pcap_open_offline(argv[1], errbuf); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
185 if (!pcap) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
186 fprintf(stderr, "%s: %s\n", argv[1], errbuf); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
187 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
188 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
189 check_dl_type(); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
190 if (!strcmp(argv[2], "src")) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
191 iphdr_addr_offset = 12; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
192 udphdr_port_offset = 0; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
193 } else if (!strcmp(argv[2], "dest")) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
194 iphdr_addr_offset = 16; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
195 udphdr_port_offset = 2; |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
196 } else { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
197 fprintf(stderr, |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
198 "error: direction argument must be \"src\" or \"dest\"\n"); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
199 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
200 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
201 match_ip_addr = inet_addr(argv[3]); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
202 if (match_ip_addr == INADDR_NONE) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
203 fprintf(stderr, "error: IP address argument is invalid\n"); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
204 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
205 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
206 match_udp_port = htons(strtoul(argv[4], 0, 0)); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
207 for (pkt_idx = 0; ; pkt_idx++) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
208 pkt = pcap_next(pcap, &pkthdr); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
209 if (!pkt) |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
210 break; |
170
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
211 process_packet(pkt, (unsigned) pkthdr.caplen, pkt_idx, |
b9af126bfddb
rtp-cont-check utility written
Mychaela Falconia <falcon@freecalypso.org>
parents:
15
diff
changeset
|
212 &pkthdr.ts); |
15
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
213 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
214 if (!stream_init_flag) { |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
215 fprintf(stderr, "error: specified RTP stream not found\n"); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
216 exit(1); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
217 } |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
218 exit(0); |
851ca64e38e9
rtp-gsmfr-extr program written, compiles
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
219 } |