-
Notifications
You must be signed in to change notification settings - Fork 121
/
test-hfp
executable file
·246 lines (190 loc) · 5.57 KB
/
test-hfp
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
#!/usr/bin/python
from __future__ import absolute_import, print_function, unicode_literals
from gi.repository import GObject
import os
import sys
import dbus
import glib
import dbus.service
import dbus.mainloop.glib
from optparse import OptionParser, make_option
from socket import SOCK_SEQPACKET, socket
mainloop = None
audio_supported = True
try:
from socket import AF_BLUETOOTH, BTPROTO_SCO
except:
print("WARNING: python compiled without Bluetooth support"
" - audio will not be available")
audio_supported = False
BUF_SIZE = 1024
BDADDR_ANY = '00:00:00:00:00:00'
HF_NREC = 0x0001
HF_3WAY = 0x0002
HF_CLI = 0x0004
HF_VOICE_RECOGNITION = 0x0008
HF_REMOTE_VOL = 0x0010
HF_ENHANCED_STATUS = 0x0020
HF_ENHANCED_CONTROL = 0x0040
HF_CODEC_NEGOTIATION = 0x0080
AG_3WAY = 0x0001
AG_NREC = 0x0002
AG_VOICE_RECOGNITION = 0x0004
AG_INBAND_RING = 0x0008
AG_VOICE_TAG = 0x0010
AG_REJECT_CALL = 0x0020
AG_ENHANCED_STATUS = 0x0040
AG_ENHANCED_CONTROL = 0x0080
AG_EXTENDED_RESULT = 0x0100
AG_CODEC_NEGOTIATION = 0x0200
HF_FEATURES = (HF_3WAY | HF_CLI | HF_VOICE_RECOGNITION |
HF_REMOTE_VOL | HF_ENHANCED_STATUS |
HF_ENHANCED_CONTROL | HF_CODEC_NEGOTIATION)
AVAIL_CODECS = "1,2"
class HfpConnection:
slc_complete = False
fd = None
io_id = 0
version = 0
features = 0
pending = None
def disconnect(self):
if (self.fd >= 0):
os.close(self.fd)
self.fd = -1
glib.source_remove(self.io_id)
self.io_id = 0
def slc_completed(self):
print("SLC establisment complete")
self.slc_complete = True
def slc_next_cmd(self, cmd):
if not cmd:
self.send_cmd("AT+BRSF=%u" % (HF_FEATURES))
elif (cmd.startswith("AT+BRSF")):
if (self.features & AG_CODEC_NEGOTIATION and
HF_FEATURES & HF_CODEC_NEGOTIATION):
self.send_cmd("AT+BAC=%s" % (AVAIL_CODECS))
else:
self.send_cmd("AT+CIND=?")
elif (cmd.startswith("AT+BAC")):
self.send_cmd("AT+CIND=?")
elif (cmd.startswith("AT+CIND=?")):
self.send_cmd("AT+CIND?")
elif (cmd.startswith("AT+CIND?")):
self.send_cmd("AT+CMER=3,0,0,1")
elif (cmd.startswith("AT+CMER=")):
if (HF_FEATURES & HF_3WAY and self.features & AG_3WAY):
self.send_cmd("AT+CHLD=?")
else:
self.slc_completed()
elif (cmd.startswith("AT+CHLD=?")):
self.slc_completed()
else:
print("Unknown SLC command completed: %s" % (cmd))
def io_cb(self, fd, cond):
buf = os.read(fd, BUF_SIZE)
buf = buf.strip()
print("Received: %s" % (buf))
if (buf == "OK" or buf == "ERROR"):
cmd = self.pending
self.pending = None
if (not self.slc_complete):
self.slc_next_cmd(cmd)
return True
parts = buf.split(':')
if (parts[0] == "+BRSF"):
self.features = int(parts[1])
return True
def send_cmd(self, cmd):
if (self.pending):
print("ERROR: Another command is pending")
return
print("Sending: %s" % (cmd))
os.write(self.fd, cmd + "\r\n")
self.pending = cmd
def __init__(self, fd, version, features):
self.fd = fd
self.version = version
self.features = features
print("Version 0x%04x Features 0x%04x" % (version, features))
self.io_id = glib.io_add_watch(fd, glib.IO_IN, self.io_cb)
self.slc_next_cmd(None)
class HfpProfile(dbus.service.Object):
sco_socket = None
io_id = 0
conns = {}
def sco_cb(self, sock, cond):
(sco, peer) = sock.accept()
print("New SCO connection from %s" % (peer))
def init_sco(self, sock):
self.sco_socket = sock
self.io_id = glib.io_add_watch(sock, glib.IO_IN, self.sco_cb)
def __init__(self, bus, path, sco):
dbus.service.Object.__init__(self, bus, path)
if sco:
self.init_sco(sco)
@dbus.service.method("org.bluez.Profile1",
in_signature="", out_signature="")
def Release(self):
print("Release")
mainloop.quit()
@dbus.service.method("org.bluez.Profile1",
in_signature="", out_signature="")
def Cancel(self):
print("Cancel")
@dbus.service.method("org.bluez.Profile1",
in_signature="o", out_signature="")
def RequestDisconnection(self, path):
conn = self.conns.pop(path)
conn.disconnect()
@dbus.service.method("org.bluez.Profile1",
in_signature="oha{sv}", out_signature="")
def NewConnection(self, path, fd, properties):
fd = fd.take()
version = 0x0105
features = 0
print("NewConnection(%s, %d)" % (path, fd))
for key in properties.keys():
if key == "Version":
version = properties[key]
elif key == "Features":
features = properties[key]
conn = HfpConnection(fd, version, features)
self.conns[path] = conn
if __name__ == '__main__':
dbus.mainloop.glib.DBusGMainLoop(set_as_default=True)
bus = dbus.SystemBus()
manager = dbus.Interface(bus.get_object("org.bluez",
"/org/bluez"), "org.bluez.ProfileManager1")
option_list = [
make_option("-p", "--path", action="store",
type="string", dest="path",
default="/bluez/test/hfp"),
make_option("-n", "--name", action="store",
type="string", dest="name",
default=None),
make_option("-C", "--channel", action="store",
type="int", dest="channel",
default=None),
]
parser = OptionParser(option_list=option_list)
(options, args) = parser.parse_args()
mainloop = GObject.MainLoop()
opts = {
"Version" : dbus.UInt16(0x0106),
"Features" : dbus.UInt16(HF_FEATURES),
}
if (options.name):
opts["Name"] = options.name
if (options.channel is not None):
opts["Channel"] = dbus.UInt16(options.channel)
if audio_supported:
sco = socket(AF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_SCO)
sco.bind(BDADDR_ANY)
sco.listen(1)
else:
sco = None
profile = HfpProfile(bus, options.path, sco)
manager.RegisterProfile(options.path, "hfp-hf", opts)
print("Profile registered - waiting for connections")
mainloop.run()