diff options
author | Guy Harris <guy@alum.mit.edu> | 2003-10-30 03:11:03 +0000 |
---|---|---|
committer | Guy Harris <guy@alum.mit.edu> | 2003-10-30 03:11:03 +0000 |
commit | 95c1f2f7c90178202fb4d79e15cd0be113e97e8e (patch) | |
tree | 02ceea77ac86278a29ddfa5ec0dcf4c6ab9a4295 /wiretap/hcidump.c | |
parent | c37d30442f91249871519a26d78ec03bc5165271 (diff) |
From Marcel Holtmann: support for reading Linux Bluez Bluetooth stack
"hcidump -w" traces.
Note that Jesper Peterson contributed support for reading Endace ERF
files.
svn path=/trunk/; revision=8824
Diffstat (limited to 'wiretap/hcidump.c')
-rw-r--r-- | wiretap/hcidump.c | 157 |
1 files changed, 157 insertions, 0 deletions
diff --git a/wiretap/hcidump.c b/wiretap/hcidump.c new file mode 100644 index 0000000000..f61c092c82 --- /dev/null +++ b/wiretap/hcidump.c @@ -0,0 +1,157 @@ +/* hcidump.c + * + * $Id: hcidump.c,v 1.1 2003/10/30 03:11:02 guy Exp $ + * + * Copyright (c) 2003 by Marcel Holtmann <marcel@holtmann.org> + * + * 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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include "wtap-int.h" +#include "file_wrappers.h" +#include "buffer.h" +#include "hcidump.h" + +struct dump_hdr { + guint16 len; + guint8 in; + guint8 pad; + guint32 ts_sec; + guint32 ts_usec; +}; + +#define DUMP_HDR_SIZE (sizeof(struct dump_hdr)) + +static gboolean hcidump_read(wtap *wth, int *err, long *data_offset) +{ + struct dump_hdr dh; + guint8 *buf; + int bytes_read, packet_size; + + *data_offset = wth->data_offset; + + bytes_read = file_read(&dh, 1, DUMP_HDR_SIZE, wth->fh); + if (bytes_read != DUMP_HDR_SIZE) { + *err = file_error(wth->fh); + if (*err == 0 && bytes_read != 0) + *err = WTAP_ERR_SHORT_READ; + return FALSE; + } + wth->data_offset += DUMP_HDR_SIZE; + + packet_size = g_ntohs(dh.len); + if (packet_size > WTAP_MAX_PACKET_SIZE) { + /* + * Probably a corrupt capture file; don't blow up trying + * to allocate space for an immensely-large packet. + */ + g_message("hcidump: File has %u-byte packet, bigger than maximum of %u", + packet_size, WTAP_MAX_PACKET_SIZE); + *err = WTAP_ERR_BAD_RECORD; + return FALSE; + } + + buffer_assure_space(wth->frame_buffer, packet_size); + buf = buffer_start_ptr(wth->frame_buffer); + + bytes_read = file_read(buf, 1, packet_size, wth->fh); + if (bytes_read != packet_size) { + *err = file_error(wth->fh); + if (*err == 0) + *err = WTAP_ERR_SHORT_READ; + return FALSE; + } + wth->data_offset += packet_size; + + wth->phdr.ts.tv_sec = g_ntohl(dh.ts_sec); + wth->phdr.ts.tv_usec = g_ntohl(dh.ts_usec); + wth->phdr.caplen = packet_size; + wth->phdr.len = packet_size; + wth->phdr.pkt_encap = WTAP_ENCAP_BLUETOOTH_H4; + + wth->pseudo_header.p2p.sent = (dh.in ? FALSE : TRUE); + + return TRUE; +} + +static gboolean hcidump_seek_read(wtap *wth, long seek_off, union wtap_pseudo_header *pseudo_header, guint8 *pd, int length, int *err) +{ + struct dump_hdr dh; + int bytes_read; + + if (file_seek(wth->random_fh, seek_off, SEEK_SET, err) == -1) + return FALSE; + + bytes_read = file_read(&dh, 1, DUMP_HDR_SIZE, wth->random_fh); + if (bytes_read != DUMP_HDR_SIZE) { + *err = file_error(wth->random_fh); + if (*err == 0 && bytes_read != 0) + *err = WTAP_ERR_SHORT_READ; + return FALSE; + } + + bytes_read = file_read(pd, 1, length, wth->random_fh); + if (bytes_read != length) { + *err = file_error(wth->random_fh); + if (*err == 0) + *err = WTAP_ERR_SHORT_READ; + return FALSE; + } + + pseudo_header->p2p.sent = (dh.in ? FALSE : TRUE); + + return TRUE; +} + +int hcidump_open(wtap *wth, int *err) +{ + struct dump_hdr dh; + guint8 type; + int bytes_read; + + bytes_read = file_read(&dh, 1, DUMP_HDR_SIZE, wth->fh); + if (bytes_read != DUMP_HDR_SIZE) { + *err = file_error(wth->fh); + return (*err != 0) ? -1 : 0; + } + + if (dh.in != 0 && dh.in != 1 && dh.pad != 0 && g_ntohs(dh.len) < 1) + return 0; + + bytes_read = file_read(&type, 1, 1, wth->fh); + if (bytes_read != 1) { + *err = file_error(wth->fh); + return (*err != 0) ? -1 : 0; + } + + if (type < 1 || type > 4) + return 0; + + if (file_seek(wth->fh, 0, SEEK_SET, err) == -1) + return -1; + + wth->file_type = WTAP_FILE_HCIDUMP; + wth->file_encap = WTAP_ENCAP_BLUETOOTH_H4; + wth->snapshot_length = 0; + + wth->subtype_read = hcidump_read; + wth->subtype_seek_read = hcidump_seek_read; + + return 1; +} |