source: lib/trace.c @ ca1272c

4.0.1-hotfixescachetimestampsdevelopdpdk-ndagetsilivegetfragoffhelplibtrace4ndag_formatpfringrc-4.0.1rc-4.0.2rc-4.0.3rc-4.0.4ringdecrementfixringperformanceringtimestampfixes
Last change on this file since ca1272c was ca1272c, checked in by Perry Lorier <perry@…>, 14 years ago

Better diagnostics

  • Property mode set to 100644
File size: 41.6 KB
Line 
1/*
2 * This file is part of libtrace
3 *
4 * Copyright (c) 2007 The University of Waikato, Hamilton, New Zealand.
5 * Authors: Daniel Lawson
6 *          Perry Lorier
7 *         
8 * All rights reserved.
9 *
10 * This code has been developed by the University of Waikato WAND
11 * research group. For further information please see http://www.wand.net.nz/
12 *
13 * libtrace is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2 of the License, or
16 * (at your option) any later version.
17 *
18 * libtrace is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with libtrace; if not, write to the Free Software
25 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
26 *
27 * $Id$
28 *
29 */
30
31
32/* @file
33 *
34 * @brief Trace file processing library
35 *
36 * @author Daniel Lawson
37 * @author Perry Lorier
38 *
39 * @internal
40 */
41#define _GNU_SOURCE
42#include "common.h"
43#include "config.h"
44#include <assert.h>
45#include <errno.h>
46#include <fcntl.h>
47#include <stdio.h>
48#include <stdlib.h>
49#include <string.h>
50#include <sys/stat.h>
51#include <sys/types.h>
52#ifndef WIN32
53#include <sys/socket.h>
54#endif
55#include <stdarg.h>
56
57#ifdef HAVE_LIMITS_H
58#  include <limits.h>
59#endif
60
61#ifdef HAVE_SYS_LIMITS_H
62#  include <sys/limits.h>
63#endif
64
65#ifdef HAVE_NET_IF_ARP_H
66#  include <net/if_arp.h>
67#endif
68
69#ifdef HAVE_NET_IF_H
70#  include <net/if.h>
71#endif
72
73#ifdef HAVE_NETINET_IN_H
74#  include <netinet/in.h>
75#endif
76
77#ifdef HAVE_NET_ETHERNET_H
78#  include <net/ethernet.h>
79#endif
80
81#ifdef HAVE_NETINET_IF_ETHER_H
82#  include <netinet/if_ether.h>
83#endif
84
85#include <time.h>
86#ifdef WIN32
87#include <sys/timeb.h>
88#endif
89
90#include "libtrace.h"
91#include "libtrace_int.h"
92
93#ifdef HAVE_PCAP_BPF_H
94#  include <pcap-bpf.h>
95#else
96#  ifdef HAVE_NET_BPF_H
97#    include <net/bpf.h>
98#  endif
99#endif
100
101
102#include "libtrace_int.h"
103#include "format_helper.h"
104#include "rt_protocol.h"
105
106#define MAXOPTS 1024
107
108
109static struct libtrace_format_t *formats_list = NULL;
110
111/* strncpy is not assured to copy the final \0, so we
112 * will use our own one that does
113 */
114static void xstrncpy(char *dest, const char *src, size_t n)
115{
116        strncpy(dest,src,n);
117        dest[n]='\0';
118}
119 
120static char *xstrndup(const char *src,size_t n)
121{       
122        char *ret=(char*)malloc(n+1);
123        if (ret==NULL) {
124                fprintf(stderr,"Out of memory");
125                exit(EXIT_FAILURE);
126        }
127        xstrncpy(ret,src,n);
128        return ret;
129}
130
131void register_format(struct libtrace_format_t *f) {
132        assert(f->next==NULL);
133        f->next=formats_list;
134        formats_list=f;
135        /* Now, verify things
136         * This #if can be changed to a 1 to output warnings about inconsistant
137         * functions being provided by format modules.  This generally is very
138         * noisy, as almost all modules don't implement one or more functions
139         * for various reasons.  This is very useful when checking a new
140         * format module is sane.
141         */ 
142#if 0
143        if (f->init_input) {
144#define REQUIRE(x) \
145                if (!f->x) \
146                        fprintf(stderr,"%s: Input format should provide " #x "\n",f->name)
147                REQUIRE(read_packet);
148                REQUIRE(start_input);
149                REQUIRE(fin_input);
150                REQUIRE(get_link_type);
151                REQUIRE(get_capture_length);
152                REQUIRE(get_wire_length);
153                REQUIRE(get_framing_length);
154                REQUIRE(trace_event);
155                if (!f->get_erf_timestamp
156                        && !f->get_seconds
157                        && !f->get_timeval) {
158                        fprintf(stderr,"%s: A trace format capable of input, should provide at least one of\n"
159"get_erf_timestamp, get_seconds or trace_timeval\n",f->name);
160                }
161                if (f->trace_event!=trace_event_trace) {
162                        /* Theres nothing that a trace file could optimise with
163                         * config_input
164                         */
165                        REQUIRE(pause_input);
166                        REQUIRE(config_input);
167                        REQUIRE(get_fd);
168                }
169                else {
170                        if (f->get_fd) {
171                                fprintf(stderr,"%s: Unnecessary get_fd\n",
172                                                f->name);
173                        }
174                }
175#undef REQUIRE
176        }
177        else {
178#define REQUIRE(x) \
179                if (f->x) \
180                        fprintf(stderr,"%s: Non Input format shouldn't need " #x "\n",f->name)
181                REQUIRE(read_packet);
182                REQUIRE(start_input);
183                REQUIRE(pause_input);
184                REQUIRE(fin_input);
185                REQUIRE(get_link_type);
186                REQUIRE(get_capture_length);
187                REQUIRE(get_wire_length);
188                REQUIRE(get_framing_length);
189                REQUIRE(trace_event);
190                REQUIRE(get_seconds);
191                REQUIRE(get_timeval);
192                REQUIRE(get_erf_timestamp);
193#undef REQUIRE
194        }
195        if (f->init_output) {
196#define REQUIRE(x) \
197                if (!f->x) \
198                        fprintf(stderr,"%s: Output format should provide " #x "\n",f->name)
199                REQUIRE(write_packet);
200                REQUIRE(start_output);
201                REQUIRE(config_output);
202                REQUIRE(fin_output);
203#undef REQUIRE
204        }
205        else {
206#define REQUIRE(x) \
207                if (f->x) \
208                        fprintf(stderr,"%s: Non Output format shouldn't need " #x "\n",f->name)
209                REQUIRE(write_packet);
210                REQUIRE(start_output);
211                REQUIRE(config_output);
212                REQUIRE(fin_output);
213#undef REQUIRE
214        }
215#endif
216}
217
218/* call all the constructors if they haven't yet all been called */
219static void trace_init(void)
220{
221        if (!formats_list) {
222                duck_constructor();
223                erf_constructor();
224                tsh_constructor();
225                legacy_constructor();
226                atmhdr_constructor();
227#ifdef HAVE_NETPACKET_PACKET_H
228                linuxnative_constructor();
229#endif
230#ifdef HAVE_LIBPCAP
231                pcap_constructor();
232#endif
233#ifdef HAVE_BIOCSETIF
234                bpf_constructor();
235#endif
236                pcapfile_constructor();
237                rt_constructor();
238#ifdef HAVE_DAG
239                dag_constructor();
240#endif
241        }
242}
243
244/* Prints help information for libtrace
245 *
246 * Function prints out some basic help information regarding libtrace,
247 * and then prints out the help() function registered with each input module
248 */
249DLLEXPORT void trace_help(void) {
250        struct libtrace_format_t *tmp;
251        trace_init();
252        printf("libtrace %s\n\n",PACKAGE_VERSION);
253        printf("Following this are a list of the format modules supported in this build of libtrace\n\n");
254        for(tmp=formats_list;tmp;tmp=tmp->next) {
255                if (tmp->help)
256                        tmp->help();
257        }
258}
259
260#define URI_PROTO_LINE 16U
261
262
263/* Create a trace file from a URI
264 *
265 * @params char * containing a valid libtrace URI
266 * @returns opaque pointer to a libtrace_t
267 *
268 * Valid URI's are:
269 *  erf:/path/to/erf/file
270 *  erf:/path/to/erf/file.gz
271 *  erf:/path/to/rtclient/socket
272 *  erf:-                       (stdin)
273 *  dag:/dev/dagcard
274 *  pcapint:pcapinterface               (eg: pcapint:eth0)
275 *  pcap:/path/to/pcap/file
276 *  pcap:-
277 *  rtclient:hostname
278 *  rtclient:hostname:port
279 *
280 * If an error occured when attempting to open a trace, NULL is returned
281 * and an error is output to stdout.
282 */
283DLLEXPORT libtrace_t *trace_create(const char *uri) {
284        libtrace_t *libtrace = 
285                        (libtrace_t *)malloc(sizeof(libtrace_t));
286        char *scan = 0;
287        const char *uridata = 0;                 
288        struct libtrace_format_t *tmp;
289
290        trace_init();
291
292        assert(uri && "Passing NULL to trace_create makes me a very sad program");
293
294        if (!libtrace) {
295                /* Out of memory */
296                return NULL;
297        }
298       
299        libtrace->err.err_num = TRACE_ERR_NOERROR;
300        libtrace->format=NULL;
301       
302        libtrace->event.tdelta = 0.0;
303        libtrace->event.packet = NULL;
304        libtrace->event.psize = 0;
305        libtrace->event.trace_last_ts = 0.0;
306        libtrace->filter = NULL;
307        libtrace->snaplen = 0;
308        libtrace->started=false;
309
310        /* parse the URI to determine what sort of event we are dealing with */
311        if ((uridata = trace_parse_uri(uri, &scan)) == 0) {
312                trace_set_err(libtrace,TRACE_ERR_BAD_FORMAT,"Bad uri format (%s)",uri);
313                return libtrace;
314        }
315       
316        for (tmp=formats_list;tmp;tmp=tmp->next) {
317                if (strlen(scan) == strlen(tmp->name) &&
318                                strncasecmp(scan, tmp->name, strlen(scan)) == 0
319                                ) {
320                        libtrace->format=tmp;
321                        break;
322                }
323        }
324        if (libtrace->format == 0) {
325                trace_set_err(libtrace, TRACE_ERR_BAD_FORMAT,
326                                "Unknown format (%s)",scan);
327                return libtrace;
328        }
329
330        libtrace->uridata = strdup(uridata);
331        /* libtrace->format now contains the type of uri
332         * libtrace->uridata contains the appropriate data for this
333         */
334       
335        if (libtrace->format->init_input) {
336                int err=libtrace->format->init_input(libtrace);
337                assert (err==-1 || err==0);
338                if (err==-1) {
339                        /* init_input should call trace_set_err to set
340                         * the error message
341                         */
342                        return libtrace;
343                }
344        } else {
345                trace_set_err(libtrace,TRACE_ERR_UNSUPPORTED,
346                                "Format does not support input (%s)",scan);
347                return libtrace;
348        }
349       
350
351        free(scan);
352        libtrace->err.err_num=TRACE_ERR_NOERROR;
353        libtrace->err.problem[0]='\0';
354        return libtrace;
355}
356
357/* Creates a "dummy" trace file that has only the format type set.
358 *
359 * @returns opaque pointer to a (sparsely initialised) libtrace_t
360 *
361 * IMPORTANT: Do not attempt to call trace_read_packet or other such functions
362 * with the dummy trace. Its intended purpose is to act as a packet->trace for
363 * libtrace_packet_t's that are not associated with a libtrace_t structure.
364 */
365DLLEXPORT libtrace_t * trace_create_dead (const char *uri) {
366        libtrace_t *libtrace = (libtrace_t *) malloc(sizeof(libtrace_t));
367        char *scan = (char *)calloc(sizeof(char),URI_PROTO_LINE);
368        char *uridata;
369        struct libtrace_format_t *tmp;
370
371        trace_init();
372       
373        libtrace->err.err_num = TRACE_ERR_NOERROR;
374
375        if((uridata = strchr(uri,':')) == NULL) {
376                xstrncpy(scan, uri, strlen(uri));
377        } else {
378                xstrncpy(scan,uri, (size_t)(uridata - uri));
379        }
380       
381        libtrace->format = 0;   
382       
383        for(tmp=formats_list;tmp;tmp=tmp->next) {
384                if (strlen(scan) == strlen(tmp->name) &&
385                                !strncasecmp(scan,
386                                        tmp->name,
387                                        strlen(scan))) {
388                                libtrace->format=tmp;
389                                break;
390                                }
391        }
392        if (libtrace->format == 0) {
393                trace_set_err(libtrace,TRACE_ERR_BAD_FORMAT,
394                                "Unknown format (%s)",scan);
395        }
396
397        libtrace->format_data = NULL;
398        free(scan);
399        return libtrace;
400
401}
402
403/* Creates a trace output file from a URI.
404 *
405 * @param uri   the uri string describing the output format and destination
406 * @returns opaque pointer to a libtrace_output_t
407 *
408 *  If an error occured when attempting to open the output trace, NULL is
409 *  returned and trace_errno is set.
410 */
411       
412DLLEXPORT libtrace_out_t *trace_create_output(const char *uri) {
413        libtrace_out_t *libtrace = 
414                        (libtrace_out_t*)malloc(sizeof(libtrace_out_t));
415       
416        char *scan = 0;
417        const char *uridata = 0;
418        struct libtrace_format_t *tmp;
419
420        trace_init();
421
422        libtrace->err.err_num = TRACE_ERR_NOERROR;
423        strcpy(libtrace->err.problem,"Error message set\n");
424        libtrace->format = NULL;
425        libtrace->uridata = NULL;
426       
427        /* parse the URI to determine what sort of event we are dealing with */
428
429        if ((uridata = trace_parse_uri(uri, &scan)) == 0) {
430                trace_set_err_out(libtrace,TRACE_ERR_BAD_FORMAT,
431                                "Bad uri format (%s)",uri);
432                return libtrace;
433        }
434       
435        for(tmp=formats_list;tmp;tmp=tmp->next) {
436                if (strlen(scan) == strlen(tmp->name) &&
437                                !strncasecmp(scan,
438                                        tmp->name,
439                                        strlen(scan))) {
440                                libtrace->format=tmp;
441                                break;
442                                }
443        }
444        free(scan);
445
446        if (libtrace->format == NULL) {
447                trace_set_err_out(libtrace,TRACE_ERR_BAD_FORMAT,
448                                "Unknown output format (%s)",scan);
449                return libtrace;
450        }
451        libtrace->uridata = strdup(uridata);
452
453        /* libtrace->format now contains the type of uri
454         * libtrace->uridata contains the appropriate data for this
455         */
456
457        if (libtrace->format->init_output) {
458                /* 0 on success, -1 on failure */
459                switch(libtrace->format->init_output(libtrace)) {
460                        case -1: /* failure */
461                                return libtrace;
462                        case 0: /* success */
463                                break;
464                        default:
465                                assert(!"init_output() should return -1 for failure, or 0 for success");
466                }
467        } else {
468                trace_set_err_out(libtrace,TRACE_ERR_UNSUPPORTED,
469                                "Format does not support writing (%s)",scan);
470                return libtrace;
471        }
472
473
474        libtrace->started=false;
475        return libtrace;
476}
477
478/* Start a trace
479 * @param libtrace      the input trace to start
480 * @returns 0 on success
481 *
482 * This does the work associated with actually starting up
483 * the trace.  it may fail.
484 */
485DLLEXPORT int trace_start(libtrace_t *libtrace)
486{
487        assert(libtrace);
488        assert(!trace_is_err(libtrace) && "Please use trace_is_err to check for errors after calling trace_create!");
489        if (libtrace->format->start_input) {
490                int ret=libtrace->format->start_input(libtrace);
491                if (ret < 0) {
492                        return ret;
493                }
494        }
495
496        libtrace->started=true;
497        return 0;
498}
499
500DLLEXPORT int trace_start_output(libtrace_out_t *libtrace) 
501{
502        assert(libtrace);
503        if (libtrace->format->start_output) {
504                int ret=libtrace->format->start_output(libtrace);
505                if (ret < 0) {
506                        return ret;
507                }
508        }
509
510        libtrace->started=true;
511        return 0;
512}
513
514DLLEXPORT int trace_pause(libtrace_t *libtrace)
515{
516        assert(libtrace);
517        assert(libtrace->started && "BUG: Called trace_pause without calling trace_start first");
518        if (libtrace->format->pause_input)
519                libtrace->format->pause_input(libtrace);
520        libtrace->started=false;
521        return 0;
522}
523
524DLLEXPORT int trace_config(libtrace_t *libtrace,
525                trace_option_t option,
526                void *value)
527{
528        int ret;
529        libtrace_err_t err;
530       
531        assert(!trace_is_err(libtrace) && "Please use trace_is_err to check for errors after calling trace_create!");
532       
533        if (libtrace->format->config_input) {
534                ret=libtrace->format->config_input(libtrace,option,value);
535                if (ret==0)
536                        return 0;
537        }
538        switch(option) {
539                case TRACE_OPTION_SNAPLEN:
540                        /* Clear the error if there was one */
541                        if (trace_is_err(libtrace)) {
542                                err = trace_get_err(libtrace);
543                        }
544                        libtrace->snaplen=*(int*)value;
545                        return 0;
546                case TRACE_OPTION_FILTER:
547                        /* Clear the error if there was one */
548                        if (trace_is_err(libtrace)) {
549                                err = trace_get_err(libtrace);
550                        }
551                        libtrace->filter=(libtrace_filter_t *)value;
552                        return 0;
553                case TRACE_OPTION_PROMISC:
554                        if (!trace_is_err(libtrace)) {
555                                trace_set_err(libtrace,TRACE_ERR_OPTION_UNAVAIL,
556                                                "Promisc mode is not supported by this format module");
557                        }
558                        return -1;
559                case TRACE_OPTION_META_FREQ:
560                        if (!trace_is_err(libtrace)) {
561                                trace_set_err(libtrace, 
562                                                TRACE_ERR_OPTION_UNAVAIL,
563                                                "This format does not support meta-data gathering");
564                        }
565                        return -1;
566                case TRACE_OPTION_EVENT_REALTIME:
567                        if (!trace_is_err(libtrace)) {
568                                trace_set_err(libtrace, 
569                                                TRACE_ERR_OPTION_UNAVAIL,
570                                                "This format does not support meta-data gathering");
571                        }
572                        return -1;
573                       
574        }
575        if (!trace_is_err(libtrace)) {
576                trace_set_err(libtrace,TRACE_ERR_UNKNOWN_OPTION,
577                        "Unknown option %i", option);
578        }
579        return -1;
580}
581
582/* Parses an output options string and calls the appropriate function to deal with output options.
583 *
584 * @param libtrace      the output trace object to apply the options to
585 * @param options       the options string
586 * @returns -1 if option configuration failed, 0 otherwise
587 *
588 * @author Shane Alcock
589 */
590DLLEXPORT int trace_config_output(libtrace_out_t *libtrace, 
591                trace_option_output_t option,
592                void *value) {
593        if (libtrace->format->config_output) {
594                return libtrace->format->config_output(libtrace, option, value);
595        }
596        return -1;
597}
598
599/* Close a trace file, freeing up any resources it may have been using
600 *
601 */
602DLLEXPORT void trace_destroy(libtrace_t *libtrace) {
603        assert(libtrace);
604        if (libtrace->format) {
605                if (libtrace->started && libtrace->format->pause_input)
606                        libtrace->format->pause_input(libtrace);
607                libtrace->format->fin_input(libtrace);
608        }
609        /* need to free things! */
610        if (libtrace->uridata)
611                free(libtrace->uridata);
612        free(libtrace);
613}
614
615
616DLLEXPORT void trace_destroy_dead(libtrace_t *libtrace) {
617        assert(libtrace);
618        free(libtrace);
619}
620/* Close an output trace file, freeing up any resources it may have been using
621 *
622 * @param libtrace      the output trace file to be destroyed
623 *
624 * @author Shane Alcock
625 * */
626DLLEXPORT void trace_destroy_output(libtrace_out_t *libtrace) 
627{
628        assert(libtrace);
629        if (libtrace->format && libtrace->format->fin_output)
630                libtrace->format->fin_output(libtrace);
631        if (libtrace->uridata)
632                free(libtrace->uridata);
633        free(libtrace);
634}
635
636DLLEXPORT libtrace_packet_t *trace_create_packet(void) 
637{
638        libtrace_packet_t *packet = 
639                (libtrace_packet_t*)calloc((size_t)1,sizeof(libtrace_packet_t));
640
641        packet->buf_control=TRACE_CTRL_PACKET;
642        packet->capture_length=-1;
643        return packet;
644}
645
646DLLEXPORT libtrace_packet_t *trace_copy_packet(const libtrace_packet_t *packet) {
647        libtrace_packet_t *dest = 
648                (libtrace_packet_t *)malloc(sizeof(libtrace_packet_t));
649        if (!dest) {
650                printf("out of memory constructing packet\n");
651                abort();
652        }
653        dest->trace=packet->trace;
654        dest->buffer=malloc(65536);
655        if (!dest->buffer) {
656                printf("out of memory allocating buffer memory\n");
657                abort();
658        }
659        dest->header=dest->buffer;
660        dest->payload=(void*)
661                ((char*)dest->buffer+trace_get_framing_length(packet));
662        dest->type=packet->type;
663        dest->buf_control=TRACE_CTRL_PACKET;
664        /* Reset the cache - better to recalculate than try to convert
665         * the values over to the new packet */
666        dest->capture_length = -1;
667        dest->l3_header = NULL;
668        dest->l3_ethertype = 0;
669        memcpy(dest->header,packet->header,trace_get_framing_length(packet));
670        memcpy(dest->payload,packet->payload,trace_get_capture_length(packet));
671
672        return dest;
673}
674
675/** Destroy a packet object
676 *
677 * sideeffect: sets packet to NULL
678 */
679DLLEXPORT void trace_destroy_packet(libtrace_packet_t *packet) {
680        if (packet->buf_control == TRACE_CTRL_PACKET) {
681                free(packet->buffer);
682        }
683        packet->buf_control=(buf_control_t)'\0'; 
684                                /* an "bad" value to force an assert
685                                 * if this packet is ever reused
686                                 */
687        free(packet);
688}       
689
690/* Read one packet from the trace into buffer
691 *
692 * @param libtrace      the libtrace opaque pointer
693 * @param packet        the packet opaque pointer
694 * @returns 0 on EOF, negative value on error
695 *
696 */
697DLLEXPORT int trace_read_packet(libtrace_t *libtrace, libtrace_packet_t *packet) {
698
699        assert(libtrace && "You called trace_read_packet() with a NULL libtrace parameter!\n");
700        assert(libtrace->started && "BUG: You must call libtrace_start() before trace_read_packet()\n");
701        assert(packet);
702        assert((packet->buf_control==TRACE_CTRL_PACKET || packet->buf_control==TRACE_CTRL_EXTERNAL)&&
703                "BUG: You must allocate a packet using packet_create()");
704     
705        /* Store the trace we are reading from into the packet opaque
706         * structure */
707        packet->trace = libtrace;
708
709        /* Finalise the packet, freeing any resources the format module
710         * may have allocated it
711         */
712        if (libtrace->format->fin_packet) {
713                libtrace->format->fin_packet(packet);
714        }
715
716        /* Clear the packet cache */
717        packet->capture_length = -1;
718        packet->l3_header = NULL;
719        packet->l3_ethertype = 0;
720
721        if (libtrace->format->read_packet) {
722                do {
723                        size_t ret;
724                        ret=libtrace->format->read_packet(libtrace,packet);
725                        if (ret==(size_t)-1 || ret==0) {
726                                return ret;
727                        }
728                        if (libtrace->filter) {
729                                /* If the filter doesn't match, read another
730                                 * packet
731                                 */
732                                if (!trace_apply_filter(libtrace->filter,packet)){
733                                        continue;
734                                }
735                        }
736                        if (libtrace->snaplen>0) {
737                                /* Snap the packet */
738                                trace_set_capture_length(packet,
739                                                libtrace->snaplen);
740                        }
741                        return ret;
742                } while(1);
743        }
744        trace_set_err(libtrace,TRACE_ERR_UNSUPPORTED,"This format does not support reading packets\n");
745        return ~0U;
746}
747
748/* Writes a packet to the specified output
749 *
750 * @param libtrace      describes the output format, destination, etc.
751 * @param packet        the packet to be written out
752 * @returns the number of bytes written, -1 if write failed
753 *
754 * @author Shane Alcock
755 * */
756DLLEXPORT int trace_write_packet(libtrace_out_t *libtrace, libtrace_packet_t *packet) {
757        assert(libtrace);
758        assert(packet); 
759        /* Verify the packet is valid */
760        assert(libtrace->started);
761
762        if (libtrace->format->write_packet) {
763                return libtrace->format->write_packet(libtrace, packet);
764        }
765        trace_set_err_out(libtrace,TRACE_ERR_UNSUPPORTED,
766                "This format does not support writing packets");
767        return -1;
768}
769
770DLLEXPORT void *trace_get_packet_buffer(const libtrace_packet_t *packet,
771                libtrace_linktype_t *linktype, uint32_t *remaining) {
772        assert(packet != NULL);
773        if (linktype) *linktype = trace_get_link_type(packet);
774        if (remaining) *remaining = trace_get_capture_length(packet);
775        return (void *) packet->payload;
776}
777
778DLLEXPORT void *trace_get_link(const libtrace_packet_t *packet) {
779        return (void *)packet->payload;
780}
781
782/* Get the current time in DAG time format
783 * @param packet        a pointer to a libtrace_packet structure
784 * @returns a 64 bit timestamp in DAG ERF format (upper 32 bits are the seconds
785 * past 1970-01-01, the lower 32bits are partial seconds)
786 * @author Daniel Lawson
787 */ 
788DLLEXPORT uint64_t trace_get_erf_timestamp(const libtrace_packet_t *packet) {
789        uint64_t timestamp = 0;
790        double seconds = 0.0;
791        struct timeval ts;
792
793        if (packet->trace->format->get_erf_timestamp) {
794                /* timestamp -> timestamp */
795                timestamp = packet->trace->format->get_erf_timestamp(packet);
796        } else if (packet->trace->format->get_timeval) {
797                /* timeval -> timestamp */
798                ts = packet->trace->format->get_timeval(packet);
799                timestamp = ((((uint64_t)ts.tv_sec) << 32) + \
800                                (((uint64_t)ts.tv_usec * UINT_MAX)/1000000));
801        } else if (packet->trace->format->get_seconds) {
802                /* seconds -> timestamp */
803                seconds = packet->trace->format->get_seconds(packet);
804                timestamp = ((uint64_t)((uint32_t)seconds) << 32) + \
805                      (uint64_t)(( seconds - (uint32_t)seconds   ) * UINT_MAX);
806        }
807        return timestamp;
808}
809
810/* Get the current time in struct timeval
811 * @param packet        a pointer to a libtrace_packet structure
812 *
813 * @returns time that this packet was seen in a struct timeval
814 * @author Daniel Lawson
815 * @author Perry Lorier
816 */ 
817DLLEXPORT struct timeval trace_get_timeval(const libtrace_packet_t *packet) {
818        struct timeval tv;
819        uint64_t ts = 0;
820        double seconds = 0.0;
821        if (packet->trace->format->get_timeval) {
822                /* timeval -> timeval */
823                tv = packet->trace->format->get_timeval(packet);
824        } else if (packet->trace->format->get_erf_timestamp) {
825                /* timestamp -> timeval */
826                ts = packet->trace->format->get_erf_timestamp(packet);
827#if __BYTE_ORDER == __BIG_ENDIAN
828                tv.tv_sec = ts & 0xFFFFFFFF;
829#elif __BYTE_ORDER == __LITTLE_ENDIAN
830                tv.tv_sec = ts >> 32;
831#else
832#error "What on earth are you running this on?"
833#endif
834                tv.tv_usec = ((ts&0xFFFFFFFF)*1000000)>>32;
835                if (tv.tv_usec >= 1000000) {
836                        tv.tv_usec -= 1000000;
837                        tv.tv_sec += 1;
838                }
839        } else if (packet->trace->format->get_seconds) {
840                /* seconds -> timeval */
841                seconds = packet->trace->format->get_seconds(packet);
842                tv.tv_sec = (uint32_t)seconds;
843                tv.tv_usec = (uint32_t)(((seconds - tv.tv_sec) * 1000000)/UINT_MAX);
844        }
845        else {
846                tv.tv_sec=-1;
847                tv.tv_usec=-1;
848        }
849
850        return tv;
851}
852
853/* Get the current time in floating point seconds
854 * @param packet        a pointer to a libtrace_packet structure
855 * @returns time that this packet was seen in 64bit floating point seconds
856 * @author Perry Lorier
857 */ 
858DLLEXPORT double trace_get_seconds(const libtrace_packet_t *packet) {
859        double seconds = 0.0;
860        uint64_t ts = 0;
861        struct timeval tv;
862
863        if (packet->trace->format->get_seconds) {
864                /* seconds->seconds */
865                seconds = packet->trace->format->get_seconds(packet);
866        } else if (packet->trace->format->get_erf_timestamp) {
867                /* timestamp -> seconds */
868                ts = packet->trace->format->get_erf_timestamp(packet);
869                seconds =  (ts>>32) + ((ts & UINT_MAX)*1.0 / UINT_MAX);
870        } else if (packet->trace->format->get_timeval) {
871                /* timeval -> seconds */
872                tv = packet->trace->format->get_timeval(packet);
873                seconds = tv.tv_sec + ((tv.tv_usec * 1.0) / 1000000);
874        }
875
876        return seconds;
877}
878
879DLLEXPORT size_t trace_get_capture_length(const libtrace_packet_t *packet) 
880{
881        /* Cache the capture length */
882        if (packet->capture_length == -1) {
883                if (!packet->trace->format->get_capture_length)
884                        return ~0U;
885                /* Cast away constness because this is "just" a cache */
886                ((libtrace_packet_t*)packet)->capture_length = 
887                        packet->trace->format->get_capture_length(packet);
888        }
889
890        return packet->capture_length;
891}
892       
893/* Get the size of the packet as it was seen on the wire.
894 * @param packet        a pointer to a libtrace_packet structure
895 *
896 * @returns the size of the packet as it was on the wire.
897 * @author Perry Lorier
898 * @author Daniel Lawson
899 * @note Due to the trace being a header capture, or anonymisation this may
900 * not be the same as the Capture Len.
901 */ 
902DLLEXPORT size_t trace_get_wire_length(const libtrace_packet_t *packet){
903        if (packet->trace->format->get_wire_length) {
904                return packet->trace->format->get_wire_length(packet);
905        }
906        return ~0U;
907
908}
909
910/* Get the length of the capture framing headers.
911 * @param packet        the packet opaque pointer
912 * @returns the size of the packet as it was on the wire.
913 * @author Perry Lorier
914 * @author Daniel Lawson
915 * @note this length corresponds to the difference between the size of a
916 * captured packet in memory, and the captured length of the packet
917 */ 
918DLLEXPORT SIMPLE_FUNCTION
919size_t trace_get_framing_length(const libtrace_packet_t *packet) {
920        if (packet->trace->format->get_framing_length) {
921                return packet->trace->format->get_framing_length(packet);
922        }
923        return ~0U;
924}
925
926
927/* Get the type of the link layer
928 * @param packet        a pointer to a libtrace_packet structure
929 * @returns libtrace_linktype_t
930 * @author Perry Lorier
931 * @author Daniel Lawson
932 */
933DLLEXPORT libtrace_linktype_t trace_get_link_type(const libtrace_packet_t *packet ) {
934        if (packet->trace->format->get_link_type) {
935                return packet->trace->format->get_link_type(packet);
936        }
937        return (libtrace_linktype_t)-1;
938}
939
940/* process a libtrace event
941 * @param trace the libtrace opaque pointer
942 * @param packet the libtrace_packet opaque pointer
943 * @returns
944 *  TRACE_EVENT_IOWAIT  Waiting on I/O on fd
945 *  TRACE_EVENT_SLEEP   Next event in seconds
946 *  TRACE_EVENT_PACKET  Packet arrived in buffer with size size
947 *  TRACE_EVENT_TERMINATE Trace terminated (perhaps with an error condition)
948 * FIXME currently keeps a copy of the packet inside the trace pointer,
949 * which in turn is stored inside the new packet object...
950 * @author Perry Lorier
951 */
952DLLEXPORT libtrace_eventobj_t trace_event(libtrace_t *trace, 
953                libtrace_packet_t *packet) {
954        libtrace_eventobj_t event = {TRACE_EVENT_IOWAIT,0,0.0,0};
955
956        if (!trace) {
957                fprintf(stderr,"You called trace_event() with a NULL trace object!\n");
958        }
959        assert(trace);
960        assert(packet);
961
962        /* Store the trace we are reading from into the packet opaque
963         * structure */
964        packet->trace = trace;
965
966        if (packet->trace->format->trace_event) {
967                return packet->trace->format->trace_event(trace,packet);
968        } else {
969                return event;
970        }
971
972}
973
974/** Setup a BPF filter based on pre-compiled byte-code.
975 * @param bf_insns      A pointer to the start of the byte-code
976 * @param bf_len        The number of BPF instructions
977 * @returns             an opaque pointer to a libtrace_filter_t object
978 * @note                The supplied byte-code is not checked for correctness.
979 * @author              Scott Raynel
980 */
981DLLEXPORT libtrace_filter_t *
982trace_create_filter_from_bytecode(void *bf_insns, unsigned int bf_len)
983{
984#ifndef HAVE_BPF
985        fprintf(stderr, "This version of libtrace does not have BPF support\n");
986        return NULL;
987#else
988        struct libtrace_filter_t *filter = (struct libtrace_filter_t *)
989                malloc(sizeof(struct libtrace_filter_t));
990        filter->filter.bf_insns = (struct bpf_insn *)
991                malloc(sizeof(struct bpf_insn) * bf_len);
992       
993        memcpy(filter->filter.bf_insns, bf_insns,
994                        bf_len * sizeof(struct bpf_insn));
995       
996        filter->filter.bf_len = bf_len;
997        filter->filterstring = NULL;
998        /* "flag" indicates that the filter member is valid */
999        filter->flag = 1; 
1000       
1001        return filter;
1002#endif
1003}
1004
1005/* setup a BPF filter
1006 * @param filterstring a char * containing the bpf filter string
1007 * @returns opaque pointer pointer to a libtrace_filter_t object
1008 * @author Daniel Lawson
1009 */
1010DLLEXPORT libtrace_filter_t *trace_create_filter(const char *filterstring) {
1011#ifdef HAVE_BPF
1012        libtrace_filter_t *filter = (libtrace_filter_t*)
1013                                malloc(sizeof(libtrace_filter_t));
1014        filter->filterstring = strdup(filterstring);
1015        filter->flag = 0;
1016        return filter;
1017#else
1018        fprintf(stderr,"This version of libtrace does not have bpf filter support\n");
1019        return NULL;
1020#endif
1021}
1022
1023DLLEXPORT void trace_destroy_filter(libtrace_filter_t *filter)
1024{
1025#ifdef HAVE_BPF
1026        free(filter->filterstring);
1027        if (filter->flag)
1028                pcap_freecode(&filter->filter);
1029        free(filter);
1030#else
1031
1032#endif
1033}
1034
1035/* compile a bpf filter, now we know what trace it's on
1036 * @internal
1037 *
1038 * @returns -1 on error, 0 on success
1039 */
1040int trace_bpf_compile(libtrace_filter_t *filter,
1041                const libtrace_packet_t *packet ) {
1042#ifdef HAVE_BPF
1043        void *linkptr = 0;
1044        libtrace_linktype_t linktype;
1045        assert(filter);
1046
1047        /* If this isn't a real packet, then fail */
1048        linkptr = trace_get_packet_buffer(packet,&linktype,NULL);
1049        if (!linkptr) {
1050                trace_set_err(packet->trace,
1051                                TRACE_ERR_BAD_PACKET,"Packet has no payload");
1052                return -1;
1053        }
1054       
1055        if (filter->filterstring && ! filter->flag) {
1056                pcap_t *pcap = NULL;
1057                if (linktype==(libtrace_linktype_t)-1) {
1058                        trace_set_err(packet->trace,
1059                                        TRACE_ERR_BAD_PACKET,
1060                                        "Packet has an unknown linktype");
1061                        return -1;
1062                }
1063                if (libtrace_to_pcap_dlt(linktype) == ~1U) {
1064                        trace_set_err(packet->trace,TRACE_ERR_BAD_PACKET,
1065                                        "Unknown pcap equivalent linktype");
1066                        return -1;
1067                }
1068                pcap=(pcap_t *)pcap_open_dead(
1069                                (int)libtrace_to_pcap_dlt(linktype),
1070                                1500U);
1071                /* build filter */
1072                assert(pcap);
1073                if (pcap_compile( pcap, &filter->filter, filter->filterstring, 
1074                                        1, 0)) {
1075                        trace_set_err(packet->trace,TRACE_ERR_BAD_PACKET,
1076                                        "Unable to compile the filter \"%s\": %s", 
1077                                        filter->filterstring,
1078                                        pcap_geterr(pcap));
1079                        pcap_close(pcap);
1080                        return -1;
1081                }
1082                pcap_close(pcap);
1083                filter->flag=1;
1084        }
1085        return 0;
1086#else
1087        assert(!"This should never be called when BPF not enabled");
1088        trace_set_err(packet->trace,TRACE_ERR_OPTION_UNAVAIL,
1089                                "Feature unavailable");
1090        return -1;
1091#endif
1092}
1093
1094DLLEXPORT int trace_apply_filter(libtrace_filter_t *filter,
1095                        const libtrace_packet_t *packet) {
1096#ifdef HAVE_BPF
1097        void *linkptr = 0;
1098        uint32_t clen = 0;
1099        bool free_packet_needed = false;
1100        int ret;
1101        libtrace_packet_t *packet_copy = (libtrace_packet_t*)packet;
1102
1103        assert(filter);
1104        assert(packet);
1105
1106        if (libtrace_to_pcap_dlt(trace_get_link_type(packet))==~0U) {
1107                /* Copy the packet, as we don't want to trash the one we
1108                 * were passed in
1109                 */
1110                packet_copy=trace_copy_packet(packet);
1111                free_packet_needed=true;
1112                while (libtrace_to_pcap_dlt(trace_get_link_type(packet_copy))==
1113                                ~0U) {
1114                        if (!demote_packet(packet_copy)) {
1115                                trace_set_err(packet->trace, 
1116                                                TRACE_ERR_NO_CONVERSION,
1117                                                "pcap does not support this format");
1118                                if (free_packet_needed) {
1119                                        trace_destroy_packet(packet_copy);
1120                                }
1121                                return -1;
1122                        }
1123                }
1124        }
1125       
1126        linkptr = trace_get_packet_buffer(packet_copy,NULL,&clen);
1127        if (!linkptr) {
1128                if (free_packet_needed) {
1129                        trace_destroy_packet(packet_copy);
1130                }
1131                return 0;
1132        }
1133
1134        /* We need to compile it now, because before we didn't know what the
1135         * link type was
1136         */
1137        if (trace_bpf_compile(filter,packet_copy)==-1) {
1138                if (free_packet_needed) {
1139                        trace_destroy_packet(packet_copy);
1140                }
1141                return -1;
1142        }
1143
1144        assert(filter->flag);
1145        ret=bpf_filter(filter->filter.bf_insns,(u_char*)linkptr,(unsigned int)clen,(unsigned int)clen);
1146        if (free_packet_needed) {
1147                trace_destroy_packet(packet_copy);
1148        }
1149        return ret;
1150#else
1151        fprintf(stderr,"This version of libtrace does not have bpf filter support\n");
1152        return 0;
1153#endif
1154}
1155
1156/* Set the direction flag, if it has one
1157 * @param packet the packet opaque pointer
1158 * @param direction the new direction (0,1,2,3)
1159 * @returns a signed value containing the direction flag, or -1 if this is not supported
1160 */
1161DLLEXPORT libtrace_direction_t trace_set_direction(libtrace_packet_t *packet, 
1162                libtrace_direction_t direction) 
1163{
1164        assert(packet);
1165        if (packet->trace->format->set_direction) {
1166                return packet->trace->format->set_direction(packet,direction);
1167        }
1168        return (libtrace_direction_t)~0U;
1169}
1170
1171/* Get the direction flag, if it has one
1172 * @param packet a pointer to a libtrace_packet structure
1173 * @returns a signed value containing the direction flag, or -1 if this is not supported
1174 * The direction is defined as 0 for packets originating locally (ie, outbound)
1175 * and 1 for packets originating remotely (ie, inbound).
1176 * Other values are possible, which might be overloaded to mean special things
1177 * for a special trace.
1178 * @author Daniel Lawson
1179 */
1180DLLEXPORT libtrace_direction_t trace_get_direction(const libtrace_packet_t *packet) 
1181{
1182        assert(packet);
1183        if (packet->trace->format->get_direction) {
1184                return packet->trace->format->get_direction(packet);
1185        }
1186        return (libtrace_direction_t)~0U;
1187}
1188
1189#define ROOT_SERVER(x) ((x) < 512)
1190#define ROOT_CLIENT(x) ((512 <= (x)) && ((x) < 1024))
1191#define NONROOT_SERVER(x) ((x) >= 5000)
1192#define NONROOT_CLIENT(x) ((1024 <= (x)) && ((x) < 5000))
1193#define DYNAMIC(x) ((49152 < (x)) && ((x) < 65535))
1194#define SERVER(x) ROOT_SERVER(x) || NONROOT_SERVER(x)
1195#define CLIENT(x) ROOT_CLIENT(x) || NONROOT_CLIENT(x)
1196
1197/* Attempt to deduce the 'server' port
1198 * @param protocol the IP protocol (eg, 6 or 17 for TCP or UDP)
1199 * @param source the TCP or UDP source port
1200 * @param dest the TCP or UDP destination port
1201 * @returns a hint as to which port is the server port
1202 */
1203DLLEXPORT int8_t trace_get_server_port(UNUSED uint8_t protocol, 
1204                uint16_t source, uint16_t dest) 
1205{
1206        /*
1207         * * If the ports are equal, return DEST
1208         * * Check for well-known ports in the given protocol
1209         * * Root server ports: 0 - 511
1210         * * Root client ports: 512 - 1023
1211         * * non-root client ports: 1024 - 4999
1212         * * non-root server ports: 5000+
1213         * * Check for static ranges: 1024 - 49151
1214         * * Check for dynamic ranges: 49152 - 65535
1215         * * flip a coin.
1216         */
1217       
1218        /* equal */
1219        if (source == dest)
1220                return USE_DEST;
1221
1222        /* root server port, 0 - 511 */
1223        if (ROOT_SERVER(source) && ROOT_SERVER(dest)) {
1224                if (source < dest)
1225                        return USE_SOURCE;
1226                return USE_DEST;
1227        }
1228
1229        if (ROOT_SERVER(source) && !ROOT_SERVER(dest))
1230                return USE_SOURCE;
1231        if (!ROOT_SERVER(source) && ROOT_SERVER(dest))
1232                return USE_DEST;
1233
1234        /* non-root server */
1235        if (NONROOT_SERVER(source) && NONROOT_SERVER(dest)) {
1236                if (source < dest)
1237                        return USE_SOURCE;
1238                return USE_DEST;
1239        }
1240        if (NONROOT_SERVER(source) && !NONROOT_SERVER(dest))
1241                return USE_SOURCE;
1242        if (!NONROOT_SERVER(source) && NONROOT_SERVER(dest))
1243                return USE_DEST;
1244
1245        /* root client */
1246        if (ROOT_CLIENT(source) && ROOT_CLIENT(dest)) {
1247                if (source < dest)
1248                        return USE_SOURCE;
1249                return USE_DEST;
1250        }
1251        if (ROOT_CLIENT(source) && !ROOT_CLIENT(dest)) {
1252                /* prefer root-client over nonroot-client */
1253                if (NONROOT_CLIENT(dest))
1254                        return USE_SOURCE;
1255                return USE_DEST;
1256        }
1257        if (!ROOT_CLIENT(source) && ROOT_CLIENT(dest)) {
1258                /* prefer root-client over nonroot-client */
1259                if (NONROOT_CLIENT(source))
1260                        return USE_DEST;
1261                return USE_SOURCE;
1262        }
1263       
1264        /* nonroot client */
1265        if (NONROOT_CLIENT(source) && NONROOT_CLIENT(dest)) {
1266                if (source < dest) 
1267                        return USE_SOURCE;
1268                return USE_DEST;
1269        }
1270        if (NONROOT_CLIENT(source) && !NONROOT_CLIENT(dest))
1271                return USE_DEST;
1272        if (!NONROOT_CLIENT(source) && NONROOT_CLIENT(dest))
1273                return USE_SOURCE;
1274
1275        /* dynamic range */
1276        if (DYNAMIC(source) && DYNAMIC(dest)) {
1277                if (source < dest)
1278                        return USE_SOURCE;
1279                return USE_DEST;
1280        }
1281        if (DYNAMIC(source) && !DYNAMIC(dest))
1282                return USE_DEST;
1283        if (!DYNAMIC(source) && DYNAMIC(dest))
1284                return USE_SOURCE;
1285        /*
1286        if (SERVER(source) && CLIENT(dest))
1287                return USE_SOURCE;
1288       
1289        if (SERVER(dest) && CLIENT(source))
1290                return USE_DEST;
1291        if (ROOT_SERVER(source) && !ROOT_SERVER(dest))
1292                return USE_SOURCE;
1293        if (ROOT_SERVER(dest) && !ROOT_SERVER(source))
1294                return USE_DEST;
1295        */
1296        /* failing that test... */
1297        if (source < dest) {
1298                return USE_SOURCE;
1299        } 
1300        return USE_DEST;
1301       
1302}
1303
1304/* Truncate the packet at the suggested length
1305 * @param packet        the packet opaque pointer
1306 * @param size          the new length of the packet
1307 * @returns the new size of the packet
1308 * @note size and the return size refer to the network-level payload of the
1309 * packet, and do not include any capture headers. For example, to truncate a
1310 * packet after the IP header, set size to sizeof(ethernet_header) +
1311 * sizeof(ip_header)
1312 * @note If the original network-level payload is smaller than size, then the
1313 * original size is returned and the packet is left unchanged.
1314 * @author Daniel Lawson
1315 */
1316DLLEXPORT size_t trace_set_capture_length(libtrace_packet_t *packet, size_t size) {
1317        assert(packet);
1318
1319        if (packet->trace->format->set_capture_length) {
1320                return packet->trace->format->set_capture_length(packet,size);
1321        }
1322
1323        return ~0U;
1324}
1325
1326DLLEXPORT const char * trace_parse_uri(const char *uri, char **format) {
1327        const char *uridata = 0;
1328       
1329        if((uridata = strchr(uri,':')) == NULL) {
1330                /* badly formed URI - needs a : */
1331                return 0;
1332        }
1333
1334        if ((unsigned)(uridata - uri) > URI_PROTO_LINE) {
1335                /* badly formed URI - uri type is too long */
1336                return 0;
1337        }
1338
1339        *format=xstrndup(uri, (size_t)(uridata - uri));
1340
1341        /* push uridata past the delimiter */
1342        uridata++;
1343       
1344        return uridata;
1345}
1346
1347enum base_format_t trace_get_format(libtrace_packet_t *packet) 
1348{
1349        assert(packet);
1350
1351        return packet->trace->format->type;
1352}
1353       
1354DLLEXPORT libtrace_err_t trace_get_err(libtrace_t *trace)
1355{
1356        libtrace_err_t err = trace->err;
1357        trace->err.err_num = 0; /* "OK" */
1358        trace->err.problem[0]='\0';
1359        return err;
1360}
1361
1362DLLEXPORT bool trace_is_err(libtrace_t *trace)
1363{
1364        return trace->err.err_num != 0;
1365}
1366
1367DLLEXPORT void trace_perror(libtrace_t *trace,const char *msg,...)
1368{
1369        char buf[256];
1370        va_list va;
1371        va_start(va,msg);
1372        vsnprintf(buf,sizeof(buf),msg,va);
1373        va_end(va);
1374        if(trace->err.err_num) {
1375                fprintf(stderr,"%s(%s): %s\n",
1376                                buf,trace->uridata,trace->err.problem);
1377        } else {
1378                fprintf(stderr,"%s(%s): No error\n",
1379                                buf,trace->uridata);
1380        }
1381        trace->err.err_num = 0; /* "OK" */
1382        trace->err.problem[0]='\0';
1383}
1384
1385DLLEXPORT libtrace_err_t trace_get_err_output(libtrace_out_t *trace)
1386{
1387        libtrace_err_t err = trace->err;
1388        trace->err.err_num = TRACE_ERR_NOERROR; /* "OK" */
1389        trace->err.problem[0]='\0';
1390        return err;
1391}
1392
1393DLLEXPORT bool trace_is_err_output(libtrace_out_t *trace)
1394{
1395        return trace->err.err_num != 0;
1396}
1397
1398DLLEXPORT void trace_perror_output(libtrace_out_t *trace,const char *msg,...)
1399{
1400        char buf[256];
1401        va_list va;
1402        va_start(va,msg);
1403        vsnprintf(buf,sizeof(buf),msg,va);
1404        va_end(va);
1405        if(trace->err.err_num) {
1406                fprintf(stderr,"%s(%s): %s\n",
1407                                buf,
1408                                trace->uridata?trace->uridata:"no uri",
1409                                trace->err.problem);
1410        } else {
1411                fprintf(stderr,"%s(%s): No error\n",buf,trace->uridata);
1412        }
1413        trace->err.err_num = TRACE_ERR_NOERROR; /* "OK" */
1414        trace->err.problem[0]='\0';
1415}
1416
1417DLLEXPORT int trace_seek_erf_timestamp(libtrace_t *trace, uint64_t ts)
1418{
1419        if (trace->format->seek_erf) {
1420                return trace->format->seek_erf(trace,ts);
1421        }
1422        else {
1423                if (trace->format->seek_timeval) {
1424                        struct timeval tv;
1425#if __BYTE_ORDER == __BIG_ENDIAN
1426                        tv.tv_sec = ts & 0xFFFFFFFF;
1427#elif __BYTE_ORDER == __LITTLE_ENDIAN
1428                        tv.tv_sec = ts >> 32;
1429#else
1430#error "What on earth are you running this on?"
1431#endif
1432                        tv.tv_usec = ((ts&0xFFFFFFFF)*1000000)>>32;
1433                        if (tv.tv_usec >= 1000000) {
1434                                tv.tv_usec -= 1000000;
1435                                tv.tv_sec += 1;
1436                        }
1437                        return trace->format->seek_timeval(trace,tv);
1438                }
1439                if (trace->format->seek_seconds) {
1440                        double seconds = 
1441                                (ts>>32) + ((ts & UINT_MAX)*1.0 / UINT_MAX);
1442                        return trace->format->seek_seconds(trace,seconds);
1443                }
1444                trace_set_err(trace,
1445                                TRACE_ERR_OPTION_UNAVAIL,
1446                                "Feature unimplemented");
1447                return -1;
1448        }
1449}
1450
1451DLLEXPORT int trace_seek_seconds(libtrace_t *trace, double seconds)
1452{
1453        if (trace->format->seek_seconds) {
1454                return trace->format->seek_seconds(trace,seconds);
1455        }
1456        else {
1457                if (trace->format->seek_timeval) {
1458                        struct timeval tv;
1459                        tv.tv_sec = (uint32_t)seconds;
1460                        tv.tv_usec = (uint32_t)(((seconds - tv.tv_sec) * 1000000)/UINT_MAX);
1461                        return trace->format->seek_timeval(trace,tv);
1462                }
1463                if (trace->format->seek_erf) {
1464                        uint64_t timestamp = 
1465                                ((uint64_t)((uint32_t)seconds) << 32) + \
1466                            (uint64_t)(( seconds - (uint32_t)seconds   ) * UINT_MAX);
1467                        return trace->format->seek_erf(trace,timestamp);
1468                }
1469                trace_set_err(trace,
1470                                TRACE_ERR_OPTION_UNAVAIL,
1471                                "Feature unimplemented");
1472                return -1;
1473        }
1474}
1475
1476DLLEXPORT int trace_seek_timeval(libtrace_t *trace, struct timeval tv)
1477{
1478        if (trace->format->seek_timeval) {
1479                return trace->format->seek_timeval(trace,tv);
1480        }
1481        else {
1482                if (trace->format->seek_erf) {
1483                        uint64_t timestamp = ((((uint64_t)tv.tv_sec) << 32) + \
1484                                (((uint64_t)tv.tv_usec * UINT_MAX)/1000000));
1485                        return trace->format->seek_erf(trace,timestamp);
1486                }
1487                if (trace->format->seek_seconds) {
1488                        double seconds = tv.tv_sec + ((tv.tv_usec * 1.0)/1000000);
1489                        return trace->format->seek_seconds(trace,seconds);
1490                }
1491                trace_set_err(trace,
1492                                TRACE_ERR_OPTION_UNAVAIL,
1493                                "Feature unimplemented");
1494                return -1;
1495        }
1496}
1497
1498DLLEXPORT char *trace_ether_ntoa(const uint8_t *addr, char *buf)
1499{
1500        static char staticbuf[18]={0,};
1501        if (!buf)
1502                buf=staticbuf;
1503        snprintf(buf,(size_t)18,"%02x:%02x:%02x:%02x:%02x:%02x",
1504                        addr[0],addr[1],addr[2],
1505                        addr[3],addr[4],addr[5]);
1506        return buf;
1507}
1508
1509DLLEXPORT uint8_t *trace_ether_aton(const char *buf, uint8_t *addr)
1510{
1511        uint8_t *buf2 = addr;
1512        unsigned int tmp[6];
1513        static uint8_t staticaddr[6];
1514        if (!buf2)
1515                buf2=staticaddr;
1516        sscanf(buf,"%x:%x:%x:%x:%x:%x",
1517                        &tmp[0],&tmp[1],&tmp[2],
1518                        &tmp[3],&tmp[4],&tmp[5]);
1519        buf2[0]=tmp[0]; buf2[1]=tmp[1]; buf2[2]=tmp[2];
1520        buf2[3]=tmp[3]; buf2[4]=tmp[4]; buf2[5]=tmp[5];
1521        return buf2;
1522}
1523
1524DLLEXPORT
1525void trace_construct_packet(libtrace_packet_t *packet,
1526                libtrace_linktype_t linktype,
1527                const void *data,
1528                uint16_t len)
1529{
1530        size_t size;
1531        static libtrace_t *deadtrace=NULL;
1532        libtrace_pcapfile_pkt_hdr_t hdr;
1533#ifdef WIN32
1534        struct _timeb tstruct;
1535#else
1536        struct timeval tv;
1537#endif
1538
1539        if (NULL == deadtrace) 
1540                deadtrace=trace_create_dead("pcapfile");
1541
1542#ifdef WIN32
1543        _ftime(&tstruct);
1544        hdr.ts_sec=tstruct.time;
1545        hdr.ts_usec=tstruct.millitm * 1000;
1546#else
1547        gettimeofday(&tv,NULL);
1548        hdr.ts_sec=tv.tv_sec;
1549        hdr.ts_usec=tv.tv_usec;
1550#endif
1551
1552        hdr.caplen=len;
1553        hdr.wirelen=len;
1554
1555        packet->trace=deadtrace;
1556        size=len+sizeof(hdr);
1557        if (packet->buf_control==TRACE_CTRL_PACKET) {
1558                packet->buffer=realloc(packet->buffer,size);
1559        }
1560        else {
1561                packet->buffer=malloc(size);
1562        }
1563        packet->buf_control=TRACE_CTRL_PACKET;
1564        packet->header=packet->buffer;
1565        packet->payload=(void*)((char*)packet->buffer+sizeof(hdr));
1566        memcpy(packet->header,&hdr,sizeof(hdr));
1567        memcpy(packet->payload,data,(size_t)len);
1568        packet->type=pcap_linktype_to_rt(libtrace_to_pcap_linktype(linktype));
1569}
Note: See TracBrowser for help on using the repository browser.