Track mode changes of Bluetooth devices
[connman] / plugins / bluetooth.c
1 /*
2  *
3  *  Connection Manager
4  *
5  *  Copyright (C) 2007-2008  Intel Corporation. All rights reserved.
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License version 2 as
9  *  published by the Free Software Foundation.
10  *
11  *  This program is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *  GNU General Public License for more details.
15  *
16  *  You should have received a copy of the GNU General Public License
17  *  along with this program; if not, write to the Free Software
18  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
19  *
20  */
21
22 #ifdef HAVE_CONFIG_H
23 #include <config.h>
24 #endif
25
26 #include <errno.h>
27
28 #include <gdbus.h>
29
30 #include <connman/plugin.h>
31 #include <connman/driver.h>
32 #include <connman/log.h>
33
34 #define BLUEZ_SERVICE                   "org.bluez"
35 #define BLUEZ_MANAGER_INTERFACE         BLUEZ_SERVICE ".Manager"
36 #define BLUEZ_ADAPTER_INTERFACE         BLUEZ_SERVICE ".Adapter"
37
38 #define ADAPTER_ADDED                   "AdapterAdded"
39 #define ADAPTER_REMOVED                 "AdapterRemoved"
40 #define PROPERTY_CHANGED                "PropertyChanged"
41
42 #define TIMEOUT 5000
43
44 static int bluetooth_probe(struct connman_element *device)
45 {
46         DBG("device %p name %s", device, device->name);
47
48         return 0;
49 }
50
51 static void bluetooth_remove(struct connman_element *device)
52 {
53         DBG("device %p name %s", device, device->name);
54 }
55
56 static int bluetooth_enable(struct connman_element *device)
57 {
58         DBG("device %p name %s", device, device->name);
59
60         return -EINVAL;
61 }
62
63 static int bluetooth_disable(struct connman_element *device)
64 {
65         DBG("device %p name %s", device, device->name);
66
67         return 0;
68 }
69
70 static struct connman_driver bluetooth_driver = {
71         .name           = "bluetooth",
72         .type           = CONNMAN_ELEMENT_TYPE_DEVICE,
73         .subtype        = CONNMAN_ELEMENT_SUBTYPE_BLUETOOTH,
74         .probe          = bluetooth_probe,
75         .remove         = bluetooth_remove,
76         .enable         = bluetooth_enable,
77         .disable        = bluetooth_disable,
78 };
79
80 static GSList *device_list = NULL;
81
82 static struct connman_element *find_adapter(const char *path)
83 {
84         const char *devname = g_basename(path);
85         GSList *list;
86
87         DBG("path %s", path);
88
89         for (list = device_list; list; list = list->next) {
90                 struct connman_element *device = list->data;
91
92                 if (g_str_equal(device->devname, devname) == TRUE)
93                         return device;
94         }
95
96         return NULL;
97 }
98
99 static void property_changed(DBusConnection *connection, DBusMessage *message)
100 {
101         const char *path = dbus_message_get_path(message);
102         struct connman_element *device;
103         DBusMessageIter iter, value;
104         const char *key;
105
106         DBG("path %s", path);
107
108         device = find_adapter(path);
109         if (device == NULL)
110                 return;
111
112         if (dbus_message_iter_init(message, &iter) == FALSE)
113                 return;
114
115         dbus_message_iter_get_basic(&iter, &key);
116
117         if (g_str_equal(key, "Powered") == TRUE) {
118                 gboolean val;
119
120                 dbus_message_iter_next(&iter);
121                 dbus_message_iter_recurse(&iter, &value);
122
123                 dbus_message_iter_get_basic(&value, &val);
124                 connman_element_set_enabled(device, val);
125         }
126 }
127
128 static void properties_reply(DBusPendingCall *call, void *user_data)
129 {
130         DBusMessage *message = user_data;
131         const char *path = dbus_message_get_path(message);
132         struct connman_element *device;
133         DBusMessageIter array, dict;
134         DBusMessage *reply;
135
136         DBG("path %s", path);
137
138         device = find_adapter(path);
139
140         dbus_message_unref(message);
141
142         reply = dbus_pending_call_steal_reply(call);
143
144         if (device == NULL)
145                 goto done;
146
147         if (dbus_message_iter_init(reply, &array) == FALSE)
148                 goto done;
149
150         if (dbus_message_iter_get_arg_type(&array) != DBUS_TYPE_ARRAY)
151                 goto done;
152
153         dbus_message_iter_recurse(&array, &dict);
154         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
155                 DBusMessageIter entry, value;
156                 const char *key;
157
158                 dbus_message_iter_recurse(&dict, &entry);
159                 dbus_message_iter_get_basic(&entry, &key);
160
161                 if (g_str_equal(key, "Powered") == TRUE) {
162                         gboolean val;
163
164                         dbus_message_iter_next(&entry);
165                         dbus_message_iter_recurse(&entry, &value);
166
167                         dbus_message_iter_get_basic(&value, &val);
168                         connman_element_set_enabled(device, val);
169                 }
170
171                 dbus_message_iter_next(&dict);
172         }
173
174 done:
175         dbus_message_unref(reply);
176 }
177
178 static void add_adapter(DBusConnection *connection, const char *path)
179 {
180         struct connman_element *device;
181         DBusMessage *message;
182         DBusPendingCall *call;
183
184         DBG("path %s", path);
185
186         device = find_adapter(path);
187         if (device != NULL)
188                 return;
189
190         device = connman_element_create(NULL);
191         device->type = CONNMAN_ELEMENT_TYPE_DEVICE;
192         device->subtype = CONNMAN_ELEMENT_SUBTYPE_BLUETOOTH;
193
194         device->name = g_path_get_basename(path);
195
196         connman_element_register(device, NULL);
197         device_list = g_slist_append(device_list, device);
198
199         message = dbus_message_new_method_call(BLUEZ_SERVICE, path,
200                                 BLUEZ_ADAPTER_INTERFACE, "GetProperties");
201         if (message == NULL)
202                 return;
203
204         if (dbus_connection_send_with_reply(connection, message,
205                                                 &call, TIMEOUT) == FALSE) {
206                 connman_error("Failed to get adapter properties");
207                 dbus_message_unref(message);
208                 return;
209         }
210
211         dbus_pending_call_set_notify(call, properties_reply, message, NULL);
212 }
213
214 static void remove_adapter(DBusConnection *connection, const char *path)
215 {
216         struct connman_element *device;
217
218         DBG("path %s", path);
219
220         device = find_adapter(path);
221         if (device == NULL)
222                 return;
223
224         device_list = g_slist_remove(device_list, device);
225
226         connman_element_unregister(device);
227         connman_element_unref(device);
228 }
229
230 static void adapters_reply(DBusPendingCall *call, void *user_data)
231 {
232         DBusConnection *connection = user_data;
233         DBusMessage *reply;
234         DBusError error;
235         char **adapters;
236         int i, num_adapters;
237
238         DBG("");
239
240         reply = dbus_pending_call_steal_reply(call);
241
242         dbus_error_init(&error);
243
244         if (dbus_message_get_args(reply, &error,
245                                 DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
246                                                 &adapters, &num_adapters,
247                                                 DBUS_TYPE_INVALID) == FALSE) {
248                 if (dbus_error_is_set(&error) == TRUE) {
249                         connman_error("%s", error.message);
250                         dbus_error_free(&error);
251                 } else
252                         connman_error("Wrong arguments for adapter list");
253                 goto done;
254         }
255
256         for (i = 0; i < num_adapters; i++)
257                 add_adapter(connection, adapters[i]);
258
259         g_strfreev(adapters);
260
261 done:
262         dbus_message_unref(reply);
263 }
264
265 static void bluetooth_connect(DBusConnection *connection, void *user_data)
266 {
267         DBusMessage *message;
268         DBusPendingCall *call;
269
270         DBG("connection %p", connection);
271
272         message = dbus_message_new_method_call(BLUEZ_SERVICE, "/",
273                                 BLUEZ_MANAGER_INTERFACE, "ListAdapters");
274         if (message == NULL)
275                 return;
276
277         if (dbus_connection_send_with_reply(connection, message,
278                                                 &call, TIMEOUT) == FALSE) {
279                 connman_error("Failed to get Bluetooth adapters");
280                 dbus_message_unref(message);
281                 return;
282         }
283
284         dbus_pending_call_set_notify(call, adapters_reply, connection, NULL);
285
286         dbus_message_unref(message);
287 }
288
289 static void bluetooth_disconnect(DBusConnection *connection, void *user_data)
290 {
291         GSList *list;
292
293         DBG("connection %p", connection);
294
295         for (list = device_list; list; list = list->next) {
296                 struct connman_element *device = list->data;
297
298                 connman_element_unregister(device);
299                 connman_element_unref(device);
300         }
301
302         g_slist_free(device_list);
303         device_list = NULL;
304 }
305
306 static DBusHandlerResult bluetooth_signal(DBusConnection *connection,
307                                         DBusMessage *message, void *user_data)
308 {
309         DBG("connection %p", connection);
310
311         if (dbus_message_is_signal(message, BLUEZ_ADAPTER_INTERFACE,
312                                                 PROPERTY_CHANGED) == TRUE) {
313                 property_changed(connection, message);
314         } else if (dbus_message_is_signal(message, BLUEZ_MANAGER_INTERFACE,
315                                                 ADAPTER_ADDED) == TRUE) {
316                 const char *path;
317                 dbus_message_get_args(message, NULL,
318                                         DBUS_TYPE_OBJECT_PATH, &path,
319                                                         DBUS_TYPE_INVALID);
320                 add_adapter(connection, path);
321         } else if (dbus_message_is_signal(message, BLUEZ_MANAGER_INTERFACE,
322                                                 ADAPTER_REMOVED) == TRUE) {
323                 const char *path;
324                 dbus_message_get_args(message, NULL,
325                                         DBUS_TYPE_OBJECT_PATH, &path,
326                                                         DBUS_TYPE_INVALID);
327                 remove_adapter(connection, path);
328         }
329
330         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
331 }
332
333 static DBusConnection *connection;
334 static guint watch;
335
336 static const char *added_rule = "type=signal,member=" ADAPTER_ADDED
337                                         ",interface=" BLUEZ_MANAGER_INTERFACE;
338 static const char *removed_rule = "type=signal,member=" ADAPTER_REMOVED
339                                         ",interface=" BLUEZ_MANAGER_INTERFACE;
340
341 static const char *adapter_rule = "type=signal,member=" PROPERTY_CHANGED
342                                         ",interface=" BLUEZ_ADAPTER_INTERFACE;
343
344 static int bluetooth_init(void)
345 {
346         int err = -EIO;
347
348         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
349         if (connection == NULL)
350                 return -EIO;
351
352         if (dbus_connection_add_filter(connection, bluetooth_signal,
353                                                         NULL, NULL) == FALSE)
354                 goto unref;
355
356         err = connman_driver_register(&bluetooth_driver);
357         if (err < 0)
358                 goto remove;
359
360         watch = g_dbus_add_service_watch(connection, BLUEZ_SERVICE,
361                         bluetooth_connect, bluetooth_disconnect, NULL, NULL);
362         if (watch == 0) {
363                 connman_driver_unregister(&bluetooth_driver);
364                 err = -EIO;
365                 goto remove;
366         }
367
368         if (g_dbus_check_service(connection, BLUEZ_SERVICE) == TRUE)
369                 bluetooth_connect(connection, NULL);
370
371         dbus_bus_add_match(connection, added_rule, NULL);
372         dbus_bus_add_match(connection, removed_rule, NULL);
373         dbus_bus_add_match(connection, adapter_rule, NULL);
374         dbus_connection_flush(connection);
375
376         return 0;
377
378 remove:
379         dbus_connection_remove_filter(connection, bluetooth_signal, NULL);
380
381 unref:
382         dbus_connection_unref(connection);
383
384         return err;
385 }
386
387 static void bluetooth_exit(void)
388 {
389         dbus_bus_remove_match(connection, adapter_rule, NULL);
390         dbus_bus_remove_match(connection, removed_rule, NULL);
391         dbus_bus_remove_match(connection, added_rule, NULL);
392         dbus_connection_flush(connection);
393
394         g_dbus_remove_watch(connection, watch);
395
396         bluetooth_disconnect(connection, NULL);
397
398         connman_driver_unregister(&bluetooth_driver);
399
400         dbus_connection_remove_filter(connection, bluetooth_signal, NULL);
401
402         dbus_connection_unref(connection);
403 }
404
405 CONNMAN_PLUGIN_DEFINE(bluetooth, "Bluetooth technology plugin", VERSION,
406                                                 bluetooth_init, bluetooth_exit)