Bluetooth: Add support for max_tx_power in Get Conn Info
This patch adds support for max_tx_power in Get Connection Information request. Value is read only once for given connection and then always returned in response as parameter. Signed-off-by: Andrzej Kaczmarek <andrzej.kaczmarek@tieto.com> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
parent
d0455ed996
commit
eed5daf318
1 changed files with 17 additions and 6 deletions
|
@ -4583,12 +4583,13 @@ static void get_conn_info_complete(struct pending_cmd *cmd, void *data)
|
|||
if (!match->mgmt_status) {
|
||||
rp.rssi = conn->rssi;
|
||||
|
||||
if (match->valid_tx_power)
|
||||
if (match->valid_tx_power) {
|
||||
rp.tx_power = conn->tx_power;
|
||||
else
|
||||
rp.max_tx_power = conn->max_tx_power;
|
||||
} else {
|
||||
rp.tx_power = HCI_TX_POWER_INVALID;
|
||||
|
||||
rp.max_tx_power = HCI_TX_POWER_INVALID;
|
||||
rp.max_tx_power = HCI_TX_POWER_INVALID;
|
||||
}
|
||||
}
|
||||
|
||||
cmd_complete(cmd->sk, cmd->index, MGMT_OP_GET_CONN_INFO,
|
||||
|
@ -4611,7 +4612,9 @@ static void conn_info_refresh_complete(struct hci_dev *hdev, u8 status)
|
|||
hci_dev_lock(hdev);
|
||||
|
||||
/* TX power data is valid in case request completed successfully,
|
||||
* otherwise we assume it's not valid.
|
||||
* otherwise we assume it's not valid. At the moment we assume that
|
||||
* either both or none of current and max values are valid to keep code
|
||||
* simple.
|
||||
*/
|
||||
match.valid_tx_power = !status;
|
||||
|
||||
|
@ -4728,6 +4731,14 @@ static int get_conn_info(struct sock *sk, struct hci_dev *hdev, void *data,
|
|||
sizeof(req_txp_cp), &req_txp_cp);
|
||||
}
|
||||
|
||||
/* Max TX power needs to be read only once per connection */
|
||||
if (conn->max_tx_power == HCI_TX_POWER_INVALID) {
|
||||
req_txp_cp.handle = cpu_to_le16(conn->handle);
|
||||
req_txp_cp.type = 0x01;
|
||||
hci_req_add(&req, HCI_OP_READ_TX_POWER,
|
||||
sizeof(req_txp_cp), &req_txp_cp);
|
||||
}
|
||||
|
||||
err = hci_req_run(&req, conn_info_refresh_complete);
|
||||
if (err < 0)
|
||||
goto unlock;
|
||||
|
@ -4747,7 +4758,7 @@ static int get_conn_info(struct sock *sk, struct hci_dev *hdev, void *data,
|
|||
/* Cache is valid, just reply with values cached in hci_conn */
|
||||
rp.rssi = conn->rssi;
|
||||
rp.tx_power = conn->tx_power;
|
||||
rp.max_tx_power = HCI_TX_POWER_INVALID;
|
||||
rp.max_tx_power = conn->max_tx_power;
|
||||
|
||||
err = cmd_complete(sk, hdev->id, MGMT_OP_GET_CONN_INFO,
|
||||
MGMT_STATUS_SUCCESS, &rp, sizeof(rp));
|
||||
|
|
Loading…
Reference in a new issue