/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2000-2002 Maxim Krasnyansky <maxk@qualcomm.com>
* Copyright (C) 2003-2011 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#ifndef __PARSER_H
#define __PARSER_H
#include <time.h>
#include <sys/time.h>
#include <bluetooth/bluetooth.h>
#include <netinet/in.h>
struct frame {
void *data;
uint32_t data_len;
void *ptr;
uint32_t len;
uint16_t dev_id;
uint8_t in;
uint8_t master;
uint16_t handle;
uint16_t cid;
uint16_t num;
uint8_t dlci;
uint8_t channel;
unsigned long flags;
struct timeval ts;
int pppdump_fd;
int audio_fd;
};
/* Parser flags */
#define DUMP_WIDTH 20
#define DUMP_ASCII 0x0001
#define DUMP_HEX 0x0002
#define DUMP_EXT 0x0004
#define DUMP_RAW 0x0008
#define DUMP_BPA 0x0010
#define DUMP_TSTAMP 0x0100
#define DUMP_VERBOSE 0x0200
#define DUMP_BTSNOOP 0x1000
#define DUMP_PKTLOG 0x2000
#define DUMP_NOVENDOR 0x4000
#define DUMP_TYPE_MASK (DUMP_ASCII | DUMP_HEX | DUMP_EXT)
/* Parser filter */
#define FILT_LMP 0x0001
#define FILT_HCI 0x0002
#define FILT_SCO 0x0004
#define FILT_L2CAP 0x0008
#define FILT_RFCOMM 0x0010
#define FILT_SDP 0x0020
#define FILT_BNEP 0x0040
#define FILT_CMTP 0x0080
#define FILT_HIDP 0x0100
#define FILT_HCRP 0x0200
#define FILT_AVDTP 0x0400
#define FILT_AVCTP 0x0800
#define FILT_ATT 0x1000
#define FILT_OBEX 0x00010000
#define FILT_CAPI 0x00020000
#define FILT_PPP 0x00040000
#define FILT_ERICSSON 0x10000000
#define FILT_CSR 0x1000000a
#define FILT_DGA 0x1000000c
#define STRUCT_OFFSET(type, member) ((uint8_t *)&(((type *)NULL)->member) - \
(uint8_t *)((type *)NULL))
#define STRUCT_END(type, member) (STRUCT_OFFSET(type, member) + \
sizeof(((type *)NULL)->member))
#define DEFAULT_COMPID 65535
struct parser_t {
unsigned long flags;
unsigned long filter;
unsigned short defpsm;
unsigned short defcompid;
int state;
int pppdump_fd;
int audio_fd;
};
extern struct parser_t parser;
void init_parser(unsigned long flags, unsigned long filter,
unsigned short defpsm, unsigned short defcompid,
int pppdump_fd, int audio_fd);
static inline int p_filter(unsigned long f)
{
return !(parser.filter & f);
}
static inline void p_indent(int level, struct frame *f)
{
if (level < 0) {
parser.state = 0;
return;
}
if (!parser.state) {
if (parser.flags & DUMP_TSTAMP) {
if (parser.flags & DUMP_VERBOSE) {
struct tm tm;
time_t t = f->ts.tv_sec;
localtime_r(&t, &tm);
printf("%04d-%02d-%02d %02d:%02d:%02d.%06lu ",
tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday,
tm.tm_hour, tm.tm_min, tm.tm_sec, f->ts.tv_usec);
} else
printf("%8lu.%06lu ", f->ts.tv_sec, f->ts.tv_usec);
}
printf("%c ", (f->in ? '>' : '<'));
parser.state = 1;
} else
printf(" ");
if (level)
printf("%*c", (level*2), ' ');
}
static inline void p_ba2str(const bdaddr_t *ba, char *str)
{
if (parser.flags & DUMP_NOVENDOR) {
uint8_t b[6];
baswap((bdaddr_t *) b, ba);
sprintf(str, "%2.2X:%2.2X:%2.2X:*:*:*", b[0], b[1], b[2]);
} else
ba2str(ba, str);
}
/* get_uXX functions do byte swaping */
static inline uint8_t get_u8(struct frame *frm)
{
uint8_t *u8_ptr = frm->ptr;
frm->ptr += 1;
frm->len -= 1;
return *u8_ptr;
}
static inline uint16_t get_u16(struct frame *frm)
{
uint16_t *u16_ptr = frm->ptr;
frm->ptr += 2;
frm->len -= 2;
return ntohs(bt_get_unaligned(u16_ptr));
}
static inline uint32_t get_u32(struct frame *frm)
{
uint32_t *u32_ptr = frm->ptr;
frm->ptr += 4;
frm->len -= 4;
return ntohl(bt_get_unaligned(u32_ptr));
}
static inline uint64_t get_u64(struct frame *frm)
{
uint64_t *u64_ptr = frm->ptr;
uint64_t u64 = bt_get_unaligned(u64_ptr), tmp;
frm->ptr += 8;
frm->len -= 8;
tmp = ntohl(u64 & 0xffffffff);
u64 = (tmp << 32) | ntohl(u64 >> 32);
return u64;
}
static inline void get_u128(struct frame *frm, uint64_t *l, uint64_t *h)
{
*h = get_u64(frm);
*l = get_u64(frm);
}
char *get_uuid_name(int uuid);
void set_proto(uint16_t handle, uint16_t psm, uint8_t channel, uint32_t proto);
uint32_t get_proto(uint16_t handle, uint16_t psm, uint8_t channel);
struct frame *add_frame(struct frame *frm);
void del_frame(uint16_t handle, uint8_t dlci);
uint8_t get_opcode(uint16_t handle, uint8_t dlci);
void set_opcode(uint16_t handle, uint8_t dlci, uint8_t opcode);
uint8_t get_status(uint16_t handle, uint8_t dlci);
void set_status(uint16_t handle, uint8_t dlci, uint8_t status);
void l2cap_clear(uint16_t handle);
void ascii_dump(int level, struct frame *frm, int num);
void hex_dump(int level, struct frame *frm, int num);
void ext_dump(int level, struct frame *frm, int num);
void raw_dump(int level, struct frame *frm);
void raw_ndump(int level, struct frame *frm, int num);
void lmp_dump(int level, struct frame *frm);
void hci_dump(int level, struct frame *frm);
void l2cap_dump(int level, struct frame *frm);
void rfcomm_dump(int level, struct frame *frm);
void sdp_dump(int level, struct frame *frm);
void bnep_dump(int level, struct frame *frm);
void cmtp_dump(int level, struct frame *frm);
void hidp_dump(int level, struct frame *frm);
void hcrp_dump(int level, struct frame *frm);
void avdtp_dump(int level, struct frame *frm);
void avctp_dump(int level, struct frame *frm);
void att_dump(int level, struct frame *frm);
void obex_dump(int level, struct frame *frm);
void capi_dump(int level, struct frame *frm);
void ppp_dump(int level, struct frame *frm);
void arp_dump(int level, struct frame *frm);
void ip_dump(int level, struct frame *frm);
void ericsson_dump(int level, struct frame *frm);
void csr_dump(int level, struct frame *frm);
void bpa_dump(int level, struct frame *frm);
static inline void parse(struct frame *frm)
{
p_indent(-1, NULL);
if (parser.flags & DUMP_RAW)
raw_dump(0, frm);
else
hci_dump(0, frm);
fflush(stdout);
}
#endif /* __PARSER_H */