1dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann/* 2dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * 3dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * BlueZ - Bluetooth protocol stack for Linux 4dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * 55592142cb9383df0556b27ac59e96547b380310bJohan Hedberg * Copyright (C) 2006-2010 Nokia Corporation 69184e2eeb7b97371c6b83b747c8984e2340d2b47Marcel Holtmann * Copyright (C) 2004-2010 Marcel Holtmann <marcel@holtmann.org> 7dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * 8dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * 9dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * This program is free software; you can redistribute it and/or modify 10dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * it under the terms of the GNU General Public License as published by 11dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * the Free Software Foundation; either version 2 of the License, or 12dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * (at your option) any later version. 13dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * 14dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * This program is distributed in the hope that it will be useful, 15dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * but WITHOUT ANY WARRANTY; without even the implied warranty of 16dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * GNU General Public License for more details. 18dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * 19dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * You should have received a copy of the GNU General Public License 20dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * along with this program; if not, write to the Free Software 21dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA 22dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann * 23dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann */ 24dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann 25dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann#ifdef HAVE_CONFIG_H 26dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann#include <config.h> 27dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann#endif 28dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann 29dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann#include <stdio.h> 30dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann#include <stdlib.h> 315d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi#include <unistd.h> 32f8f494cb4880fa6a3f8b641bf6676acfce659753Johan Hedberg#include <fcntl.h> 336a3ea0f9f9aa9dd550f9f2af4a36639961846643Marcel Holtmann#include <sys/stat.h> 341e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg#include <sys/ioctl.h> 351af86fb9d1717a27b3a776fc0fb62c96045ccb9aJohan Hedberg#include <errno.h> 36dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann 37dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann#include <bluetooth/bluetooth.h> 38a278db781a26c639267b1d88d5fbe08f99af6c61Elvis Pfützenreuter#include <bluetooth/uuid.h> 395d5d89bb2dbc295443900d59d8a7172dc2f279c7Claudio Takahasi#include <bluetooth/sdp.h> 405d5d89bb2dbc295443900d59d8a7172dc2f279c7Claudio Takahasi#include <bluetooth/sdp_lib.h> 41dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann 4286892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann#include <glib.h> 4386892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann#include <dbus/dbus.h> 4415ea15b3a752f0487bc50d0ea04925f1b9d33dcbMarcel Holtmann#include <gdbus.h> 4586892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 46e891f7df6225c758da0d95f7554c6cc67f72f31eGustavo F. Padovan#include "log.h" 476a3ea0f9f9aa9dd550f9f2af4a36639961846643Marcel Holtmann#include "textfile.h" 48dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann 49d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario#include "att.h" 50506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi#include "hcid.h" 512c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes#include "adapter.h" 5286892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann#include "device.h" 53da0e7105811dc046d13d0365404efc1189ee4a8cClaudio Takahasi#include "dbus-common.h" 5416d507e0bb939b1c98f9d5ab14c656339757b878Johan Hedberg#include "event.h" 557fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz#include "error.h" 563d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz#include "glib-helper.h" 575399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi#include "gattrib.h" 585399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi#include "gatt.h" 59fb27732e05fb7b69c3b784ed8a6aaed2d9d939aeCidorvan Leite#include "agent.h" 603d3cdef8da6b3e1b14c3cdccda8c099cbad4f3aeMarcel Holtmann#include "sdp-xml.h" 61506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi#include "storage.h" 6296762463061ffbe566c7f8916d230b4190ec3b6fJohan Hedberg#include "btio.h" 6342d618a69af838356edc566d124b39c405da9495Jaikumar Ganesh#include "../attrib/client.h" 6486892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 655d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi#define DISCONNECT_TIMER 2 667ec871d37de442fd3731a0eef319851c61fb04ccLuiz Augusto von Dentz#define DISCOVERY_TIMER 2 67dfc20857eb381b464b8fd6efdaac59e4a15f5d6dMarcel Holtmann 680948c4c0e87f2a4179320e903123acbb296935f6Claudio Takahasi/* When all services should trust a remote device */ 690948c4c0e87f2a4179320e903123acbb296935f6Claudio Takahasi#define GLOBAL_TRUST "[all]" 700948c4c0e87f2a4179320e903123acbb296935f6Claudio Takahasi 718d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentzstruct btd_disconnect_data { 728d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz guint id; 738d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz disconnect_watch watch; 748d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz void *user_data; 758d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz GDestroyNotify destroy; 768d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz}; 778d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 782aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzstruct bonding_req { 792aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusConnection *conn; 802aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusMessage *msg; 812aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz GIOChannel *io; 822aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz guint listener_id; 832aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device; 842aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz}; 852aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 862aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzstruct authentication_req { 872aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz auth_type_t type; 882aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz void *cb; 892aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct agent *agent; 902aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device; 912aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz}; 922aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 93a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentzstruct browse_req { 94a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBusConnection *conn; 95a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBusMessage *msg; 965399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi GAttrib *attrib; 97a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz struct btd_device *device; 98a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz GSList *match_uuids; 99a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz GSList *profiles_added; 100a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz GSList *profiles_removed; 101a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz sdp_list_t *records; 102a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz int search_uuid; 103a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz int reconnect_attempt; 104a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz guint listener_id; 105a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz}; 106a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 107555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsodestruct btd_device { 108cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bdaddr_t bdaddr; 109f1beea3e80b6e02f49eeea926d398366b13d291cClaudio Takahasi device_type_t type; 110ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode gchar *path; 11108fef64ca40b85782a0de1c1fd098934355b5e24Johan Hedberg char name[MAX_NAME_LENGTH + 1]; 11248a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz char *alias; 11318614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter; 114ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode GSList *uuids; 115b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes GSList *services; /* Primary services path */ 11683d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes GSList *primaries; /* List of primary services */ 117521006ef7b0737739e4e2c66564ed458a348f566Claudio Takahasi GSList *drivers; /* List of device drivers */ 1188d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz GSList *watches; /* List of disconnect_data */ 119ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode gboolean temporary; 120ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode struct agent *agent; 121ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode guint disconn_timer; 122013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg guint discov_timer; 123a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz struct browse_req *browse; /* service discover request */ 1242aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct bonding_req *bonding; 1252aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct authentication_req *authr; /* authentication request */ 126c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz GSList *disconnects; /* disconnects message */ 127ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode 128bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg gboolean connected; 129e21ec2652c54dbc8abbf84039b43fbd3be0b5ebcJohan Hedberg 130548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg sdp_list_t *tmp_records; 131bcb6af7fc78234948ba1c997825c8859464b170bJohan Hedberg 1326da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz gboolean trusted; 1336fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg gboolean paired; 1341e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg gboolean blocked; 1353e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy gboolean bonded; 136837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg 137837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg gboolean authorizing; 1380ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz gint ref; 139ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode}; 140ea245383ac6650cbf34c327ed095d956b84ac5fbAlok Barsode 141d69e08eb0d567b61106ca37e0546402f4ae0c34eMarcel Holtmannstatic uint16_t uuid_list[] = { 1420dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg L2CAP_UUID, 1431c284b3ba427638179d936286f4c4866fff99e28Luiz Augusto von Dentz PNP_INFO_SVCLASS_ID, 1440dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg PUBLIC_BROWSE_GROUP, 145d69e08eb0d567b61106ca37e0546402f4ae0c34eMarcel Holtmann 0 146d69e08eb0d567b61106ca37e0546402f4ae0c34eMarcel Holtmann}; 147d69e08eb0d567b61106ca37e0546402f4ae0c34eMarcel Holtmann 148c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentzstatic GSList *device_drivers = NULL; 149c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz 150a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentzstatic void browse_request_free(struct browse_req *req) 151a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz{ 152a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (req->listener_id) 153a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_dbus_remove_watch(req->conn, req->listener_id); 154a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (req->msg) 155a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_unref(req->msg); 156a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (req->conn) 157a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_connection_unref(req->conn); 1582499fb1f1775b8afcb374ba3aefc0c5484e78fa4Johan Hedberg if (req->device) 1592499fb1f1775b8afcb374ba3aefc0c5484e78fa4Johan Hedberg btd_device_unref(req->device); 160a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_slist_foreach(req->profiles_added, (GFunc) g_free, NULL); 161a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_slist_free(req->profiles_added); 162a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_slist_free(req->profiles_removed); 163a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (req->records) 164a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz sdp_list_free(req->records, (sdp_free_func_t) sdp_record_free); 1655399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 1661b0d082bf58143aaad02a819037989fddc6c6b95Vinicius Costa Gomes if (req->attrib) 1675399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi g_attrib_unref(req->attrib); 1685399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 169a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_free(req); 170a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz} 171a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 172a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentzstatic void browse_request_cancel(struct browse_req *req) 173a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz{ 174a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz struct btd_device *device = req->device; 175a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz struct btd_adapter *adapter = device->adapter; 176a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz bdaddr_t src; 177a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 1783d8bdaa95b00ee42ecea513ba8d72772c6ffa075Johan Hedberg if (device_is_creating(device, NULL)) 1793d8bdaa95b00ee42ecea513ba8d72772c6ffa075Johan Hedberg device_set_temporary(device, TRUE); 1803d8bdaa95b00ee42ecea513ba8d72772c6ffa075Johan Hedberg 181a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz adapter_get_address(adapter, &src); 182a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 1835c36b74c0b43ae0532e26c03b6ce8a1abba7d874Claudio Takahasi bt_cancel_discovery(&src, &device->bdaddr); 184a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 185a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz device->browse = NULL; 1862499fb1f1775b8afcb374ba3aefc0c5484e78fa4Johan Hedberg browse_request_free(req); 187a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz} 188a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 189e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasistatic void device_free(gpointer user_data) 19086892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann{ 191555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = user_data; 1922f9fbeeb5931cda983aa72ed9a53b1f22d0aa85dLuiz Augusto von Dentz struct btd_adapter *adapter = device->adapter; 1932f9fbeeb5931cda983aa72ed9a53b1f22d0aa85dLuiz Augusto von Dentz struct agent *agent = adapter_get_agent(adapter); 194e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi 195fb27732e05fb7b69c3b784ed8a6aaed2d9d939aeCidorvan Leite if (device->agent) 196cc35f24a2a728c4e8c31ea0c6c11c6b701901861Johan Hedberg agent_free(device->agent); 197f62f8d892b5d5cc5aedef83779671c1ed54a35daMarcel Holtmann 198929f754fbd780a7e36463fc335f145ed6109ca51Johan Hedberg if (agent && (agent_is_busy(agent, device) || 199929f754fbd780a7e36463fc335f145ed6109ca51Johan Hedberg agent_is_busy(agent, device->authr))) 2002f9fbeeb5931cda983aa72ed9a53b1f22d0aa85dLuiz Augusto von Dentz agent_cancel(agent); 2012f9fbeeb5931cda983aa72ed9a53b1f22d0aa85dLuiz Augusto von Dentz 202b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes g_slist_foreach(device->services, (GFunc) g_free, NULL); 203b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes g_slist_free(device->services); 204b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes 205ea00a446dbacead62040dd2bd7e663774c205c04Claudio Takahasi g_slist_foreach(device->uuids, (GFunc) g_free, NULL); 206ea00a446dbacead62040dd2bd7e663774c205c04Claudio Takahasi g_slist_free(device->uuids); 207f62f8d892b5d5cc5aedef83779671c1ed54a35daMarcel Holtmann 20883d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes g_slist_foreach(device->primaries, (GFunc) g_free, NULL); 20983d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes g_slist_free(device->primaries); 21083d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes 2114bec43039626e853489e72149014868f8c8afedcJohan Hedberg if (device->tmp_records) 2124bec43039626e853489e72149014868f8c8afedcJohan Hedberg sdp_list_free(device->tmp_records, 2134bec43039626e853489e72149014868f8c8afedcJohan Hedberg (sdp_free_func_t) sdp_record_free); 2144bec43039626e853489e72149014868f8c8afedcJohan Hedberg 2155d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi if (device->disconn_timer) 2165d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi g_source_remove(device->disconn_timer); 2175d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi 21832c90b2a21d936d3881a71c137441e4cb7dd1901Luiz Augusto von Dentz if (device->discov_timer) 21932c90b2a21d936d3881a71c137441e4cb7dd1901Luiz Augusto von Dentz g_source_remove(device->discov_timer); 22032c90b2a21d936d3881a71c137441e4cb7dd1901Luiz Augusto von Dentz 2210f775bfff64dc5e073b3bd098c296da4660aa072Luiz Augusto von Dentz DBG("%p", device); 2220ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 223929f754fbd780a7e36463fc335f145ed6109ca51Johan Hedberg g_free(device->authr); 22486892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann g_free(device->path); 22548a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz g_free(device->alias); 22686892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann g_free(device); 22786892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann} 22886892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 229fee17aefe6b727ec790568aa4994039ff94bf44eJohan Hedberggboolean device_is_paired(struct btd_device *device) 230769c4b021665a26c9a6c20457ef9b7ded54c8ad6Luiz Augusto von Dentz{ 2316fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg return device->paired; 232769c4b021665a26c9a6c20457ef9b7ded54c8ad6Luiz Augusto von Dentz} 233769c4b021665a26c9a6c20457ef9b7ded54c8ad6Luiz Augusto von Dentz 2346da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentzgboolean device_is_trusted(struct btd_device *device) 2356da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz{ 2366da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz return device->trusted; 2376da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz} 2386da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz 239e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasistatic DBusMessage *get_properties(DBusConnection *conn, 240e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi DBusMessage *msg, void *user_data) 2412c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes{ 242555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = user_data; 24318614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter = device->adapter; 2444e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz DBusMessage *reply; 2454e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz DBusMessageIter iter; 2464e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz DBusMessageIter dict; 247cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bdaddr_t src; 24808fef64ca40b85782a0de1c1fd098934355b5e24Johan Hedberg char name[MAX_NAME_LENGTH + 1], srcaddr[18], dstaddr[18]; 249b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes char **str; 2502a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode const char *ptr; 2514e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz dbus_bool_t boolean; 2524e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz uint32_t class; 253769c4b021665a26c9a6c20457ef9b7ded54c8ad6Luiz Augusto von Dentz int i; 254769c4b021665a26c9a6c20457ef9b7ded54c8ad6Luiz Augusto von Dentz GSList *l; 2554e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 256cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&device->bdaddr, dstaddr); 257cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode 2584e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz reply = dbus_message_new_method_return(msg); 2594e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz if (!reply) 260e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi return NULL; 2614e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 2624e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz dbus_message_iter_init_append(reply, &iter); 2634e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 2644e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY, 2654e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING 2664e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz DBUS_TYPE_STRING_AS_STRING DBUS_TYPE_VARIANT_AS_STRING 2674e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict); 2684e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 2694e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz /* Address */ 270cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ptr = dstaddr; 2711262c4767c74f084d37c84bec778513f3d862a3eJohan Hedberg dict_append_entry(&dict, "Address", DBUS_TYPE_STRING, &ptr); 2724e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 2734e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz /* Name */ 274506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi ptr = NULL; 275506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi memset(name, 0, sizeof(name)); 2762a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode adapter_get_address(adapter, &src); 277cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&src, srcaddr); 2788a68b5fe931db5a432f924b0de22ed3acee024baClaudio Takahasi 2794d0426730e110b82b1e2d94d62ce57e4fa1b8382Johan Hedberg ptr = device->name; 2804d0426730e110b82b1e2d94d62ce57e4fa1b8382Johan Hedberg dict_append_entry(&dict, "Name", DBUS_TYPE_STRING, &ptr); 2814e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 282afda5bee3495e4fe070cf59e2f240127c341faf4Marcel Holtmann /* Alias (fallback to name or address) */ 28348a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz if (device->alias != NULL) 28448a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz ptr = device->alias; 28548a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz else if (strlen(ptr) == 0) { 28648a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz g_strdelimit(dstaddr, ":", '-'); 28748a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz ptr = dstaddr; 28848a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz } 289506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi 2904d0426730e110b82b1e2d94d62ce57e4fa1b8382Johan Hedberg dict_append_entry(&dict, "Alias", DBUS_TYPE_STRING, &ptr); 291506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi 2924e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz /* Class */ 293cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode if (read_remote_class(&src, &device->bdaddr, &class) == 0) { 294e1a6c133d7a7fd2acf6d3462d200f47ff6124c1bMarcel Holtmann const char *icon = class_to_icon(class); 295e1a6c133d7a7fd2acf6d3462d200f47ff6124c1bMarcel Holtmann 2961262c4767c74f084d37c84bec778513f3d862a3eJohan Hedberg dict_append_entry(&dict, "Class", DBUS_TYPE_UINT32, &class); 297e1a6c133d7a7fd2acf6d3462d200f47ff6124c1bMarcel Holtmann 298e1a6c133d7a7fd2acf6d3462d200f47ff6124c1bMarcel Holtmann if (icon) 2991262c4767c74f084d37c84bec778513f3d862a3eJohan Hedberg dict_append_entry(&dict, "Icon", 300e1a6c133d7a7fd2acf6d3462d200f47ff6124c1bMarcel Holtmann DBUS_TYPE_STRING, &icon); 3014e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz } 3024e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 3034e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz /* Paired */ 304769c4b021665a26c9a6c20457ef9b7ded54c8ad6Luiz Augusto von Dentz boolean = device_is_paired(device); 3051262c4767c74f084d37c84bec778513f3d862a3eJohan Hedberg dict_append_entry(&dict, "Paired", DBUS_TYPE_BOOLEAN, &boolean); 3064e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 3074e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz /* Trusted */ 3086da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz boolean = device_is_trusted(device); 3091262c4767c74f084d37c84bec778513f3d862a3eJohan Hedberg dict_append_entry(&dict, "Trusted", DBUS_TYPE_BOOLEAN, &boolean); 3104e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 3111e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg /* Blocked */ 3121e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg boolean = device->blocked; 3131e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg dict_append_entry(&dict, "Blocked", DBUS_TYPE_BOOLEAN, &boolean); 3141e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 3154e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz /* Connected */ 316c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz dict_append_entry(&dict, "Connected", DBUS_TYPE_BOOLEAN, 317bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg &device->connected); 3184e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 319ba93fb91ea81a35be0834ac395650e020a6b3fd3Claudio Takahasi /* UUIDs */ 320b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes str = g_new0(char *, g_slist_length(device->uuids) + 1); 321769c4b021665a26c9a6c20457ef9b7ded54c8ad6Luiz Augusto von Dentz for (i = 0, l = device->uuids; l; l = l->next, i++) 322b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes str[i] = l->data; 323b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes dict_append_array(&dict, "UUIDs", DBUS_TYPE_STRING, &str, i); 324b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes g_free(str); 325b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes 326b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes /* Services */ 327b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes str = g_new0(char *, g_slist_length(device->services) + 1); 328b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes for (i = 0, l = device->services; l; l = l->next, i++) 329b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes str[i] = l->data; 330b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes dict_append_array(&dict, "Services", DBUS_TYPE_OBJECT_PATH, &str, i); 331b3d33e592dea372f4e58ed3cf2ad76e7e23aaa10Vinicius Costa Gomes g_free(str); 3324e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 33374fdac28eafca963c8081ea39dcf057459cf491aLuiz Augusto von Dentz /* Adapter */ 3348a68b5fe931db5a432f924b0de22ed3acee024baClaudio Takahasi ptr = adapter_get_path(adapter); 3351262c4767c74f084d37c84bec778513f3d862a3eJohan Hedberg dict_append_entry(&dict, "Adapter", DBUS_TYPE_OBJECT_PATH, &ptr); 33674fdac28eafca963c8081ea39dcf057459cf491aLuiz Augusto von Dentz 3374e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz dbus_message_iter_close_container(&iter, &dict); 3384e6726e8029f20be3e08b44760c56fc7a419090bLuiz Augusto von Dentz 339e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi return reply; 3402c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes} 3412c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes 342e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasistatic DBusMessage *set_alias(DBusConnection *conn, DBusMessage *msg, 3437fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz const char *alias, void *data) 3447fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz{ 345555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = data; 34618614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter = device->adapter; 347cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode char srcaddr[18], dstaddr[18]; 348cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bdaddr_t src; 349506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi int err; 3507fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 35148a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz /* No change */ 35248a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz if ((device->alias == NULL && g_str_equal(alias, "")) || 35348a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz g_strcmp0(device->alias, alias) == 0) 35448a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz return dbus_message_new_method_return(msg); 35548a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz 356cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode adapter_get_address(adapter, &src); 357cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&src, srcaddr); 358cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&device->bdaddr, dstaddr); 3592a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 360cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode /* Remove alias if empty string */ 361cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode err = write_device_alias(srcaddr, dstaddr, 362506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi g_str_equal(alias, "") ? NULL : alias); 363506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi if (err < 0) 36492a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan return btd_error_failed(msg, strerror(-err)); 3657fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 36648a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz g_free(device->alias); 36748a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz device->alias = g_str_equal(alias, "") ? NULL : g_strdup(alias); 36848a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz 369c0736ea762bfea95e98c8b9f118b4e5464f2159cJohan Hedberg emit_property_changed(conn, dbus_message_get_path(msg), 370c0736ea762bfea95e98c8b9f118b4e5464f2159cJohan Hedberg DEVICE_INTERFACE, "Alias", 371c0736ea762bfea95e98c8b9f118b4e5464f2159cJohan Hedberg DBUS_TYPE_STRING, &alias); 3727fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 373e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi return dbus_message_new_method_return(msg); 3747fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz} 3757fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 376e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasistatic DBusMessage *set_trust(DBusConnection *conn, DBusMessage *msg, 3776da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz gboolean value, void *data) 3787fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz{ 379555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = data; 38018614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter = device->adapter; 381cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode char srcaddr[18], dstaddr[18]; 382cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bdaddr_t src; 3836da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz int err; 3846da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz 3856da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz if (device->trusted == value) 3866da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz return dbus_message_new_method_return(msg); 3872a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 388cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode adapter_get_address(adapter, &src); 389cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&src, srcaddr); 390cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&device->bdaddr, dstaddr); 3912a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 3926da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz err = write_trust(srcaddr, dstaddr, GLOBAL_TRUST, value); 3936da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz if (err < 0) 39492a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan return btd_error_failed(msg, strerror(-err)); 3956da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz 3966da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz device->trusted = value; 3977fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 398c0736ea762bfea95e98c8b9f118b4e5464f2159cJohan Hedberg emit_property_changed(conn, dbus_message_get_path(msg), 399c0736ea762bfea95e98c8b9f118b4e5464f2159cJohan Hedberg DEVICE_INTERFACE, "Trusted", 400c0736ea762bfea95e98c8b9f118b4e5464f2159cJohan Hedberg DBUS_TYPE_BOOLEAN, &value); 4017fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 402e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi return dbus_message_new_method_return(msg); 4037fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz} 4047fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 405521006ef7b0737739e4e2c66564ed458a348f566Claudio Takahasistatic void driver_remove(struct btd_device_driver *driver, 4061e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg struct btd_device *device) 4071e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg{ 4081e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg driver->remove(device); 4091e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 410521006ef7b0737739e4e2c66564ed458a348f566Claudio Takahasi device->drivers = g_slist_remove(device->drivers, driver); 4111e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg} 4121e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4131e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedbergstatic gboolean do_disconnect(gpointer user_data) 4141e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg{ 4151e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg struct btd_device *device = user_data; 4161e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4171e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg device->disconn_timer = 0; 4181e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 419bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg btd_adapter_disconnect_device(device->adapter, &device->bdaddr); 4201e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4211e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return FALSE; 4221e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg} 4231e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4241e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedbergstatic int device_block(DBusConnection *conn, struct btd_device *device) 4251e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg{ 426885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg int err; 4271e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg bdaddr_t src; 4281e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4291e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (device->blocked) 4301e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return 0; 4311e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 432bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg if (device->connected) 4331e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg do_disconnect(device); 4341e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4351e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg g_slist_foreach(device->drivers, (GFunc) driver_remove, device); 4361e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 437885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg err = btd_adapter_block_address(device->adapter, &device->bdaddr); 438885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg if (err < 0) 4391e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return err; 4401e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4411e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg device->blocked = TRUE; 4421e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4431e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg adapter_get_address(device->adapter, &src); 4441e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4451e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg err = write_blocked(&src, &device->bdaddr, TRUE); 4461e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (err < 0) 4471e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg error("write_blocked(): %s (%d)", strerror(-err), -err); 4481e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4491e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg device_set_temporary(device, FALSE); 4501e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4511e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg emit_property_changed(conn, device->path, DEVICE_INTERFACE, "Blocked", 4521e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg DBUS_TYPE_BOOLEAN, &device->blocked); 4531e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4541e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return 0; 4551e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg} 4561e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 457e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadiusstatic int device_unblock(DBusConnection *conn, struct btd_device *device, 458e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius gboolean silent) 4591e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg{ 460885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg int err; 4611e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg bdaddr_t src; 4621e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4631e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (!device->blocked) 4641e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return 0; 4651e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 466885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg err = btd_adapter_unblock_address(device->adapter, &device->bdaddr); 467885c513fdf93404aa713ee6bf4ddb089b42dc5dfJohan Hedberg if (err < 0) 4681e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return err; 4691e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4701e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg device->blocked = FALSE; 4711e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4721e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg adapter_get_address(device->adapter, &src); 4731e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4741e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg err = write_blocked(&src, &device->bdaddr, FALSE); 4751e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (err < 0) 4761e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg error("write_blocked(): %s (%d)", strerror(-err), -err); 4771e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 478e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius if (!silent) { 479e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius emit_property_changed(conn, device->path, 480e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius DEVICE_INTERFACE, "Blocked", 4811e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg DBUS_TYPE_BOOLEAN, &device->blocked); 482e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius device_probe_drivers(device, device->uuids); 483e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius } 4841e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4851e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return 0; 4861e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg} 4871e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4881e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedbergstatic DBusMessage *set_blocked(DBusConnection *conn, DBusMessage *msg, 4891e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg gboolean value, void *data) 4901e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg{ 4911e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg struct btd_device *device = data; 4921e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg int err; 4931e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4941e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (value) 4951e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg err = device_block(conn, device); 4961e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg else 497e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius err = device_unblock(conn, device, FALSE); 4981e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 4991e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg switch (-err) { 5001e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg case 0: 5011e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return dbus_message_new_method_return(msg); 5021e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg case EINVAL: 50392a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan return btd_error_failed(msg, "Kernel lacks blacklist support"); 5041e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg default: 50592a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan return btd_error_failed(msg, strerror(-err)); 5061e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg } 5071e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg} 5081e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 509e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasistatic DBusMessage *set_property(DBusConnection *conn, 510e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi DBusMessage *msg, void *data) 5112c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes{ 5127fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz DBusMessageIter iter; 5137fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz DBusMessageIter sub; 5147fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz const char *property; 5157fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5167fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz if (!dbus_message_iter_init(msg, &iter)) 517696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 5187fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5197fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_STRING) 520696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 5217fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5227fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz dbus_message_iter_get_basic(&iter, &property); 5237fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz dbus_message_iter_next(&iter); 5247fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5257fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_VARIANT) 526696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 5277fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz dbus_message_iter_recurse(&iter, &sub); 5287fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5297fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz if (g_str_equal("Trusted", property)) { 5307fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz dbus_bool_t value; 5317fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz if (dbus_message_iter_get_arg_type(&sub) != DBUS_TYPE_BOOLEAN) 532696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 5337fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz dbus_message_iter_get_basic(&sub, &value); 5347fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5357fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz return set_trust(conn, msg, value, data); 5367fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz } else if (g_str_equal("Alias", property)) { 537506c95298346d318304aa7e2211dfba5dbe6e3e0Claudio Takahasi const char *alias; 5387fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5397fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz if (dbus_message_iter_get_arg_type(&sub) != DBUS_TYPE_STRING) 540696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 5417fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz dbus_message_iter_get_basic(&sub, &alias); 5427fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 5437fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz return set_alias(conn, msg, alias, data); 5441e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg } else if (g_str_equal("Blocked", property)) { 5451e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg dbus_bool_t value; 5461e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 5471e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (dbus_message_iter_get_arg_type(&sub) != DBUS_TYPE_BOOLEAN) 548696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 5491e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 5501e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg dbus_message_iter_get_basic(&sub, &value); 5511e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 5521e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg return set_blocked(conn, msg, value, data); 5537fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz } 5547fe6ac58638e86d11494f5a785bcf1d074ca2c37Luiz Augusto von Dentz 555696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 5562c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes} 5572c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes 5581f5107e65f9786bd6b84ecfb4d84691e9b34529aMarcel Holtmannstatic void discover_services_req_exit(DBusConnection *conn, void *user_data) 559342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz{ 560e8610fcbe0341a4879b8230d97cd27f5f8cf9f58Luiz Augusto von Dentz struct browse_req *req = user_data; 5612a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 5628e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("DiscoverServices requestor exited"); 563e8610fcbe0341a4879b8230d97cd27f5f8cf9f58Luiz Augusto von Dentz 564a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz browse_request_cancel(req); 565342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz} 566342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz 56794c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmannstatic DBusMessage *discover_services(DBusConnection *conn, 56894c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann DBusMessage *msg, void *user_data) 56994c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann{ 570555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = user_data; 57194c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann const char *pattern; 572342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz int err; 573342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz 574a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (device->browse) 575bd3cf4860d056d3044b7eb8a4e03c53934eb20a6Gustavo F. Padovan return btd_error_in_progress(msg); 57694c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann 57794c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann if (dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &pattern, 57894c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann DBUS_TYPE_INVALID) == FALSE) 579a78a0693a6ca2c927a7e88adbef8001f72a16ac1Gustavo F. Padovan return btd_error_invalid_args(msg); 58094c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann 581a6f07d2bf12942854072c37c3c42d7447921beeeMarcel Holtmann if (strlen(pattern) == 0) { 5827e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario err = device_browse_sdp(device, conn, msg, NULL, FALSE); 583342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz if (err < 0) 584342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz goto fail; 585342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz } else { 586040728e5019fce4eba5790939329fae0aa9104ffClaudio Takahasi uuid_t uuid; 587040728e5019fce4eba5790939329fae0aa9104ffClaudio Takahasi 588040728e5019fce4eba5790939329fae0aa9104ffClaudio Takahasi if (bt_string2uuid(&uuid, pattern) < 0) 589696c18c48f9648274c375a77a70a45f5f31053fbGustavo F. Padovan return btd_error_invalid_args(msg); 590a6f07d2bf12942854072c37c3c42d7447921beeeMarcel Holtmann 5914b1914903cb105acf843b84833e81d5470133879Johan Hedberg sdp_uuid128_to_uuid(&uuid); 5924b1914903cb105acf843b84833e81d5470133879Johan Hedberg 5937e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario err = device_browse_sdp(device, conn, msg, &uuid, FALSE); 594342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz if (err < 0) 595342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz goto fail; 596342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz } 59794c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann 59894c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann return NULL; 599342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz 600342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentzfail: 60192a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan return btd_error_failed(msg, strerror(-err)); 60294c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann} 60394c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann 604a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentzstatic const char *browse_request_get_requestor(struct browse_req *req) 605a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz{ 606a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (!req->msg) 607a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz return NULL; 608a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 609a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz return dbus_message_get_sender(req->msg); 610a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz} 611a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 612a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentzstatic void iter_append_record(DBusMessageIter *dict, uint32_t handle, 613a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz const char *record) 614a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz{ 615a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBusMessageIter entry; 616a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 617a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_iter_open_container(dict, DBUS_TYPE_DICT_ENTRY, 618a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz NULL, &entry); 619a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 620a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_iter_append_basic(&entry, DBUS_TYPE_UINT32, &handle); 621a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 622a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &record); 623a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 624a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_iter_close_container(dict, &entry); 625a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz} 626a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 627a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentzstatic void discover_services_reply(struct browse_req *req, int err, 628a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz sdp_list_t *recs) 629a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz{ 630a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBusMessage *reply; 631a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBusMessageIter iter, dict; 632a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz sdp_list_t *seq; 633a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 634a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (err) { 635a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz const char *err_if; 636a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 637a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (err == -EHOSTDOWN) 638a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz err_if = ERROR_INTERFACE ".ConnectionAttemptFailed"; 639a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz else 640a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz err_if = ERROR_INTERFACE ".Failed"; 641a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 642a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz reply = dbus_message_new_error(req->msg, err_if, 643a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz strerror(-err)); 644a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_dbus_send_message(req->conn, reply); 645a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz return; 646a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz } 647a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 648a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz reply = dbus_message_new_method_return(req->msg); 649a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (!reply) 650a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz return; 651a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 652a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_iter_init_append(reply, &iter); 653a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 654a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY, 655a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING 656a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBUS_TYPE_UINT32_AS_STRING DBUS_TYPE_STRING_AS_STRING 657a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict); 658a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 659a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz for (seq = recs; seq; seq = seq->next) { 660a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz sdp_record_t *rec = (sdp_record_t *) seq->data; 661a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz GString *result; 662a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 663a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (!rec) 664a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz break; 665a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 666a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz result = g_string_new(NULL); 667a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 668a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz convert_sdp_record_to_xml(rec, result, 669a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz (void *) g_string_append); 670a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 671a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (result->len) 672a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz iter_append_record(&dict, rec->handle, result->str); 673a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 674a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_string_free(result, TRUE); 675a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz } 676a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 677a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz dbus_message_iter_close_container(&iter, &dict); 678a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 679a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz g_dbus_send_message(req->conn, reply); 680a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz} 681a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 68294c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmannstatic DBusMessage *cancel_discover(DBusConnection *conn, 68394c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann DBusMessage *msg, void *user_data) 68494c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann{ 685555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = user_data; 6867c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg const char *sender = dbus_message_get_sender(msg); 687a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz const char *requestor; 6882a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 689a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (!device->browse) 6903df548164d179e08032c82b90cc56edbf83ef9bfGustavo F. Padovan return btd_error_does_not_exist(msg); 691342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz 692a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (!dbus_message_is_method_call(device->browse->msg, DEVICE_INTERFACE, 693a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz "DiscoverServices")) 694b7d1fc1f399e6ea445520b93961f3a11243d8b04Gustavo F. Padovan return btd_error_not_authorized(msg); 695342293a80657406a02003452e3a23d097dd9c73eLuiz Augusto von Dentz 696a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz requestor = browse_request_get_requestor(device->browse); 697a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 698a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz /* only the discover requestor can cancel the inquiry process */ 699a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz if (!requestor || !g_str_equal(requestor, sender)) 700b7d1fc1f399e6ea445520b93961f3a11243d8b04Gustavo F. Padovan return btd_error_not_authorized(msg); 701a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 702a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz discover_services_reply(device->browse, -ECANCELED, NULL); 703a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz 704a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz browse_request_cancel(device->browse); 70594c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann 70694c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann return dbus_message_new_method_return(msg); 70794c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann} 70894c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann 709c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentzstatic void bonding_request_cancel(struct bonding_req *bonding) 710c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz{ 711b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg struct btd_device *device = bonding->device; 712b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg struct btd_adapter *adapter = device->adapter; 713c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 714b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg adapter_cancel_bonding(adapter, &device->bdaddr); 715c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz} 716c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 717c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentzvoid device_request_disconnect(struct btd_device *device, DBusMessage *msg) 7188d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz{ 719c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz DBusConnection *conn = get_dbus_connection(); 720c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 721c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz if (device->bonding) 722c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz bonding_request_cancel(device->bonding); 723c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 72488386d8ee86158137eca2cc849f80136af12f635Claudio Takahasi if (device->browse) { 72588386d8ee86158137eca2cc849f80136af12f635Claudio Takahasi discover_services_reply(device->browse, -ECANCELED, NULL); 726c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz browse_request_cancel(device->browse); 72788386d8ee86158137eca2cc849f80136af12f635Claudio Takahasi } 728c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 729c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz if (msg) 730c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz device->disconnects = g_slist_append(device->disconnects, 731c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz dbus_message_ref(msg)); 732c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 733c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz if (device->disconn_timer) 734c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz return; 7358d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 736d5d0fa3be8f7a20d128dcbaf8fc529c38bc52395Johan Hedberg while (device->watches) { 737d5d0fa3be8f7a20d128dcbaf8fc529c38bc52395Johan Hedberg struct btd_disconnect_data *data = device->watches->data; 7388d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 7398d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz if (data->watch) 740a381d5342d27b99612fd31dc9cc80b01f412ad39Luiz Augusto von Dentz /* temporary is set if device is going to be removed */ 741a381d5342d27b99612fd31dc9cc80b01f412ad39Luiz Augusto von Dentz data->watch(device, device->temporary, 742d5d0fa3be8f7a20d128dcbaf8fc529c38bc52395Johan Hedberg data->user_data); 7438d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 744b2b27c53f8d1987be3538b227b6fb45eacb0ed5dLuiz Augusto von Dentz /* Check if the watch has been removed by callback function */ 745b2b27c53f8d1987be3538b227b6fb45eacb0ed5dLuiz Augusto von Dentz if (!g_slist_find(device->watches, data)) 746b2b27c53f8d1987be3538b227b6fb45eacb0ed5dLuiz Augusto von Dentz continue; 747b2b27c53f8d1987be3538b227b6fb45eacb0ed5dLuiz Augusto von Dentz 748d5d0fa3be8f7a20d128dcbaf8fc529c38bc52395Johan Hedberg device->watches = g_slist_remove(device->watches, data); 749d5d0fa3be8f7a20d128dcbaf8fc529c38bc52395Johan Hedberg g_free(data); 750d5d0fa3be8f7a20d128dcbaf8fc529c38bc52395Johan Hedberg } 7518d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 7528d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz device->disconn_timer = g_timeout_add_seconds(DISCONNECT_TIMER, 753c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz do_disconnect, device); 754c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 755c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz g_dbus_emit_signal(conn, device->path, 756c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz DEVICE_INTERFACE, "DisconnectRequested", 757c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz DBUS_TYPE_INVALID); 7588d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz} 7598d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 7607c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedbergstatic DBusMessage *disconnect(DBusConnection *conn, DBusMessage *msg, 7617c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg void *user_data) 76294c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann{ 763555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = user_data; 7645d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi 765bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg if (!device->connected) 76657c9bf4d916f8fc0ecb8234404a255f0bdee250bGustavo F. Padovan return btd_error_not_connected(msg); 7675d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi 768c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz device_request_disconnect(device, msg); 7695d49d848060b0809a25acb9a20b176600f52e66dClaudio Takahasi 770c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz return NULL; 77194c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann} 77294c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann 77396c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganeshstatic DBusMessage *get_service_attribute_value_reply(DBusMessage *msg, DBusConnection *conn, 77496c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh sdp_data_t *attr) 77596c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh{ 77696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh DBusMessage *reply; 77796c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh DBusMessageIter iter; 77896c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 77996c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh reply = dbus_message_new_method_return(msg); 78096c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh if (!reply) 781a8e69319f00c3fe65b5f3bce1ea370e3c3eb3582Jing Yu return NULL; 78296c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh sdp_data_t *curr; 78396c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh sdp_list_t *ap = 0; 78496c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh for (; attr; attr = attr->next) { 78596c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh sdp_list_t *pds = 0; 78696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh for (curr = attr->val.dataseq; curr; curr = curr->next) 78796c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh pds = sdp_list_append(pds, curr->val.dataseq); 78896c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh ap = sdp_list_append(ap, pds); 78996c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh } 79096c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 79196c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh int ch = sdp_get_proto_port(ap, RFCOMM_UUID); 79296c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh sdp_list_foreach(ap, (sdp_list_func_t) sdp_list_free, NULL); 79396c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh sdp_list_free(ap, NULL); 79496c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh ap = NULL; 79596c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 79696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh dbus_message_append_args(reply, DBUS_TYPE_INT32, &ch, DBUS_TYPE_INVALID); 79796c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 79896c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh return reply; 79996c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh} 80096c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 80196c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganeshstatic DBusMessage *get_service_attribute_value(DBusConnection *conn, 80296c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh DBusMessage *msg, 80396c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh void *user_data) 80496c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh{ 80596c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh struct btd_device *device = user_data; 80696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh const sdp_record_t *rec; 80796c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh sdp_data_t *attr_data; 80896c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh const char *pattern; 80996c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh uint16_t attrId; 81096c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh int err; 81196c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 81296c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh if (dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &pattern, 81396c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh DBUS_TYPE_UINT16, &attrId, 81496c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh DBUS_TYPE_INVALID) == FALSE) 81596c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh goto fail; 81696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 81796c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh if (strlen(pattern) == 0) 81896c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh return btd_error_invalid_args(msg); 81996c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 82096c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh rec = btd_device_get_record(device, pattern); 82196c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh if (rec == NULL) { 82296c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh error("rec is NULL"); 82396c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh goto fail; 82496c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh } 82596c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 82696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh attr_data = sdp_data_get(rec, attrId); 82796c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 82896c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh if (attr_data == NULL) { 82996c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh error("attr in null"); 83096c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh goto fail; 83196c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh } 83296c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh return get_service_attribute_value_reply(msg, conn, attr_data); 83396c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganeshfail: 83496c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh return g_dbus_create_error(msg, ERROR_INTERFACE ".Failed", 83596c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh "GetServiceAttribute Failed"); 83696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh} 83796c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh 838e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasistatic GDBusMethodTable device_methods[] = { 839e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi { "GetProperties", "", "a{sv}", get_properties }, 840e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi { "SetProperty", "sv", "", set_property }, 841e0d13d6da4b527ee02838af6b9dd7d53615e4896Marcel Holtmann { "DiscoverServices", "s", "a{us}", discover_services, 84294c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann G_DBUS_METHOD_FLAG_ASYNC}, 84394c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann { "CancelDiscovery", "", "", cancel_discover }, 844c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz { "Disconnect", "", "", disconnect, 845c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz G_DBUS_METHOD_FLAG_ASYNC}, 84696c354b4b6b1f3480c4129621cf7f82171577057Jaikumar Ganesh { "GetServiceAttributeValue", "sq", "i", get_service_attribute_value}, 84794c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann { } 8482c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes}; 8492c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes 850e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasistatic GDBusSignalTable device_signals[] = { 85194c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann { "PropertyChanged", "sv" }, 85294c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann { "DisconnectRequested", "" }, 85394c199911b1dc1395a8025647f0686f58e6bf4f6Marcel Holtmann { } 8542c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes}; 8552c1effee41e974f97b21aec1bdd1a232ba48056aVinicius Costa Gomes 856c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentzgboolean device_is_connected(struct btd_device *device) 857e21ec2652c54dbc8abbf84039b43fbd3be0b5ebcJohan Hedberg{ 858bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg return device->connected; 859e21ec2652c54dbc8abbf84039b43fbd3be0b5ebcJohan Hedberg} 860e21ec2652c54dbc8abbf84039b43fbd3be0b5ebcJohan Hedberg 861bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedbergvoid device_add_connection(struct btd_device *device, DBusConnection *conn) 862c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz{ 863bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg if (device->connected) { 86416348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 86516348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 866bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg error("Device %s is already connected", addr); 867c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz return; 868c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz } 869c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz 870bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg device->connected = TRUE; 871c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz 872b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg emit_property_changed(conn, device->path, 873b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg DEVICE_INTERFACE, "Connected", 874b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg DBUS_TYPE_BOOLEAN, &device->connected); 875c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz} 876c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz 877bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedbergvoid device_remove_connection(struct btd_device *device, DBusConnection *conn) 878c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz{ 879bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg if (!device->connected) { 88016348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 88116348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 882bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg error("Device %s isn't connected", addr); 883c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz return; 884c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz } 885c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz 886bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg device->connected = FALSE; 887c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz 888ff0bc3cc49f697bf1d4b84e3d2be1c338b2ddb09Daniel Orstadius if (device->disconn_timer > 0) { 889ff0bc3cc49f697bf1d4b84e3d2be1c338b2ddb09Daniel Orstadius g_source_remove(device->disconn_timer); 890ff0bc3cc49f697bf1d4b84e3d2be1c338b2ddb09Daniel Orstadius device->disconn_timer = 0; 891ff0bc3cc49f697bf1d4b84e3d2be1c338b2ddb09Daniel Orstadius } 892ff0bc3cc49f697bf1d4b84e3d2be1c338b2ddb09Daniel Orstadius 8935c60413b3f97c203d164ae717af02de10cfbac34Luiz Augusto von Dentz while (device->disconnects) { 8945c60413b3f97c203d164ae717af02de10cfbac34Luiz Augusto von Dentz DBusMessage *msg = device->disconnects->data; 8955c60413b3f97c203d164ae717af02de10cfbac34Luiz Augusto von Dentz 8965c60413b3f97c203d164ae717af02de10cfbac34Luiz Augusto von Dentz g_dbus_send_reply(conn, msg, DBUS_TYPE_INVALID); 8975c60413b3f97c203d164ae717af02de10cfbac34Luiz Augusto von Dentz device->disconnects = g_slist_remove(device->disconnects, msg); 8985c60413b3f97c203d164ae717af02de10cfbac34Luiz Augusto von Dentz } 8995c60413b3f97c203d164ae717af02de10cfbac34Luiz Augusto von Dentz 9003e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy if (device_is_paired(device) && !device->bonded) 9013e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy device_set_paired(device, FALSE); 9023e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy 903b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg emit_property_changed(conn, device->path, 904b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg DEVICE_INTERFACE, "Connected", 905b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg DBUS_TYPE_BOOLEAN, &device->connected); 906c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz} 907c4338c0b7a46d6288e350b8c05fc02ee28b4bdbcLuiz Augusto von Dentz 9088d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentzguint device_add_disconnect_watch(struct btd_device *device, 9098d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz disconnect_watch watch, void *user_data, 9108d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz GDestroyNotify destroy) 9118d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz{ 9128d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz struct btd_disconnect_data *data; 9138d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz static guint id = 0; 9148d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 9158d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz data = g_new0(struct btd_disconnect_data, 1); 9168d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz data->id = ++id; 9178d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz data->watch = watch; 9188d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz data->user_data = user_data; 9198d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz data->destroy = destroy; 9208d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 9218d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz device->watches = g_slist_append(device->watches, data); 9228d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 9238d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz return data->id; 9248d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz} 9258d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 9268d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentzvoid device_remove_disconnect_watch(struct btd_device *device, guint id) 9278d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz{ 9288d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz GSList *l; 9298d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 9308d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz for (l = device->watches; l; l = l->next) { 9318d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz struct btd_disconnect_data *data = l->data; 9328d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 9338d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz if (data->id == id) { 9348d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz device->watches = g_slist_remove(device->watches, 9358d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz data); 9368d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz if (data->destroy) 9378d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz data->destroy(data->user_data); 9388d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz g_free(data); 9398d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz return; 9408d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz } 9418d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz } 9428d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz} 9438d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz 9447c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedbergstruct btd_device *device_create(DBusConnection *conn, 945f1beea3e80b6e02f49eeea926d398366b13d291cClaudio Takahasi struct btd_adapter *adapter, 946f1beea3e80b6e02f49eeea926d398366b13d291cClaudio Takahasi const gchar *address, device_type_t type) 94786892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann{ 948ecbcc749831ab86da7ed8d15c36f1bd1fb380be8Cidorvan Leite gchar *address_up; 949555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device; 950139c2014be451848fcc3fa31cdc07653148f596eMarcel Holtmann const gchar *adapter_path = adapter_get_path(adapter); 951a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz bdaddr_t src; 95248a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz char srcaddr[18], alias[MAX_NAME_LENGTH + 1]; 95386892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 954555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode device = g_try_malloc0(sizeof(struct btd_device)); 95586892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann if (device == NULL) 95686892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann return NULL; 95786892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 958ecbcc749831ab86da7ed8d15c36f1bd1fb380be8Cidorvan Leite address_up = g_ascii_strup(address, -1); 959139c2014be451848fcc3fa31cdc07653148f596eMarcel Holtmann device->path = g_strdup_printf("%s/dev_%s", adapter_path, address_up); 96086892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann g_strdelimit(device->path, ":", '_'); 961ecbcc749831ab86da7ed8d15c36f1bd1fb380be8Cidorvan Leite g_free(address_up); 96286892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 9638e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("Creating device %s", device->path); 96486892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 965e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi if (g_dbus_register_interface(conn, device->path, DEVICE_INTERFACE, 966e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi device_methods, device_signals, NULL, 967e2731d4c2e3ef7d1677a73aca5fa58f044075980Claudio Takahasi device, device_free) == FALSE) { 96886892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann device_free(device); 96986892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann return NULL; 97086892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann } 971da0e7105811dc046d13d0365404efc1189ee4a8cClaudio Takahasi 972cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode str2ba(address, &device->bdaddr); 973da0e7105811dc046d13d0365404efc1189ee4a8cClaudio Takahasi device->adapter = adapter; 974f1beea3e80b6e02f49eeea926d398366b13d291cClaudio Takahasi device->type = type; 975a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz adapter_get_address(adapter, &src); 976a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz ba2str(&src, srcaddr); 977a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz read_device_name(srcaddr, address, device->name); 97848a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz if (read_device_alias(srcaddr, address, alias, sizeof(alias)) == 0) 97948a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz device->alias = g_strdup(alias); 9806da6e4e3de7f1800e5b736add0b944d33d3acf37Luiz Augusto von Dentz device->trusted = read_trust(&src, address, GLOBAL_TRUST); 981da0e7105811dc046d13d0365404efc1189ee4a8cClaudio Takahasi 9821e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (read_blocked(&src, &device->bdaddr)) 9831e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg device_block(conn, device); 9841e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 9853e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy if (read_link_key(&src, &device->bdaddr, NULL, NULL) == 0) { 9866fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg device->paired = TRUE; 9873e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy device_set_bonded(device, TRUE); 9883e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy } 9896fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg 9900ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz return btd_device_ref(device); 99186892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann} 99286892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann 993a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentzvoid device_set_name(struct btd_device *device, const char *name) 994a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz{ 995a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz DBusConnection *conn = get_dbus_connection(); 996a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz 99708fef64ca40b85782a0de1c1fd098934355b5e24Johan Hedberg if (strncmp(name, device->name, MAX_NAME_LENGTH) == 0) 998a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz return; 999a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz 100008fef64ca40b85782a0de1c1fd098934355b5e24Johan Hedberg strncpy(device->name, name, MAX_NAME_LENGTH); 1001a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz 1002a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz emit_property_changed(conn, device->path, 1003a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz DEVICE_INTERFACE, "Name", 1004a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz DBUS_TYPE_STRING, &name); 1005a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz 100648a2c31cdbc1f2ac2a2bbadbd505976f84a9eacaLuiz Augusto von Dentz if (device->alias != NULL) 1007a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz return; 1008a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz 1009a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz emit_property_changed(conn, device->path, 1010a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz DEVICE_INTERFACE, "Alias", 1011a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz DBUS_TYPE_STRING, &name); 1012a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz} 1013a721957f20ec79b1a19537e5c43d3a12e4286c6cLuiz Augusto von Dentz 10145d787d0c25ea650672d93459d7a898491f0b6344Johan Hedbergvoid device_get_name(struct btd_device *device, char *name, size_t len) 10155d787d0c25ea650672d93459d7a898491f0b6344Johan Hedberg{ 10165d787d0c25ea650672d93459d7a898491f0b6344Johan Hedberg strncpy(name, device->name, len); 10175d787d0c25ea650672d93459d7a898491f0b6344Johan Hedberg} 10185d787d0c25ea650672d93459d7a898491f0b6344Johan Hedberg 10197e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demariodevice_type_t device_get_type(struct btd_device *device) 10207e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario{ 10217e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario return device->type; 10227e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario} 10237e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario 1024b31576d0de87754f2fa1c3ba2d231cdccbffaee1Luiz Augusto von Dentzvoid device_remove_bonding(struct btd_device *device) 10252aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 10262aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz char filename[PATH_MAX + 1]; 1027204ab018f03d0d65f07b19cf4f777660b7d54249Claudio Takahasi char srcaddr[18], dstaddr[18]; 10282aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bdaddr_t bdaddr; 10292aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 10302aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz adapter_get_address(device->adapter, &bdaddr); 10312aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ba2str(&bdaddr, srcaddr); 10322aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ba2str(&device->bdaddr, dstaddr); 10332aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 10342aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz create_name(filename, PATH_MAX, STORAGEDIR, srcaddr, 10352aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz "linkkeys"); 10362aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 1037204ab018f03d0d65f07b19cf4f777660b7d54249Claudio Takahasi /* Delete the link key from storage */ 1038204ab018f03d0d65f07b19cf4f777660b7d54249Claudio Takahasi textfile_casedel(filename, dstaddr); 10393e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy device_set_bonded(device, FALSE); 10402aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 10411bf7ec6b5c5a786775813650a6ef00f47b4d11ecJohan Hedberg btd_adapter_remove_bonding(device->adapter, &device->bdaddr); 10422aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 10432aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 1044204ab018f03d0d65f07b19cf4f777660b7d54249Claudio Takahasistatic void device_remove_stored(struct btd_device *device) 10457dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz{ 10467dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz bdaddr_t src; 10477dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz char addr[18]; 1048e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius DBusConnection *conn = get_dbus_connection(); 10497dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz 10507dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz adapter_get_address(device->adapter, &src); 10517dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz ba2str(&device->bdaddr, addr); 1052e9071e3bfdf24666ff126d0023f3f4cf2ca74b2fJaikumar Ganesh 10536fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg if (device->paired) 10546fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg device_remove_bonding(device); 10557dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz delete_entry(&src, "profiles", addr); 10567dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz delete_entry(&src, "trusts", addr); 10575ae3733f9c81cd590e735a1e2cac1f261e881f9aVinicius Costa Gomes delete_entry(&src, "types", addr); 10585ae3733f9c81cd590e735a1e2cac1f261e881f9aVinicius Costa Gomes delete_entry(&src, "primary", addr); 1059e9071e3bfdf24666ff126d0023f3f4cf2ca74b2fJaikumar Ganesh delete_all_records(&src, &device->bdaddr); 1060727ae28e17be0910c9d5cdba6c8e373a704f7dbfClaudio Takahasi delete_device_service(&src, &device->bdaddr); 1061e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius 1062e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius if (device->blocked) 1063e0eddab0745f605fba545d03e84ed13769d744c8Daniel Orstadius device_unblock(conn, device, TRUE); 10647dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz} 10657dfdd472eed6368bbae14aa989e712a49f3e7f12Luiz Augusto von Dentz 1066204ab018f03d0d65f07b19cf4f777660b7d54249Claudio Takahasivoid device_remove(struct btd_device *device, gboolean remove_stored) 106775add5651e5dbc49c9c144acceac7e2c32d9bd16Claudio Takahasi{ 1068f62f8d892b5d5cc5aedef83779671c1ed54a35daMarcel Holtmann 10698e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("Removing device %s", device->path); 1070f62f8d892b5d5cc5aedef83779671c1ed54a35daMarcel Holtmann 107150996c3a0b0eb98f3cb1c202257d063992c7220dJohan Hedberg if (device->agent) 107250996c3a0b0eb98f3cb1c202257d063992c7220dJohan Hedberg agent_free(device->agent); 107350996c3a0b0eb98f3cb1c202257d063992c7220dJohan Hedberg 1074253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg if (device->bonding) { 1075253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg uint8_t status; 1076253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg 1077253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg if (device->connected) 1078253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg status = HCI_OE_USER_ENDED_CONNECTION; 1079253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg else 1080253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg status = HCI_PAGE_TIMEOUT; 1081253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg 1082253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg device_cancel_bonding(device, status); 1083253209e37f869638caec4f9ab9a7e45586380c07Johan Hedberg } 10842aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 108588386d8ee86158137eca2cc849f80136af12f635Claudio Takahasi if (device->browse) { 108688386d8ee86158137eca2cc849f80136af12f635Claudio Takahasi discover_services_reply(device->browse, -ECANCELED, NULL); 1087c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz browse_request_cancel(device->browse); 108888386d8ee86158137eca2cc849f80136af12f635Claudio Takahasi } 1089c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 1090bda6bb0079268b7db27695f40168aba07e960d8bJohan Hedberg if (device->connected) 109102d1a26d52d077c2b61c740fff96a28a940fee6fLuiz Augusto von Dentz do_disconnect(device); 1092c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz 109304e2e66722dfc8f26b159bdd280c981d9903258cLuiz Augusto von Dentz if (remove_stored) 1094204ab018f03d0d65f07b19cf4f777660b7d54249Claudio Takahasi device_remove_stored(device); 10952aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 10966c212766c4e44ea1b47be61c2eb34a02ba50b81aJohan Hedberg g_slist_foreach(device->drivers, (GFunc) driver_remove, device); 10971e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg g_slist_free(device->drivers); 10981e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg device->drivers = NULL; 10996061f1a889c90d4d408ca12b63b2db6235c73baeMarcel Holtmann 1100279a53827334deab5093876e27261d38937bda36Vinicius Costa Gomes attrib_client_unregister(device); 1101279a53827334deab5093876e27261d38937bda36Vinicius Costa Gomes 11020ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz btd_device_unref(device); 110386892be8d38960096f9b9c5613ba28fc9003d288Marcel Holtmann} 1104ff296428a08dee619db1cc702146faefa91087faCidorvan Leite 1105555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsodegint device_address_cmp(struct btd_device *device, const gchar *address) 1106ff296428a08dee619db1cc702146faefa91087faCidorvan Leite{ 1107cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode char addr[18]; 1108cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode 1109cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&device->bdaddr, addr); 1110cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode return strcasecmp(addr, address); 1111ff296428a08dee619db1cc702146faefa91087faCidorvan Leite} 11123d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 11133870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedbergstatic gboolean record_has_uuid(const sdp_record_t *rec, 11143870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg const char *profile_uuid) 1115f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz{ 11163870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg sdp_list_t *pat; 1117f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 11183870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg for (pat = rec->pattern; pat != NULL; pat = pat->next) { 1119f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz char *uuid; 11203870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg int ret; 1121f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 11223870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg uuid = bt_uuid2string(pat->data); 1123f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz if (!uuid) 1124f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz continue; 1125f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 11263870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg ret = strcasecmp(uuid, profile_uuid); 1127f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 11283870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg g_free(uuid); 11293870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg 11303870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg if (ret == 0) 11313870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg return TRUE; 1132f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz } 1133f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 11343870d6ab80711042b0c9224eac34293cb6b16aeaJohan Hedberg return FALSE; 1135f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz} 1136f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1137f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentzstatic GSList *device_match_pattern(struct btd_device *device, 1138878dee664d16eb6643e0ba2d5d9c2452f98f172eJohan Hedberg const char *match_uuid, 1139f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz GSList *profiles) 1140f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz{ 1141f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz GSList *l, *uuids = NULL; 1142f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1143f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz for (l = profiles; l; l = l->next) { 1144878dee664d16eb6643e0ba2d5d9c2452f98f172eJohan Hedberg char *profile_uuid = l->data; 1145f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz const sdp_record_t *rec; 11463bb7c1527ce3ec67127200b54a8fbc01a196ebadJohan Hedberg 1147878dee664d16eb6643e0ba2d5d9c2452f98f172eJohan Hedberg rec = btd_device_get_record(device, profile_uuid); 1148f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz if (!rec) 1149f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz continue; 1150f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1151a01801fd21056ef6f7fffc6a205b6c2b9e99899fJohan Hedberg if (record_has_uuid(rec, match_uuid)) 1152878dee664d16eb6643e0ba2d5d9c2452f98f172eJohan Hedberg uuids = g_slist_append(uuids, profile_uuid); 1153cdfe8a8246013031f55c647092e41adbb29ace81Johan Hedberg } 1154f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1155f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz return uuids; 1156f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz} 1157f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1158f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentzstatic GSList *device_match_driver(struct btd_device *device, 1159f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz struct btd_device_driver *driver, 1160f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz GSList *profiles) 1161f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann{ 11626061f1a889c90d4d408ca12b63b2db6235c73baeMarcel Holtmann const char **uuid; 1163f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz GSList *uuids = NULL; 1164f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1165f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz for (uuid = driver->uuids; *uuid; uuid++) { 1166f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz GSList *match; 1167f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 11689b953c8757093b51eb86e6593d514e9839fd8d7dLuiz Augusto von Dentz /* skip duplicated uuids */ 11699b953c8757093b51eb86e6593d514e9839fd8d7dLuiz Augusto von Dentz if (g_slist_find_custom(uuids, *uuid, 11709b953c8757093b51eb86e6593d514e9839fd8d7dLuiz Augusto von Dentz (GCompareFunc) strcasecmp)) 11719b953c8757093b51eb86e6593d514e9839fd8d7dLuiz Augusto von Dentz continue; 11729b953c8757093b51eb86e6593d514e9839fd8d7dLuiz Augusto von Dentz 1173f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz /* match profile driver */ 1174f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz match = g_slist_find_custom(profiles, *uuid, 1175f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz (GCompareFunc) strcasecmp); 1176f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz if (match) { 1177f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz uuids = g_slist_append(uuids, match->data); 1178f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz continue; 1179f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz } 1180f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1181f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz /* match pattern driver */ 1182f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz match = device_match_pattern(device, *uuid, profiles); 1183b358f4f350211dfd9d52a0b4fbc611b0c711bcddClaudio Takahasi uuids = g_slist_concat(uuids, match); 1184f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz } 1185f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1186f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz return uuids; 1187f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz} 1188f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1189f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentzvoid device_probe_drivers(struct btd_device *device, GSList *profiles) 1190f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz{ 1191f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz GSList *list; 119216348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 1193f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann int err; 1194f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann 119516348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 119616348199ed59c49a710805a5061c3f22477715bfJohan Hedberg 11971e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg if (device->blocked) { 119816348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("Skipping drivers for blocked device %s", addr); 11991e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg goto add_uuids; 12001e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg } 12011e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedberg 120216348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("Probing drivers for %s", addr); 1203f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann 1204c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz for (list = device_drivers; list; list = list->next) { 1205e0863545e6239ac338fa7fbe9647a5748a60b436Marcel Holtmann struct btd_device_driver *driver = list->data; 1206f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz GSList *probe_uuids; 1207f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann 1208f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz probe_uuids = device_match_driver(device, driver, profiles); 12094b0ab7e43f4fa555641902b07f2f7ab3821f2b75Alok Barsode 1210f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz if (!probe_uuids) 1211f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz continue; 1212081d9d1df3cde11e3e3833201f4cadac6f355da0Luiz Augusto von Dentz 1213f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz err = driver->probe(device, probe_uuids); 1214f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz if (err < 0) { 121516348199ed59c49a710805a5061c3f22477715bfJohan Hedberg error("%s driver probe failed for device %s", 121616348199ed59c49a710805a5061c3f22477715bfJohan Hedberg driver->name, addr); 1217548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg g_slist_free(probe_uuids); 1218f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz continue; 1219f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann } 1220f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz 1221521006ef7b0737739e4e2c66564ed458a348f566Claudio Takahasi device->drivers = g_slist_append(device->drivers, driver); 1222f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz g_slist_free(probe_uuids); 1223f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann } 122436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 12251e4d4fe0ed499adaf3e61b1e593dccd3c0928158Johan Hedbergadd_uuids: 1226f1c3d8c1fabd801eac34c9069038d3f4cadcb58dLuiz Augusto von Dentz for (list = profiles; list; list = list->next) { 1227c4c130d3922dedc992e00fbf94bde64a180306c2Marcel Holtmann GSList *l = g_slist_find_custom(device->uuids, list->data, 12287c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg (GCompareFunc) strcasecmp); 1229c4c130d3922dedc992e00fbf94bde64a180306c2Marcel Holtmann if (l) 1230c4c130d3922dedc992e00fbf94bde64a180306c2Marcel Holtmann continue; 1231c4c130d3922dedc992e00fbf94bde64a180306c2Marcel Holtmann 123236dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz device->uuids = g_slist_insert_sorted(device->uuids, 12337c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg g_strdup(list->data), 12347c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg (GCompareFunc) strcasecmp); 1235548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg } 123636dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz} 123736dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 123899bc055edc4b9ba8ccda791757a6439fb03ff8f2Marcel Holtmannstatic void device_remove_drivers(struct btd_device *device, GSList *uuids) 123936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz{ 124018614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter = device_get_adapter(device); 1241352a65d3de4fdf6e1e507f958685097f33e3b899Johan Hedberg GSList *list, *next; 1242cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode char srcaddr[18], dstaddr[18]; 12432a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode bdaddr_t src; 1244548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg sdp_list_t *records; 12452a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 12462a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode adapter_get_address(adapter, &src); 1247cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&src, srcaddr); 1248cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&device->bdaddr, dstaddr); 124936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 1250548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg records = read_records(&src, &device->bdaddr); 1251548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 125216348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("Removing drivers for %s", dstaddr); 125336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 1254352a65d3de4fdf6e1e507f958685097f33e3b899Johan Hedberg for (list = device->drivers; list; list = next) { 1255521006ef7b0737739e4e2c66564ed458a348f566Claudio Takahasi struct btd_device_driver *driver = list->data; 125636dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz const char **uuid; 125736dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 1258352a65d3de4fdf6e1e507f958685097f33e3b899Johan Hedberg next = list->next; 1259352a65d3de4fdf6e1e507f958685097f33e3b899Johan Hedberg 126036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz for (uuid = driver->uuids; *uuid; uuid++) { 12619b4bfa74d25e360932402994a32305bf2145eb34Luiz Augusto von Dentz if (!g_slist_find_custom(uuids, *uuid, 1262155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh (GCompareFunc) strcasecmp)) 126336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz continue; 126436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 12658e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("UUID %s was removed from device %s", 12667c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg *uuid, dstaddr); 1267548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 1268e780c7bd8ec0527723db3c19f28365063bbe7d93Luiz Augusto von Dentz driver->remove(device); 126936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz device->drivers = g_slist_remove(device->drivers, 1270521006ef7b0737739e4e2c66564ed458a348f566Claudio Takahasi driver); 1271155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh break; 1272155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh } 1273155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh } 12749b4bfa74d25e360932402994a32305bf2145eb34Luiz Augusto von Dentz 1275155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh for (list = uuids; list; list = list->next) { 1276155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh sdp_record_t *rec; 1277548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 1278155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh device->uuids = g_slist_remove(device->uuids, list->data); 1279155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh 1280155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh rec = find_record_in_list(records, list->data); 1281155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh if (!rec) 1282155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh continue; 1283155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh 1284155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh delete_record(srcaddr, dstaddr, rec->handle); 1285155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh 1286155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh records = sdp_list_remove(records, rec); 1287155e4e6fe2af8d662e26843c5fc15e6814622ddbJaikumar Ganesh sdp_record_free(rec); 12882d370d5d678973644c2c3c75b22d5f24b7a2c638Johan Hedberg 128936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz } 129036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 1291548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg if (records) 1292548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg sdp_list_free(records, (sdp_free_func_t) sdp_record_free); 1293f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann} 1294f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann 129517541956196b13ee083852fd4124cd8cfd0928a4Johan Hedbergstatic void services_changed(struct btd_device *device) 12963d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz{ 1297533655873c4978091edf3698b20d2b96c43dafc8Johan Hedberg DBusConnection *conn = get_dbus_connection(); 12983d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz char **uuids; 12993d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz GSList *l; 130036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz int i; 13013d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 130236dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz uuids = g_new0(char *, g_slist_length(device->uuids) + 1); 130336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz for (i = 0, l = device->uuids; l; l = l->next, i++) 130436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz uuids[i] = l->data; 130536dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 130658f06324289d7d343a52a9104d02121cb8db1047Johan Hedberg emit_array_property_changed(conn, device->path, DEVICE_INTERFACE, 1307d5e700051b1263b2028331d41d60de02a5a6f90eVinicius Costa Gomes "UUIDs", DBUS_TYPE_STRING, &uuids, i); 130836dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 130936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz g_free(uuids); 131036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz} 131136dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 13128b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedbergstatic int rec_cmp(const void *a, const void *b) 13138b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedberg{ 13148b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedberg const sdp_record_t *r1 = a; 13158b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedberg const sdp_record_t *r2 = b; 13168b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedberg 13178b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedberg return r1->handle - r2->handle; 13188b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedberg} 13198b2e688eaf5b71006c72cf91a8e4df3c0c41c306Johan Hedberg 132036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentzstatic void update_services(struct browse_req *req, sdp_list_t *recs) 132136dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz{ 1322555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = req->device; 132318614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter = device_get_adapter(device); 132436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz sdp_list_t *seq; 1325cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode char srcaddr[18], dstaddr[18]; 13262a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode bdaddr_t src; 13272a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 13282a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode adapter_get_address(adapter, &src); 1329cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&src, srcaddr); 1330cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode ba2str(&device->bdaddr, dstaddr); 13313d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 133236dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz for (seq = recs; seq; seq = seq->next) { 13333d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz sdp_record_t *rec = (sdp_record_t *) seq->data; 133436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz sdp_list_t *svcclass = NULL; 13350dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg gchar *profile_uuid; 133636dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz GSList *l; 13373d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 13383d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz if (!rec) 13393d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz break; 13403d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 134136dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz if (sdp_get_service_classes(rec, &svcclass) < 0) 134236dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz continue; 134336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 134423844f34167a89b687970d308e2620f8e106f8dfJohan Hedberg /* Check for empty service classes list */ 134523844f34167a89b687970d308e2620f8e106f8dfJohan Hedberg if (svcclass == NULL) { 13468e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("Skipping record with no service classes"); 134723844f34167a89b687970d308e2620f8e106f8dfJohan Hedberg continue; 134823844f34167a89b687970d308e2620f8e106f8dfJohan Hedberg } 134923844f34167a89b687970d308e2620f8e106f8dfJohan Hedberg 135036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz /* Extract the first element and skip the remainning */ 13510dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg profile_uuid = bt_uuid2string(svcclass->data); 13520dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg if (!profile_uuid) { 1353aaf0f75d2a18a86bca3c418ddd63e936627c4446Johan Hedberg sdp_list_free(svcclass, free); 135436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz continue; 1355aaf0f75d2a18a86bca3c418ddd63e936627c4446Johan Hedberg } 135636dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 13570dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg if (!strcasecmp(profile_uuid, PNP_UUID)) { 1358fce6db565f747ca9ad560f7d8bff6a45522d905cMarcel Holtmann uint16_t source, vendor, product, version; 1359e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse sdp_data_t *pdlist; 1360e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse 1361fce6db565f747ca9ad560f7d8bff6a45522d905cMarcel Holtmann pdlist = sdp_data_get(rec, SDP_ATTR_VENDOR_ID_SOURCE); 1362fce6db565f747ca9ad560f7d8bff6a45522d905cMarcel Holtmann source = pdlist ? pdlist->val.uint16 : 0x0000; 1363fce6db565f747ca9ad560f7d8bff6a45522d905cMarcel Holtmann 1364e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse pdlist = sdp_data_get(rec, SDP_ATTR_VENDOR_ID); 1365e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse vendor = pdlist ? pdlist->val.uint16 : 0x0000; 1366e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse 1367e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse pdlist = sdp_data_get(rec, SDP_ATTR_PRODUCT_ID); 1368e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse product = pdlist ? pdlist->val.uint16 : 0x0000; 1369e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse 1370e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse pdlist = sdp_data_get(rec, SDP_ATTR_VERSION); 1371e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse version = pdlist ? pdlist->val.uint16 : 0x0000; 1372e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse 1373fce6db565f747ca9ad560f7d8bff6a45522d905cMarcel Holtmann if (source || vendor || product || version) 1374fce6db565f747ca9ad560f7d8bff6a45522d905cMarcel Holtmann store_device_id(srcaddr, dstaddr, source, 1375fce6db565f747ca9ad560f7d8bff6a45522d905cMarcel Holtmann vendor, product, version); 1376e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse } 1377e2a5786af8c8278eeeb0bedccda32c7422e9a2b7David Woodhouse 137837a7d2aba17bcb47a3e9bfba78ad23a8a3cbe420Johan Hedberg /* Check for duplicates */ 1379981f4416220e01a3eab92aa3c8d03c16dcad450dJohan Hedberg if (sdp_list_find(req->records, rec, rec_cmp)) { 13800dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg g_free(profile_uuid); 1381aaf0f75d2a18a86bca3c418ddd63e936627c4446Johan Hedberg sdp_list_free(svcclass, free); 138237a7d2aba17bcb47a3e9bfba78ad23a8a3cbe420Johan Hedberg continue; 1383981f4416220e01a3eab92aa3c8d03c16dcad450dJohan Hedberg } 138437a7d2aba17bcb47a3e9bfba78ad23a8a3cbe420Johan Hedberg 1385cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode store_record(srcaddr, dstaddr, rec); 138637a7d2aba17bcb47a3e9bfba78ad23a8a3cbe420Johan Hedberg 1387681e50c618d246483728bca6628a18c1c44c5b36Luiz Augusto von Dentz /* Copy record */ 13887c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg req->records = sdp_list_append(req->records, 13897c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg sdp_copy_record(rec)); 1390681e50c618d246483728bca6628a18c1c44c5b36Luiz Augusto von Dentz 13910dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg l = g_slist_find_custom(device->uuids, profile_uuid, 1392c4c130d3922dedc992e00fbf94bde64a180306c2Marcel Holtmann (GCompareFunc) strcmp); 139336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz if (!l) 13940dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg req->profiles_added = 13950dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg g_slist_append(req->profiles_added, 13960dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg profile_uuid); 139736dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz else { 13980dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg req->profiles_removed = 13990dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg g_slist_remove(req->profiles_removed, 14000dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg l->data); 14010dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg g_free(profile_uuid); 14023d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz } 14033d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 140436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz sdp_list_free(svcclass, free); 14053d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz } 140636dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz} 140736dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 140817541956196b13ee083852fd4124cd8cfd0928a4Johan Hedbergstatic void store_profiles(struct btd_device *device) 140936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz{ 141018614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter = device->adapter; 1411cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bdaddr_t src; 141236dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz char *str; 14133d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 14142a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode adapter_get_address(adapter, &src); 14153d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 141636dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz if (!device->uuids) { 1417cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode write_device_profiles(&src, &device->bdaddr, ""); 141836dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz return; 141936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz } 142036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 142136dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz str = bt_list2string(device->uuids); 1422cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode write_device_profiles(&src, &device->bdaddr, str); 142336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz g_free(str); 142436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz} 142536dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 142632c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadiusstatic void create_device_reply(struct btd_device *device, struct browse_req *req) 142732c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius{ 142832c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius DBusMessage *reply; 142932c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius 143032c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius reply = dbus_message_new_method_return(req->msg); 143132c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius if (!reply) 143232c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius return; 143332c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius 143432c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius dbus_message_append_args(reply, DBUS_TYPE_OBJECT_PATH, &device->path, 143532c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius DBUS_TYPE_INVALID); 143632c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius 143732c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius g_dbus_send_message(req->conn, reply); 143832c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius} 143932c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius 1440d14f607a0374bc313e410987ddd357581336003eClaudio TakahasiGSList *device_services_from_record(struct btd_device *device, GSList *profiles) 1441612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi{ 1442612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi GSList *l, *prim_list = NULL; 1443612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi char *att_uuid; 1444612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi uuid_t proto_uuid; 1445612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1446612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi sdp_uuid16_create(&proto_uuid, ATT_UUID); 1447612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi att_uuid = bt_uuid2string(&proto_uuid); 1448612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1449612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi for (l = profiles; l; l = l->next) { 1450612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi const char *profile_uuid = l->data; 1451612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi const sdp_record_t *rec; 1452612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi struct att_primary *prim; 1453612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi uint16_t start = 0, end = 0, psm = 0; 1454612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi uuid_t prim_uuid; 1455612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1456612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi rec = btd_device_get_record(device, profile_uuid); 1457612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi if (!rec) 1458612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi continue; 1459612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1460612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi if (!record_has_uuid(rec, att_uuid)) 1461612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi continue; 1462612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1463612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi if (!gatt_parse_record(rec, &prim_uuid, &psm, &start, &end)) 1464612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi continue; 1465612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1466612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi prim = g_new0(struct att_primary, 1); 1467612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi prim->start = start; 1468612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi prim->end = end; 1469612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi sdp_uuid2strn(&prim_uuid, prim->uuid, sizeof(prim->uuid)); 1470612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1471612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi prim_list = g_slist_append(prim_list, prim); 1472612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi } 1473612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1474612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi g_free(att_uuid); 1475612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1476612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi return prim_list; 1477612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi} 1478612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 1479da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentzstatic void search_cb(sdp_list_t *recs, int err, gpointer user_data) 148036dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz{ 148136dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz struct browse_req *req = user_data; 1482555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsode struct btd_device *device = req->device; 148316348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 148416348199ed59c49a710805a5061c3f22477715bfJohan Hedberg 148516348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 14862a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 1487681e50c618d246483728bca6628a18c1c44c5b36Luiz Augusto von Dentz if (err < 0) { 1488681e50c618d246483728bca6628a18c1c44c5b36Luiz Augusto von Dentz error("%s: error updating services: %s (%d)", 148916348199ed59c49a710805a5061c3f22477715bfJohan Hedberg addr, strerror(-err), -err); 149032c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius goto send_reply; 1491681e50c618d246483728bca6628a18c1c44c5b36Luiz Augusto von Dentz } 149236dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 149336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz update_services(req, recs); 149436dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz 149545bc7305c6e0baeb6d0a3591e8622ef7c7135d74Luiz Augusto von Dentz if (device->tmp_records) 14967c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg sdp_list_free(device->tmp_records, 14977c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg (sdp_free_func_t) sdp_record_free); 149845bc7305c6e0baeb6d0a3591e8622ef7c7135d74Luiz Augusto von Dentz 149945bc7305c6e0baeb6d0a3591e8622ef7c7135d74Luiz Augusto von Dentz device->tmp_records = req->records; 150045bc7305c6e0baeb6d0a3591e8622ef7c7135d74Luiz Augusto von Dentz req->records = NULL; 1501548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 1502cfea4ccc6fc8e014bfbd5bb80de0a2b854fc373bJaikumar Ganesh if (!req->profiles_added && !req->profiles_removed) { 150316348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("%s: No service update", addr); 150432c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius goto send_reply; 1505cfea4ccc6fc8e014bfbd5bb80de0a2b854fc373bJaikumar Ganesh } 1506cfea4ccc6fc8e014bfbd5bb80de0a2b854fc373bJaikumar Ganesh 150736dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz /* Probe matching drivers for services added */ 1508612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi if (req->profiles_added) { 1509612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi GSList *list; 1510612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 15110dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg device_probe_drivers(device, req->profiles_added); 15122efdbe3a944fb2c8c6e0f581b899140b4ef84bcbLuiz Augusto von Dentz 1513d14f607a0374bc313e410987ddd357581336003eClaudio Takahasi list = device_services_from_record(device, req->profiles_added); 1514612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi if (list) 15151f8969c0435f8d49c20f46dba9bece21031997c7Johan Hedberg device_register_services(req->conn, device, list, 15161f8969c0435f8d49c20f46dba9bece21031997c7Johan Hedberg ATT_PSM); 1517612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi } 1518612d0207646064f309edd564a69d30b42de9e26fClaudio Takahasi 151936dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz /* Remove drivers for services removed */ 15200dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg if (req->profiles_removed) 15210dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg device_remove_drivers(device, req->profiles_removed); 15222efdbe3a944fb2c8c6e0f581b899140b4ef84bcbLuiz Augusto von Dentz 152336dedff329b5ced8979a2161075e6a9d38c58785Luiz Augusto von Dentz /* Propagate services changes */ 152417541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg services_changed(req->device); 1525f4eb9e2dea643f41e261bb9e2bff33fc03bd9eccMarcel Holtmann 152632c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadiussend_reply: 15272ba670eae0d7d0d57160b7e5bd387079f86d933cJohan Hedberg if (!req->msg) 15282ba670eae0d7d0d57160b7e5bd387079f86d933cJohan Hedberg goto cleanup; 15292ba670eae0d7d0d57160b7e5bd387079f86d933cJohan Hedberg 1530438ab01b43075b715345df0d85447aaf338fd4fcLuiz Augusto von Dentz if (dbus_message_is_method_call(req->msg, DEVICE_INTERFACE, 153132c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius "DiscoverServices")) 153245bc7305c6e0baeb6d0a3591e8622ef7c7135d74Luiz Augusto von Dentz discover_services_reply(req, err, device->tmp_records); 153332c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius else if (dbus_message_is_method_call(req->msg, ADAPTER_INTERFACE, 153432c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius "CreatePairedDevice")) 153532c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius create_device_reply(device, req); 153632c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius else if (dbus_message_is_method_call(req->msg, ADAPTER_INTERFACE, 153732c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius "CreateDevice")) { 153832c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius if (err < 0) { 153992a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan DBusMessage *reply; 154092a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan reply = btd_error_failed(req->msg, strerror(-err)); 154192a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan g_dbus_send_message(req->conn, reply); 154232c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius goto cleanup; 154332c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius } 15443d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 154532c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius create_device_reply(device, req); 154632c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius device_set_temporary(device, FALSE); 154732c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius } 1548048cda340a2e17a89cab71e8c40ff9a1c66ea5c1Luiz Augusto von Dentz 15491e8fbfbfa6fbcf88a668f77e5601bbc505eb483fLuiz Augusto von Dentzcleanup: 155027b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes if (!device->temporary) { 155127b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes bdaddr_t sba, dba; 155227b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes 155327b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes adapter_get_address(device->adapter, &sba); 155427b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes device_get_address(device, &dba); 155527b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes 155632c43b955601343cbaa041be0ec1c8671071db5cDaniel Orstadius store_profiles(device); 155727b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes write_device_type(&sba, &dba, device->type); 155827b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes } 155927b16a98221951d9fb931e46b8af65bd8d185324Vinicius Costa Gomes 1560a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz device->browse = NULL; 15612499fb1f1775b8afcb374ba3aefc0c5484e78fa4Johan Hedberg browse_request_free(req); 1562da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz} 1563da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 1564da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentzstatic void browse_cb(sdp_list_t *recs, int err, gpointer user_data) 1565da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz{ 1566da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz struct browse_req *req = user_data; 1567da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz struct btd_device *device = req->device; 1568da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz struct btd_adapter *adapter = device->adapter; 1569cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bdaddr_t src; 1570da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz uuid_t uuid; 1571da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 15727c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg /* If we have a valid response and req->search_uuid == 2, then L2CAP 15737c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg * UUID & PNP searching was successful -- we are done */ 15740cd8e651b6f004bcc64387d59f6bcb29190ffed6Johan Hedberg if (err < 0 || (req->search_uuid == 2 && req->records)) { 15750cd8e651b6f004bcc64387d59f6bcb29190ffed6Johan Hedberg if (err == -ECONNRESET && req->reconnect_attempt < 1) { 15760cd8e651b6f004bcc64387d59f6bcb29190ffed6Johan Hedberg req->search_uuid--; 15770cd8e651b6f004bcc64387d59f6bcb29190ffed6Johan Hedberg req->reconnect_attempt++; 15780cd8e651b6f004bcc64387d59f6bcb29190ffed6Johan Hedberg } else 15790cd8e651b6f004bcc64387d59f6bcb29190ffed6Johan Hedberg goto done; 15800cd8e651b6f004bcc64387d59f6bcb29190ffed6Johan Hedberg } 1581da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 1582da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz update_services(req, recs); 1583da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 1584da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz adapter_get_address(adapter, &src); 1585da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 1586da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz /* Search for mandatory uuids */ 15877d3301934f1b30d90646c97f40464ed198be91d3David Woodhouse if (uuid_list[req->search_uuid]) { 15887d3301934f1b30d90646c97f40464ed198be91d3David Woodhouse sdp_uuid16_create(&uuid, uuid_list[req->search_uuid++]); 1589c4c130d3922dedc992e00fbf94bde64a180306c2Marcel Holtmann bt_search_service(&src, &device->bdaddr, &uuid, 1590c4c130d3922dedc992e00fbf94bde64a180306c2Marcel Holtmann browse_cb, user_data, NULL); 1591da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz return; 1592da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz } 1593da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 1594da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentzdone: 1595da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz search_cb(recs, err, user_data); 1596da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz} 1597da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 159869adac833c5633714b84bf840c75aa814193b8a6Johan Hedbergstatic void init_browse(struct browse_req *req, gboolean reverse) 1599da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz{ 1600da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz GSList *l; 1601da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz 160269adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg /* If we are doing reverse-SDP don't try to detect removed profiles 160369adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg * since some devices hide their service records while they are 160469adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg * connected 160569adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg */ 160669adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg if (reverse) 160769adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg return; 160869adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg 1609da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz for (l = req->device->uuids; l; l = l->next) 16100dabe8201eac11459010694bca66d6b217936fcbJohan Hedberg req->profiles_removed = g_slist_append(req->profiles_removed, 1611da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz l->data); 16123d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz} 16133d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 1614d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demariostatic char *primary_list_to_string(GSList *primary_list) 1615d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario{ 1616d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario GString *services; 1617d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario GSList *l; 1618d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1619d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario services = g_string_new(NULL); 1620d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1621d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario for (l = primary_list; l; l = l->next) { 1622d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario struct att_primary *primary = l->data; 1623d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario char service[64]; 1624d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1625d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario memset(service, 0, sizeof(service)); 1626d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1627d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario snprintf(service, sizeof(service), "%04X#%04X#%s ", 1628d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario primary->start, primary->end, primary->uuid); 1629d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1630d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario services = g_string_append(services, service); 1631d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario } 1632d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1633d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario return g_string_free(services, FALSE); 1634d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario} 1635d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1636399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasistatic void store_services(struct btd_device *device) 1637399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi{ 1638399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi struct btd_adapter *adapter = device->adapter; 1639399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi bdaddr_t dba, sba; 16403a4be695834ccfac110c548cf870dc729c00f44cVinicius Costa Gomes char *str = primary_list_to_string(device->primaries); 1641399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi 1642399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi adapter_get_address(adapter, &sba); 1643399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi device_get_address(device, &dba); 1644399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi 1645399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi write_device_type(&sba, &dba, device->type); 1646399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi write_device_services(&sba, &dba, str); 1647399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi 1648399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi g_free(str); 1649399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi} 1650399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi 16515399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasistatic void primary_cb(GSList *services, guint8 status, gpointer user_data) 1652d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi{ 1653d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi struct browse_req *req = user_data; 1654d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi struct btd_device *device = req->device; 1655d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario GSList *l, *uuids = NULL; 1656d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 16575399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi if (status) { 165892a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan DBusMessage *reply; 16595399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi reply = btd_error_failed(req->msg, att_ecode2str(status)); 166092a56b931f72b218e0825f57a9bb8b7a4dbd44e7Gustavo F. Padovan g_dbus_send_message(req->conn, reply); 1661d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi goto done; 1662d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi } 1663d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 16645c36b74c0b43ae0532e26c03b6ce8a1abba7d874Claudio Takahasi services_changed(device); 16655c36b74c0b43ae0532e26c03b6ce8a1abba7d874Claudio Takahasi device_set_temporary(device, FALSE); 1666d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1667d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario for (l = services; l; l = l->next) { 1668d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario struct att_primary *prim = l->data; 1669d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario uuids = g_slist_append(uuids, prim->uuid); 1670d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario } 1671d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1672d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario device_probe_drivers(device, uuids); 1673bb5eda2bc85b68e9cf3908f39972b476afb6633fVinicius Costa Gomes 1674f194be5c746d1ad6f093d1b175b7b0e1ccafad58Bruna Moreira device_register_services(req->conn, device, g_slist_copy(services), -1); 1675bb5eda2bc85b68e9cf3908f39972b476afb6633fVinicius Costa Gomes 1676d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario g_slist_free(uuids); 1677d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 16785c36b74c0b43ae0532e26c03b6ce8a1abba7d874Claudio Takahasi create_device_reply(device, req); 1679d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 1680399ad77a2fc90c8df9ee9deae2cb85ce61639403Claudio Takahasi store_services(device); 1681d3cb258b9b9af0dcacfba0e6aa0db3f280554fb0Sheldon Demario 1682d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasidone: 1683d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi device->browse = NULL; 1684d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi browse_request_free(req); 1685d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi} 1686d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 16875399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasistatic void gatt_connect_cb(GIOChannel *io, GError *gerr, gpointer user_data) 16885399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi{ 16895399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi struct browse_req *req = user_data; 16905399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi struct btd_device *device = req->device; 16915399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 16925399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi if (gerr) { 16935399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi DBusMessage *reply; 16945399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 16955399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi DBG("%s", gerr->message); 16965399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 16975399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi reply = btd_error_failed(req->msg, gerr->message); 16985399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi g_dbus_send_message(req->conn, reply); 16995399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 17005399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi device->browse = NULL; 17015399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi browse_request_free(req); 17025399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 17035399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi return; 17045399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi } 17055399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 17065399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi req->attrib = g_attrib_new(io); 17071b0d082bf58143aaad02a819037989fddc6c6b95Vinicius Costa Gomes g_io_channel_unref(io); 17081b0d082bf58143aaad02a819037989fddc6c6b95Vinicius Costa Gomes 17095399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi gatt_discover_primary(req->attrib, NULL, primary_cb, req); 17105399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi} 17115399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 17127e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demarioint device_browse_primary(struct btd_device *device, DBusConnection *conn, 17137e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario DBusMessage *msg, gboolean secure) 17143d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz{ 171518614bd2b008cb9f3879990883c569c37b72f195Alok Barsode struct btd_adapter *adapter = device->adapter; 17163d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz struct browse_req *req; 17175399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi BtIOSecLevel sec_level; 17181b0d082bf58143aaad02a819037989fddc6c6b95Vinicius Costa Gomes GIOChannel *io; 1719cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bdaddr_t src; 17207e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario 17217e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario if (device->browse) 17227e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario return -EBUSY; 17232a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode 1724d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi req = g_new0(struct browse_req, 1); 1725d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi req->device = btd_device_ref(device); 17261af86fb9d1717a27b3a776fc0fb62c96045ccb9aJohan Hedberg 17272a8fb41c4c57b24a22f3adaab472b416faae122eAlok Barsode adapter_get_address(adapter, &src); 17283d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 17295399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi sec_level = secure ? BT_IO_SEC_HIGH : BT_IO_SEC_LOW; 17305399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 17311b0d082bf58143aaad02a819037989fddc6c6b95Vinicius Costa Gomes io = bt_io_connect(BT_IO_L2CAP, gatt_connect_cb, req, NULL, NULL, 17325399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi BT_IO_OPT_SOURCE_BDADDR, &src, 17335399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi BT_IO_OPT_DEST_BDADDR, &device->bdaddr, 17341f8969c0435f8d49c20f46dba9bece21031997c7Johan Hedberg BT_IO_OPT_CID, ATT_CID, 17355399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi BT_IO_OPT_SEC_LEVEL, sec_level, 17365399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi BT_IO_OPT_INVALID); 17375399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi 17381b0d082bf58143aaad02a819037989fddc6c6b95Vinicius Costa Gomes if (io == NULL ) { 1739d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi browse_request_free(req); 17405399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi return -EIO; 17417e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario } 1742438ab01b43075b715345df0d85447aaf338fd4fcLuiz Augusto von Dentz 17437e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario if (conn == NULL) 17447e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario conn = get_dbus_connection(); 17457e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario 17467e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario req->conn = dbus_connection_ref(conn); 17477e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario device->browse = req; 17487e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario 17497e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario if (msg) { 17507e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario const char *sender = dbus_message_get_sender(msg); 17517e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario 17527e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario req->msg = dbus_message_ref(msg); 17537e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario /* Track the request owner to cancel it 17547e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario * automatically if the owner exits */ 17557e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario req->listener_id = g_dbus_add_disconnect_watch(conn, 17567e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario sender, 17577e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario discover_services_req_exit, 17587e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario req, NULL); 1759d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi } 1760d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 17615399423bd667efa5d15d8dec895250fe5a3bbec2Claudio Takahasi return 0; 1762d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi} 1763d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 17647e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demarioint device_browse_sdp(struct btd_device *device, DBusConnection *conn, 17657e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario DBusMessage *msg, uuid_t *search, gboolean reverse) 1766d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi{ 1767d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi struct btd_adapter *adapter = device->adapter; 1768d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi struct browse_req *req; 1769d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi bt_callback_t cb; 1770d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi bdaddr_t src; 1771d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi uuid_t uuid; 17727e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario int err; 17737e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario 17747e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario if (device->browse) 17757e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario return -EBUSY; 17763d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz 1777d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi adapter_get_address(adapter, &src); 1778d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 1779d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi req = g_new0(struct browse_req, 1); 1780d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi req->device = btd_device_ref(device); 1781a6f07d2bf12942854072c37c3c42d7447921beeeMarcel Holtmann if (search) { 1782040728e5019fce4eba5790939329fae0aa9104ffClaudio Takahasi memcpy(&uuid, search, sizeof(uuid_t)); 1783da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz cb = search_cb; 1784a6f07d2bf12942854072c37c3c42d7447921beeeMarcel Holtmann } else { 17857d3301934f1b30d90646c97f40464ed198be91d3David Woodhouse sdp_uuid16_create(&uuid, uuid_list[req->search_uuid++]); 178669adac833c5633714b84bf840c75aa814193b8a6Johan Hedberg init_browse(req, reverse); 1787da8ef81cf060726782614baeea5b7e2c466b2341Luiz Augusto von Dentz cb = browse_cb; 1788a6f07d2bf12942854072c37c3c42d7447921beeeMarcel Holtmann } 1789d69e08eb0d567b61106ca37e0546402f4ae0c34eMarcel Holtmann 17907e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario err = bt_search_service(&src, &device->bdaddr, &uuid, cb, req, NULL); 17917e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario if (err < 0) { 1792d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi browse_request_free(req); 1793d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi return err; 17947e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario } 1795d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 1796d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi if (conn == NULL) 1797d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi conn = get_dbus_connection(); 1798d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi 1799d49c4e8457a3169f32c9b7466516b2d2e83b0f6cClaudio Takahasi req->conn = dbus_connection_ref(conn); 1800a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz device->browse = req; 1801d0c0409d8ad37a042539706ff5382899acc81395Johan Hedberg 1802d0c0409d8ad37a042539706ff5382899acc81395Johan Hedberg if (msg) { 18037c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg const char *sender = dbus_message_get_sender(msg); 18047c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg 18055c6426eff87049c9f8e49877f650772840907239Luiz Augusto von Dentz req->msg = dbus_message_ref(msg); 1806d0c0409d8ad37a042539706ff5382899acc81395Johan Hedberg /* Track the request owner to cancel it 1807d0c0409d8ad37a042539706ff5382899acc81395Johan Hedberg * automatically if the owner exits */ 1808a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz req->listener_id = g_dbus_add_disconnect_watch(conn, 18097c9a25e3a7bfbc50d4e7e8c151d08c213076d960Johan Hedberg sender, 181095e5960735be4066d43f77d91ebe78771cd76a43Luiz Augusto von Dentz discover_services_req_exit, 1811e8610fcbe0341a4879b8230d97cd27f5f8cf9f58Luiz Augusto von Dentz req, NULL); 1812d0c0409d8ad37a042539706ff5382899acc81395Johan Hedberg } 181395e5960735be4066d43f77d91ebe78771cd76a43Luiz Augusto von Dentz 1814a4145c63530b4c3575b7da5f117c0df352f939fcLuiz Augusto von Dentz return err; 18153d9966f38f1d6ca12c9e9e2eace5181ba04844b4Luiz Augusto von Dentz} 181624cce397c3479e95f3e525da9285234fbafd2984Marcel Holtmann 181718614bd2b008cb9f3879990883c569c37b72f195Alok Barsodestruct btd_adapter *device_get_adapter(struct btd_device *device) 1818dcf5298e8173e946e3ac2ef6150ad78d030b15d0Alok Barsode{ 1819dcf5298e8173e946e3ac2ef6150ad78d030b15d0Alok Barsode if (!device) 1820dcf5298e8173e946e3ac2ef6150ad78d030b15d0Alok Barsode return NULL; 1821dcf5298e8173e946e3ac2ef6150ad78d030b15d0Alok Barsode 1822dcf5298e8173e946e3ac2ef6150ad78d030b15d0Alok Barsode return device->adapter; 1823dcf5298e8173e946e3ac2ef6150ad78d030b15d0Alok Barsode} 1824dcf5298e8173e946e3ac2ef6150ad78d030b15d0Alok Barsode 182519ce4933f3dadf3b04a2a9bd84d66d750cc010c3Alok Barsodevoid device_get_address(struct btd_device *device, bdaddr_t *bdaddr) 1826aec749f0732638f182c4b50fb59d6c905a80d42dAlok Barsode{ 1827cbf6ef965b0db117ec9b762aad9cff995fd3b0bfAlok Barsode bacpy(bdaddr, &device->bdaddr); 1828aec749f0732638f182c4b50fb59d6c905a80d42dAlok Barsode} 1829aec749f0732638f182c4b50fb59d6c905a80d42dAlok Barsode 1830555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsodeconst gchar *device_get_path(struct btd_device *device) 183146fd7beaa5b27f74e64d77449247e5459d7a3084Alok Barsode{ 183246fd7beaa5b27f74e64d77449247e5459d7a3084Alok Barsode if (!device) 183346fd7beaa5b27f74e64d77449247e5459d7a3084Alok Barsode return NULL; 183446fd7beaa5b27f74e64d77449247e5459d7a3084Alok Barsode 183546fd7beaa5b27f74e64d77449247e5459d7a3084Alok Barsode return device->path; 183646fd7beaa5b27f74e64d77449247e5459d7a3084Alok Barsode} 183746fd7beaa5b27f74e64d77449247e5459d7a3084Alok Barsode 1838555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsodestruct agent *device_get_agent(struct btd_device *device) 1839a2335a65bb61313b3e46be861c90ca8bdb786eb8Alok Barsode{ 1840a2335a65bb61313b3e46be861c90ca8bdb786eb8Alok Barsode if (!device) 1841a2335a65bb61313b3e46be861c90ca8bdb786eb8Alok Barsode return NULL; 1842a2335a65bb61313b3e46be861c90ca8bdb786eb8Alok Barsode 184350996c3a0b0eb98f3cb1c202257d063992c7220dJohan Hedberg if (device->agent) 184450996c3a0b0eb98f3cb1c202257d063992c7220dJohan Hedberg return device->agent; 184550996c3a0b0eb98f3cb1c202257d063992c7220dJohan Hedberg 184650996c3a0b0eb98f3cb1c202257d063992c7220dJohan Hedberg return adapter_get_agent(device->adapter); 1847a2335a65bb61313b3e46be861c90ca8bdb786eb8Alok Barsode} 1848a2335a65bb61313b3e46be861c90ca8bdb786eb8Alok Barsode 1849555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsodegboolean device_is_busy(struct btd_device *device) 18509f94306bcd017a6acb152685c940ed6d027a98c7Alok Barsode{ 1851a6a65ceb00cf583c8be297b4bf489eec7a92a768Luiz Augusto von Dentz return device->browse ? TRUE : FALSE; 18529f94306bcd017a6acb152685c940ed6d027a98c7Alok Barsode} 18539f94306bcd017a6acb152685c940ed6d027a98c7Alok Barsode 1854555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsodegboolean device_is_temporary(struct btd_device *device) 1855f169545f05c25960c094c12f11a4ee452fb96ba8Alok Barsode{ 1856f169545f05c25960c094c12f11a4ee452fb96ba8Alok Barsode return device->temporary; 1857f169545f05c25960c094c12f11a4ee452fb96ba8Alok Barsode} 1858f169545f05c25960c094c12f11a4ee452fb96ba8Alok Barsode 1859555fcc9b4bf67e923708af8de46aa91b7077f050Alok Barsodevoid device_set_temporary(struct btd_device *device, gboolean temporary) 1860595bd38a9fe105ef20d1b0527e04c7d28532d22dAlok Barsode{ 1861595bd38a9fe105ef20d1b0527e04c7d28532d22dAlok Barsode if (!device) 1862595bd38a9fe105ef20d1b0527e04c7d28532d22dAlok Barsode return; 1863595bd38a9fe105ef20d1b0527e04c7d28532d22dAlok Barsode 1864b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg DBG("temporary %d", temporary); 186529227ad09e8996699e1b1d7e1c90d45fc80cab65Alok Barsode 1866b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg device->temporary = temporary; 18672203f153c53189ec1c30df99b717e035681196e6Alok Barsode} 1868c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz 18693e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliyvoid device_set_bonded(struct btd_device *device, gboolean bonded) 18703e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy{ 18713e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy if (!device) 18723e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy return; 18733e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy 18743e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy DBG("bonded %d", bonded); 18753e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy 18763e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy device->bonded = bonded; 18773e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy} 18783e28ead202ff45d0fd66876f6a9cd3e8c3dbf42eDmitriy Paliy 1879fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomesvoid device_set_type(struct btd_device *device, device_type_t type) 1880fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomes{ 1881fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomes if (!device) 1882fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomes return; 1883fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomes 1884fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomes device->type = type; 1885fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomes} 1886fba8f0e7d1fdefe35074f808a691e242d19edf92Vinicius Costa Gomes 1887013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedbergstatic gboolean start_discovery(gpointer user_data) 1888013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg{ 1889013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg struct btd_device *device = user_data; 1890013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg 18917e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario device_browse_sdp(device, NULL, NULL, NULL, TRUE); 1892013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg 1893013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg device->discov_timer = 0; 1894013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg 1895013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg return FALSE; 1896013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg} 1897013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg 18988b78d14dd4ac9776f5848dee94ce2fcf976fd6d8Luiz Augusto von Dentzstatic DBusMessage *new_authentication_return(DBusMessage *msg, int status) 1899013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg{ 19002aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz switch (status) { 19012aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x00: /* success */ 19022aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return dbus_message_new_method_return(msg); 19032aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19042aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x04: /* page timeout */ 190596762463061ffbe566c7f8916d230b4190ec3b6fJohan Hedberg return dbus_message_new_error(msg, 190696762463061ffbe566c7f8916d230b4190ec3b6fJohan Hedberg ERROR_INTERFACE ".ConnectionAttemptFailed", 190796762463061ffbe566c7f8916d230b4190ec3b6fJohan Hedberg "Page Timeout"); 19082aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x08: /* connection timeout */ 190996762463061ffbe566c7f8916d230b4190ec3b6fJohan Hedberg return dbus_message_new_error(msg, 191096762463061ffbe566c7f8916d230b4190ec3b6fJohan Hedberg ERROR_INTERFACE ".ConnectionAttemptFailed", 191196762463061ffbe566c7f8916d230b4190ec3b6fJohan Hedberg "Connection Timeout"); 19122aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x10: /* connection accept timeout */ 19132aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x22: /* LMP response timeout */ 19142aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x28: /* instant passed - is this a timeout? */ 19152aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return dbus_message_new_error(msg, 19162aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ERROR_INTERFACE ".AuthenticationTimeout", 19172aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz "Authentication Timeout"); 19182aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x17: /* too frequent pairing attempts */ 19192aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return dbus_message_new_error(msg, 19202aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ERROR_INTERFACE ".RepeatedAttempts", 19212aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz "Repeated Attempts"); 19222aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19232aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x06: 19242aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x18: /* pairing not allowed (e.g. gw rejected attempt) */ 19252aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return dbus_message_new_error(msg, 19262aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ERROR_INTERFACE ".AuthenticationRejected", 19272aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz "Authentication Rejected"); 19282aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19292aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x07: /* memory capacity */ 19302aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x09: /* connection limit */ 19312aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x0a: /* synchronous connection limit */ 19322aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x0d: /* limited resources */ 19332aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x13: /* user ended the connection */ 19342aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x14: /* terminated due to low resources */ 1935922daca3e63d106c8cb8a56575cec0d1d9bd45a5Luiz Augusto von Dentz case 0x16: /* connection terminated */ 19362aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return dbus_message_new_error(msg, 19372aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ERROR_INTERFACE ".AuthenticationCanceled", 19382aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz "Authentication Canceled"); 19392aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19402aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x05: /* authentication failure */ 19412aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x0E: /* rejected due to security reasons - is this auth failure? */ 19422aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x25: /* encryption mode not acceptable - is this auth failure? */ 19432aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x26: /* link key cannot be changed - is this auth failure? */ 19442aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x29: /* pairing with unit key unsupported - is this auth failure? */ 19452aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case 0x2f: /* insufficient security - is this auth failure? */ 19462aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz default: 19472aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return dbus_message_new_error(msg, 19482aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ERROR_INTERFACE ".AuthenticationFailed", 19492aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz "Authentication Failed"); 19502aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 19512aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 19522aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19538d07c9eea9156c18c9323cb08728566e5f446703Luiz Augusto von Dentzstatic void bonding_request_free(struct bonding_req *bonding) 19542aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 19552aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device; 19562aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19572aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!bonding) 19582aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return; 19592aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19602aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (bonding->listener_id) 19612aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz g_dbus_remove_watch(bonding->conn, bonding->listener_id); 196268b27e68b50b1e68d663142d2b0432c435329ea6Johan Hedberg 19632aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (bonding->msg) 19642aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz dbus_message_unref(bonding->msg); 19652aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19662aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (bonding->conn) 19672aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz dbus_connection_unref(bonding->conn); 19682aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19698d07c9eea9156c18c9323cb08728566e5f446703Luiz Augusto von Dentz if (bonding->io) 19702aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz g_io_channel_unref(bonding->io); 19712aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19722aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device = bonding->device; 19734c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz g_free(bonding); 19742aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19754c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz if (!device) 19764c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz return; 19772aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19782aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device->bonding = NULL; 19794c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz 19803ba95c2c6e3ae23b385d70e96cd733626ca87244Luiz Augusto von Dentz adapter_resume_discovery(device->adapter); 19813ba95c2c6e3ae23b385d70e96cd733626ca87244Luiz Augusto von Dentz 19824c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz if (!device->agent) 19834c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz return; 19844c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz 19852975f0c78ce85dd5cfa85be196ac14a4d570e48cJohan Hedberg agent_cancel(device->agent); 1986cc35f24a2a728c4e8c31ea0c6c11c6b701901861Johan Hedberg agent_free(device->agent); 19874c736d92510c0a61fa8df49698903676c4e21d4bLuiz Augusto von Dentz device->agent = NULL; 19882aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 19892aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 19906fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedbergvoid device_set_paired(struct btd_device *device, gboolean value) 19912aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 19922aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusConnection *conn = get_dbus_connection(); 199368b27e68b50b1e68d663142d2b0432c435329ea6Johan Hedberg 19946fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg if (device->paired == value) 19956fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg return; 19966fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg 19976fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg device->paired = value; 19986fe85942c1272ef3d4ef68a35eade7a276219bb6Johan Hedberg 1999c0736ea762bfea95e98c8b9f118b4e5464f2159cJohan Hedberg emit_property_changed(conn, device->path, DEVICE_INTERFACE, "Paired", 20002aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBUS_TYPE_BOOLEAN, &value); 20012aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 20022aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20032aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzstatic void device_agent_removed(struct agent *agent, void *user_data) 20042aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 20052aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device = user_data; 20062aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2007e5e25c761845284c6aca75599bc75c8e0d901311Johan Hedberg device->agent = NULL; 20082aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20092aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (device->authr) 20102aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device->authr->agent = NULL; 20112aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 20122aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20132aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzstatic struct bonding_req *bonding_request_new(DBusConnection *conn, 20142aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusMessage *msg, 20152aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device, 20162aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz const char *agent_path, 20172aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz uint8_t capability) 20182aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 20192aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct bonding_req *bonding; 20202aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz const char *name = dbus_message_get_sender(msg); 20212aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct agent *agent; 202216348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 20232aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 202416348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 202516348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("Requesting bonding for %s", addr); 20262aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20272aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!agent_path) 20282aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz goto proceed; 20292aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20302aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz agent = agent_create(device->adapter, name, agent_path, 20312aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz capability, 20322aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device_agent_removed, 20332aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device); 20342aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!agent) { 20352aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz error("Unable to create a new agent"); 20362aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return NULL; 20372aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 20382aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20392aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device->agent = agent; 20402aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20418e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("Temporary agent registered for %s at %s:%s", 204216348199ed59c49a710805a5061c3f22477715bfJohan Hedberg addr, name, agent_path); 20432aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20442aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzproceed: 20452aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bonding = g_new0(struct bonding_req, 1); 20462aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20472aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bonding->conn = dbus_connection_ref(conn); 20482aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bonding->msg = dbus_message_ref(msg); 20492aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20503ba95c2c6e3ae23b385d70e96cd733626ca87244Luiz Augusto von Dentz adapter_suspend_discovery(device->adapter); 20513ba95c2c6e3ae23b385d70e96cd733626ca87244Luiz Augusto von Dentz 20522aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return bonding; 20532aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 20542aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20552aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzstatic void create_bond_req_exit(DBusConnection *conn, void *user_data) 20562aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 20572aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device = user_data; 205816348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 20592aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 206016348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 206116348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("%s: requestor exited before bonding was completed", addr); 20622aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20632aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (device->authr) 2064f7d1ee361e410e096929bd3918178af356c50bbdJohan Hedberg device_cancel_authentication(device, FALSE); 20652aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20662aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (device->bonding) { 20672aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device->bonding->listener_id = 0; 2068c3cfa26a86a25e35d8b0e7c24978a44f9af80a2aLuiz Augusto von Dentz device_request_disconnect(device, NULL); 20692aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 20702aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 20712aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20722aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von DentzDBusMessage *device_create_bonding(struct btd_device *device, 20732aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusConnection *conn, 20742aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusMessage *msg, 20752aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz const char *agent_path, 20762aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz uint8_t capability) 20772aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 20782aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz char filename[PATH_MAX + 1]; 20792aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz char *str, srcaddr[18], dstaddr[18]; 20802aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_adapter *adapter = device->adapter; 20812aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct bonding_req *bonding; 20822aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bdaddr_t src; 2083b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg int err; 20842aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20852aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz adapter_get_address(adapter, &src); 20862aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ba2str(&src, srcaddr); 20872aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ba2str(&device->bdaddr, dstaddr); 20882aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20892aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (device->bonding) 2090bd3cf4860d056d3044b7eb8a4e03c53934eb20a6Gustavo F. Padovan return btd_error_in_progress(msg); 20912aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20922aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz /* check if a link key already exists */ 20932aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz create_name(filename, PATH_MAX, STORAGEDIR, srcaddr, 20942aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz "linkkeys"); 20952aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 20962aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz str = textfile_caseget(filename, dstaddr); 20972aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (str) { 20982aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz free(str); 209973774f1b253c882f9fa2a21b3df4b2bd52fbc3ceGustavo F. Padovan return btd_error_already_exists(msg); 21002aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 21012aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2102b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg err = adapter_create_bonding(adapter, &device->bdaddr, capability); 2103b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg if (err < 0) 2104b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg return btd_error_failed(msg, strerror(-err)); 21052aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 21062aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bonding = bonding_request_new(conn, msg, device, agent_path, 21072aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz capability); 21082aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!bonding) { 2109b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg adapter_cancel_bonding(adapter, &device->bdaddr); 21102aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return NULL; 21112aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 21122aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 21132aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bonding->listener_id = g_dbus_add_disconnect_watch(conn, 21142aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz dbus_message_get_sender(msg), 21152aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz create_bond_req_exit, device, 21162aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz NULL); 21172aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 21182aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device->bonding = bonding; 21192aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz bonding->device = device; 21202aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 21212aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return NULL; 21222aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 21232aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2124e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedbergvoid device_simple_pairing_complete(struct btd_device *device, uint8_t status) 2125e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg{ 2126e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg struct authentication_req *auth = device->authr; 2127e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg 2128e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg if (auth && auth->type == AUTH_TYPE_NOTIFY && auth->agent) 2129e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg agent_cancel(auth->agent); 2130e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg} 2131e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg 2132a53621433ce81981a1fc2e610086ff528f1770efJohan Hedbergstatic void device_auth_req_free(struct btd_device *device) 2133f0ab6f3c4c8de3a49591d484a59c30a021b4e4c1Johan Hedberg{ 2134f0ab6f3c4c8de3a49591d484a59c30a021b4e4c1Johan Hedberg g_free(device->authr); 2135f0ab6f3c4c8de3a49591d484a59c30a021b4e4c1Johan Hedberg device->authr = NULL; 2136f0ab6f3c4c8de3a49591d484a59c30a021b4e4c1Johan Hedberg} 2137f0ab6f3c4c8de3a49591d484a59c30a021b4e4c1Johan Hedberg 21382aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzvoid device_bonding_complete(struct btd_device *device, uint8_t status) 21392aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 21402aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct bonding_req *bonding = device->bonding; 2141e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg struct authentication_req *auth = device->authr; 2142f945a68fa973a13a0f57437e291258eb9f05dd7aJaikumar Ganesh bdaddr_t bdaddr; 2143e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg 2144b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg DBG("bonding %p status 0x%02x", bonding, status); 2145b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg 2146e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg if (auth && auth->type == AUTH_TYPE_NOTIFY && auth->agent) 2147e35dd0c0246236371269b79cc28b1a23f4999560Johan Hedberg agent_cancel(auth->agent); 21482aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 21498bbc3fa4c0456c39c4174ab4be4bf39efe0de091jhtop.kim // Temporary hack till we move to mgmt interface. 21508bbc3fa4c0456c39c4174ab4be4bf39efe0de091jhtop.kim if (status == 0x06 && auth == NULL) { 2151f945a68fa973a13a0f57437e291258eb9f05dd7aJaikumar Ganesh device_remove_bonding(device); 2152f945a68fa973a13a0f57437e291258eb9f05dd7aJaikumar Ganesh device_get_address(device, &bdaddr); 2153f945a68fa973a13a0f57437e291258eb9f05dd7aJaikumar Ganesh btd_adapter_retry_authentication(device->adapter, &bdaddr); 21548bbc3fa4c0456c39c4174ab4be4bf39efe0de091jhtop.kim return; 2155f945a68fa973a13a0f57437e291258eb9f05dd7aJaikumar Ganesh } else if (status) { 21564a4471e7e071fe8e8ae68d1b130dac6db9748fe2Luiz Augusto von Dentz device_cancel_authentication(device, TRUE); 2157bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg device_cancel_bonding(device, status); 2158bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg return; 2159bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg } 21602aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2161a53621433ce81981a1fc2e610086ff528f1770efJohan Hedberg device_auth_req_free(device); 2162bcb6af7fc78234948ba1c997825c8859464b170bJohan Hedberg 2163b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg /* If we're already paired nothing more is needed */ 2164b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg if (device->paired) 2165bcb6af7fc78234948ba1c997825c8859464b170bJohan Hedberg return; 2166bcb6af7fc78234948ba1c997825c8859464b170bJohan Hedberg 2167b9efb73d372a913dc52b3ba216cb7ac8de9f4cbcJohan Hedberg device_set_paired(device, TRUE); 2168e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg 216968b27e68b50b1e68d663142d2b0432c435329ea6Johan Hedberg /* If we were initiators start service discovery immediately. 217068b27e68b50b1e68d663142d2b0432c435329ea6Johan Hedberg * However if the other end was the initator wait a few seconds 217168b27e68b50b1e68d663142d2b0432c435329ea6Johan Hedberg * before SDP. This is due to potential IOP issues if the other 217268b27e68b50b1e68d663142d2b0432c435329ea6Johan Hedberg * end starts doing SDP at the same time as us */ 2173e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg if (bonding) { 2174629c9dbe7f161c0c285749bb014f55a2b30fd65cJohan Hedberg DBG("Proceeding with service discovery"); 2175e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg /* If we are initiators remove any discovery timer and just 2176e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg * start discovering services directly */ 2177e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg if (device->discov_timer) { 2178e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg g_source_remove(device->discov_timer); 2179e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg device->discov_timer = 0; 2180e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg } 2181e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg 21827e6edb65cfabc1b9a7f131f6f51938bb1f57f0f9Sheldon Demario device_browse_sdp(device, bonding->conn, bonding->msg, 21832aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz NULL, FALSE); 21845e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz 2185e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg bonding_request_free(bonding); 2186e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg } else { 21875e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz if (!device->browse && !device->discov_timer && 21885e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz main_opts.reverse_sdp) { 21895e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz /* If we are not initiators and there is no currently 21905e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz * active discovery or discovery timer, set discovery 21915e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz * timer */ 21928e58667ef0a4cda88ac64137728da28d8fdf3f0fGustavo F. Padovan DBG("setting timer for reverse service discovery"); 21935e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz device->discov_timer = g_timeout_add_seconds( 21945e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz DISCOVERY_TIMER, 21955e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz start_discovery, 21965e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz device); 21975e5fbd39b64ff0ad84e9be9a51daa020638e679bLuiz Augusto von Dentz } 2198e4d0a3b9051923b015ce633f9385e5af126211feJohan Hedberg } 21992aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 22002aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2201e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberggboolean device_is_creating(struct btd_device *device, const char *sender) 2202e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg{ 2203e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg DBusMessage *msg; 2204e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg 2205e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg if (device->bonding && device->bonding->msg) 2206e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg msg = device->bonding->msg; 2207e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg else if (device->browse && device->browse->msg) 2208e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg msg = device->browse->msg; 2209e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg else 2210e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg return FALSE; 2211e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg 2212e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg if (!dbus_message_is_method_call(msg, ADAPTER_INTERFACE, 2213e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg "CreatePairedDevice") && 2214e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg !dbus_message_is_method_call(msg, ADAPTER_INTERFACE, 2215e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg "CreateDevice")) 2216e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg return FALSE; 2217e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg 2218e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg if (sender == NULL) 2219e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg return TRUE; 2220e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg 2221e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg return g_str_equal(sender, dbus_message_get_sender(msg)); 2222e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg} 2223e164ff20b95acd2a25c70623212c190abf7eee19Johan Hedberg 22242aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzgboolean device_is_bonding(struct btd_device *device, const char *sender) 22252aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 22262aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct bonding_req *bonding = device->bonding; 22272aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22282aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!device->bonding) 22292aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return FALSE; 22302aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22312aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!sender) 22322aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return TRUE; 22332aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22342aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return g_str_equal(sender, dbus_message_get_sender(bonding->msg)); 22352aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 2236e21ec2652c54dbc8abbf84039b43fbd3be0b5ebcJohan Hedberg 22372aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzvoid device_cancel_bonding(struct btd_device *device, uint8_t status) 22382aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 22392aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct bonding_req *bonding = device->bonding; 22402aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusMessage *reply; 224116348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 22422aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22432aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!bonding) 22442aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return; 22452aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 224616348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 224716348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("Canceling bonding request for %s", addr); 22482aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22492aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (device->authr) 2250f7d1ee361e410e096929bd3918178af356c50bbdJohan Hedberg device_cancel_authentication(device, FALSE); 22512aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22522aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz reply = new_authentication_return(bonding->msg, status); 22532aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz g_dbus_send_message(bonding->conn, reply); 22542aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22558d07c9eea9156c18c9323cb08728566e5f446703Luiz Augusto von Dentz bonding_request_cancel(bonding); 22568d07c9eea9156c18c9323cb08728566e5f446703Luiz Augusto von Dentz bonding_request_free(bonding); 22572aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 22582aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2259bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedbergstatic void pincode_cb(struct agent *agent, DBusError *err, 2260bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg const char *pincode, void *data) 22612aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 22622aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct authentication_req *auth = data; 22632aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device = auth->device; 22642aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22652aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz /* No need to reply anything if the authentication already failed */ 22662bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz if (auth->cb == NULL) 22672aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return; 22682aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22692aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ((agent_pincode_cb) auth->cb)(agent, err, pincode, device); 22702aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2271a9c4e4a0aec81cecbc2bded149b924028953a952Luiz Augusto von Dentz device->authr->cb = NULL; 2272a9c4e4a0aec81cecbc2bded149b924028953a952Luiz Augusto von Dentz device->authr->agent = NULL; 22732aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 22742aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22752aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzstatic void confirm_cb(struct agent *agent, DBusError *err, void *data) 22762aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 22772aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct authentication_req *auth = data; 22782aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device = auth->device; 22792aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22802aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz /* No need to reply anything if the authentication already failed */ 22812bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz if (auth->cb == NULL) 22822aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return; 22832aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22842aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ((agent_cb) auth->cb)(agent, err, device); 22852aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2286a9c4e4a0aec81cecbc2bded149b924028953a952Luiz Augusto von Dentz device->authr->cb = NULL; 2287a9c4e4a0aec81cecbc2bded149b924028953a952Luiz Augusto von Dentz device->authr->agent = NULL; 22882aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 22892aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2290bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedbergstatic void passkey_cb(struct agent *agent, DBusError *err, 2291bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg uint32_t passkey, void *data) 22922aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 22932aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct authentication_req *auth = data; 22942aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct btd_device *device = auth->device; 22952aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 22962aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz /* No need to reply anything if the authentication already failed */ 22972bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz if (auth->cb == NULL) 22982aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return; 22992aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 23002aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ((agent_passkey_cb) auth->cb)(agent, err, passkey, device); 23012aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2302a9c4e4a0aec81cecbc2bded149b924028953a952Luiz Augusto von Dentz device->authr->cb = NULL; 2303a9c4e4a0aec81cecbc2bded149b924028953a952Luiz Augusto von Dentz device->authr->agent = NULL; 23042aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 23052aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 23067050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganeshstatic void pairing_consent_cb(struct agent *agent, DBusError *err, void *data) 23077050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh{ 23087050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh struct authentication_req *auth = data; 23097050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh struct btd_device *device = auth->device; 23107050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh 23117050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh /* No need to reply anything if the authentication already failed */ 23127050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh if (!auth->cb) 23137050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh return; 23147050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh 23157050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh ((agent_cb) auth->cb)(agent, err, device); 23167050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh 23177050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh auth->cb = NULL; 23187050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh} 23197050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh 23202aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzint device_request_authentication(struct btd_device *device, auth_type_t type, 2321bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg uint32_t passkey, void *cb) 23222aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 23232aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct authentication_req *auth; 23242aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct agent *agent; 232516348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 2326bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg int err; 23272aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 232816348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 232916348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("Requesting agent authentication for %s", addr); 233016348199ed59c49a710805a5061c3f22477715bfJohan Hedberg 2331508fdc901e7e1721eef19de5d8ab6e2f1f313dd7Rafal Michalski if (device->authr) { 233216348199ed59c49a710805a5061c3f22477715bfJohan Hedberg error("Authentication already requested for %s", addr); 2333508fdc901e7e1721eef19de5d8ab6e2f1f313dd7Rafal Michalski return -EALREADY; 2334508fdc901e7e1721eef19de5d8ab6e2f1f313dd7Rafal Michalski } 2335508fdc901e7e1721eef19de5d8ab6e2f1f313dd7Rafal Michalski 2336ca0465aff7258cc249e7cba0631fbb11b7829b9eJohan Hedberg agent = device_get_agent(device); 23372aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!agent) { 233816348199ed59c49a710805a5061c3f22477715bfJohan Hedberg error("No agent available for request type %d", type); 23392aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return -EPERM; 23402aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 23412aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 23422aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz auth = g_new0(struct authentication_req, 1); 23432aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz auth->agent = agent; 23442aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz auth->device = device; 23452aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz auth->cb = cb; 23462aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz auth->type = type; 23472aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz device->authr = auth; 23482aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 23492aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz switch (type) { 23502aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_PINCODE: 2351bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg err = agent_request_pincode(agent, device, pincode_cb, 2352fc4c6f53f10e4aba7c3183ba294618ec489fc683Johan Hedberg auth, NULL); 23532aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 23542aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_PASSKEY: 2355bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg err = agent_request_passkey(agent, device, passkey_cb, 2356fc4c6f53f10e4aba7c3183ba294618ec489fc683Johan Hedberg auth, NULL); 23572aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 23582aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_CONFIRM: 2359bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg err = agent_request_confirmation(agent, device, passkey, 2360fc4c6f53f10e4aba7c3183ba294618ec489fc683Johan Hedberg confirm_cb, auth, NULL); 23612aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 23622aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_NOTIFY: 2363bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg err = agent_display_passkey(agent, device, passkey); 23642aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 23657050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh case AUTH_TYPE_AUTO: 23667050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh err = 0; 23677050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh break; 23687050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh case AUTH_TYPE_PAIRING_CONSENT: 23697050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh err = agent_request_pairing_consent(agent, device, 23707050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh pairing_consent_cb, auth, NULL); 23717050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh break; 23722aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz default: 2373bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg err = -EINVAL; 23742aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 23752aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2376bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg if (err < 0) { 23772aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz error("Failed requesting authentication"); 2378a53621433ce81981a1fc2e610086ff528f1770efJohan Hedberg device_auth_req_free(device); 23792aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 23802aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2381bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg return err; 23822aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 23832aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 23842aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzstatic void cancel_authentication(struct authentication_req *auth) 23852aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 23862bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz struct btd_device *device; 23872bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz struct agent *agent; 23882aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz DBusError err; 23892aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 239037b02c1ef9be4f989c9ad5e511f519d35f2bc088Johan Hedberg if (!auth || !auth->cb) 23912aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return; 23922aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 23932bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz device = auth->device; 23942bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz agent = auth->agent; 23952bf0e14286389430bde40885f1aa6ce51b1e8b8eLuiz Augusto von Dentz 23962aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz dbus_error_init(&err); 23972aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz dbus_set_error_const(&err, "org.bluez.Error.Canceled", NULL); 23982aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 23992aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz switch (auth->type) { 24002aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_PINCODE: 24012aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ((agent_pincode_cb) auth->cb)(agent, &err, NULL, device); 24022aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 24032aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_CONFIRM: 24042aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ((agent_cb) auth->cb)(agent, &err, device); 24052aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 24062aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_PASSKEY: 24072aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz ((agent_passkey_cb) auth->cb)(agent, &err, 0, device); 24082aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 24097050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh case AUTH_TYPE_PAIRING_CONSENT: 24107050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh ((agent_cb) auth->cb) (agent, &err, device); 24117050b0c6c21919186cddda6f2286f43cb99798b2Jaikumar Ganesh break; 24122aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz case AUTH_TYPE_NOTIFY: 24134d21e85715580f468c7f190a3cd25d7fadaba9aaJohan Hedberg /* User Notify doesn't require any reply */ 24142aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz break; 24152aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz } 24162aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 24172aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz dbus_error_free(&err); 24182aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz auth->cb = NULL; 24192aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 24202aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2421f7d1ee361e410e096929bd3918178af356c50bbdJohan Hedbergvoid device_cancel_authentication(struct btd_device *device, gboolean aborted) 24222aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 24232aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz struct authentication_req *auth = device->authr; 242416348199ed59c49a710805a5061c3f22477715bfJohan Hedberg char addr[18]; 24252aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 24262aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (!auth) 24272aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return; 24282aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 242916348199ed59c49a710805a5061c3f22477715bfJohan Hedberg ba2str(&device->bdaddr, addr); 243016348199ed59c49a710805a5061c3f22477715bfJohan Hedberg DBG("Canceling authentication request for %s", addr); 24312aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 24322aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz if (auth->agent) 24332aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz agent_cancel(auth->agent); 24342aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 2435f7d1ee361e410e096929bd3918178af356c50bbdJohan Hedberg if (!aborted) 2436f7d1ee361e410e096929bd3918178af356c50bbdJohan Hedberg cancel_authentication(auth); 2437f7d1ee361e410e096929bd3918178af356c50bbdJohan Hedberg 2438a53621433ce81981a1fc2e610086ff528f1770efJohan Hedberg device_auth_req_free(device); 24392aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz} 24402aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz 24412aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentzgboolean device_is_authenticating(struct btd_device *device) 24422aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz{ 24432aad1cf41acbc69481915d24cef33fa721d4e1fdLuiz Augusto von Dentz return (device->authr != NULL); 2444013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg} 2445013d376e47dc68ec385e9f88d6bc6c07c921ee1aJohan Hedberg 2446837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberggboolean device_is_authorizing(struct btd_device *device) 2447837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg{ 2448837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg return device->authorizing; 2449837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg} 2450837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg 2451837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedbergvoid device_set_authorizing(struct btd_device *device, gboolean auth) 2452837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg{ 2453837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg device->authorizing = auth; 2454837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg} 2455837d65f3a7f94ed4e6fe95f4e845d7ae3242be24Johan Hedberg 24565eb9d13c5b75f3659454466d511533c2f413cbbdClaudio Takahasivoid device_register_services(DBusConnection *conn, struct btd_device *device, 24575eb9d13c5b75f3659454466d511533c2f413cbbdClaudio Takahasi GSList *prim_list, int psm) 245883d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes{ 24598447ce5c943e5b73149321fd4f61ed482c4e9427Claudio Takahasi device->services = attrib_client_register(conn, device, psm, NULL, 24608447ce5c943e5b73149321fd4f61ed482c4e9427Claudio Takahasi prim_list); 24615eb9d13c5b75f3659454466d511533c2f413cbbdClaudio Takahasi device->primaries = g_slist_concat(device->primaries, prim_list); 246283d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes} 246383d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes 246483d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa GomesGSList *btd_device_get_primaries(struct btd_device *device) 246583d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes{ 246683d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes return device->primaries; 246783d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes} 246883d8b6546ccd98ce30c65bc7ec716c42437e569aVinicius Costa Gomes 246917541956196b13ee083852fd4124cd8cfd0928a4Johan Hedbergvoid btd_device_add_uuid(struct btd_device *device, const char *uuid) 247017541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg{ 247117541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg GSList *uuid_list; 247217541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg char *new_uuid; 247317541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg 247417541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg if (g_slist_find_custom(device->uuids, uuid, 247517541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg (GCompareFunc) strcasecmp)) 247617541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg return; 247717541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg 247817541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg new_uuid = g_strdup(uuid); 247917541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg uuid_list = g_slist_append(NULL, new_uuid); 248017541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg 248117541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg device_probe_drivers(device, uuid_list); 248217541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg 24830e073403c77dd0906cd89dbd2d2b6707f4493188Johan Hedberg g_free(new_uuid); 248417541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg g_slist_free(uuid_list); 248517541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg 24860e073403c77dd0906cd89dbd2d2b6707f4493188Johan Hedberg store_profiles(device); 248717541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg services_changed(device); 248817541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg} 248917541956196b13ee083852fd4124cd8cfd0928a4Johan Hedberg 2490548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedbergconst sdp_record_t *btd_device_get_record(struct btd_device *device, 2491bac81ba536a0d77154e01a71b8bb1bd1712d42f6Johan Hedberg const char *uuid) 2492548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg{ 2493548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg bdaddr_t src; 2494548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 249582520ced2eb56caef66cf1265858a76d714fa6c5Luiz Augusto von Dentz if (device->tmp_records) { 249682520ced2eb56caef66cf1265858a76d714fa6c5Luiz Augusto von Dentz const sdp_record_t *record; 249782520ced2eb56caef66cf1265858a76d714fa6c5Luiz Augusto von Dentz 249882520ced2eb56caef66cf1265858a76d714fa6c5Luiz Augusto von Dentz record = find_record_in_list(device->tmp_records, uuid); 249982520ced2eb56caef66cf1265858a76d714fa6c5Luiz Augusto von Dentz if (record != NULL) 250082520ced2eb56caef66cf1265858a76d714fa6c5Luiz Augusto von Dentz return record; 250182520ced2eb56caef66cf1265858a76d714fa6c5Luiz Augusto von Dentz } 2502548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 2503548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg adapter_get_address(device->adapter, &src); 2504548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 2505548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg device->tmp_records = read_records(&src, &device->bdaddr); 2506548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg if (!device->tmp_records) 2507548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg return NULL; 2508548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 2509548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg return find_record_in_list(device->tmp_records, uuid); 2510548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg} 2511548026e08bd9b83b3685d515a916e2cf674184f3Johan Hedberg 2512c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentzint btd_register_device_driver(struct btd_device_driver *driver) 2513c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz{ 2514c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz device_drivers = g_slist_append(device_drivers, driver); 2515c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz 2516c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz return 0; 2517c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz} 2518c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz 2519c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentzvoid btd_unregister_device_driver(struct btd_device_driver *driver) 2520c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz{ 2521c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz device_drivers = g_slist_remove(device_drivers, driver); 2522c560d02ccf1dd156f068b1da8a3e7d75d2319dfdLuiz Augusto von Dentz} 25230ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25240ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentzstruct btd_device *btd_device_ref(struct btd_device *device) 25250ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz{ 25260ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz device->ref++; 25270ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25280f775bfff64dc5e073b3bd098c296da4660aa072Luiz Augusto von Dentz DBG("%p: ref=%d", device, device->ref); 25290ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25300ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz return device; 25310ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz} 25320ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25330ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentzvoid btd_device_unref(struct btd_device *device) 25340ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz{ 25358d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz DBusConnection *conn = get_dbus_connection(); 25360ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz gchar *path; 25370ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25380ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz device->ref--; 25390ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25400f775bfff64dc5e073b3bd098c296da4660aa072Luiz Augusto von Dentz DBG("%p: ref=%d", device, device->ref); 25410ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25420ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz if (device->ref > 0) 25430ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz return; 25440ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25450ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz path = g_strdup(device->path); 25460ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25478d7017d8be3305ed828dee928fc2731d0d89a27bLuiz Augusto von Dentz g_dbus_unregister_interface(conn, path, DEVICE_INTERFACE); 25480ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz 25490ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz g_free(path); 25500ba18c28575090e30fcb3023ea1b4039a2e27610Luiz Augusto von Dentz} 25511f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demario 25521f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demariovoid device_set_class(struct btd_device *device, uint32_t value) 25531f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demario{ 25541f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demario DBusConnection *conn = get_dbus_connection(); 25551f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demario 25561f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demario emit_property_changed(conn, device->path, DEVICE_INTERFACE, "Class", 25571f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demario DBUS_TYPE_UINT32, &value); 25581f921e01c700151bcac3dc9477d85bfff36e05d3Sheldon Demario} 2559