Return-Path: From: Jakub Pawlowski To: linux-bluetooth@vger.kernel.org Cc: Jakub Pawlowski Subject: [PATCH v5 2/3] Bluetooth: Extract generic start and stop discovery Date: Wed, 5 Nov 2014 14:37:25 -0800 Message-Id: <1415227046-28448-2-git-send-email-jpawlowski@google.com> In-Reply-To: <1415227046-28448-1-git-send-email-jpawlowski@google.com> References: <1415227046-28448-1-git-send-email-jpawlowski@google.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: This commit extract generic_start_discovery and generic_stop_discovery in preparation for start and stop service discovery. The reason behind that is that both functions will share big part of code, and it would be much easier to maintain just one generic method. Signed-off-by: Jakub Pawlowski --- net/bluetooth/mgmt.c | 133 ++++++++++++++++++++++++++++++--------------------- 1 file changed, 79 insertions(+), 54 deletions(-) diff --git a/net/bluetooth/mgmt.c b/net/bluetooth/mgmt.c index ce0272c..b700bfd 100644 --- a/net/bluetooth/mgmt.c +++ b/net/bluetooth/mgmt.c @@ -3648,7 +3648,8 @@ static int remove_remote_oob_data(struct sock *sk, struct hci_dev *hdev, return err; } -static int mgmt_start_discovery_failed(struct hci_dev *hdev, u8 status) +static int mgmt_start_discovery_failed(struct hci_dev *hdev, u8 status, + uint16_t opcode) { struct pending_cmd *cmd; u8 type; @@ -3656,7 +3657,7 @@ static int mgmt_start_discovery_failed(struct hci_dev *hdev, u8 status) hci_discovery_set_state(hdev, DISCOVERY_STOPPED); - cmd = mgmt_pending_find(MGMT_OP_START_DISCOVERY, hdev); + cmd = mgmt_pending_find(opcode, hdev); if (!cmd) return -ENOENT; @@ -3669,7 +3670,8 @@ static int mgmt_start_discovery_failed(struct hci_dev *hdev, u8 status) return err; } -static void start_discovery_complete(struct hci_dev *hdev, u8 status) +static void generic_start_discovery_complete(struct hci_dev *hdev, u8 status, + uint16_t opcode) { unsigned long timeout = 0; @@ -3677,7 +3679,7 @@ static void start_discovery_complete(struct hci_dev *hdev, u8 status) if (status) { hci_dev_lock(hdev); - mgmt_start_discovery_failed(hdev, status); + mgmt_start_discovery_failed(hdev, status, opcode); hci_dev_unlock(hdev); return; } @@ -3708,10 +3710,16 @@ static void start_discovery_complete(struct hci_dev *hdev, u8 status) queue_delayed_work(hdev->workqueue, &hdev->le_scan_disable, timeout); } -static int start_discovery(struct sock *sk, struct hci_dev *hdev, - void *data, u16 len) +static void start_discovery_complete(struct hci_dev *hdev, u8 status) +{ + generic_start_discovery_complete(hdev, status, MGMT_OP_START_DISCOVERY); +} + +static int generic_start_discovery(struct sock *sk, struct hci_dev *hdev, + uint16_t opcode, + void (*complete_cb)(struct hci_dev *hdev, u8 status), + u8 type) { - struct mgmt_cp_start_discovery *cp = data; struct pending_cmd *cmd; struct hci_cp_le_set_scan_param param_cp; struct hci_cp_le_set_scan_enable enable_cp; @@ -3727,33 +3735,33 @@ static int start_discovery(struct sock *sk, struct hci_dev *hdev, hci_dev_lock(hdev); if (!hdev_is_powered(hdev)) { - err = cmd_complete(sk, hdev->id, MGMT_OP_START_DISCOVERY, + err = cmd_complete(sk, hdev->id, opcode, MGMT_STATUS_NOT_POWERED, - &cp->type, sizeof(cp->type)); + &type, sizeof(type)); goto failed; } if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags)) { - err = cmd_complete(sk, hdev->id, MGMT_OP_START_DISCOVERY, - MGMT_STATUS_BUSY, &cp->type, - sizeof(cp->type)); + err = cmd_complete(sk, hdev->id, opcode, + MGMT_STATUS_BUSY, &type, + sizeof(type)); goto failed; } if (hdev->discovery.state != DISCOVERY_STOPPED) { - err = cmd_complete(sk, hdev->id, MGMT_OP_START_DISCOVERY, - MGMT_STATUS_BUSY, &cp->type, - sizeof(cp->type)); + err = cmd_complete(sk, hdev->id, opcode, + MGMT_STATUS_BUSY, &type, + sizeof(type)); goto failed; } - cmd = mgmt_pending_add(sk, MGMT_OP_START_DISCOVERY, hdev, NULL, 0); + cmd = mgmt_pending_add(sk, opcode, hdev, NULL, 0); if (!cmd) { err = -ENOMEM; goto failed; } - hdev->discovery.type = cp->type; + hdev->discovery.type = type; hci_req_init(&req, hdev); @@ -3761,18 +3769,16 @@ static int start_discovery(struct sock *sk, struct hci_dev *hdev, case DISCOV_TYPE_BREDR: status = mgmt_bredr_support(hdev); if (status) { - err = cmd_complete(sk, hdev->id, - MGMT_OP_START_DISCOVERY, status, - &cp->type, sizeof(cp->type)); + err = cmd_complete(sk, hdev->id, opcode, status, + &type, sizeof(type)); mgmt_pending_remove(cmd); goto failed; } if (test_bit(HCI_INQUIRY, &hdev->flags)) { - err = cmd_complete(sk, hdev->id, - MGMT_OP_START_DISCOVERY, - MGMT_STATUS_BUSY, &cp->type, - sizeof(cp->type)); + err = cmd_complete(sk, hdev->id, opcode, + MGMT_STATUS_BUSY, &type, + sizeof(type)); mgmt_pending_remove(cmd); goto failed; } @@ -3789,19 +3795,17 @@ static int start_discovery(struct sock *sk, struct hci_dev *hdev, case DISCOV_TYPE_INTERLEAVED: status = mgmt_le_support(hdev); if (status) { - err = cmd_complete(sk, hdev->id, - MGMT_OP_START_DISCOVERY, status, - &cp->type, sizeof(cp->type)); + err = cmd_complete(sk, hdev->id, opcode, status, + &type, sizeof(type)); mgmt_pending_remove(cmd); goto failed; } if (hdev->discovery.type == DISCOV_TYPE_INTERLEAVED && !test_bit(HCI_BREDR_ENABLED, &hdev->dev_flags)) { - err = cmd_complete(sk, hdev->id, - MGMT_OP_START_DISCOVERY, + err = cmd_complete(sk, hdev->id, opcode, MGMT_STATUS_NOT_SUPPORTED, - &cp->type, sizeof(cp->type)); + &type, sizeof(type)); mgmt_pending_remove(cmd); goto failed; } @@ -3813,11 +3817,9 @@ static int start_discovery(struct sock *sk, struct hci_dev *hdev, */ if (hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT)) { - err = cmd_complete(sk, hdev->id, - MGMT_OP_START_DISCOVERY, + err = cmd_complete(sk, hdev->id, opcode, MGMT_STATUS_REJECTED, - &cp->type, - sizeof(cp->type)); + &type, sizeof(type)); mgmt_pending_remove(cmd); goto failed; } @@ -3840,10 +3842,9 @@ static int start_discovery(struct sock *sk, struct hci_dev *hdev, */ err = hci_update_random_address(&req, true, &own_addr_type); if (err < 0) { - err = cmd_complete(sk, hdev->id, - MGMT_OP_START_DISCOVERY, + err = cmd_complete(sk, hdev->id, opcode, MGMT_STATUS_FAILED, - &cp->type, sizeof(cp->type)); + &type, sizeof(type)); mgmt_pending_remove(cmd); goto failed; } @@ -3863,14 +3864,14 @@ static int start_discovery(struct sock *sk, struct hci_dev *hdev, break; default: - err = cmd_complete(sk, hdev->id, MGMT_OP_START_DISCOVERY, + err = cmd_complete(sk, hdev->id, opcode, MGMT_STATUS_INVALID_PARAMS, - &cp->type, sizeof(cp->type)); + &type, sizeof(type)); mgmt_pending_remove(cmd); goto failed; } - err = hci_req_run(&req, start_discovery_complete); + err = hci_req_run(&req, complete_cb); if (err < 0) mgmt_pending_remove(cmd); else @@ -3881,12 +3882,22 @@ failed: return err; } -static int mgmt_stop_discovery_failed(struct hci_dev *hdev, u8 status) +static int start_discovery(struct sock *sk, struct hci_dev *hdev, + void *data, u16 len) +{ + struct mgmt_cp_start_discovery *cp = data; + + return generic_start_discovery(sk, hdev, MGMT_OP_START_DISCOVERY, + start_discovery_complete, cp->type); +} + +static int mgmt_stop_discovery_failed(struct hci_dev *hdev, u8 status, + uint16_t opcode) { struct pending_cmd *cmd; int err; - cmd = mgmt_pending_find(MGMT_OP_STOP_DISCOVERY, hdev); + cmd = mgmt_pending_find(opcode, hdev); if (!cmd) return -ENOENT; @@ -3897,14 +3908,15 @@ static int mgmt_stop_discovery_failed(struct hci_dev *hdev, u8 status) return err; } -static void stop_discovery_complete(struct hci_dev *hdev, u8 status) +static void generic_stop_discovery_complete(struct hci_dev *hdev, u8 status, + uint16_t opcode) { BT_DBG("status %d", status); hci_dev_lock(hdev); if (status) { - mgmt_stop_discovery_failed(hdev, status); + mgmt_stop_discovery_failed(hdev, status, opcode); goto unlock; } @@ -3914,10 +3926,15 @@ unlock: hci_dev_unlock(hdev); } -static int stop_discovery(struct sock *sk, struct hci_dev *hdev, void *data, - u16 len) +static void stop_discovery_complete(struct hci_dev *hdev, u8 status) +{ + generic_stop_discovery_complete(hdev, status, MGMT_OP_STOP_DISCOVERY); +} + +static int generic_stop_discovery(struct sock *sk, struct hci_dev *hdev, + __u8 type, + void (*stop_discovery_cb)(struct hci_dev *, u8)) { - struct mgmt_cp_stop_discovery *mgmt_cp = data; struct pending_cmd *cmd; struct hci_request req; int err; @@ -3928,15 +3945,14 @@ static int stop_discovery(struct sock *sk, struct hci_dev *hdev, void *data, if (!hci_discovery_active(hdev)) { err = cmd_complete(sk, hdev->id, MGMT_OP_STOP_DISCOVERY, - MGMT_STATUS_REJECTED, &mgmt_cp->type, - sizeof(mgmt_cp->type)); + MGMT_STATUS_REJECTED, &type, sizeof(type)); goto unlock; } - if (hdev->discovery.type != mgmt_cp->type) { + if (hdev->discovery.type != type) { err = cmd_complete(sk, hdev->id, MGMT_OP_STOP_DISCOVERY, - MGMT_STATUS_INVALID_PARAMS, &mgmt_cp->type, - sizeof(mgmt_cp->type)); + MGMT_STATUS_INVALID_PARAMS, &type, + sizeof(type)); goto unlock; } @@ -3950,7 +3966,7 @@ static int stop_discovery(struct sock *sk, struct hci_dev *hdev, void *data, hci_stop_discovery(&req); - err = hci_req_run(&req, stop_discovery_complete); + err = hci_req_run(&req, stop_discovery_cb); if (!err) { hci_discovery_set_state(hdev, DISCOVERY_STOPPING); goto unlock; @@ -3961,7 +3977,7 @@ static int stop_discovery(struct sock *sk, struct hci_dev *hdev, void *data, /* If no HCI commands were sent we're done */ if (err == -ENODATA) { err = cmd_complete(sk, hdev->id, MGMT_OP_STOP_DISCOVERY, 0, - &mgmt_cp->type, sizeof(mgmt_cp->type)); + &type, sizeof(type)); hci_discovery_set_state(hdev, DISCOVERY_STOPPED); } @@ -3970,6 +3986,15 @@ unlock: return err; } +static int stop_discovery(struct sock *sk, struct hci_dev *hdev, void *data, + u16 len) +{ + struct mgmt_cp_stop_discovery *mgmt_cp = data; + + return generic_stop_discovery(sk, hdev, mgmt_cp->type, + stop_discovery_complete); +} + static int confirm_name(struct sock *sk, struct hci_dev *hdev, void *data, u16 len) { -- 2.1.0.rc2.206.gedb03e5