source: lib/format_pcapfile.c @ 279486e

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

Deal with OOM to keep splint happier

  • Property mode set to 100644
File size: 11.8 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#include "common.h"
32#include "config.h"
33#include "libtrace.h"
34#include "libtrace_int.h"
35#include "format_helper.h"
36
37#include <sys/stat.h>
38#include <assert.h>
39#include <stdio.h>
40#include <stdlib.h>
41#include <string.h>
42#include <errno.h>
43#include <fcntl.h>
44
45#define DATA(x) ((struct pcapfile_format_data_t*)((x)->format_data))
46#define DATAOUT(x) ((struct pcapfile_format_data_out_t*)((x)->format_data))
47
48typedef struct pcapfile_header_t {
49                uint32_t magic_number;   /* magic number */
50                uint16_t version_major;  /* major version number */
51                uint16_t version_minor;  /* minor version number */
52                int32_t  thiszone;       /* GMT to local correction */
53                uint32_t sigfigs;        /* timestamp accuracy */
54                uint32_t snaplen;        /* aka "wirelen" */
55                uint32_t network;        /* data link type */
56} pcapfile_header_t; 
57
58struct pcapfile_format_data_t {
59        libtrace_io_t *file;
60        pcapfile_header_t header;
61};
62
63struct pcapfile_format_data_out_t {
64        libtrace_io_t *file;
65        int level;
66        int flag;
67
68};
69
70static int pcapfile_init_input(libtrace_t *libtrace) {
71        libtrace->format_data = malloc(sizeof(struct pcapfile_format_data_t));
72
73        if (libtrace->format_data == NULL) {
74                trace_set_err(libtrace,ENOMEM,"Out of memory");
75                return -1;
76        }
77
78        DATA(libtrace)->file=NULL;
79
80        return 0;
81}
82
83static int pcapfile_init_output(libtrace_out_t *libtrace) {
84        libtrace->format_data = 
85                malloc(sizeof(struct pcapfile_format_data_out_t));
86
87        DATAOUT(libtrace)->file=NULL;
88        DATAOUT(libtrace)->level=0;
89        DATAOUT(libtrace)->flag=O_CREAT|O_WRONLY;
90
91        return 0;
92}
93
94static uint16_t swaps(libtrace_t *libtrace, uint16_t num)
95{
96        /* to deal with open_dead traces that might try and use this
97         * if we don't have any per trace data, assume host byte order
98         */
99        if (!DATA(libtrace))
100                return num;
101        if (DATA(libtrace)->header.magic_number == 0xd4c3b2a1)
102                return byteswap16(num);
103
104        return num;
105}
106
107static uint32_t swapl(libtrace_t *libtrace, uint32_t num)
108{
109        /* to deal with open_dead traces that might try and use this
110         * if we don't have any per trace data, assume host byte order
111         */
112        if (!DATA(libtrace))
113                return num;
114        if (DATA(libtrace)->header.magic_number == 0xd4c3b2a1)
115                return byteswap32(num);
116
117        return num;
118}
119
120
121static int pcapfile_start_input(libtrace_t *libtrace) 
122{
123        int err;
124
125        if (!DATA(libtrace)->file) {
126                DATA(libtrace)->file=trace_open_file(libtrace);
127
128                if (!DATA(libtrace)->file)
129                        return -1;
130
131                err=libtrace_io_read(DATA(libtrace)->file,
132                                &DATA(libtrace)->header,
133                                sizeof(DATA(libtrace)->header));
134
135                if (err<1)
136                        return -1;
137               
138                if (swapl(libtrace,DATA(libtrace)->header.magic_number) != 0xa1b2c3d4) {
139                        trace_set_err(libtrace,TRACE_ERR_INIT_FAILED,"Not a pcap tracefile\n");
140                        return -1; /* Not a pcap file */
141                }
142
143                if (swaps(libtrace,DATA(libtrace)->header.version_major)!=2
144                        && swaps(libtrace,DATA(libtrace)->header.version_minor)!=4) {
145                        trace_set_err(libtrace,TRACE_ERR_INIT_FAILED,"Unknown pcap tracefile version %d.%d\n",
146                                        swaps(libtrace,
147                                                DATA(libtrace)->header.version_major),
148                                        swaps(libtrace,
149                                                DATA(libtrace)->header.version_minor));
150                        return -1;
151                }
152
153        }
154
155        return 0;
156}
157
158static int pcapfile_start_output(libtrace_out_t *libtrace)
159{
160        return 0;
161}
162
163static int pcapfile_config_input(libtrace_t *libtrace,
164                trace_option_t option,
165                void *data)
166{
167        trace_set_err(libtrace,TRACE_ERR_UNKNOWN_OPTION,
168                        "Unknown option %i", option);
169        return -1;
170}
171
172static int pcapfile_fin_input(libtrace_t *libtrace) 
173{
174        libtrace_io_close(DATA(libtrace)->file);
175        free(libtrace->format_data);
176        return 0; /* success */
177}
178
179static int pcapfile_fin_output(libtrace_out_t *libtrace)
180{
181        libtrace_io_close(DATA(libtrace)->file);
182        free(libtrace->format_data);
183        libtrace->format_data=NULL;
184        return 0; /* success */
185}
186
187static int pcapfile_config_output(libtrace_out_t *libtrace,
188                trace_option_t option,
189                void *data)
190{
191        trace_set_err_out(libtrace,TRACE_ERR_UNKNOWN_OPTION,
192                        "Unknown option %i", option);
193        return -1;
194}
195
196static int pcapfile_read_packet(libtrace_t *libtrace, libtrace_packet_t *packet)
197{
198        int err;
199
200        assert(libtrace->format_data);
201
202        packet->type = pcap_dlt_to_rt(swapl(libtrace,
203                                DATA(libtrace)->header.network));
204
205        if (!packet->buffer || packet->buf_control == TRACE_CTRL_EXTERNAL) {
206                packet->buffer = malloc(LIBTRACE_PACKET_BUFSIZE);
207                packet->buf_control = TRACE_CTRL_PACKET;
208        }
209
210        err=libtrace_io_read(DATA(libtrace)->file,
211                        packet->buffer,
212                        sizeof(libtrace_pcapfile_pkt_hdr_t));
213
214        if (err<0) {
215                trace_set_err(libtrace,errno,"reading packet");
216                return -1;
217        }
218        if (err==0) {
219                /* EOF */
220                return 0;
221        }
222
223        packet->header = packet->buffer;
224
225
226        err=libtrace_io_read(DATA(libtrace)->file,
227                        (char*)packet->buffer+sizeof(libtrace_pcapfile_pkt_hdr_t),
228                        swapl(libtrace,((libtrace_pcapfile_pkt_hdr_t*)packet->buffer)->caplen)
229                        );
230
231       
232        if (err<0) {
233                trace_set_err(libtrace,errno,"reading packet");
234                return -1;
235        }
236        if (err==0) {
237                return 0;
238        }
239
240        packet->payload = (char*)packet->buffer
241                + sizeof(libtrace_pcapfile_pkt_hdr_t);
242       
243        return sizeof(libtrace_pcapfile_pkt_hdr_t)
244                +swapl(libtrace,((libtrace_pcapfile_pkt_hdr_t*)packet->buffer)->caplen);
245}
246
247static int pcapfile_write_packet(libtrace_out_t *out,
248                libtrace_packet_t *packet)
249{
250        struct libtrace_pcapfile_pkt_hdr_t hdr;
251        struct timeval tv = trace_get_timeval(packet);
252        int numbytes;
253        int ret;
254
255        /* Now we know the link type write out a header if we've not done
256         * so already
257         */
258        if (!DATAOUT(out)->file) {
259                struct pcapfile_header_t hdr;
260
261                DATAOUT(out)->file=trace_open_file_out(out,
262                                DATAOUT(out)->level,
263                                DATAOUT(out)->flag);
264                if (!DATAOUT(out)->file)
265                        return -1;
266
267                hdr.magic_number = 0xa1b2c3d4;
268                hdr.version_major = 2;
269                hdr.version_minor = 4;
270                hdr.thiszone = 0;
271                hdr.sigfigs = 0;
272                hdr.snaplen = 65536;
273                hdr.network = 
274                        libtrace_to_pcap_dlt(trace_get_link_type(packet));
275
276                libtrace_io_write(DATAOUT(out)->file, &hdr, sizeof(hdr));
277        }
278
279        hdr.ts_sec = tv.tv_sec;
280        hdr.ts_usec = tv.tv_usec;
281        hdr.caplen = trace_get_capture_length(packet);
282        /* PCAP doesn't include the FCS, we do */
283        hdr.wirelen = trace_get_wire_length(packet)-4; 
284
285        numbytes=libtrace_io_write(DATAOUT(out)->file,
286                        &hdr, sizeof(hdr));
287
288        if (numbytes!=sizeof(hdr)) 
289                return -1;
290
291        ret=libtrace_io_write(DATAOUT(out)->file,
292                        trace_get_link(packet),
293                        trace_get_capture_length(packet));
294
295        if (ret!=trace_get_capture_length(packet))
296                return -1;
297
298        return numbytes+ret;
299}
300
301static libtrace_linktype_t pcapfile_get_link_type(
302                const libtrace_packet_t *packet) 
303{
304#if 0
305        return pcap_dlt_to_libtrace(
306                        swapl(packet->trace,
307                                DATA(packet->trace)->header.network
308                             )
309                        );
310#endif
311        return pcap_dlt_to_libtrace(rt_to_pcap_dlt(packet->type));
312}
313
314static libtrace_direction_t pcapfile_get_direction(const libtrace_packet_t *packet) 
315{
316        libtrace_direction_t direction  = -1;
317        switch(pcapfile_get_link_type(packet)) {
318                case TRACE_TYPE_LINUX_SLL:
319                {
320                        libtrace_sll_header_t *sll;
321                        sll = trace_get_link(packet);
322                        if (!sll) {
323                                trace_set_err(packet->trace,
324                                        TRACE_ERR_BAD_PACKET,
325                                                "Bad or missing packet");
326                                return -1;
327                        }
328                        /* 0 == LINUX_SLL_HOST */
329                        /* the Waikato Capture point defines "packets
330                         * originating locally" (ie, outbound), with a
331                         * direction of 0, and "packets destined locally"
332                         * (ie, inbound), with a direction of 1.
333                         * This is kind-of-opposite to LINUX_SLL.
334                         * We return consistent values here, however
335                         *
336                         * Note that in recent versions of pcap, you can
337                         * use "inbound" and "outbound" on ppp in linux
338                         */
339                        if (ntohs(sll->pkttype == 0)) {
340                                direction = TRACE_DIR_INCOMING;
341                        } else {
342                                direction = TRACE_DIR_OUTGOING;
343                        }
344                        break;
345
346                }
347                case TRACE_TYPE_PFLOG:
348                {
349                        libtrace_pflog_header_t *pflog;
350                        pflog = trace_get_link(packet);
351                        if (!pflog) {
352                                trace_set_err(packet->trace,
353                                                TRACE_ERR_BAD_PACKET,
354                                                "Bad or missing packet");
355                                return -1;
356                        }
357                        /* enum    { PF_IN=0, PF_OUT=1 }; */
358                        if (ntohs(pflog->dir==0)) {
359
360                                direction = TRACE_DIR_INCOMING;
361                        }
362                        else {
363                                direction = TRACE_DIR_OUTGOING;
364                        }
365                        break;
366                }
367                default:
368                        break;
369        }       
370        return direction;
371}
372
373
374static struct timeval pcapfile_get_timeval(
375                const libtrace_packet_t *packet) 
376{
377        libtrace_pcapfile_pkt_hdr_t *hdr =
378                (libtrace_pcapfile_pkt_hdr_t*)packet->header;
379        struct timeval ts;
380        ts.tv_sec = swapl(packet->trace,hdr->ts_sec);
381        ts.tv_usec = swapl(packet->trace,hdr->ts_usec);
382        return ts;
383}
384
385
386static int pcapfile_get_capture_length(const libtrace_packet_t *packet) {
387        libtrace_pcapfile_pkt_hdr_t *pcapptr
388                = (libtrace_pcapfile_pkt_hdr_t *)packet->header;
389
390        return swapl(packet->trace,pcapptr->caplen);
391}
392
393static int pcapfile_get_wire_length(const libtrace_packet_t *packet) {
394        libtrace_pcapfile_pkt_hdr_t *pcapptr
395                = (libtrace_pcapfile_pkt_hdr_t *)packet->header;
396        if (packet->type==pcap_dlt_to_rt(TRACE_DLT_EN10MB))
397                /* Include the missing FCS */
398                return swapl(packet->trace,pcapptr->wirelen)+4; 
399        else
400                return swapl(packet->trace,pcapptr->wirelen);
401}
402
403static int pcapfile_get_framing_length(const libtrace_packet_t *packet UNUSED) {
404        return sizeof(libtrace_pcapfile_pkt_hdr_t);
405}
406
407static size_t pcapfile_set_capture_length(libtrace_packet_t *packet,size_t size) {
408        libtrace_pcapfile_pkt_hdr_t *pcapptr = 0;
409        assert(packet);
410        if (size > trace_get_capture_length(packet)) {
411                /* can't make a packet larger */
412                return trace_get_capture_length(packet);
413        }
414        pcapptr = (libtrace_pcapfile_pkt_hdr_t *)packet->header;
415        pcapptr->caplen = swapl(packet->trace,size);
416        return trace_get_capture_length(packet);
417}
418
419static void pcapfile_help() {
420        printf("pcapfile format module: $Revision$\n");
421        printf("Supported input URIs:\n");
422        printf("\tpcapfile:/path/to/file\n");
423        printf("\tpcapfile:/path/to/file.gz\n");
424        printf("\n");
425        printf("\te.g.: pcapfile:/tmp/trace.pcap\n");
426        printf("\n");
427}
428
429static struct libtrace_format_t pcapfile = {
430        "pcapfile",
431        "$Id$",
432        TRACE_FORMAT_PCAPFILE,
433        pcapfile_init_input,            /* init_input */
434        pcapfile_config_input,          /* config_input */
435        pcapfile_start_input,           /* start_input */
436        NULL,                           /* pause_input */
437        pcapfile_init_output,           /* init_output */
438        pcapfile_config_output,         /* config_output */
439        pcapfile_start_output,          /* start_output */
440        pcapfile_fin_input,             /* fin_input */
441        pcapfile_fin_output,            /* fin_output */
442        pcapfile_read_packet,           /* read_packet */
443        NULL,                           /* fin_packet */
444        pcapfile_write_packet,          /* write_packet */
445        pcapfile_get_link_type,         /* get_link_type */
446        pcapfile_get_direction,         /* get_direction */
447        NULL,                           /* set_direction */
448        NULL,                           /* get_erf_timestamp */
449        pcapfile_get_timeval,           /* get_timeval */
450        NULL,                           /* get_seconds */
451        NULL,                           /* seek_erf */
452        NULL,                           /* seek_timeval */
453        NULL,                           /* seek_seconds */
454        pcapfile_get_capture_length,    /* get_capture_length */
455        pcapfile_get_wire_length,       /* get_wire_length */
456        pcapfile_get_framing_length,    /* get_framing_length */
457        pcapfile_set_capture_length,    /* set_capture_length */
458        NULL,                           /* get_fd */
459        trace_event_trace,              /* trace_event */
460        pcapfile_help,                  /* help */
461        NULL                            /* next pointer */
462};
463
464
465void pcapfile_constructor() {
466        register_format(&pcapfile);
467}
468
469
Note: See TracBrowser for help on using the repository browser.