source: tools/tracereplay/tracereplay.c @ 93928b7

4.0.1-hotfixescachetimestampsdevelopdpdk-ndagetsilivegetfragoffhelplibtrace4ndag_formatpfringrc-4.0.1rc-4.0.2rc-4.0.3rc-4.0.4ringdecrementfixringperformanceringtimestampfixes
Last change on this file since 93928b7 was 93928b7, checked in by Andreas Löf <andreas.lof@…>, 11 years ago

still broken, but less complicated

  • Property mode set to 100644
File size: 7.4 KB
Line 
1
2/*
3
4  Tracereplay is a simple utility that takes a trace and replays it to a
5  specified interface.
6  It pads packets with zeroes to reach the original length of the packet
7  and recalculates checksums in ip/tcp/udp headers.
8
9  Authors: Andreas Loef and Yuwei Wang
10
11
12 */
13
14
15
16
17#include <stdio.h>
18#include <stdlib.h>
19#include <assert.h>
20#include <sys/types.h>
21#include <unistd.h>
22#include <string.h>
23#include <libtrace.h>
24#include <getopt.h>
25#include <arpa/inet.h>
26
27#define FCS_SIZE 4
28
29
30
31
32/* This function assumes that the relevant fields have been zeroed out. RFC 1071*/
33static uint16_t checksum(void * buffer, uint16_t length) {
34  uint32_t sum = 0;
35  uint16_t * buff = (uint16_t *) buffer;
36  uint16_t count = length;
37
38  while(count > 1 ) {
39    sum += *buff++;
40    count = count -2;
41  }
42
43  if(count > 0) {
44    sum += (*buff << 8);
45  }
46 
47  while (sum>>16)
48    sum = (sum & 0xffff) + (sum >> 16);
49  printf("%04X\n",sum);
50  return ~sum;
51}
52
53static void udp_tcp_checksum(libtrace_ip_t *ip, uint32_t length) {
54
55  uint32_t remaining = 0;
56
57  uint32_t sum = 0;
58 
59  uint16_t protocol = ip->ip_p;
60
61  uint16_t temp;
62
63  sum += ~checksum(&ip->ip_src,sizeof(uint32_t));
64  sum += ~checksum(&ip->ip_dst,sizeof(uint32_t));
65  temp = htons(protocol);
66  sum += ~checksum(&temp,sizeof(uint16_t));
67  temp = htons(length);
68  sum += ~checksum(&temp,sizeof(uint16_t));
69
70
71  printf("IP payload length: %d\n",length);
72 
73  void * transportheader = trace_get_payload_from_ip(ip,NULL,NULL);
74
75  uint16_t * check = NULL;
76  uint16_t tsum = 0;
77
78  printf("proto: %d\n",ip->ip_p);
79
80  if(protocol == 17 ) {
81    libtrace_udp_t * udp_header = transportheader;
82    printf("udp  length: %d\n",ntohs(udp_header -> len));
83    check = &udp_header -> check;
84    *check = 0;
85    printf("l3 payload length: %d\n",length); 
86    tsum = checksum(transportheader, length);
87    int odd = 0;//length % 2;
88  }
89  else if(protocol == 6) {
90    libtrace_tcp_t * tcp_header = transportheader;
91    tcp_header -> check = 0;
92    check = &tcp_header -> check;
93
94    //use tcp header length and datagram length instead
95    tsum = checksum(transportheader,length);
96  }
97
98
99  printf("tsum: %04X\n", tsum);
100
101  sum = ~tsum;
102
103  while (sum>>16)
104    sum = (sum & 0xffff) + (sum >> 16);
105 
106  if(check != NULL) {
107    *check = (uint16_t)~sum;
108  }
109 
110
111}
112
113
114static libtrace_packet_t * per_packet(libtrace_packet_t *packet) {
115  uint32_t remaining = 0; 
116  libtrace_linktype_t linktype = 0;
117  void * pkt_buffer = trace_get_packet_buffer(packet,&linktype,&remaining);
118  remaining = 0;
119  libtrace_ip_t * header = NULL;
120  uint16_t sum = 0;
121  libtrace_packet_t *new_packet = trace_create_packet();
122 
123  size_t wire_length = trace_get_wire_length(packet);
124
125  printf("wire length: %d\n",wire_length);
126
127  if(linktype == TRACE_TYPE_ETH || linktype == TRACE_TYPE_80211) {
128    wire_length -= FCS_SIZE;
129  }
130
131  printf("wire length after FCS: %d\n",wire_length);
132
133  trace_construct_packet(new_packet,linktype,pkt_buffer,wire_length);
134 
135
136  header = trace_get_ip(new_packet);
137  if(header != NULL) {
138    wire_length -= sizeof(uint32_t)*header->ip_hl;
139    header -> ip_sum = 0;
140    sum = checksum(header,header->ip_hl*sizeof(uint32_t));
141    header -> ip_sum = sum;
142    udp_tcp_checksum(header,ntohs(header->ip_len) - sizeof(uint32_t)*header->ip_hl);
143  }
144
145  return new_packet;
146 
147}
148
149
150
151static uint32_t event_read_packet(libtrace_t *trace, libtrace_packet_t *packet) 
152{
153        libtrace_eventobj_t obj;
154        fd_set rfds;
155        struct timeval sleep_tv;
156       
157        FD_ZERO(&rfds);
158       
159        for (;;) {
160                obj = trace_event(trace, packet);
161
162                switch(obj.type) {
163                       
164                        /* Device has no packets at present - lets wait until
165                         * it does get something */
166                        case TRACE_EVENT_IOWAIT:
167                                FD_ZERO(&rfds);
168                                FD_SET(obj.fd, &rfds);
169                                select(obj.fd + 1, &rfds, NULL, NULL, 0);
170                                continue;
171                               
172                        /* Replaying a trace in tracetime and the next packet
173                         * is not due yet */
174                        case TRACE_EVENT_SLEEP:
175                                /* select offers good precision for sleeping */
176                                sleep_tv.tv_sec = (int)obj.seconds;
177                                sleep_tv.tv_usec = (int) ((obj.seconds - sleep_tv.tv_sec) * 1000000.0);
178                                select(0, NULL, NULL, NULL, &sleep_tv);
179                                continue;
180                               
181                        /* We've got a packet! */
182                        case TRACE_EVENT_PACKET:
183                                /* Check for error first */
184                                if (obj.size == -1)
185                                        return -1;
186                                return 1;
187                               
188                        /* End of trace has been reached */
189                        case TRACE_EVENT_TERMINATE:
190                                return -1;
191                               
192                        /* An event we don't know about has occured */
193                        default:
194                                fprintf(stderr, "Unknown event type occured\n");
195                                return -1;
196                }
197        }
198}
199
200static void usage(char * argv) {
201        fprintf(stderr, "usage: %s [options] libtraceuri outputuri...\n", argv);
202        fprintf(stderr, " --filter bpfexpr\n");
203        fprintf(stderr, " -f bpfexpr\n");
204        fprintf(stderr, "\t\tApply a bpf filter expression\n");
205}
206
207/* int main(int argc, char *argv[]) {  */
208 
209/*   /\* uint16_t buffer[] = {0x45,0x00,0x00,0x30, */
210/*                     0x3b,0xa9,0x40,0x00, */
211/*                     0x6e,0x06,0x44,0x5b, */
212/*                     0x25,0xdb,0xef,0x28, */
213/*                     0x7d,0xb6,0x6a,0xb1 */
214/*                     };*\/  */
215
216/*   uint8_t buffer[] = {0x00,0x01, */
217/*                    0xf2,0x03, */
218/*                    0xf4,0xf5, */
219/*                    0xf6,0xf7 */
220/*   }; */
221
222/*   uint16_t checksum = ip_checksum(buffer,8); */
223
224/*   printf("checksum: %04X\n",checksum); */
225 
226/* } */
227
228
229int main(int argc, char *argv[]) {
230       
231        libtrace_t *trace;
232        libtrace_out_t *output;
233        libtrace_packet_t *packet;
234        libtrace_filter_t *filter=NULL;
235        int psize = 0;
236        char *uri = 0;
237
238        while(1) {
239                int option_index;
240                struct option long_options[] = {
241                        { "filter",     1, 0, 'f'},
242                        { "help",       0, 0, 'h'},
243                        { NULL,         0, 0, 0}
244                };
245
246                int c = getopt_long(argc, argv, "f:",
247                                long_options, &option_index);
248
249                if(c == -1)
250                        break;
251
252                switch (c) {
253                        case 'f':
254                                filter = trace_create_filter(optarg);
255                                break;
256                        case 'h':
257                                usage(argv[0]);
258                                return 1;
259                        default:
260                                fprintf(stderr, "Unknown option: %c\n", c);
261                }
262        }
263
264        if(optind>=argc) {
265                fprintf(stderr, "Missing input uri\n");
266                usage(argv[0]);
267                return 1;
268        }
269        if(optind+1>=argc) {
270                fprintf(stderr, "Missing output uri\n");
271                usage(argv[0]);
272                return 1;
273        }
274
275        uri = strdup(argv[optind]);
276
277        /* Create the trace */
278        trace = trace_create(uri);
279        if (trace_is_err(trace)) {
280                trace_perror(trace, "trace_create");
281                return 1;
282        }
283
284        /* apply filter */
285        if(filter) {
286                if(trace_config(trace, TRACE_OPTION_FILTER, filter)) {
287                        trace_perror(trace, "ignoring: ");
288                }
289        }
290
291        /* Starting the trace */
292        if (trace_start(trace) != 0) {
293                trace_perror(trace, "trace_start");
294                return 1;
295        }
296
297        /* Creating output trace */
298        output = trace_create_output(argv[optind+1]);
299       
300        if (trace_is_err_output(output)) {
301                trace_perror_output(output, "Opening output trace: ");
302                return 1;
303        }
304        if (trace_start_output(output)) {
305                trace_perror_output(output, "Starting output trace: ");
306                trace_destroy_output(output);
307                trace_destroy(trace);
308                return 1;
309        }
310
311        packet = trace_create_packet();
312
313        for (;;) {
314                if ((psize = event_read_packet(trace, packet)) <= 0) {
315                        break;
316                }
317
318                /* Got a packet - let's do something with it */
319                libtrace_packet_t * new = per_packet(packet);
320
321                //libtrace_ip_t * header;
322                //              header = trace_get_ip(new);
323
324                //printf("before write: %04X\n",header->ip_sum);
325               
326                if (trace_write_packet(output, new) < 0) {
327                        trace_perror_output(output, "Writing packet");
328                        trace_destroy(trace);
329                        trace_destroy_output(output);
330                        trace_destroy_packet(packet);
331                        return 1;
332                }
333                trace_destroy_packet(new);
334        }
335        free(uri);
336        trace_destroy(trace);
337        if(filter != NULL) {
338          trace_destroy_filter(filter);
339        }
340        trace_destroy_output(output);
341        trace_destroy_packet(packet);
342        return 0;
343
344}
345
Note: See TracBrowser for help on using the repository browser.