adapter: wait for kernel exp features in adapter initialization

Things like BAP depend on ISO sockets being enabled in kernel.  It is
possible the MGMT commands enabling experimental kernel features do not
complete, before BAP etc. initialization and probing starts, in which
case BAP will be mostly nonfunctional.

This was observed to occur always when running BlueZ in a Fedora VM,
requiring bluetoothd restart after every boot for BAP to work,
log containing lines in the order:

bluetoothd[981]: src/adapter.c:read_exp_features_complete() 6fbaf188-05e0-496a-9885-d6ddfdb4e03e flags 0 action 1
bluetoothd[981]: src/adapter.c:read_info_complete() index 0 status 0x00
bluetoothd[981]: profiles/audio/bap.c:bap_probe() BAP requires ISO Socket which is not enabled
bluetoothd[981]: src/adapter.c:iso_socket_complete() ISO Socket successfully set

Fix by waiting in adapter initialization that all MGMT exp feature
requests are done, before proceeding to read adapter information.

Also fix canceling MGMT_OP_SET_EXP_FEATURE for ISO sockets.

diff --git a/src/adapter.c b/src/adapter.c
index c33953d..94f1635 100644 (file)
--- a/src/adapter.c
+++ b/src/adapter.c
@@ -264,6 +264,11 @@ struct btd_adapter_pin_cb_iter {
        /* When the iterator reaches the end, it is NULL and attempt is 0 */
 };
 
+struct exp_pending {
+       struct btd_adapter *adapter;
+       unsigned int id;
+};
+
 enum {
        ADAPTER_POWER_STATE_OFF,
        ADAPTER_POWER_STATE_ON,
@@ -424,6 +429,7 @@ struct btd_adapter {
 #endif
        bool is_default;                /* true if adapter is default one */
 
+       struct queue *exp_pending;
        struct queue *exps;
 #ifdef TIZEN_FEATURE_BLUEZ_MODIFY
        bool le_2m_phy_supported;
@@ -10748,6 +10754,16 @@ static void remove_discovery_list(struct btd_adapter *adapter)
        adapter->discovery_list = NULL;
 }
 
+static void cancel_exp_pending(void *data)
+{
+       struct exp_pending *pending = data;
+       struct btd_adapter *adapter = pending->adapter;
+
+       pending->adapter = NULL;
+       mgmt_cancel(adapter->mgmt, pending->id);
+       g_free(pending);
+}
+
 static void adapter_free(gpointer user_data)
 {
        struct btd_adapter *adapter = user_data;
@@ -10776,6 +10792,8 @@ static void adapter_free(gpointer user_data)
        g_queue_free(adapter->auths);
        queue_destroy(adapter->exps, NULL);
 
+       queue_destroy(adapter->exp_pending, cancel_exp_pending);
+
        /*
         * Unregister all handlers for this specific index since
         * the adapter bound to them is no longer valid.
@@ -11944,6 +11962,7 @@ static struct btd_adapter *btd_adapter_new(uint16_t index)
 
        adapter->auths = g_queue_new();
        adapter->exps = queue_new();
+       adapter->exp_pending = queue_new();
 
 #ifdef TIZEN_FEATURE_BLUEZ_MODIFY
 #ifdef TIZEN_FEATURE_BLUEZ_BATTERY_WATCH
@@ -12050,6 +12069,8 @@ static void adapter_remove(struct btd_adapter *adapter)
 
        g_slist_free(adapter->msd_callbacks);
        adapter->msd_callbacks = NULL;
+
+       queue_remove_all(adapter->exp_pending, NULL, NULL, cancel_exp_pending);
 }
 
 const char *adapter_get_path(struct btd_adapter *adapter)
@@ -16198,10 +16219,38 @@ static bool set_blocked_keys(struct btd_adapter *adapter)
        .func = _func, \
 }
 
+static void exp_complete(void *user_data);
+
+static bool exp_mgmt_send(struct btd_adapter *adapter, uint16_t opcode,
+                       uint16_t index, uint16_t length, const void *param,
+                       mgmt_request_func_t callback)
+{
+       struct exp_pending *pending;
+
+       pending = g_new0(struct exp_pending, 1);
+       pending->adapter = adapter;
+
+       if (!queue_push_tail(adapter->exp_pending, pending)) {
+               g_free(pending);
+               return false;
+       }
+
+       pending->id = mgmt_send(adapter->mgmt, opcode, index, length, param,
+                                       callback, pending, exp_complete);
+       if (!pending->id) {
+               queue_remove(adapter->exp_pending, pending);
+               g_free(pending);
+               return false;
+       }
+
+       return true;
+}
+
 static void set_exp_debug_complete(uint8_t status, uint16_t len,
                                        const void *param, void *user_data)
 {
-       struct btd_adapter *adapter = user_data;
+       struct exp_pending *pending = user_data;
+       struct btd_adapter *adapter = pending->adapter;
        uint8_t action;
 
        if (status != 0) {
@@ -16226,9 +16275,9 @@ static void exp_debug_func(struct btd_adapter *adapter, uint8_t action)
        memcpy(cp.uuid, debug_uuid.val, 16);
        cp.action = action;
 
-       if (mgmt_send(adapter->mgmt, MGMT_OP_SET_EXP_FEATURE,
+       if (exp_mgmt_send(adapter, MGMT_OP_SET_EXP_FEATURE,
                        adapter->dev_id, sizeof(cp), &cp,
-                       set_exp_debug_complete, adapter, NULL) > 0)
+                       set_exp_debug_complete))
                return;
 
        btd_error(adapter->dev_id, "Failed to set exp debug");
@@ -16251,7 +16300,8 @@ static void quality_report_func(struct btd_adapter *adapter, uint8_t action)
 static void set_rpa_resolution_complete(uint8_t status, uint16_t len,
                                        const void *param, void *user_data)
 {
-       struct btd_adapter *adapter = user_data;
+       struct exp_pending *pending = user_data;
+       struct btd_adapter *adapter = pending->adapter;
        uint8_t action;
 
        if (status != 0) {
@@ -16276,9 +16326,9 @@ static void rpa_resolution_func(struct btd_adapter *adapter, uint8_t action)
        memcpy(cp.uuid, rpa_resolution_uuid.val, 16);
        cp.action = action;
 
-       if (mgmt_send(adapter->mgmt, MGMT_OP_SET_EXP_FEATURE,
+       if (exp_mgmt_send(adapter, MGMT_OP_SET_EXP_FEATURE,
                        adapter->dev_id, sizeof(cp), &cp,
-                       set_rpa_resolution_complete, adapter, NULL) > 0)
+                       set_rpa_resolution_complete))
                return;
 
        btd_error(adapter->dev_id, "Failed to set RPA Resolution");
@@ -16287,7 +16337,8 @@ static void rpa_resolution_func(struct btd_adapter *adapter, uint8_t action)
 static void codec_offload_complete(uint8_t status, uint16_t len,
                                        const void *param, void *user_data)
 {
-       struct btd_adapter *adapter = user_data;
+       struct exp_pending *pending = user_data;
+       struct btd_adapter *adapter = pending->adapter;
        uint8_t action;
 
        if (status != 0) {
@@ -16312,9 +16363,9 @@ static void codec_offload_func(struct btd_adapter *adapter, uint8_t action)
        memcpy(cp.uuid, codec_offload_uuid.val, 16);
        cp.action = action;
 
-       if (mgmt_send(adapter->mgmt, MGMT_OP_SET_EXP_FEATURE,
+       if (exp_mgmt_send(adapter, MGMT_OP_SET_EXP_FEATURE,
                        adapter->dev_id, sizeof(cp), &cp,
-                       codec_offload_complete, adapter, NULL) > 0)
+                       codec_offload_complete))
                return;
 
        btd_error(adapter->dev_id, "Failed to set Codec Offload");
@@ -16323,7 +16374,8 @@ static void codec_offload_func(struct btd_adapter *adapter, uint8_t action)
 static void iso_socket_complete(uint8_t status, uint16_t len,
                                const void *param, void *user_data)
 {
-       struct btd_adapter *adapter = user_data;
+       struct exp_pending *pending = user_data;
+       struct btd_adapter *adapter = pending->adapter;
        uint8_t action;
 
        if (status != 0) {
@@ -16348,9 +16400,9 @@ static void iso_socket_func(struct btd_adapter *adapter, uint8_t action)
        memcpy(cp.uuid, iso_socket_uuid.val, 16);
        cp.action = action;
 
-       if (mgmt_send(adapter->mgmt, MGMT_OP_SET_EXP_FEATURE,
+       if (exp_mgmt_send(adapter, MGMT_OP_SET_EXP_FEATURE,
                        MGMT_INDEX_NONE, sizeof(cp), &cp,
-                       iso_socket_complete, adapter, NULL) > 0)
+                       iso_socket_complete))
                return;
 
        btd_error(adapter->dev_id, "Failed to set ISO Socket");
@@ -16375,7 +16427,8 @@ static const struct exp_feat {
 static void read_exp_features_complete(uint8_t status, uint16_t length,
                                        const void *param, void *user_data)
 {
-       struct btd_adapter *adapter = user_data;
+       struct exp_pending *pending = user_data;
+       struct btd_adapter *adapter = pending->adapter;
        const struct mgmt_rp_read_exp_features_info *rp = param;
        size_t feature_count = 0;
        size_t i = 0;
@@ -16434,9 +16487,8 @@ static void read_exp_features_complete(uint8_t status, uint16_t length,
 
 static void read_exp_features(struct btd_adapter *adapter)
 {
-       if (mgmt_send(adapter->mgmt, MGMT_OP_READ_EXP_FEATURES_INFO,
-                       adapter->dev_id, 0, NULL, read_exp_features_complete,
-                       adapter, NULL) > 0)
+       if (exp_mgmt_send(adapter, MGMT_OP_READ_EXP_FEATURES_INFO,
+                       adapter->dev_id, 0, NULL, read_exp_features_complete))
                return;
 
        btd_error(adapter->dev_id, "Failed to read exp features info");
@@ -16875,6 +16927,43 @@ static void reset_adv_monitors(uint16_t index)
        error("Failed to reset Adv Monitors");
 }
 
+static void read_info(struct btd_adapter *adapter)
+{
+       DBG("sending read info command for index %u", adapter->dev_id);
+
+       if (mgmt_send(mgmt_primary, MGMT_OP_READ_INFO, adapter->dev_id, 0, NULL,
+                                       read_info_complete, adapter, NULL) > 0)
+               return;
+
+       btd_error(adapter->dev_id,
+                       "Failed to read controller info for index %u",
+                       adapter->dev_id);
+
+       adapter_list = g_list_remove(adapter_list, adapter);
+
+       btd_adapter_unref(adapter);
+}
+
+static void exp_complete(void *user_data)
+{
+       struct exp_pending *pending = user_data;
+       struct btd_adapter *adapter = pending->adapter;
+
+       if (!adapter)
+               return;  /* canceled */
+
+       queue_remove(adapter->exp_pending, pending);
+       g_free(pending);
+
+       if (queue_isempty(adapter->exp_pending)) {
+               read_info(adapter);
+               return;
+       }
+
+       DBG("index %u has %u pending MGMT EXP requests", adapter->dev_id,
+                                       queue_length(adapter->exp_pending));
+}
+
 static void index_added(uint16_t index, uint16_t length, const void *param,
                                                        void *user_data)
 {
@@ -16921,18 +17010,8 @@ static void index_added(uint16_t index, uint16_t length, const void *param,
         */
        adapter_list = g_list_append(adapter_list, adapter);
 
-       DBG("sending read info command for index %u", index);
-
-       if (mgmt_send(mgmt_primary, MGMT_OP_READ_INFO, index, 0, NULL,
-                                       read_info_complete, adapter, NULL) > 0)
-               return;
-
-       btd_error(adapter->dev_id,
-                       "Failed to read controller info for index %u", index);
-
-       adapter_list = g_list_remove(adapter_list, adapter);
-
-       btd_adapter_unref(adapter);
+       if (queue_isempty(adapter->exp_pending))
+               read_info(adapter);
 }
 
 static void index_removed(uint16_t index, uint16_t length, const void *param,