1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
|
/*
*
* Bluetooth packet analyzer - AVDTP parser
*
* Copyright (C) 2004 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
*
*
* $Id$
*/
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <errno.h>
#include <string.h>
#include <sys/types.h>
#include <netinet/in.h>
#include "parser.h"
static char *si2str(uint8_t si)
{
switch (si & 0x7f) {
case 0x01:
return "Discover";
case 0x02:
return "Capabilities";
case 0x03:
return "Set config";
case 0x04:
return "Get config";
case 0x05:
return "Reconfigure";
case 0x06:
return "Open";
case 0x07:
return "Start";
case 0x08:
return "Close";
case 0x09:
return "Suspend";
case 0x0a:
return "Abort";
case 0x0b:
return "Security";
default:
return "Unknown";
}
}
static char *pt2str(uint8_t hdr)
{
switch (hdr & 0x0c) {
case 0x00:
return "Single";
case 0x04:
return "Start";
case 0x08:
return "Cont";
case 0x0c:
return "End";
default:
return "Unk";
}
}
static char *mt2str(uint8_t hdr)
{
switch (hdr & 0x03) {
case 0x00:
return "cmd";
case 0x08:
return "rsp";
case 0x0c:
return "rej";
default:
return "rfa";
}
}
void avdtp_dump(int level, struct frame *frm)
{
uint8_t hdr, sid = 0xff, nsp;
hdr = get_u8(frm);
nsp = (hdr & 0x0c) == 0x04 ? get_u8(frm) : 0;
sid = hdr & 0x08 ? 0x00 : get_u8(frm);
p_indent(level, frm);
printf("AVDTP(s): %s %s: transaction %d\n",
sid & 0x08 ? pt2str(hdr) : si2str(sid), mt2str(hdr), hdr >> 8);
raw_dump(level, frm);
}
|
