1 | // [License]
|
---|
2 | // The Ariba-Underlay Copyright
|
---|
3 | //
|
---|
4 | // Copyright (c) 2008-2009, Institute of Telematics, UniversitÀt Karlsruhe (TH)
|
---|
5 | //
|
---|
6 | // Institute of Telematics
|
---|
7 | // UniversitÀt Karlsruhe (TH)
|
---|
8 | // Zirkel 2, 76128 Karlsruhe
|
---|
9 | // Germany
|
---|
10 | //
|
---|
11 | // Redistribution and use in source and binary forms, with or without
|
---|
12 | // modification, are permitted provided that the following conditions are
|
---|
13 | // met:
|
---|
14 | //
|
---|
15 | // 1. Redistributions of source code must retain the above copyright
|
---|
16 | // notice, this list of conditions and the following disclaimer.
|
---|
17 | // 2. Redistributions in binary form must reproduce the above copyright
|
---|
18 | // notice, this list of conditions and the following disclaimer in the
|
---|
19 | // documentation and/or other materials provided with the distribution.
|
---|
20 | //
|
---|
21 | // THIS SOFTWARE IS PROVIDED BY THE INSTITUTE OF TELEMATICS ``AS IS'' AND
|
---|
22 | // ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
---|
23 | // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
---|
24 | // PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE ARIBA PROJECT OR
|
---|
25 | // CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
---|
26 | // EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
---|
27 | // PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
---|
28 | // PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
---|
29 | // LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
---|
30 | // NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
---|
31 | // SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
---|
32 | //
|
---|
33 | // The views and conclusions contained in the software and documentation
|
---|
34 | // are those of the authors and should not be interpreted as representing
|
---|
35 | // official policies, either expressed or implied, of the Institute of
|
---|
36 | // Telematics.
|
---|
37 | // [License]
|
---|
38 |
|
---|
39 | #include "BluetoothSdp.h"
|
---|
40 |
|
---|
41 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
42 |
|
---|
43 | // Attribute descriptors for SDP
|
---|
44 | // base was chosen randomly
|
---|
45 | #define SDP_SPOVNET_BASE 0x4000
|
---|
46 | #define SDP_ATTR_SPOVNET_NAME 0x0000 + SDP_SPOVNET_BASE
|
---|
47 | #define SDP_ATTR_SPOVNET_INFO1 0x0001 + SDP_SPOVNET_BASE
|
---|
48 | #define SDP_ATTR_SPOVNET_INFO2 0x0002 + SDP_SPOVNET_BASE
|
---|
49 | #define SDP_ATTR_SPOVNET_INFO3 0x0003 + SDP_SPOVNET_BASE
|
---|
50 |
|
---|
51 | // The SpoVNet unique identifier, this should be the same for all SpoVNet implementations
|
---|
52 | const uint8_t svc_uuid_int[] = {0x59, 0x29, 0x24, 0x34, 0x69, 0x42, 0x11, 0xde, 0x94,
|
---|
53 | 0x3e, 0x00, 0x21, 0x5d, 0xb4, 0xd8, 0x54};
|
---|
54 |
|
---|
55 | const char *service_name = "SpoVNet";
|
---|
56 | const char *svc_dsc = "www.ariba-underlay.org";
|
---|
57 | const char *service_prov = "ITM Uni Karlsruhe";
|
---|
58 |
|
---|
59 | #endif // HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
60 |
|
---|
61 |
|
---|
62 | namespace ariba {
|
---|
63 | namespace utility {
|
---|
64 | use_logging_cpp(BluetoothSdp);
|
---|
65 |
|
---|
66 | BluetoothSdp::BluetoothSdp(BootstrapInformationCallback* _callback) :
|
---|
67 | BootstrapModule(_callback), scan_timer_(io_service_) {
|
---|
68 | srand( time(NULL) );
|
---|
69 | found = false;
|
---|
70 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
71 |
|
---|
72 | // This can be ignored, as the channel we really be saved in one
|
---|
73 | // of the info strings (as an attribute)
|
---|
74 | channel_ = 1;
|
---|
75 |
|
---|
76 | #endif // HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
77 | }
|
---|
78 |
|
---|
79 | BluetoothSdp::~BluetoothSdp() {
|
---|
80 | }
|
---|
81 |
|
---|
82 | string BluetoothSdp::getName() {
|
---|
83 | return "BluetoothSdp";
|
---|
84 | }
|
---|
85 |
|
---|
86 | string BluetoothSdp::getInformation() {
|
---|
87 | return "bootstrap module based on bluetooth service discovery protocol";
|
---|
88 | }
|
---|
89 |
|
---|
90 | bool BluetoothSdp::isFunctional() {
|
---|
91 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
92 | return true;
|
---|
93 | #else
|
---|
94 | return false;
|
---|
95 | #endif
|
---|
96 | }
|
---|
97 |
|
---|
98 | void BluetoothSdp::start() {
|
---|
99 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
100 |
|
---|
101 | /*
|
---|
102 | * Initializes and forks the scanner.
|
---|
103 | */
|
---|
104 |
|
---|
105 | io_service_.post(boost::bind(&BluetoothSdp::bt_scan, this));
|
---|
106 | t_ = boost::thread(boost::bind(&boost::asio::io_service::run, &io_service_));
|
---|
107 |
|
---|
108 | #endif // HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
109 | }
|
---|
110 |
|
---|
111 | void BluetoothSdp::stop() {
|
---|
112 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
113 |
|
---|
114 | /*
|
---|
115 | * Stops the scanner.
|
---|
116 | */
|
---|
117 |
|
---|
118 | // not sure if this is thread safe
|
---|
119 | io_service_.stop();
|
---|
120 | t_.join();
|
---|
121 |
|
---|
122 | if(sdp_session_ != NULL)
|
---|
123 | sdp_close(sdp_session_);
|
---|
124 |
|
---|
125 | #endif // HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
126 | }
|
---|
127 |
|
---|
128 | void BluetoothSdp::publishService(string name, string info1, string info2,
|
---|
129 | string info3) {
|
---|
130 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
131 |
|
---|
132 | /*
|
---|
133 | * Publishes an SpoVNet SDP Service and
|
---|
134 | * adds the arguments as info attributes.
|
---|
135 | */
|
---|
136 |
|
---|
137 | logging_debug("registering SDP service");
|
---|
138 |
|
---|
139 | uint8_t rfcomm_channel = channel_;
|
---|
140 |
|
---|
141 | uuid_t root_uuid, l2cap_uuid, rfcomm_uuid, svc_uuid, svc_class_uuid;
|
---|
142 | sdp_list_t *l2cap_list = 0, *rfcomm_list = 0, *root_list = 0, *proto_list =
|
---|
143 | 0, *access_proto_list = 0, *svc_class_list = 0, *profile_list = 0;
|
---|
144 | sdp_data_t *channel = 0;
|
---|
145 | sdp_profile_desc_t profile;
|
---|
146 | sdp_record_t record = {0};
|
---|
147 | sdp_session_ = 0;
|
---|
148 |
|
---|
149 | if((name.length() > 256) || (info1.length() > 256) || (info2.length() > 256) || (info3.length() > 256)) {
|
---|
150 | logging_error("string argument too long, max size is 256");
|
---|
151 | return;
|
---|
152 | }
|
---|
153 |
|
---|
154 | // prepare the info attribute buffers
|
---|
155 | //string namebuf, info1buf, info2buf, info3buf;
|
---|
156 | uint8_t namelen, info1len, info2len, info3len;
|
---|
157 |
|
---|
158 | namelen = (uint8_t)name.length();
|
---|
159 | info1len = (uint8_t)info1.length();
|
---|
160 | info2len = (uint8_t)info2.length();
|
---|
161 | info3len = (uint8_t)info3.length();
|
---|
162 |
|
---|
163 | // set the general service ID
|
---|
164 | sdp_uuid128_create(&svc_uuid, &svc_uuid_int);
|
---|
165 | sdp_set_service_id(&record, svc_uuid);
|
---|
166 |
|
---|
167 | // set the service class
|
---|
168 | sdp_uuid16_create(&svc_class_uuid, SERIAL_PORT_SVCLASS_ID);
|
---|
169 | svc_class_list = sdp_list_append(0, &svc_class_uuid);
|
---|
170 | sdp_set_service_classes(&record, svc_class_list);
|
---|
171 |
|
---|
172 | // set the Bluetooth profile information
|
---|
173 | sdp_uuid16_create(&profile.uuid, SERIAL_PORT_PROFILE_ID);
|
---|
174 | profile.version = 0x0100;
|
---|
175 | profile_list = sdp_list_append(0, &profile);
|
---|
176 | sdp_set_profile_descs(&record, profile_list);
|
---|
177 |
|
---|
178 | // make the service record publicly browsable
|
---|
179 | sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
|
---|
180 | root_list = sdp_list_append(0, &root_uuid);
|
---|
181 | sdp_set_browse_groups(&record, root_list);
|
---|
182 |
|
---|
183 | // set l2cap informatiint argc, char* argv[]on
|
---|
184 | sdp_uuid16_create(&l2cap_uuid, L2CAP_UUID);
|
---|
185 | l2cap_list = sdp_list_append(0, &l2cap_uuid);
|
---|
186 | proto_list = sdp_list_append(0, l2cap_list);
|
---|
187 |
|
---|
188 | // register the RFCOMM channel for RFCOMM sockets
|
---|
189 | sdp_uuid16_create(&rfcomm_uuid, RFCOMM_UUID);
|
---|
190 | channel = sdp_data_alloc(SDP_UINT8, &rfcomm_channel);
|
---|
191 | rfcomm_list = sdp_list_append(0, &rfcomm_uuid);
|
---|
192 | sdp_list_append(rfcomm_list, channel);
|
---|
193 | sdp_list_append(proto_list, rfcomm_list);
|
---|
194 |
|
---|
195 | access_proto_list = sdp_list_append(0, proto_list);
|
---|
196 | sdp_set_access_protos(&record, access_proto_list);
|
---|
197 |
|
---|
198 | // set the name, provider, and description
|
---|
199 | sdp_set_info_attr(&record, service_name, service_prov, svc_dsc);
|
---|
200 |
|
---|
201 | // add the spovnet attributes
|
---|
202 | sdp_attr_add_new(&record, SDP_ATTR_SPOVNET_NAME, SDP_TEXT_STR8,
|
---|
203 | name.data());
|
---|
204 |
|
---|
205 | sdp_attr_add_new(&record, SDP_ATTR_SPOVNET_INFO1, SDP_TEXT_STR8,
|
---|
206 | info1.data());
|
---|
207 |
|
---|
208 | sdp_attr_add_new(&record, SDP_ATTR_SPOVNET_INFO2, SDP_TEXT_STR8,
|
---|
209 | info2.data());
|
---|
210 |
|
---|
211 | sdp_attr_add_new(&record, SDP_ATTR_SPOVNET_INFO3, SDP_TEXT_STR8,
|
---|
212 | info3.data());
|
---|
213 |
|
---|
214 | // connect to the local SDP server, register the service record
|
---|
215 | if( sdp_session_ == NULL ){
|
---|
216 | sdp_session_ = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, SDP_RETRY_IF_BUSY);
|
---|
217 | }
|
---|
218 |
|
---|
219 | if (sdp_session_ == NULL) {
|
---|
220 | logging_error( "something is wrong with your SDP server, nothing registered: " << strerror(errno) );
|
---|
221 | } else {
|
---|
222 | int ret = sdp_record_register(sdp_session_, &record, 0);
|
---|
223 |
|
---|
224 | if(ret < 0){
|
---|
225 | logging_error("failed registering sdp record: " << strerror(errno));
|
---|
226 | }else{
|
---|
227 | logging_debug("sdp record registered using session " << sdp_session_);
|
---|
228 | }
|
---|
229 | }
|
---|
230 |
|
---|
231 | // cleanup
|
---|
232 | sdp_data_free(channel);
|
---|
233 | sdp_list_free(l2cap_list, 0);
|
---|
234 | sdp_list_free(rfcomm_list, 0);
|
---|
235 | sdp_list_free(root_list, 0);
|
---|
236 | sdp_list_free(access_proto_list, 0);
|
---|
237 | sdp_list_free(svc_class_list, 0);
|
---|
238 | sdp_list_free(profile_list, 0);
|
---|
239 |
|
---|
240 | #endif // HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
241 | }
|
---|
242 |
|
---|
243 | void BluetoothSdp::revokeService(string name) {
|
---|
244 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
245 |
|
---|
246 | logging_debug("unregistering SDP service");
|
---|
247 | sdp_close(sdp_session_);
|
---|
248 |
|
---|
249 | #endif // HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
250 | }
|
---|
251 |
|
---|
252 | #ifdef HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
253 |
|
---|
254 | void BluetoothSdp::bt_scan() {
|
---|
255 | /*
|
---|
256 | * Scans for other bluetooth devices and starts a SDP search on them.
|
---|
257 | */
|
---|
258 |
|
---|
259 | logging_debug("scanning for peers");
|
---|
260 |
|
---|
261 | inquiry_info *ii = NULL;
|
---|
262 | int max_rsp, num_rsp;
|
---|
263 | int dev_id, sock, len, flags;
|
---|
264 | int i;
|
---|
265 |
|
---|
266 | bdaddr_t address;
|
---|
267 | uint8_t channel;
|
---|
268 |
|
---|
269 | dev_id = hci_get_route(NULL);
|
---|
270 | sock = hci_open_dev(dev_id);
|
---|
271 | if (dev_id < 0 || sock < 0) {
|
---|
272 | logging_error("opening socket for device "
|
---|
273 | << dev_id << " failed. can not scan for peers: " << strerror(errno));
|
---|
274 | return;
|
---|
275 | }
|
---|
276 |
|
---|
277 | len = 8;
|
---|
278 | max_rsp = 255;
|
---|
279 | flags = IREQ_CACHE_FLUSH;
|
---|
280 | ii = (inquiry_info*) malloc(max_rsp * sizeof(inquiry_info));
|
---|
281 |
|
---|
282 | num_rsp = hci_inquiry(dev_id, len, max_rsp, NULL, &ii, flags);
|
---|
283 | if (num_rsp < 0)
|
---|
284 | logging_error("hci_inquiry failed with " << num_rsp << ": " << strerror(errno));
|
---|
285 |
|
---|
286 | for (i = 0; i < num_rsp; i++) {
|
---|
287 | address = (ii + i)->bdaddr;
|
---|
288 |
|
---|
289 | string saddress = ba2string(&address);
|
---|
290 | string sname = ba2name(&address, sock);
|
---|
291 |
|
---|
292 | logging_debug("found peer [" << saddress << "] [" << sname << "]");
|
---|
293 | sdp_search( address, sname );
|
---|
294 | }
|
---|
295 |
|
---|
296 | free(ii);
|
---|
297 | close(sock);
|
---|
298 |
|
---|
299 | if(!found){
|
---|
300 | int nextscan = (rand() % 30) + 5;
|
---|
301 | logging_debug("next sdp scan in " << nextscan << " seconds");
|
---|
302 |
|
---|
303 |
|
---|
304 | scan_timer_.expires_from_now( boost::posix_time::seconds(nextscan) );
|
---|
305 | scan_timer_.async_wait( boost::bind(&BluetoothSdp::bt_scan, this) );
|
---|
306 | }
|
---|
307 | }
|
---|
308 |
|
---|
309 | void BluetoothSdp::sdp_search(bdaddr_t target, string devicename) {
|
---|
310 |
|
---|
311 | /*
|
---|
312 | * Searches target for SDP records with the SpoVnet uuid
|
---|
313 | * and extracts its info attributes.
|
---|
314 | */
|
---|
315 |
|
---|
316 | int status;
|
---|
317 | uuid_t svc_uuid;
|
---|
318 | sdp_list_t *response_list, *search_list, *attrid_list;
|
---|
319 | sdp_session_t *session = NULL;
|
---|
320 | uint32_t range = 0x0000ffff;
|
---|
321 | uint8_t port = 0;
|
---|
322 |
|
---|
323 | // connect to the SDP server running on the remote machine
|
---|
324 | logging_debug("querying services from bt device ["
|
---|
325 | << ba2string(&target) << "] [" << devicename << "]");
|
---|
326 |
|
---|
327 | // prepare the buffers for the attributes
|
---|
328 | char name[256], info1[256], info2[256], info3[256];
|
---|
329 |
|
---|
330 | session = sdp_connect(BDADDR_ANY, &target, SDP_RETRY_IF_BUSY);
|
---|
331 |
|
---|
332 | if (session == NULL) {
|
---|
333 | logging_error("failed to connect to SDP server at "
|
---|
334 | << ba2string(&target) << ": " << strerror(errno));
|
---|
335 | return;
|
---|
336 | }
|
---|
337 |
|
---|
338 | sdp_uuid128_create(&svc_uuid, &svc_uuid_int);
|
---|
339 | search_list = sdp_list_append(0, &svc_uuid);
|
---|
340 | attrid_list = sdp_list_append(0, &range);
|
---|
341 |
|
---|
342 | // get a list of service records that have UUID uuid_
|
---|
343 | response_list = NULL;
|
---|
344 | status = sdp_service_search_attr_req(session, search_list,
|
---|
345 | SDP_ATTR_REQ_RANGE, attrid_list, &response_list);
|
---|
346 |
|
---|
347 | if (status == 0) {
|
---|
348 | sdp_list_t *proto_list = NULL;
|
---|
349 | sdp_list_t *r = response_list;
|
---|
350 |
|
---|
351 | // go through each of the service records
|
---|
352 | for ( ; r != NULL; r = r->next) {
|
---|
353 | sdp_record_t *rec = (sdp_record_t*) r->data;
|
---|
354 |
|
---|
355 | // get a list of the protocol sequences
|
---|
356 | if (sdp_get_access_protos(rec, &proto_list) == 0) {
|
---|
357 |
|
---|
358 | // get the RFCOMM port number
|
---|
359 | port = sdp_get_proto_port(proto_list, RFCOMM_UUID);
|
---|
360 |
|
---|
361 | sdp_list_free(proto_list, 0);
|
---|
362 |
|
---|
363 | sdp_get_string_attr(rec, SDP_ATTR_SPOVNET_NAME, (char*)&name, 256);
|
---|
364 | sdp_get_string_attr(rec, SDP_ATTR_SPOVNET_INFO1, (char*)&info1, 256);
|
---|
365 | sdp_get_string_attr(rec, SDP_ATTR_SPOVNET_INFO2, (char*)&info2, 256);
|
---|
366 | sdp_get_string_attr(rec, SDP_ATTR_SPOVNET_INFO3, (char*)&info3, 256);
|
---|
367 |
|
---|
368 | logging_info("Remote peer name is: " << name);
|
---|
369 | logging_info("Remote peer info1 is: " << info1);
|
---|
370 | logging_info("Remote peer info2 is: " << info2);
|
---|
371 | logging_info("Remote peer info3 is: " << info3);
|
---|
372 |
|
---|
373 | // Callback
|
---|
374 | found = true;
|
---|
375 | callback->onBootstrapServiceFound(name, info1, info2, info3);
|
---|
376 | }
|
---|
377 | sdp_record_free(rec);
|
---|
378 | }
|
---|
379 | } else {
|
---|
380 | logging_error("sdp_service_search_attr_req failed with timeout: " << strerror(errno));
|
---|
381 | }
|
---|
382 |
|
---|
383 | sdp_list_free(response_list, 0);
|
---|
384 | sdp_list_free(search_list, 0);
|
---|
385 | sdp_list_free(attrid_list, 0);
|
---|
386 | sdp_close(session);
|
---|
387 | }
|
---|
388 |
|
---|
389 | string BluetoothSdp::ba2string(bdaddr_t* ba) {
|
---|
390 | /*
|
---|
391 | * Returns a string holding the bt adress in human readable form.
|
---|
392 | */
|
---|
393 | char addr[32] = { 0 };
|
---|
394 | char str[32] = { 0 };
|
---|
395 | ba2str(ba, str);
|
---|
396 | string result = str;
|
---|
397 | return result;
|
---|
398 | }
|
---|
399 |
|
---|
400 | string BluetoothSdp::ba2name(bdaddr_t* ba, int sock){
|
---|
401 |
|
---|
402 | char name[256] = {0};
|
---|
403 | memset(name, 0, sizeof(name));
|
---|
404 |
|
---|
405 | if( hci_read_remote_name(sock, ba, sizeof(name), name, 0) < 0 )
|
---|
406 | strcpy(name, "unknown");
|
---|
407 |
|
---|
408 | string result = name;
|
---|
409 | return result;
|
---|
410 | }
|
---|
411 |
|
---|
412 | #endif // HAVE_BLUETOOTH_BLUETOOTH_H
|
---|
413 |
|
---|
414 | }} //namespace ariba, utility
|
---|