forked from Minki/linux
Bluetooth: Add read_local_oob_data management command
This patch adds a command to read local OOB data to the managment interface. The command maps directly to the Read Local OOB Data HCI command. Signed-off-by: Szymon Janc <szymon.janc@tieto.com> Signed-off-by: Gustavo F. Padovan <padovan@profusion.mobi>
This commit is contained in:
parent
8fce6357a9
commit
c35938b2f5
@ -613,6 +613,13 @@ struct hci_cp_write_ssp_mode {
|
|||||||
__u8 mode;
|
__u8 mode;
|
||||||
} __packed;
|
} __packed;
|
||||||
|
|
||||||
|
#define HCI_OP_READ_LOCAL_OOB_DATA 0x0c57
|
||||||
|
struct hci_rp_read_local_oob_data {
|
||||||
|
__u8 status;
|
||||||
|
__u8 hash[16];
|
||||||
|
__u8 randomizer[16];
|
||||||
|
} __packed;
|
||||||
|
|
||||||
#define HCI_OP_READ_INQ_RSP_TX_POWER 0x0c58
|
#define HCI_OP_READ_INQ_RSP_TX_POWER 0x0c58
|
||||||
|
|
||||||
#define HCI_OP_READ_LOCAL_VERSION 0x1001
|
#define HCI_OP_READ_LOCAL_VERSION 0x1001
|
||||||
|
@ -768,6 +768,8 @@ int mgmt_user_confirm_neg_reply_complete(u16 index, bdaddr_t *bdaddr,
|
|||||||
u8 status);
|
u8 status);
|
||||||
int mgmt_auth_failed(u16 index, bdaddr_t *bdaddr, u8 status);
|
int mgmt_auth_failed(u16 index, bdaddr_t *bdaddr, u8 status);
|
||||||
int mgmt_set_local_name_complete(u16 index, u8 *name, u8 status);
|
int mgmt_set_local_name_complete(u16 index, u8 *name, u8 status);
|
||||||
|
int mgmt_read_local_oob_data_reply_complete(u16 index, u8 *hash, u8 *randomizer,
|
||||||
|
u8 status);
|
||||||
|
|
||||||
/* HCI info for socket */
|
/* HCI info for socket */
|
||||||
#define hci_pi(sk) ((struct hci_pinfo *) sk)
|
#define hci_pi(sk) ((struct hci_pinfo *) sk)
|
||||||
|
@ -177,6 +177,12 @@ struct mgmt_cp_set_local_name {
|
|||||||
__u8 name[MGMT_MAX_NAME_LENGTH];
|
__u8 name[MGMT_MAX_NAME_LENGTH];
|
||||||
} __packed;
|
} __packed;
|
||||||
|
|
||||||
|
#define MGMT_OP_READ_LOCAL_OOB_DATA 0x0018
|
||||||
|
struct mgmt_rp_read_local_oob_data {
|
||||||
|
__u8 hash[16];
|
||||||
|
__u8 randomizer[16];
|
||||||
|
} __packed;
|
||||||
|
|
||||||
#define MGMT_EV_CMD_COMPLETE 0x0001
|
#define MGMT_EV_CMD_COMPLETE 0x0001
|
||||||
struct mgmt_ev_cmd_complete {
|
struct mgmt_ev_cmd_complete {
|
||||||
__le16 opcode;
|
__le16 opcode;
|
||||||
|
@ -822,6 +822,17 @@ static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
|
|||||||
rp->status);
|
rp->status);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
|
||||||
|
struct sk_buff *skb)
|
||||||
|
{
|
||||||
|
struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
|
||||||
|
|
||||||
|
BT_DBG("%s status 0x%x", hdev->name, rp->status);
|
||||||
|
|
||||||
|
mgmt_read_local_oob_data_reply_complete(hdev->id, rp->hash,
|
||||||
|
rp->randomizer, rp->status);
|
||||||
|
}
|
||||||
|
|
||||||
static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
|
static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
|
||||||
{
|
{
|
||||||
BT_DBG("%s status 0x%x", hdev->name, status);
|
BT_DBG("%s status 0x%x", hdev->name, status);
|
||||||
@ -1752,6 +1763,10 @@ static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *sk
|
|||||||
hci_cc_pin_code_neg_reply(hdev, skb);
|
hci_cc_pin_code_neg_reply(hdev, skb);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case HCI_OP_READ_LOCAL_OOB_DATA:
|
||||||
|
hci_cc_read_local_oob_data_reply(hdev, skb);
|
||||||
|
break;
|
||||||
|
|
||||||
case HCI_OP_LE_READ_BUFFER_SIZE:
|
case HCI_OP_LE_READ_BUFFER_SIZE:
|
||||||
hci_cc_le_read_buffer_size(hdev, skb);
|
hci_cc_le_read_buffer_size(hdev, skb);
|
||||||
break;
|
break;
|
||||||
|
@ -1296,6 +1296,55 @@ failed:
|
|||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int read_local_oob_data(struct sock *sk, u16 index)
|
||||||
|
{
|
||||||
|
struct hci_dev *hdev;
|
||||||
|
struct pending_cmd *cmd;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
BT_DBG("hci%u", index);
|
||||||
|
|
||||||
|
hdev = hci_dev_get(index);
|
||||||
|
if (!hdev)
|
||||||
|
return cmd_status(sk, index, MGMT_OP_READ_LOCAL_OOB_DATA,
|
||||||
|
ENODEV);
|
||||||
|
|
||||||
|
hci_dev_lock_bh(hdev);
|
||||||
|
|
||||||
|
if (!test_bit(HCI_UP, &hdev->flags)) {
|
||||||
|
err = cmd_status(sk, index, MGMT_OP_READ_LOCAL_OOB_DATA,
|
||||||
|
ENETDOWN);
|
||||||
|
goto unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!(hdev->features[6] & LMP_SIMPLE_PAIR)) {
|
||||||
|
err = cmd_status(sk, index, MGMT_OP_READ_LOCAL_OOB_DATA,
|
||||||
|
EOPNOTSUPP);
|
||||||
|
goto unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (mgmt_pending_find(MGMT_OP_READ_LOCAL_OOB_DATA, index)) {
|
||||||
|
err = cmd_status(sk, index, MGMT_OP_READ_LOCAL_OOB_DATA, EBUSY);
|
||||||
|
goto unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
cmd = mgmt_pending_add(sk, MGMT_OP_READ_LOCAL_OOB_DATA, index, NULL, 0);
|
||||||
|
if (!cmd) {
|
||||||
|
err = -ENOMEM;
|
||||||
|
goto unlock;
|
||||||
|
}
|
||||||
|
|
||||||
|
err = hci_send_cmd(hdev, HCI_OP_READ_LOCAL_OOB_DATA, 0, NULL);
|
||||||
|
if (err < 0)
|
||||||
|
mgmt_pending_remove(cmd);
|
||||||
|
|
||||||
|
unlock:
|
||||||
|
hci_dev_unlock_bh(hdev);
|
||||||
|
hci_dev_put(hdev);
|
||||||
|
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
int mgmt_control(struct sock *sk, struct msghdr *msg, size_t msglen)
|
int mgmt_control(struct sock *sk, struct msghdr *msg, size_t msglen)
|
||||||
{
|
{
|
||||||
unsigned char *buf;
|
unsigned char *buf;
|
||||||
@ -1394,6 +1443,10 @@ int mgmt_control(struct sock *sk, struct msghdr *msg, size_t msglen)
|
|||||||
case MGMT_OP_SET_LOCAL_NAME:
|
case MGMT_OP_SET_LOCAL_NAME:
|
||||||
err = set_local_name(sk, index, buf + sizeof(*hdr), len);
|
err = set_local_name(sk, index, buf + sizeof(*hdr), len);
|
||||||
break;
|
break;
|
||||||
|
case MGMT_OP_READ_LOCAL_OOB_DATA:
|
||||||
|
err = read_local_oob_data(sk, index);
|
||||||
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
BT_DBG("Unknown op %u", opcode);
|
BT_DBG("Unknown op %u", opcode);
|
||||||
err = cmd_status(sk, index, opcode, 0x01);
|
err = cmd_status(sk, index, opcode, 0x01);
|
||||||
@ -1723,3 +1776,33 @@ failed:
|
|||||||
mgmt_pending_remove(cmd);
|
mgmt_pending_remove(cmd);
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int mgmt_read_local_oob_data_reply_complete(u16 index, u8 *hash, u8 *randomizer,
|
||||||
|
u8 status)
|
||||||
|
{
|
||||||
|
struct pending_cmd *cmd;
|
||||||
|
int err;
|
||||||
|
|
||||||
|
BT_DBG("hci%u status %u", index, status);
|
||||||
|
|
||||||
|
cmd = mgmt_pending_find(MGMT_OP_READ_LOCAL_OOB_DATA, index);
|
||||||
|
if (!cmd)
|
||||||
|
return -ENOENT;
|
||||||
|
|
||||||
|
if (status) {
|
||||||
|
err = cmd_status(cmd->sk, index, MGMT_OP_READ_LOCAL_OOB_DATA,
|
||||||
|
EIO);
|
||||||
|
} else {
|
||||||
|
struct mgmt_rp_read_local_oob_data rp;
|
||||||
|
|
||||||
|
memcpy(rp.hash, hash, sizeof(rp.hash));
|
||||||
|
memcpy(rp.randomizer, randomizer, sizeof(rp.randomizer));
|
||||||
|
|
||||||
|
err = cmd_complete(cmd->sk, index, MGMT_OP_READ_LOCAL_OOB_DATA,
|
||||||
|
&rp, sizeof(rp));
|
||||||
|
}
|
||||||
|
|
||||||
|
mgmt_pending_remove(cmd);
|
||||||
|
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user