forked from pybluez/pybluez
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathbtcommon.py
398 lines (369 loc) · 13 KB
/
btcommon.py
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
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
import sys
import struct
import binascii
L2CAP=0
RFCOMM=3
PORT_ANY=0
# Service Class IDs
SDP_SERVER_CLASS = "1000"
BROWSE_GRP_DESC_CLASS = "1001"
PUBLIC_BROWSE_GROUP = "1002"
SERIAL_PORT_CLASS = "1101"
LAN_ACCESS_CLASS = "1102"
DIALUP_NET_CLASS = "1103"
IRMC_SYNC_CLASS = "1104"
OBEX_OBJPUSH_CLASS = "1105"
OBEX_FILETRANS_CLASS = "1106"
IRMC_SYNC_CMD_CLASS = "1107"
HEADSET_CLASS = "1108"
CORDLESS_TELEPHONY_CLASS = "1109"
AUDIO_SOURCE_CLASS = "110a"
AUDIO_SINK_CLASS = "110b"
AV_REMOTE_TARGET_CLASS = "110c"
ADVANCED_AUDIO_CLASS = "110d"
AV_REMOTE_CLASS = "110e"
VIDEO_CONF_CLASS = "110f"
INTERCOM_CLASS = "1110"
FAX_CLASS = "1111"
HEADSET_AGW_CLASS = "1112"
WAP_CLASS = "1113"
WAP_CLIENT_CLASS = "1114"
PANU_CLASS = "1115"
NAP_CLASS = "1116"
GN_CLASS = "1117"
DIRECT_PRINTING_CLASS = "1118"
REFERENCE_PRINTING_CLASS = "1119"
IMAGING_CLASS = "111a"
IMAGING_RESPONDER_CLASS = "111b"
IMAGING_ARCHIVE_CLASS = "111c"
IMAGING_REFOBJS_CLASS = "111d"
HANDSFREE_CLASS = "111e"
HANDSFREE_AGW_CLASS = "111f"
DIRECT_PRT_REFOBJS_CLASS = "1120"
REFLECTED_UI_CLASS = "1121"
BASIC_PRINTING_CLASS = "1122"
PRINTING_STATUS_CLASS = "1123"
HID_CLASS = "1124"
HCR_CLASS = "1125"
HCR_PRINT_CLASS = "1126"
HCR_SCAN_CLASS = "1127"
CIP_CLASS = "1128"
VIDEO_CONF_GW_CLASS = "1129"
UDI_MT_CLASS = "112a"
UDI_TA_CLASS = "112b"
AV_CLASS = "112c"
SAP_CLASS = "112d"
PNP_INFO_CLASS = "1200"
GENERIC_NETWORKING_CLASS = "1201"
GENERIC_FILETRANS_CLASS = "1202"
GENERIC_AUDIO_CLASS = "1203"
GENERIC_TELEPHONY_CLASS = "1204"
UPNP_CLASS = "1205"
UPNP_IP_CLASS = "1206"
UPNP_PAN_CLASS = "1300"
UPNP_LAP_CLASS = "1301"
UPNP_L2CAP_CLASS = "1302"
VIDEO_SOURCE_CLASS = "1303"
VIDEO_SINK_CLASS = "1304"
# Bluetooth Profile Descriptors
SDP_SERVER_PROFILE = ( SDP_SERVER_CLASS, 0x0100)
BROWSE_GRP_DESC_PROFILE = ( BROWSE_GRP_DESC_CLASS, 0x0100)
SERIAL_PORT_PROFILE = ( SERIAL_PORT_CLASS, 0x0100)
LAN_ACCESS_PROFILE = ( LAN_ACCESS_CLASS, 0x0100)
DIALUP_NET_PROFILE = ( DIALUP_NET_CLASS, 0x0100)
IRMC_SYNC_PROFILE = ( IRMC_SYNC_CLASS, 0x0100)
OBEX_OBJPUSH_PROFILE = ( OBEX_OBJPUSH_CLASS, 0x0100)
OBEX_FILETRANS_PROFILE = ( OBEX_FILETRANS_CLASS, 0x0100)
IRMC_SYNC_CMD_PROFILE = ( IRMC_SYNC_CMD_CLASS, 0x0100)
HEADSET_PROFILE = ( HEADSET_CLASS, 0x0100)
CORDLESS_TELEPHONY_PROFILE = ( CORDLESS_TELEPHONY_CLASS, 0x0100)
AUDIO_SOURCE_PROFILE = ( AUDIO_SOURCE_CLASS, 0x0100)
AUDIO_SINK_PROFILE = ( AUDIO_SINK_CLASS, 0x0100)
AV_REMOTE_TARGET_PROFILE = ( AV_REMOTE_TARGET_CLASS, 0x0100)
ADVANCED_AUDIO_PROFILE = ( ADVANCED_AUDIO_CLASS, 0x0100)
AV_REMOTE_PROFILE = ( AV_REMOTE_CLASS, 0x0100)
VIDEO_CONF_PROFILE = ( VIDEO_CONF_CLASS, 0x0100)
INTERCOM_PROFILE = ( INTERCOM_CLASS, 0x0100)
FAX_PROFILE = ( FAX_CLASS, 0x0100)
HEADSET_AGW_PROFILE = ( HEADSET_AGW_CLASS, 0x0100)
WAP_PROFILE = ( WAP_CLASS, 0x0100)
WAP_CLIENT_PROFILE = ( WAP_CLIENT_CLASS, 0x0100)
PANU_PROFILE = ( PANU_CLASS, 0x0100)
NAP_PROFILE = ( NAP_CLASS, 0x0100)
GN_PROFILE = ( GN_CLASS, 0x0100)
DIRECT_PRINTING_PROFILE = ( DIRECT_PRINTING_CLASS, 0x0100)
REFERENCE_PRINTING_PROFILE = ( REFERENCE_PRINTING_CLASS, 0x0100)
IMAGING_PROFILE = ( IMAGING_CLASS, 0x0100)
IMAGING_RESPONDER_PROFILE = ( IMAGING_RESPONDER_CLASS, 0x0100)
IMAGING_ARCHIVE_PROFILE = ( IMAGING_ARCHIVE_CLASS, 0x0100)
IMAGING_REFOBJS_PROFILE = ( IMAGING_REFOBJS_CLASS, 0x0100)
HANDSFREE_PROFILE = ( HANDSFREE_CLASS, 0x0100)
HANDSFREE_AGW_PROFILE = ( HANDSFREE_AGW_CLASS, 0x0100)
DIRECT_PRT_REFOBJS_PROFILE = ( DIRECT_PRT_REFOBJS_CLASS, 0x0100)
REFLECTED_UI_PROFILE = ( REFLECTED_UI_CLASS, 0x0100)
BASIC_PRINTING_PROFILE = ( BASIC_PRINTING_CLASS, 0x0100)
PRINTING_STATUS_PROFILE = ( PRINTING_STATUS_CLASS, 0x0100)
HID_PROFILE = ( HID_CLASS, 0x0100)
HCR_PROFILE = ( HCR_SCAN_CLASS, 0x0100)
HCR_PRINT_PROFILE = ( HCR_PRINT_CLASS, 0x0100)
HCR_SCAN_PROFILE = ( HCR_SCAN_CLASS, 0x0100)
CIP_PROFILE = ( CIP_CLASS, 0x0100)
VIDEO_CONF_GW_PROFILE = ( VIDEO_CONF_GW_CLASS, 0x0100)
UDI_MT_PROFILE = ( UDI_MT_CLASS, 0x0100)
UDI_TA_PROFILE = ( UDI_TA_CLASS, 0x0100)
AV_PROFILE = ( AV_CLASS, 0x0100)
SAP_PROFILE = ( SAP_CLASS, 0x0100)
PNP_INFO_PROFILE = ( PNP_INFO_CLASS, 0x0100)
GENERIC_NETWORKING_PROFILE = ( GENERIC_NETWORKING_CLASS, 0x0100)
GENERIC_FILETRANS_PROFILE = ( GENERIC_FILETRANS_CLASS, 0x0100)
GENERIC_AUDIO_PROFILE = ( GENERIC_AUDIO_CLASS, 0x0100)
GENERIC_TELEPHONY_PROFILE = ( GENERIC_TELEPHONY_CLASS, 0x0100)
UPNP_PROFILE = ( UPNP_CLASS, 0x0100)
UPNP_IP_PROFILE = ( UPNP_IP_CLASS, 0x0100)
UPNP_PAN_PROFILE = ( UPNP_PAN_CLASS, 0x0100)
UPNP_LAP_PROFILE = ( UPNP_LAP_CLASS, 0x0100)
UPNP_L2CAP_PROFILE = ( UPNP_L2CAP_CLASS, 0x0100)
VIDEO_SOURCE_PROFILE = ( VIDEO_SOURCE_CLASS, 0x0100)
VIDEO_SINK_PROFILE = ( VIDEO_SINK_CLASS, 0x0100)
# Universal Service Attribute IDs
SERVICE_RECORD_HANDLE_ATTRID = 0x0000
SERVICE_CLASS_ID_LIST_ATTRID = 0x0001
SERVICE_RECORD_STATE_ATTRID = 0x0002
SERVICE_ID_ATTRID = 0x0003
PROTOCOL_DESCRIPTOR_LIST_ATTRID = 0x0004
BROWSE_GROUP_LIST_ATTRID = 0x0005
LANGUAGE_BASE_ATTRID_LIST_ATTRID = 0x0006
SERVICE_INFO_TIME_TO_LIVE_ATTRID = 0x0007
SERVICE_AVAILABILITY_ATTRID = 0x0008
BLUETOOTH_PROFILE_DESCRIPTOR_LIST_ATTRID = 0x0009
DOCUMENTATION_URL_ATTRID = 0x000a
CLIENT_EXECUTABLE_URL_ATTRID = 0x000b
ICON_URL_ATTRID = 0x000c
SERVICE_NAME_ATTRID = 0x0100
SERVICE_DESCRIPTION_ATTRID = 0x0101
PROVIDER_NAME_ATTRID = 0x0102
# Protocol UUIDs
SDP_UUID = "0001"
UDP_UUID = "0002"
RFCOMM_UUID = "0003"
TCP_UUID = "0004"
TCS_BIN_UUID = "0005"
TCS_AT_UUID = "0006"
OBEX_UUID = "0008"
IP_UUID = "0009"
FTP_UUID = "000a"
HTTP_UUID = "000c"
WSP_UUID = "000e"
BNEP_UUID = "000f"
UPNP_UUID = "0010"
HIDP_UUID = "0011"
HCRP_CTRL_UUID = "0012"
HCRP_DATA_UUID = "0014"
HCRP_NOTE_UUID = "0016"
AVCTP_UUID = "0017"
AVDTP_UUID = "0019"
CMTP_UUID = "001b"
UDI_UUID = "001d"
L2CAP_UUID = "0100"
class BluetoothError (IOError):
pass
def is_valid_address (s):
"""
returns True if address is a valid Bluetooth address
valid address are always strings of the form XX:XX:XX:XX:XX:XX
where X is a hexadecimal character. For example,
01:23:45:67:89:AB is a valid address, but
IN:VA:LI:DA:DD:RE is not
"""
try:
pairs = s.split (":")
if len (pairs) != 6: return False
for b in pairs: int (b, 16)
except:
return False
return True
def is_valid_uuid (uuid):
"""
is_valid_uuid (uuid) -> bool
returns True if uuid is a valid 128-bit UUID.
valid UUIDs are always strings taking one of the following forms:
XXXX
XXXXXXXX
XXXXXXXX-XXXX-XXXX-XXXX-XXXXXXXXXXXX
where each X is a hexadecimal digit (case insensitive)
"""
try:
if len (uuid) == 4:
if int (uuid, 16) < 0: return False
elif len (uuid) == 8:
if int (uuid, 16) < 0: return False
elif len (uuid) == 36:
pieces = uuid.split ("-")
if len (pieces) != 5 or \
len (pieces[0]) != 8 or \
len (pieces[1]) != 4 or \
len (pieces[2]) != 4 or \
len (pieces[3]) != 4 or \
len (pieces[4]) != 12:
return False
[ int (p, 16) for p in pieces ]
else:
return False
except ValueError:
return False
except TypeError:
return False
return True
def to_full_uuid (uuid):
"""
converts a short 16-bit or 32-bit reserved UUID to a full 128-bit Bluetooth
UUID.
"""
if not is_valid_uuid (uuid): raise ValueError ("invalid UUID")
if len (uuid) == 4:
return "0000%s-0000-1000-8000-00805F9B34FB" % uuid
elif len (uuid) == 8:
return "%s-0000-1000-8000-00805F9B34FB" % uuid
else:
return uuid
# =============== parsing and constructing raw SDP records ============
def sdp_parse_size_desc (data):
dts = struct.unpack ("B", data[0:1])[0]
dtype, dsizedesc = dts >> 3, dts & 0x7
dstart = 1
if dtype == 0: dsize = 0
elif dsizedesc == 0: dsize = 1
elif dsizedesc == 1: dsize = 2
elif dsizedesc == 2: dsize = 4
elif dsizedesc == 3: dsize = 8
elif dsizedesc == 4: dsize = 16
elif dsizedesc == 5:
dsize = struct.unpack ("B", data[1:2])[0]
dstart += 1
elif dsizedesc == 6:
dsize = struct.unpack ("!H", data[1:3])[0]
dstart += 2
elif dsizedesc == 7:
dsize == struct.unpack ("!I", data[1:5])[0]
dstart += 4
if dtype > 8:
raise ValueError ("Invalid TypeSizeDescriptor byte %s %d, %d" \
% (binascii.hexlify (data[0:1]), dtype, dsizedesc))
return dtype, dsize, dstart
def sdp_parse_uuid (data, size):
if size == 2:
return binascii.hexlify (data)
elif size == 4:
return binascii.hexlify (data)
elif size == 16:
return "%08X-%04X-%04X-%04X-%04X%08X" % struct.unpack ("!IHHHHI", data)
else: return ValueError ("invalid UUID size")
def sdp_parse_int (data, size, signed):
fmts = { 1 : "!b" , 2 : "!h" , 4 : "!i" , 8 : "!q" , 16 : "!qq" }
fmt = fmts[size]
if not signed: fmt = fmt.upper ()
if fmt in [ "!qq", "!QQ" ]:
upp, low = struct.unpack ("!QQ", data)
result = ( upp << 64) | low
if signed:
result=- ((~ (result-1))&0x7FFFFFFFFFFFFFFFFFFFFFFFFFFFFFFF)
return result
else:
return struct.unpack (fmt, data)[0]
def sdp_parse_data_elementSequence (data):
result = []
pos = 0
datalen = len (data)
while pos < datalen:
rtype, rval, consumed = sdp_parse_data_element (data[pos:])
pos += consumed
result.append ( (rtype, rval))
return result
def sdp_parse_data_element (data):
dtype, dsize, dstart = sdp_parse_size_desc (data)
elem = data[dstart:dstart+dsize]
if dtype == 0:
rtype, rval = "Nil", None
elif dtype == 1:
rtype, rval = "UInt%d"% (dsize*8), sdp_parse_int (elem, dsize, False)
elif dtype == 2:
rtype, rval = "SInt%d"% (dsize*8), sdp_parse_int (elem, dsize, True)
elif dtype == 3:
rtype, rval = "UUID", sdp_parse_uuid (elem, dsize)
elif dtype == 4:
rtype, rval = "String", elem
elif dtype == 5:
rtype, rval = "Bool", (struct.unpack ("B", elem)[0] != 0)
elif dtype == 6:
rtype, rval = "ElemSeq", sdp_parse_data_elementSequence (elem)
elif dtype == 7:
rtype, rval = "AltElemSeq", sdp_parse_data_elementSequence (elem)
elif dtype == 8:
rtype, rval = "URL", elem
return rtype, rval, dstart+dsize
def sdp_parse_raw_record (data):
dtype, dsize, dstart = sdp_parse_size_desc (data)
assert dtype == 6
pos = dstart
datalen = len (data)
record = {}
while pos < datalen:
type, attrid, consumed = sdp_parse_data_element (data[pos:])
assert type == "UInt16"
pos += consumed
type, attrval, consumed = sdp_parse_data_element (data[pos:])
pos += consumed
record[attrid] = attrval
return record
def sdp_make_data_element (type, value):
def maketsd (tdesc, sdesc):
return struct.pack ("B", (tdesc << 3) | sdesc)
def maketsdl (tdesc, size):
if size < (1<<8): return struct.pack ("!BB", tdesc << 3 | 5, size)
elif size < (1<<16): return struct.pack ("!BH", tdesc << 3 | 6, size)
else: return struct.pack ("!BI", tdesc << 3 | 7, size)
easyinttypes = { "UInt8" : (1, 0, "!B"), "UInt16" : (1, 1, "!H"),
"UInt32" : (1, 2, "!I"), "UInt64" : (1, 3, "!Q"),
"SInt8" : (2, 0, "!b"), "SInt16" : (2, 1, "!h"),
"SInt32" : (2, 2, "!i"), "SInt64" : (2, 3, "!q"),
}
if type == "Nil":
return maketsd (0, 0)
elif type in easyinttypes:
tdesc, sdesc, fmt = easyinttypes[type]
return maketsd (tdesc, sdesc) + struct.pack (fmt, value)
elif type == "UInt128":
ts = maketsd (1, 4)
upper = ts >> 64
lower = (ts & 0xFFFFFFFFFFFFFFFF)
return ts + struct.pack ("!QQ", upper, lower)
elif type == "SInt128":
ts = maketsd (2, 4)
# FIXME
raise NotImplementedException ("128-bit signed int NYI!")
elif type == "UUID":
if len (value) == 4:
return maketsd (3, 1) + binascii.unhexlify (value)
elif len (value) == 8:
return maketsd (3, 2) + binascii.unhexlify (value)
elif len (value) == 36:
return maketsd (3, 4) + binascii.unhexlify (value.replace ("-",""))
elif type == "String":
return maketsdl (4, len (value)) + str.encode(value)
elif type == "Bool":
return maketsd (5,0) + (value and "\x01" or "\x00")
elif type == "ElemSeq":
packedseq = bytes()
for subtype, subval in value:
nextelem = sdp_make_data_element (subtype, subval)
packedseq = packedseq + nextelem
return maketsdl (6, len (packedseq)) + packedseq
elif type == "AltElemSeq":
packedseq = bytes()
for subtype, subval in value:
packedseq = packedseq + sdp_make_data_element (subtype, subval)
return maketsdl (7, len (packedseq)) + packedseq
elif type == "URL":
return maketsdl (8, len (value)) + value
else:
raise ValueError ("invalid type %s" % type)