parser.h revision bda29c1eba75f38240df570735d3e4bfc9c5a4d6
1/* 2 * 3 * BlueZ - Bluetooth protocol stack for Linux 4 * 5 * Copyright (C) 2000-2002 Maxim Krasnyansky <maxk@qualcomm.com> 6 * Copyright (C) 2003-2006 Marcel Holtmann <marcel@holtmann.org> 7 * 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License as published by 11 * the Free Software Foundation; either version 2 of the License, or 12 * (at your option) any later version. 13 * 14 * This program is distributed in the hope that it will be useful, 15 * but WITHOUT ANY WARRANTY; without even the implied warranty of 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17 * GNU General Public License for more details. 18 * 19 * You should have received a copy of the GNU General Public License 20 * along with this program; if not, write to the Free Software 21 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA 22 * 23 */ 24 25#ifndef __PARSER_H 26#define __PARSER_H 27 28#include <time.h> 29#include <sys/time.h> 30#include <bluetooth/bluetooth.h> 31#include <netinet/in.h> 32 33struct frame { 34 void *data; 35 uint32_t data_len; 36 void *ptr; 37 uint32_t len; 38 uint16_t dev_id; 39 uint8_t in; 40 uint8_t master; 41 uint16_t handle; 42 uint16_t cid; 43 uint16_t num; 44 uint8_t dlci; 45 uint8_t channel; 46 unsigned long flags; 47 struct timeval ts; 48 int audio_fd; 49}; 50 51/* Parser flags */ 52#define DUMP_WIDTH 20 53 54#define DUMP_ASCII 0x0001 55#define DUMP_HEX 0x0002 56#define DUMP_EXT 0x0004 57#define DUMP_RAW 0x0008 58#define DUMP_BPA 0x0010 59#define DUMP_TSTAMP 0x0100 60#define DUMP_VERBOSE 0x0200 61#define DUMP_BTSNOOP 0x1000 62#define DUMP_NOVENDOR 0x2000 63#define DUMP_TYPE_MASK (DUMP_ASCII | DUMP_HEX | DUMP_EXT) 64 65/* Parser filter */ 66#define FILT_LMP 0x0001 67#define FILT_HCI 0x0002 68#define FILT_SCO 0x0004 69#define FILT_L2CAP 0x0008 70#define FILT_RFCOMM 0x0010 71#define FILT_SDP 0x0020 72#define FILT_BNEP 0x0040 73#define FILT_CMTP 0x0080 74#define FILT_HIDP 0x0100 75#define FILT_HCRP 0x0200 76#define FILT_AVDTP 0x0400 77#define FILT_AVCTP 0x0800 78 79#define FILT_OBEX 0x00010000 80#define FILT_CAPI 0x00020000 81#define FILT_PPP 0x00040000 82#define FILT_CSR 0x1000000a 83#define FILT_DGA 0x1000000c 84 85#define STRUCT_OFFSET(type, member) ((uint8_t *)&(((type *)NULL)->member) - \ 86 (uint8_t *)((type *)NULL)) 87 88#define STRUCT_END(type, member) (STRUCT_OFFSET(type, member) + \ 89 sizeof(((type *)NULL)->member)) 90 91#define DEFAULT_COMPID 65535 92 93struct parser_t { 94 unsigned long flags; 95 unsigned long filter; 96 unsigned short defpsm; 97 unsigned short defcompid; 98 int state; 99 int audio_fd; 100}; 101 102extern struct parser_t parser; 103 104void init_parser(unsigned long flags, unsigned long filter, 105 unsigned short defpsm, unsigned short defcompid, 106 int audio_fd); 107 108static inline int p_filter(unsigned long f) 109{ 110 return !(parser.filter & f); 111} 112 113static inline void p_indent(int level, struct frame *f) 114{ 115 if (level < 0) { 116 parser.state = 0; 117 return; 118 } 119 120 if (!parser.state) { 121 if (parser.flags & DUMP_TSTAMP) { 122 if (parser.flags & DUMP_VERBOSE) { 123 struct tm tm; 124 time_t t = f->ts.tv_sec; 125 localtime_r(&t, &tm); 126 printf("%04d-%02d-%02d %02d:%02d:%02d.%06lu ", 127 tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday, 128 tm.tm_hour, tm.tm_min, tm.tm_sec, f->ts.tv_usec); 129 } else 130 printf("%8lu.%06lu ", f->ts.tv_sec, f->ts.tv_usec); 131 } 132 printf("%c ", (f->in ? '>' : '<')); 133 parser.state = 1; 134 } else 135 printf(" "); 136 137 if (level) 138 printf("%*c", (level*2), ' '); 139} 140 141static inline void p_ba2str(const bdaddr_t *ba, char *str) 142{ 143 if (parser.flags & DUMP_NOVENDOR) { 144 uint8_t b[6]; 145 146 baswap((bdaddr_t *) b, ba); 147 sprintf(str, "%2.2X:%2.2X:%2.2X:*:*:*", b[0], b[1], b[2]); 148 } else 149 ba2str(ba, str); 150} 151 152/* get_uXX functions do byte swaping */ 153 154static inline uint8_t get_u8(struct frame *frm) 155{ 156 uint8_t *u8_ptr = frm->ptr; 157 frm->ptr += 1; 158 frm->len -= 1; 159 return *u8_ptr; 160} 161 162static inline uint16_t get_u16(struct frame *frm) 163{ 164 uint16_t *u16_ptr = frm->ptr; 165 frm->ptr += 2; 166 frm->len -= 2; 167 return ntohs(bt_get_unaligned(u16_ptr)); 168} 169 170static inline uint32_t get_u32(struct frame *frm) 171{ 172 uint32_t *u32_ptr = frm->ptr; 173 frm->ptr += 4; 174 frm->len -= 4; 175 return ntohl(bt_get_unaligned(u32_ptr)); 176} 177 178static inline uint64_t get_u64(struct frame *frm) 179{ 180 uint64_t *u64_ptr = frm->ptr; 181 uint64_t u64 = bt_get_unaligned(u64_ptr), tmp; 182 frm->ptr += 8; 183 frm->len -= 8; 184 tmp = ntohl(u64 & 0xffffffff); 185 u64 = (tmp << 32) | ntohl(u64 >> 32); 186 return u64; 187} 188 189static inline void get_u128(struct frame *frm, uint64_t *l, uint64_t *h) 190{ 191 *h = get_u64(frm); 192 *l = get_u64(frm); 193} 194 195char *get_uuid_name(int uuid); 196 197void set_proto(uint16_t handle, uint16_t psm, uint8_t channel, uint32_t proto); 198uint32_t get_proto(uint16_t handle, uint16_t psm, uint8_t channel); 199 200void l2cap_clear(uint16_t handle); 201void obex_clear(uint16_t handle, uint8_t dlci); 202 203void ascii_dump(int level, struct frame *frm, int num); 204void hex_dump(int level, struct frame *frm, int num); 205void ext_dump(int level, struct frame *frm, int num); 206void raw_dump(int level, struct frame *frm); 207void raw_ndump(int level, struct frame *frm, int num); 208 209void lmp_dump(int level, struct frame *frm); 210void hci_dump(int level, struct frame *frm); 211void l2cap_dump(int level, struct frame *frm); 212void rfcomm_dump(int level, struct frame *frm); 213void sdp_dump(int level, struct frame *frm); 214void bnep_dump(int level, struct frame *frm); 215void cmtp_dump(int level, struct frame *frm); 216void hidp_dump(int level, struct frame *frm); 217void hcrp_dump(int level, struct frame *frm); 218void avdtp_dump(int level, struct frame *frm); 219void avctp_dump(int level, struct frame *frm); 220 221void obex_dump(int level, struct frame *frm); 222void capi_dump(int level, struct frame *frm); 223void ppp_dump(int level, struct frame *frm); 224void csr_dump(int level, struct frame *frm); 225void bpa_dump(int level, struct frame *frm); 226 227static inline void parse(struct frame *frm) 228{ 229 p_indent(-1, NULL); 230 if (parser.flags & DUMP_RAW) 231 raw_dump(0, frm); 232 else 233 hci_dump(0, frm); 234 fflush(stdout); 235} 236 237#endif /* __PARSER_H */ 238