Now that we are able to keep track of devices appearing and disappearing from BlueZ, we are able to register the modem when a device that supports the HFP AG UUID appears. --- plugins/bluez5.h | 1 + plugins/hfp_hf_bluez5.c | 78 ++++++++++++++++++++++++++++++++++++++++++++++++- 2 files changed, 78 insertions(+), 1 deletion(-) diff --git a/plugins/bluez5.h b/plugins/bluez5.h index 65c0b00..3aa8ffe 100644 --- a/plugins/bluez5.h +++ b/plugins/bluez5.h @@ -26,6 +26,7 @@ #define BLUEZ_ERROR_INTERFACE BLUEZ_SERVICE ".Error" #define HFP_HS_UUID "0000111e-0000-1000-8000-00805f9b34fb" +#define HFP_AG_UUID "0000111f-0000-1000-8000-00805f9b34fb" int bluetooth_register_profile(DBusConnection *conn, const char *uuid, const char *name, const char *object); diff --git a/plugins/hfp_hf_bluez5.c b/plugins/hfp_hf_bluez5.c index e0962a6..fbb1be3 100644 --- a/plugins/hfp_hf_bluez5.c +++ b/plugins/hfp_hf_bluez5.c @@ -42,9 +42,37 @@ #define HFP_EXT_PROFILE_PATH "/bluetooth/profile/hfp_hf" +static GHashTable *modem_hash = NULL; static GHashTable *devices_proxies = NULL; static GDBusClient *bluez = NULL; +static struct ofono_modem *modem_register(const char *device, + const char *alias) +{ + struct ofono_modem *modem; + char *path; + + modem = g_hash_table_lookup(modem_hash, device); + if (modem != NULL) + return modem; + + path = g_strconcat("hfp", device, NULL); + + modem = ofono_modem_create(path, "hfp"); + + g_free(path); + + if (modem == NULL) + return NULL; + + ofono_modem_set_name(modem, alias); + ofono_modem_register(modem); + + g_hash_table_insert(modem_hash, g_strdup(device), modem); + + return modem; +} + static int hfp_probe(struct ofono_modem *modem) { DBG("modem: %p", modem); @@ -154,9 +182,33 @@ static void connect_handler(DBusConnection *conn, void *user_data) HFP_EXT_PROFILE_PATH); } +static gboolean has_hfp_ag_uuid(DBusMessageIter *array) +{ + DBusMessageIter value; + + if (dbus_message_iter_get_arg_type(array) != DBUS_TYPE_ARRAY) + return FALSE; + + dbus_message_iter_recurse(array, &value); + + while (dbus_message_iter_get_arg_type(&value) == DBUS_TYPE_STRING) { + const char *uuid; + + dbus_message_iter_get_basic(&value, &uuid); + + if (g_str_equal(uuid, HFP_AG_UUID) == TRUE) + return TRUE; + + dbus_message_iter_next(&value); + } + + return FALSE; +} + static void proxy_added(GDBusProxy *proxy, void *user_data) { - const char *interface, *path; + const char *interface, *path, *alias; + DBusMessageIter iter; interface = g_dbus_proxy_get_interface(proxy); path = g_dbus_proxy_get_path(proxy); @@ -167,11 +219,25 @@ static void proxy_added(GDBusProxy *proxy, void *user_data) g_hash_table_insert(devices_proxies, g_strdup(path), g_dbus_proxy_ref(proxy)); DBG("Device proxy: %s(%p)", path, proxy); + + if (g_dbus_proxy_get_property(proxy, "UUIDs", &iter) == FALSE) + return; + + if (has_hfp_ag_uuid(&iter) == FALSE) + return; + + if (g_dbus_proxy_get_property(proxy, "Alias", &iter) == FALSE) + return; + + dbus_message_iter_get_basic(&iter, &alias); + + modem_register(path, alias); } static void proxy_removed(GDBusProxy *proxy, void *user_data) { const char *interface, *path; + struct ofono_modem *modem; interface = g_dbus_proxy_get_interface(proxy); path = g_dbus_proxy_get_path(proxy); @@ -181,6 +247,12 @@ static void proxy_removed(GDBusProxy *proxy, void *user_data) DBG("Device proxy: %s(%p)", path, proxy); } + modem = g_hash_table_lookup(modem_hash, path); + if (modem == NULL) + return; + + g_hash_table_remove(modem_hash, path); + ofono_modem_remove(modem); } static void property_changed(GDBusProxy *proxy, const char *name, @@ -227,6 +299,9 @@ static int hfp_init(void) return -ENOMEM; } + modem_hash = g_hash_table_new_full(g_str_hash, g_str_equal, g_free, + NULL); + devices_proxies = g_hash_table_new_full(g_str_hash, g_str_equal, g_free, (GDestroyNotify) g_dbus_proxy_unref); @@ -247,6 +322,7 @@ static void hfp_exit(void) ofono_modem_driver_unregister(&hfp_driver); g_dbus_client_unref(bluez); + g_hash_table_destroy(modem_hash); g_hash_table_destroy(devices_proxies); } -- 1.8.1.1