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
|
/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2004-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
*
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#include <stdio.h>
#include <errno.h>
#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include "parser.h"
static char *pid2str(uint16_t pid)
{
switch (pid) {
case 0x0001:
return "CreditGrant";
case 0x0002:
return "CreditRequest";
case 0x0003:
return "CreditReturn";
case 0x0004:
return "CreditQuery";
case 0x0005:
return "GetLPTStatus";
case 0x0006:
return "Get1284ID";
case 0x0007:
return "SoftReset";
case 0x0008:
return "HardRest";
case 0x0009:
return "RegisterNotification";
case 0x000A:
return "NotificationConnectionAlive";
default:
return "Reserved";
}
}
static char *status2str(uint16_t status)
{
switch (status) {
case 0x0000:
return "Feature unsupported";
case 0x0001:
return "Success";
case 0x0002:
return "Credit synchronization error";
case 0xFFFF:
return "Generic error";
default:
return "Unknown";
}
}
void hcrp_dump(int level, struct frame *frm)
{
uint16_t pid, tid, plen, status;
uint32_t credits;
pid = get_u16(frm);
tid = get_u16(frm);
plen = get_u16(frm);
p_indent(level, frm);
printf("HCRP %s %s: tid 0x%x plen %d",
pid2str(pid), frm->in ? "rsp" : "cmd", tid, plen);
if (frm->in) {
status = get_u16(frm);
printf(" status %d (%s)\n", status, status2str(status));
} else
printf("\n");
if (pid == 0x0001 && !frm->in) {
credits = get_u32(frm);
p_indent(level + 1, frm);
printf("credits %d\n", credits);
}
if (pid == 0x0002 && frm->in) {
credits = get_u32(frm);
p_indent(level + 1, frm);
printf("credits %d\n", credits);
}
raw_dump(level + 1, frm);
}
|
