forked from luck/tmp_suning_uos_patched
Bluetooth: mgmt: Fix dev_class related command response timing
All mgmt commands that may fire off a hci_write_class_of_device command should wait for the completion of the HCI command before sending a response to user space. Signed-off-by: Johan Hedberg <johan.hedberg@intel.com> Acked-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
parent
c95f0ba76f
commit
90e704543d
@ -1332,6 +1332,7 @@ static int set_le(struct sock *sk, u16 index, void *data, u16 len)
|
||||
static int add_uuid(struct sock *sk, u16 index, void *data, u16 len)
|
||||
{
|
||||
struct mgmt_cp_add_uuid *cp = data;
|
||||
struct pending_cmd *cmd;
|
||||
struct hci_dev *hdev;
|
||||
struct bt_uuid *uuid;
|
||||
int err;
|
||||
@ -1374,7 +1375,17 @@ static int add_uuid(struct sock *sk, u16 index, void *data, u16 len)
|
||||
if (err < 0)
|
||||
goto failed;
|
||||
|
||||
err = cmd_complete(sk, index, MGMT_OP_ADD_UUID, 0, hdev->dev_class, 3);
|
||||
if (!test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
|
||||
err = cmd_complete(sk, index, MGMT_OP_ADD_UUID, 0,
|
||||
hdev->dev_class, 3);
|
||||
goto failed;
|
||||
}
|
||||
|
||||
cmd = mgmt_pending_add(sk, MGMT_OP_ADD_UUID, hdev, data, len);
|
||||
if (!cmd) {
|
||||
err = -ENOMEM;
|
||||
goto failed;
|
||||
}
|
||||
|
||||
failed:
|
||||
hci_dev_unlock(hdev);
|
||||
@ -1386,6 +1397,7 @@ static int add_uuid(struct sock *sk, u16 index, void *data, u16 len)
|
||||
static int remove_uuid(struct sock *sk, u16 index, void *data, u16 len)
|
||||
{
|
||||
struct mgmt_cp_remove_uuid *cp = data;
|
||||
struct pending_cmd *cmd;
|
||||
struct list_head *p, *n;
|
||||
struct hci_dev *hdev;
|
||||
u8 bt_uuid_any[] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
|
||||
@ -1448,8 +1460,17 @@ static int remove_uuid(struct sock *sk, u16 index, void *data, u16 len)
|
||||
if (err < 0)
|
||||
goto unlock;
|
||||
|
||||
err = cmd_complete(sk, index, MGMT_OP_REMOVE_UUID, 0,
|
||||
if (!test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
|
||||
err = cmd_complete(sk, index, MGMT_OP_REMOVE_UUID, 0,
|
||||
hdev->dev_class, 3);
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
cmd = mgmt_pending_add(sk, MGMT_OP_REMOVE_UUID, hdev, data, len);
|
||||
if (!cmd) {
|
||||
err = -ENOMEM;
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
unlock:
|
||||
hci_dev_unlock(hdev);
|
||||
@ -1462,6 +1483,7 @@ static int set_dev_class(struct sock *sk, u16 index, void *data, u16 len)
|
||||
{
|
||||
struct hci_dev *hdev;
|
||||
struct mgmt_cp_set_dev_class *cp = data;
|
||||
struct pending_cmd *cmd;
|
||||
int err;
|
||||
|
||||
BT_DBG("request for hci%u", index);
|
||||
@ -1500,10 +1522,20 @@ static int set_dev_class(struct sock *sk, u16 index, void *data, u16 len)
|
||||
}
|
||||
|
||||
err = update_class(hdev);
|
||||
if (err < 0)
|
||||
goto unlock;
|
||||
|
||||
if (err == 0)
|
||||
if (!test_bit(HCI_PENDING_CLASS, &hdev->dev_flags)) {
|
||||
err = cmd_complete(sk, index, MGMT_OP_SET_DEV_CLASS, 0,
|
||||
hdev->dev_class, 3);
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
cmd = mgmt_pending_add(sk, MGMT_OP_SET_DEV_CLASS, hdev, data, len);
|
||||
if (!cmd) {
|
||||
err = -ENOMEM;
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
unlock:
|
||||
hci_dev_unlock(hdev);
|
||||
@ -3110,6 +3142,7 @@ int mgmt_index_removed(struct hci_dev *hdev)
|
||||
struct cmd_lookup {
|
||||
struct sock *sk;
|
||||
struct hci_dev *hdev;
|
||||
u8 mgmt_status;
|
||||
};
|
||||
|
||||
static void settings_rsp(struct pending_cmd *cmd, void *data)
|
||||
@ -3632,14 +3665,41 @@ int mgmt_ssp_enable_complete(struct hci_dev *hdev, u8 enable, u8 status)
|
||||
return err;
|
||||
}
|
||||
|
||||
static void class_rsp(struct pending_cmd *cmd, void *data)
|
||||
{
|
||||
struct cmd_lookup *match = data;
|
||||
|
||||
cmd_complete(cmd->sk, cmd->index, cmd->opcode, match->mgmt_status,
|
||||
match->hdev->dev_class, 3);
|
||||
|
||||
list_del(&cmd->list);
|
||||
|
||||
if (match->sk == NULL) {
|
||||
match->sk = cmd->sk;
|
||||
sock_hold(match->sk);
|
||||
}
|
||||
|
||||
mgmt_pending_free(cmd);
|
||||
}
|
||||
|
||||
int mgmt_set_class_of_dev_complete(struct hci_dev *hdev, u8 *dev_class,
|
||||
u8 status)
|
||||
{
|
||||
int err;
|
||||
struct cmd_lookup match = { NULL, hdev, mgmt_status(status) };
|
||||
int err = 0;
|
||||
|
||||
clear_bit(HCI_PENDING_CLASS, &hdev->dev_flags);
|
||||
|
||||
err = mgmt_event(MGMT_EV_CLASS_OF_DEV_CHANGED, hdev, dev_class, 3, NULL);
|
||||
mgmt_pending_foreach(MGMT_OP_SET_DEV_CLASS, hdev, class_rsp, &match);
|
||||
mgmt_pending_foreach(MGMT_OP_ADD_UUID, hdev, class_rsp, &match);
|
||||
mgmt_pending_foreach(MGMT_OP_REMOVE_UUID, hdev, class_rsp, &match);
|
||||
|
||||
if (!status)
|
||||
err = mgmt_event(MGMT_EV_CLASS_OF_DEV_CHANGED, hdev,
|
||||
dev_class, 3, NULL);
|
||||
|
||||
if (match.sk)
|
||||
sock_put(match.sk);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user