parser.h revision 15bc85742616202550ff3718d2ab4055a09151cb
1/* 2 HCIDump - HCI packet analyzer 3 Copyright (C) 2000-2001 Maxim Krasnyansky <maxk@qualcomm.com> 4 5 This program is free software; you can redistribute it and/or modify 6 it under the terms of the GNU General Public License version 2 as 7 published by the Free Software Foundation; 8 9 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS 10 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 11 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. 12 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY CLAIM, 13 OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES WHATSOEVER 14 RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, 15 NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE 16 USE OR PERFORMANCE OF THIS SOFTWARE. 17 18 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, COPYRIGHTS, 19 TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS SOFTWARE IS DISCLAIMED. 20*/ 21 22/* 23 * $Id$ 24 */ 25 26struct frame { 27 void *data; 28 int data_len; 29 void *ptr; 30 int len; 31 int in; 32 int handle; 33 int cid; 34 long flags; 35 struct timeval ts; 36}; 37 38/* Parser flags */ 39#define DUMP_WIDTH 20 40 41#define DUMP_HEX 0x01 42#define DUMP_ASCII 0x02 43#define DUMP_TYPE_MASK (DUMP_HEX | DUMP_ASCII) 44#define DUMP_TSTAMP 0x04 45#define DUMP_RAW 0x08 46 47/* Parser filter */ 48#define FILT_HCI 0x0001 49#define FILT_L2CAP 0x0002 50#define FILT_RFCOMM 0x0004 51#define FILT_SDP 0x0008 52#define FILT_SCO 0x0010 53#define FILT_BNEP 0x0020 54#define FILT_CMTP 0x0040 55#define FILT_HIDP 0x0080 56 57#define STRUCT_OFFSET(type, member) ((uint8_t *)&(((type *)NULL)->member) - \ 58 (uint8_t *)((type *)NULL)) 59 60#define STRUCT_END(type, member) (STRUCT_OFFSET(type, member) + \ 61 sizeof(((type *)NULL)->member)) 62 63struct parser_t { 64 unsigned long flags; 65 unsigned long filter; 66 unsigned int defpsm; 67 int state; 68}; 69 70extern struct parser_t parser; 71 72void init_parser(unsigned long flags, unsigned long filter, 73 unsigned int assume_psm); 74 75static inline int p_filter(unsigned long f) 76{ 77 return !(parser.filter & f); 78} 79 80static inline void p_indent(int level, struct frame *f) 81{ 82 if (level < 0) { 83 parser.state = 0; 84 return; 85 } 86 87 if (!parser.state) { 88 if (parser.flags & DUMP_TSTAMP) 89 printf("%8lu.%06lu ", f->ts.tv_sec, f->ts.tv_usec); 90 printf("%c ", (f->in ? '>' : '<')); 91 parser.state = 1; 92 } else 93 printf(" "); 94 95 if (level) 96 printf("%*c", (level*2), ' '); 97} 98 99/* get_uXX functions do byte swaping */ 100 101/* use memmove to prevent gcc from using builtin memcpy */ 102#define get_unaligned(p) \ 103 ({ __typeof__(*(p)) t; memmove(&t, (p), sizeof(t)); t; }) 104 105static inline uint8_t get_u8(struct frame *frm) 106{ 107 uint8_t *u8_ptr = frm->ptr; 108 frm->ptr += 1; 109 frm->len -= 1; 110 return *u8_ptr; 111} 112 113static inline uint16_t get_u16(struct frame *frm) 114{ 115 uint16_t *u16_ptr = frm->ptr; 116 frm->ptr += 2; 117 frm->len -= 2; 118 return ntohs(get_unaligned(u16_ptr)); 119} 120 121static inline uint32_t get_u32(struct frame *frm) 122{ 123 uint32_t *u32_ptr = frm->ptr; 124 frm->ptr += 4; 125 frm->len -= 4; 126 return ntohl(get_unaligned(u32_ptr)); 127} 128 129static inline uint64_t get_u64(struct frame *frm) 130{ 131 uint64_t *u64_ptr = frm->ptr; 132 uint64_t u64 = get_unaligned(u64_ptr), tmp; 133 frm->ptr += 8; 134 frm->len -= 8; 135 tmp = ntohl(u64 & 0xffffffff); 136 u64 = (tmp << 32) | ntohl(u64 >> 32); 137 return u64; 138} 139 140static inline void get_u128(struct frame *frm, uint64_t *l, uint64_t *h) 141{ 142 *h = get_u64(frm); 143 *l = get_u64(frm); 144} 145 146char *get_uuid_name(int uuid); 147 148void raw_dump(int level, struct frame *frm); 149void raw_ndump(int level, struct frame *frm, int num); 150void hci_dump(int level, struct frame *frm); 151void l2cap_dump(int level, struct frame *frm); 152void rfcomm_dump(int level, struct frame *frm); 153void sdp_dump(int level, struct frame *frm); 154void bnep_dump(int level, struct frame *frm); 155void cmtp_dump(int level, struct frame *frm); 156void hidp_dump(int level, struct frame *frm); 157 158static inline void parse(struct frame *frm) 159{ 160 p_indent(-1, NULL); 161 if (parser.flags & DUMP_RAW) 162 raw_dump(0, frm); 163 else 164 hci_dump(0, frm); 165 fflush(stdout); 166} 167