| /* |
| * |
| * BlueZ - Bluetooth protocol stack for Linux |
| * |
| * Copyright (C) 2002-2003 Maxim Krasnyansky <maxk@qualcomm.com> |
| * Copyright (C) 2002-2008 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 <syslog.h> |
| #include <sys/types.h> |
| #include <sys/socket.h> |
| |
| #include <bluetooth/bluetooth.h> |
| #include <bluetooth/sdp.h> |
| #include <bluetooth/sdp_lib.h> |
| #include <bluetooth/bnep.h> |
| |
| #include "pand.h" |
| |
| static sdp_record_t *record; |
| static sdp_session_t *session; |
| |
| void bnep_sdp_unregister(void) |
| { |
| if (record && sdp_record_unregister(session, record)) |
| syslog(LOG_ERR, "Service record unregistration failed."); |
| |
| sdp_close(session); |
| } |
| |
| static void add_lang_attr(sdp_record_t *r) |
| { |
| sdp_lang_attr_t base_lang; |
| sdp_list_t *langs = 0; |
| |
| /* UTF-8 MIBenum (http://www.iana.org/assignments/character-sets) */ |
| base_lang.code_ISO639 = (0x65 << 8) | 0x6e; |
| base_lang.encoding = 106; |
| base_lang.base_offset = SDP_PRIMARY_LANG_BASE; |
| langs = sdp_list_append(0, &base_lang); |
| sdp_set_lang_attr(r, langs); |
| sdp_list_free(langs, 0); |
| } |
| |
| int bnep_sdp_register(bdaddr_t *device, uint16_t role) |
| { |
| sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto; |
| uuid_t root_uuid, pan, l2cap, bnep; |
| sdp_profile_desc_t profile[1]; |
| sdp_list_t *proto[2]; |
| sdp_data_t *v, *p; |
| uint16_t psm = 15, version = 0x0100; |
| uint16_t security_desc = 0; |
| uint16_t net_access_type = 0xfffe; |
| uint32_t max_net_access_rate = 0; |
| char *name = "BlueZ PAN"; |
| char *desc = "BlueZ PAN Service"; |
| int status; |
| |
| session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0); |
| if (!session) { |
| syslog(LOG_ERR, "Failed to connect to the local SDP server. %s(%d)", |
| strerror(errno), errno); |
| return -1; |
| } |
| |
| record = sdp_record_alloc(); |
| if (!record) { |
| syslog(LOG_ERR, "Failed to allocate service record %s(%d)", |
| strerror(errno), errno); |
| sdp_close(session); |
| return -1; |
| } |
| |
| sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP); |
| root = sdp_list_append(NULL, &root_uuid); |
| sdp_set_browse_groups(record, root); |
| sdp_list_free(root, 0); |
| |
| sdp_uuid16_create(&l2cap, L2CAP_UUID); |
| proto[0] = sdp_list_append(NULL, &l2cap); |
| p = sdp_data_alloc(SDP_UINT16, &psm); |
| proto[0] = sdp_list_append(proto[0], p); |
| apseq = sdp_list_append(NULL, proto[0]); |
| |
| sdp_uuid16_create(&bnep, BNEP_UUID); |
| proto[1] = sdp_list_append(NULL, &bnep); |
| v = sdp_data_alloc(SDP_UINT16, &version); |
| proto[1] = sdp_list_append(proto[1], v); |
| |
| /* Supported protocols */ |
| { |
| uint16_t ptype[4] = { |
| 0x0800, /* IPv4 */ |
| 0x0806, /* ARP */ |
| }; |
| sdp_data_t *head, *pseq; |
| int p; |
| |
| for (p = 0, head = NULL; p < 2; p++) { |
| sdp_data_t *data = sdp_data_alloc(SDP_UINT16, &ptype[p]); |
| if (head) |
| sdp_seq_append(head, data); |
| else |
| head = data; |
| } |
| pseq = sdp_data_alloc(SDP_SEQ16, head); |
| proto[1] = sdp_list_append(proto[1], pseq); |
| } |
| |
| apseq = sdp_list_append(apseq, proto[1]); |
| |
| aproto = sdp_list_append(NULL, apseq); |
| sdp_set_access_protos(record, aproto); |
| |
| add_lang_attr(record); |
| |
| sdp_list_free(proto[0], NULL); |
| sdp_list_free(proto[1], NULL); |
| sdp_list_free(apseq, NULL); |
| sdp_list_free(aproto, NULL); |
| sdp_data_free(p); |
| sdp_data_free(v); |
| sdp_attr_add_new(record, SDP_ATTR_SECURITY_DESC, SDP_UINT16, &security_desc); |
| |
| switch (role) { |
| case BNEP_SVC_NAP: |
| sdp_uuid16_create(&pan, NAP_SVCLASS_ID); |
| svclass = sdp_list_append(NULL, &pan); |
| sdp_set_service_classes(record, svclass); |
| |
| sdp_uuid16_create(&profile[0].uuid, NAP_PROFILE_ID); |
| profile[0].version = 0x0100; |
| pfseq = sdp_list_append(NULL, &profile[0]); |
| sdp_set_profile_descs(record, pfseq); |
| |
| sdp_set_info_attr(record, "Network Access Point", name, desc); |
| |
| sdp_attr_add_new(record, SDP_ATTR_NET_ACCESS_TYPE, SDP_UINT16, &net_access_type); |
| sdp_attr_add_new(record, SDP_ATTR_MAX_NET_ACCESSRATE, SDP_UINT32, &max_net_access_rate); |
| break; |
| |
| case BNEP_SVC_GN: |
| sdp_uuid16_create(&pan, GN_SVCLASS_ID); |
| svclass = sdp_list_append(NULL, &pan); |
| sdp_set_service_classes(record, svclass); |
| |
| sdp_uuid16_create(&profile[0].uuid, GN_PROFILE_ID); |
| profile[0].version = 0x0100; |
| pfseq = sdp_list_append(NULL, &profile[0]); |
| sdp_set_profile_descs(record, pfseq); |
| |
| sdp_set_info_attr(record, "Group Network Service", name, desc); |
| break; |
| |
| case BNEP_SVC_PANU: |
| sdp_uuid16_create(&pan, PANU_SVCLASS_ID); |
| svclass = sdp_list_append(NULL, &pan); |
| sdp_set_service_classes(record, svclass); |
| sdp_list_free(svclass, 0); |
| |
| sdp_uuid16_create(&profile[0].uuid, PANU_PROFILE_ID); |
| profile[0].version = 0x0100; |
| pfseq = sdp_list_append(NULL, &profile[0]); |
| sdp_set_profile_descs(record, pfseq); |
| sdp_list_free(pfseq, 0); |
| |
| sdp_set_info_attr(record, "PAN User", name, desc); |
| break; |
| } |
| |
| status = sdp_device_record_register(session, device, record, 0); |
| if (status) { |
| syslog(LOG_ERR, "SDP registration failed."); |
| sdp_record_free(record); record = NULL; |
| sdp_close(session); |
| return -1; |
| } |
| |
| return 0; |
| } |
| |
| /* Search for PAN service. |
| * Returns 1 if service is found and 0 otherwise. */ |
| int bnep_sdp_search(bdaddr_t *src, bdaddr_t *dst, uint16_t service) |
| { |
| sdp_list_t *srch, *rsp = NULL; |
| sdp_session_t *s; |
| uuid_t svclass; |
| int err; |
| |
| switch (service) { |
| case BNEP_SVC_PANU: |
| sdp_uuid16_create(&svclass, PANU_SVCLASS_ID); |
| break; |
| case BNEP_SVC_NAP: |
| sdp_uuid16_create(&svclass, NAP_SVCLASS_ID); |
| break; |
| case BNEP_SVC_GN: |
| sdp_uuid16_create(&svclass, GN_SVCLASS_ID); |
| break; |
| } |
| |
| srch = sdp_list_append(NULL, &svclass); |
| |
| s = sdp_connect(src, dst, 0); |
| if (!s) { |
| syslog(LOG_ERR, "Failed to connect to the SDP server. %s(%d)", |
| strerror(errno), errno); |
| return 0; |
| } |
| |
| err = sdp_service_search_req(s, srch, 1, &rsp); |
| sdp_close(s); |
| |
| /* Assume that search is successeful |
| * if at least one record is found */ |
| if (!err && sdp_list_len(rsp)) |
| return 1; |
| |
| return 0; |
| } |