source: lib/trace.c @ 755e794

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

Add /dev/bpf capture support for the ThreeBSD's

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