/* i4btrace.c * * $Id$ * * Wiretap Library * Copyright (c) 1999 by Bert Driehuis * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */ #ifdef HAVE_CONFIG_H #include "config.h" #endif #include #include #include #include "wtap-int.h" #include "file_wrappers.h" #include "buffer.h" #include "i4b_trace.h" #include "i4btrace.h" typedef struct { gboolean byte_swapped; } i4btrace_t; static gboolean i4btrace_read(wtap *wth, int *err, gchar **err_info, gint64 *data_offset); static gboolean i4btrace_seek_read(wtap *wth, gint64 seek_off, union wtap_pseudo_header *pseudo_header, guint8 *pd, int length, int *err, gchar **err_info); static int i4b_read_rec_header(FILE_T fh, i4b_trace_hdr_t *hdr, int *err, gchar **err_info); static void i4b_byte_swap_header(wtap *wth, i4b_trace_hdr_t *hdr); static gboolean i4b_read_rec_data(FILE_T fh, guint8 *pd, int length, int *err, gchar **err_info); static void i4b_set_pseudo_header(i4b_trace_hdr_t *hdr, union wtap_pseudo_header *pseudo_header); /* * Test some fields in the header to see if they make sense. */ #define I4B_HDR_IS_OK(hdr) \ (!((unsigned)hdr.length < 3 || (unsigned)hdr.length > 16384 || \ (unsigned)hdr.unit > 4 || (unsigned)hdr.type > 4 || \ (unsigned)hdr.dir > 2 || (unsigned)hdr.trunc > 2048)) int i4btrace_open(wtap *wth, int *err, gchar **err_info) { int bytes_read; i4b_trace_hdr_t hdr; gboolean byte_swapped = FALSE; i4btrace_t *i4btrace; /* I4B trace files have no magic in the header... Sigh */ errno = WTAP_ERR_CANT_READ; bytes_read = file_read(&hdr, sizeof(hdr), wth->fh); if (bytes_read != sizeof(hdr)) { *err = file_error(wth->fh, err_info); if (*err != 0) return -1; return 0; } /* Silly heuristic... */ if (!I4B_HDR_IS_OK(hdr)) { /* * OK, try byte-swapping the header fields. */ hdr.length = BSWAP32(hdr.length); hdr.unit = BSWAP32(hdr.unit); hdr.type = BSWAP32(hdr.type); hdr.dir = BSWAP32(hdr.dir); hdr.trunc = BSWAP32(hdr.trunc); if (!I4B_HDR_IS_OK(hdr)) { /* * It doesn't look valid in either byte order. */ return 0; } /* * It looks valid byte-swapped, so assume it's a * trace written in the opposite byte order. */ byte_swapped = TRUE; } if (file_seek(wth->fh, 0, SEEK_SET, err) == -1) return -1; /* Get capture start time */ wth->file_type = WTAP_FILE_I4BTRACE; i4btrace = (i4btrace_t *)g_malloc(sizeof(i4btrace_t)); wth->priv = (void *)i4btrace; wth->subtype_read = i4btrace_read; wth->subtype_seek_read = i4btrace_seek_read; wth->snapshot_length = 0; /* not known */ i4btrace->byte_swapped = byte_swapped; wth->file_encap = WTAP_ENCAP_ISDN; wth->tsprecision = WTAP_FILE_TSPREC_USEC; return 1; } /* Read the next packet */ static gboolean i4btrace_read(wtap *wth, int *err, gchar **err_info, gint64 *data_offset) { int ret; i4b_trace_hdr_t hdr; guint32 length; void *bufp; /* Read record header. */ *data_offset = file_tell(wth->fh); ret = i4b_read_rec_header(wth->fh, &hdr, err, err_info); if (ret <= 0) { /* Read error or EOF */ return FALSE; } i4b_byte_swap_header(wth, &hdr); if (hdr.length < sizeof(hdr)) { *err = WTAP_ERR_BAD_FILE; /* record length < header! */ *err_info = g_strdup_printf("i4btrace: record length %u < header length %lu", hdr.length, (unsigned long)sizeof(hdr)); return FALSE; } length = hdr.length - (guint32)sizeof(hdr); if (length > WTAP_MAX_PACKET_SIZE) { /* * Probably a corrupt capture file; don't blow up trying * to allocate space for an immensely-large packet. */ *err = WTAP_ERR_BAD_FILE; *err_info = g_strdup_printf("i4btrace: File has %u-byte packet, bigger than maximum of %u", length, WTAP_MAX_PACKET_SIZE); return FALSE; } wth->phdr.presence_flags = WTAP_HAS_TS; wth->phdr.len = length; wth->phdr.caplen = length; wth->phdr.ts.secs = hdr.ts_sec; wth->phdr.ts.nsecs = hdr.ts_usec * 1000; /* * Read the packet data. */ buffer_assure_space(wth->frame_buffer, length); bufp = buffer_start_ptr(wth->frame_buffer); if (!i4b_read_rec_data(wth->fh, bufp, length, err, err_info)) return FALSE; /* Read error */ switch (hdr.type) { case TRC_CH_I: /* * XXX - what is it? It's probably not WTAP_ENCAP_NULL, * as that means it has a 4-byte AF_ type as the * encapsulation header. */ wth->phdr.pkt_encap = WTAP_ENCAP_NULL; break; case TRC_CH_D: case TRC_CH_B1: case TRC_CH_B2: /* * D or B channel. */ wth->phdr.pkt_encap = WTAP_ENCAP_ISDN; break; } i4b_set_pseudo_header(&hdr, &wth->pseudo_header); return TRUE; } static gboolean i4btrace_seek_read(wtap *wth, gint64 seek_off, union wtap_pseudo_header *pseudo_header, guint8 *pd, int length, int *err, gchar **err_info) { int ret; i4b_trace_hdr_t hdr; if (file_seek(wth->random_fh, seek_off, SEEK_SET, err) == -1) return FALSE; /* Read record header. */ ret = i4b_read_rec_header(wth->random_fh, &hdr, err, err_info); if (ret <= 0) { /* Read error or EOF */ if (ret == 0) { /* EOF means "short read" in random-access mode */ *err = WTAP_ERR_SHORT_READ; } return FALSE; } i4b_byte_swap_header(wth, &hdr); i4b_set_pseudo_header(&hdr, pseudo_header); /* * Read the packet data. */ return i4b_read_rec_data(wth->random_fh, pd, length, err, err_info); } static int i4b_read_rec_header(FILE_T fh, i4b_trace_hdr_t *hdr, int *err, gchar **err_info) { int bytes_read; errno = WTAP_ERR_CANT_READ; bytes_read = file_read(hdr, sizeof *hdr, fh); if (bytes_read != sizeof *hdr) { *err = file_error(fh, err_info); if (*err != 0) return -1; if (bytes_read != 0) { *err = WTAP_ERR_SHORT_READ; return -1; } return 0; } return 1; } static void i4b_byte_swap_header(wtap *wth, i4b_trace_hdr_t *hdr) { i4btrace_t *i4btrace = (i4btrace_t *)wth->priv; if (i4btrace->byte_swapped) { /* * Byte-swap the header. */ hdr->length = BSWAP32(hdr->length); hdr->unit = BSWAP32(hdr->unit); hdr->type = BSWAP32(hdr->type); hdr->dir = BSWAP32(hdr->dir); hdr->trunc = BSWAP32(hdr->trunc); hdr->count = BSWAP32(hdr->count); hdr->ts_sec = BSWAP32(hdr->ts_sec); hdr->ts_usec = BSWAP32(hdr->ts_usec); } } static gboolean i4b_read_rec_data(FILE_T fh, guint8 *pd, int length, int *err, gchar **err_info) { int bytes_read; errno = WTAP_ERR_CANT_READ; bytes_read = file_read(pd, length, fh); if (bytes_read != length) { *err = file_error(fh, err_info); if (*err == 0) *err = WTAP_ERR_SHORT_READ; return FALSE; } return TRUE; } static void i4b_set_pseudo_header(i4b_trace_hdr_t *hdr, union wtap_pseudo_header *pseudo_header) { pseudo_header->isdn.uton = (hdr->dir == FROM_TE); switch (hdr->type) { case TRC_CH_D: /* * D channel, so it's LAPD; set "p2p.sent". */ pseudo_header->isdn.channel = 0; break; case TRC_CH_B1: /* * B channel 1. */ pseudo_header->isdn.channel = 1; break; case TRC_CH_B2: /* * B channel 2. */ pseudo_header->isdn.channel = 2; break; } }