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
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
|
#!/usr/bin/env python3
#
# SPDX-FileCopyrightText: © 2019 The usbmon-tools Authors
# SPDX-FileCopyrightText: © 2020 The glucometerutils Authors
#
# SPDX-License-Identifier: Apache-2.0
import argparse
import logging
import sys
import textwrap
import construct
import usbmon
import usbmon.chatter
import usbmon.pcapng
_KEEPALIVE_TYPE = 0x22
_UNENCRYPTED_TYPES = (
0x01,
0x04,
0x05,
0x06,
0x0C,
0x0D,
0x14,
0x15,
0x33,
0x34,
0x35,
0x71,
_KEEPALIVE_TYPE,
)
_ABBOTT_VENDOR_ID = 0x1A61
_LIBRE2_PRODUCT_ID = 0x3950
_ENCRYPTED_MESSAGE = construct.Struct(
message_type=construct.Byte,
encrypted_message=construct.Bytes(64 - 1 - 4 - 4),
sequence_number=construct.Int32ul,
mac=construct.Int32ul,
)
def main():
if sys.version_info < (3, 7):
raise Exception("Unsupported Python version, please use at least Python 3.7.")
parser = argparse.ArgumentParser()
parser.add_argument(
"--device_address",
action="store",
type=str,
help=(
"Device address (busnum.devnum) of the device to extract capture"
" of. If none provided, device descriptors will be relied on."
),
)
parser.add_argument(
"--encrypted_protocol",
action="store_true",
help=(
"Whether to expect encrypted protocol in the capture."
" Ignored if the device descriptors are present in the capture."
),
)
parser.add_argument(
"--vlog",
action="store",
required=False,
type=int,
help=(
"Python logging level. See the levels at"
" https://docs.python.org/3/library/logging.html#logging-levels"
),
)
parser.add_argument(
"--print_keepalive",
action="store_true",
help=(
"Whether to print the keepalive messages sent by the device. "
"Keepalive messages are usually safely ignored."
),
)
parser.add_argument(
"pcap_file",
action="store",
type=argparse.FileType(mode="rb"),
help="Path to the pcapng file with the USB capture.",
)
args = parser.parse_args()
logging.basicConfig(level=args.vlog)
session = usbmon.pcapng.parse_stream(args.pcap_file, retag_urbs=False)
if not args.device_address:
for descriptor in session.device_descriptors.values():
if descriptor.vendor_id == _ABBOTT_VENDOR_ID:
if args.device_address and args.device_address != descriptor.address:
raise Exception(
"Multiple Abbott device present in capture, please"
" provide a --device_address flag."
)
args.device_address = descriptor.address
descriptor = session.device_descriptors.get(args.device_address, None)
if not descriptor:
logging.warning(
"Unable to find device %s in the capture's descriptors."
" Assuming non-encrypted protocol.",
args.device_address,
)
else:
assert descriptor.vendor_id == _ABBOTT_VENDOR_ID
if descriptor and descriptor.product_id == _LIBRE2_PRODUCT_ID:
args.encrypted_protocol = True
for first, second in session.in_pairs():
# Ignore stray callbacks/errors.
if not first.type == usbmon.constants.PacketType.SUBMISSION:
continue
if not first.address.startswith(f"{args.device_address}."):
# No need to check second, they will be linked.
continue
if first.xfer_type == usbmon.constants.XferType.INTERRUPT:
pass
elif (
first.xfer_type == usbmon.constants.XferType.CONTROL
and not first.setup_packet
or first.setup_packet.type == usbmon.setup.Type.CLASS
):
pass
else:
continue
if first.direction == usbmon.constants.Direction.OUT:
packet = first
else:
packet = second
if not packet.payload:
continue
assert len(packet.payload) >= 2
message_type = packet.payload[0]
if message_type == _KEEPALIVE_TYPE and not args.print_keepalive:
continue
message_metadata = []
if args.encrypted_protocol and message_type not in _UNENCRYPTED_TYPES:
# With encrypted communication, the length of the message is also encrypted,
# and all the packets use the full 64 bytes. So instead, we extract what
# metadata we can.
parsed = _ENCRYPTED_MESSAGE.parse(packet.payload)
message_metadata.extend(
[f"SEQUENCE_NUMBER={parsed.sequence_number}", f"MAC={parsed.mac:04x}"]
)
message_type = f"x{message_type:02x}"
message = parsed.encrypted_message
else:
message_length = packet.payload[1]
message_metadata.append(f"LENGTH={message_length}")
message_end_idx = 2 + message_length
message_type = f" {message_type:02x}"
message = packet.payload[2:message_end_idx]
if message_metadata:
metadata_string = "\n".join(
textwrap.wrap(
" ".join(message_metadata), width=80, break_long_words=False
)
)
print(metadata_string)
print(
usbmon.chatter.dump_bytes(
packet.direction, message, prefix=f"[{message_type}]", print_empty=True,
),
"\n",
)
if __name__ == "__main__":
main()
|
