source: lib/format_wag.c @ 37a39b7

4.0.1-hotfixescachetimestampsdevelopdpdk-ndagetsilivegetfragoffhelplibtrace4ndag_formatpfringrc-4.0.1rc-4.0.2rc-4.0.3rc-4.0.4ringdecrementfixringperformanceringtimestampfixes
Last change on this file since 37a39b7 was 37a39b7, checked in by Daniel Lawson <dlawson@…>, 16 years ago

adding wag codepath

  • Property mode set to 100644
File size: 6.1 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 "libtrace.h"
32#include "format.h"
33#include "wag.h"
34
35#ifdef HAVE_INTTYPES_H
36#  include <inttypes.h>
37#else
38#  error "Can't find inttypes.h - this needs to be fixed"
39#endif
40
41#ifdef HAVE_STDDEF_H
42#  include <stddef.h>
43#else
44# error "Can't find stddef.h - do you define ptrdiff_t elsewhere?"
45#endif
46#include <sys/types.h>
47#include <sys/socket.h>
48#include <sys/un.h>
49#include <sys/mman.h>
50#include <sys/stat.h>
51#include <fcntl.h>
52#include <unistd.h>
53#include <assert.h>
54#include <errno.h>
55#include <netdb.h>
56
57#ifndef O_LARGEFILE
58#define O_LARGEFILE 0
59#endif
60static int wag_init_input(struct libtrace_t *libtrace) {
61        struct stat buf;
62        struct hostent *he;
63        struct sockaddr_in remote;
64        struct sockaddr_un unix_sock;
65        if (!strncmp(libtrace->conn_info.path,"-",1)) {
66                // STDIN
67#if HAVE_ZLIB
68                libtrace->input.file = gzdopen(STDIN, "r");
69#else   
70                libtrace->input.file = stdin;
71#endif
72
73        } else {
74                if (stat(libtrace->conn_info.path,&buf) == -1 ) {
75                        perror("stat");
76                        return 0;
77                }
78                if (S_ISSOCK(buf.st_mode)) {
79                        // SOCKET
80                        if ((libtrace->input.fd = socket(
81                                        AF_UNIX, SOCK_STREAM, 0)) == -1) {
82                                perror("socket");
83                                return 0;
84                        }
85                        unix_sock.sun_family = AF_UNIX;
86                        bzero(unix_sock.sun_path,108);
87                        snprintf(unix_sock.sun_path,
88                                        108,"%s"
89                                        ,libtrace->conn_info.path);
90
91                        if (connect(libtrace->input.fd, 
92                                        (struct sockaddr *)&unix_sock,
93                                        sizeof(struct sockaddr)) == -1) {
94                                perror("connect (unix)");
95                                return 0;
96                        }
97                } else { 
98                        // TRACE
99#if HAVE_ZLIB
100                        // using gzdopen means we can set O_LARGEFILE
101                        // ourselves. However, this way is messy and
102                        // we lose any error checking on "open"
103                        libtrace->input.file = 
104                                gzdopen(open(
105                                        libtrace->conn_info.path,
106                                        O_LARGEFILE), "r");
107#else
108                        libtrace->input.file = 
109                                fdopen(open(
110                                        libtrace->conn_info.path,
111                                        O_LARGEFILE), "r");
112#endif
113
114                }
115        }
116}
117
118static int wag_fin_input(struct libtrace_t *libtrace) {
119#if HAVE_ZLIB
120        gzclose(libtrace->input.file);
121#else   
122        fclose(libtrace->input.file);   
123#endif
124}
125
126static int wag_read_packet(struct libtrace_t *libtrace, struct libtrace_packet_t *packet) {
127        int numbytes;
128        int size;
129        char buf[RP_BUFSIZE];
130        int read_required = 0;
131        struct wag_frame_hdr *waghdr = 0;
132
133        void *buffer = 0;
134
135        packet->trace = libtrace;
136        buffer = packet->buffer;
137       
138
139        do {
140                if (fifo_out_available(libtrace->fifo) == 0 || read_required) {
141                        if ((numbytes = wag_read(libtrace,buf,RP_BUFSIZE)) <= 0) {
142                                return numbytes;
143                        }
144                        assert(libtrace->fifo);
145                        fifo_write(libtrace->fifo,buf,numbytes);
146                        read_required = 0;
147                }
148                // read in wag_frame_hdr
149                if ((numbytes = fifo_out_read(libtrace->fifo, 
150                                                buffer,
151                                                sizeof(struct wag_frame_hdr)))
152                                == 0 ) {
153                        fifo_out_reset(libtrace->fifo);
154                        read_required = 1;
155                        continue;
156                }
157                size = ntohs(((struct wag_frame_hdr *)buffer)->size);
158
159                // read in full packet
160                if((numbytes = fifo_out_reaD(libtrace->fifo,buffer,size)) == 0) {
161                        fifo_out_reset(libtrace->fifo);
162                        read_required = 1;
163                        continue;
164                }
165
166                // have the whole packet
167                fifo_out_update(libtrace->fifo,size);
168                fifo_ack_update(libtrace->fifo,size);
169
170                packet->size = numbytes;
171                return numbytes;
172        } while(1);
173}
174
175static void *wag_get_link(const struct libtrace_packet_t *packet) {
176        struct wag_data_frame *wagptr = (struct wag_data_frame *)packet->buffer;
177        void *payload = wagptr->data;
178        return (void*)payload;
179}
180
181static libtrace_linktype_t wag_get_link_type(const struct libtrace_packet_t *packet) {
182        return TRACE_TYPE_80211;
183}
184
185static int8_t wag_get_direction(const struct libtrace_packet_t *packet) {
186        struct wag_data_frame *wagptr = (struct wag_data_frame *)packet->buffer;
187        if (wagptr->hdr.type == 0) {
188                return wagptr->hdr.subtype;
189        }
190        return -1;
191}
192
193static uint64_t wag_get_erf_timestamp(const struct libtrace_packet_t *packet) {
194        struct wag_data_frame *wagptr = (struct wag_data_frame *)packet->buffer;
195        uint64_t timestamp = 0;
196        timestamp = wagptr->ts.subsecs;
197        timestamp |= (uint64_t)wagptr->ts.secs<<32;
198        timestamp = ((timestamp%44000000)*(UINT_MAX/44000000)) 
199                | ((timestamp/44000000)<<32);
200        return timestamp;
201}
202
203static int wag_get_capture_length(const struct libtrace_packet_t *packet) {
204        struct wag_data_frame *wagptr = (struct wag_data_frame *)packet->buffer;
205        return ntohs(wagptr->hdr.size);
206}
207
208static int wag_get_wire_length(const struct libtrace_packet_t *packet) {
209        struct wag_data_frame *wagptr = (struct wag_data_frame *)packet->buffer;
210        return ntohs(wagptr->hdr.size);
211}
212
213static struct format_t wag = {
214        "wag",
215        "$Id$",
216        wag_init_input,                 /* init_input */       
217        NULL,                           /* init_output */
218        wag_fin_input,                  /* fin_input */
219        NULL,                           /* fin_output */
220        NULL,                           /* read */
221        wag_read_packet,                /* read_packet */
222        NULL,                           /* write_packet */
223        wag_get_link,                   /* get_link */
224        wag_get_link_type,              /* get_link_type */
225        wag_get_direction,              /* get_direction */
226        NULL,                           /* set_direction */
227        wag_get_erf_timestamp,          /* get_wag_timestamp */
228        NULL,                           /* get_timeval */
229        NULL,                           /* get_seconds */
230        wag_get_capture_length,         /* get_capture_length */
231        wag_get_wire_length,            /* get_wire_length */
232        NULL                            /* set_capture_length */
233};
234
235void __attribute__((constructor)) wag_constructor() {
236        register_format(&wag);
237}
Note: See TracBrowser for help on using the repository browser.