Commit 5a0a8b49 authored by Vinicius Costa Gomes's avatar Vinicius Costa Gomes Committed by Gustavo F. Padovan

Bluetooth: Add support for communicating keys with userspace

As the key format has changed to something that has a dynamic size,
the way that keys are received and sent must be changed.

The structure fields order is changed to make the parsing of the
information received from the Management Interface easier.
Signed-off-by: default avatarVinicius Costa Gomes <vinicius.gomes@openbossa.org>
Signed-off-by: default avatarGustavo F. Padovan <padovan@profusion.mobi>
parent 0eb08e33
...@@ -908,7 +908,7 @@ static int load_keys(struct sock *sk, u16 index, unsigned char *data, u16 len) ...@@ -908,7 +908,7 @@ static int load_keys(struct sock *sk, u16 index, unsigned char *data, u16 len)
struct hci_dev *hdev; struct hci_dev *hdev;
struct mgmt_cp_load_keys *cp; struct mgmt_cp_load_keys *cp;
u16 key_count, expected_len; u16 key_count, expected_len;
int i; int i, err;
cp = (void *) data; cp = (void *) data;
...@@ -918,9 +918,9 @@ static int load_keys(struct sock *sk, u16 index, unsigned char *data, u16 len) ...@@ -918,9 +918,9 @@ static int load_keys(struct sock *sk, u16 index, unsigned char *data, u16 len)
key_count = get_unaligned_le16(&cp->key_count); key_count = get_unaligned_le16(&cp->key_count);
expected_len = sizeof(*cp) + key_count * sizeof(struct mgmt_key_info); expected_len = sizeof(*cp) + key_count * sizeof(struct mgmt_key_info);
if (expected_len != len) { if (expected_len > len) {
BT_ERR("load_keys: expected %u bytes, got %u bytes", BT_ERR("load_keys: expected at least %u bytes, got %u bytes",
len, expected_len); expected_len, len);
return -EINVAL; return -EINVAL;
} }
...@@ -942,17 +942,36 @@ static int load_keys(struct sock *sk, u16 index, unsigned char *data, u16 len) ...@@ -942,17 +942,36 @@ static int load_keys(struct sock *sk, u16 index, unsigned char *data, u16 len)
else else
clear_bit(HCI_DEBUG_KEYS, &hdev->flags); clear_bit(HCI_DEBUG_KEYS, &hdev->flags);
for (i = 0; i < key_count; i++) { len -= sizeof(*cp);
struct mgmt_key_info *key = &cp->keys[i]; i = 0;
while (i < len) {
struct mgmt_key_info *key = (void *) cp->keys + i;
i += sizeof(*key) + key->dlen;
if (key->type == HCI_LK_SMP_LTK) {
struct key_master_id *id = (void *) key->data;
if (key->dlen != sizeof(struct key_master_id))
continue;
hci_add_ltk(hdev, 0, &key->bdaddr, id->ediv,
id->rand, key->val);
continue;
}
hci_add_link_key(hdev, NULL, 0, &key->bdaddr, key->val, key->type, hci_add_link_key(hdev, NULL, 0, &key->bdaddr, key->val, key->type,
key->pin_len); key->pin_len);
} }
err = cmd_complete(sk, index, MGMT_OP_LOAD_KEYS, NULL, 0);
hci_dev_unlock_bh(hdev); hci_dev_unlock_bh(hdev);
hci_dev_put(hdev); hci_dev_put(hdev);
return 0; return err;
} }
static int remove_key(struct sock *sk, u16 index, unsigned char *data, u16 len) static int remove_key(struct sock *sk, u16 index, unsigned char *data, u16 len)
...@@ -1958,17 +1977,28 @@ int mgmt_connectable(u16 index, u8 connectable) ...@@ -1958,17 +1977,28 @@ int mgmt_connectable(u16 index, u8 connectable)
int mgmt_new_key(u16 index, struct link_key *key, u8 persistent) int mgmt_new_key(u16 index, struct link_key *key, u8 persistent)
{ {
struct mgmt_ev_new_key ev; struct mgmt_ev_new_key *ev;
int err, total;
memset(&ev, 0, sizeof(ev)); total = sizeof(struct mgmt_ev_new_key) + key->dlen;
ev = kzalloc(total, GFP_ATOMIC);
if (!ev)
return -ENOMEM;
bacpy(&ev->key.bdaddr, &key->bdaddr);
ev->key.type = key->type;
memcpy(ev->key.val, key->val, 16);
ev->key.pin_len = key->pin_len;
ev->key.dlen = key->dlen;
ev->store_hint = persistent;
memcpy(ev->key.data, key->data, key->dlen);
ev.store_hint = persistent; err = mgmt_event(MGMT_EV_NEW_KEY, index, ev, total, NULL);
bacpy(&ev.key.bdaddr, &key->bdaddr);
ev.key.type = key->type;
memcpy(ev.key.val, key->val, 16);
ev.key.pin_len = key->pin_len;
return mgmt_event(MGMT_EV_NEW_KEY, index, &ev, sizeof(ev), NULL); kfree(ev);
return err;
} }
int mgmt_connected(u16 index, bdaddr_t *bdaddr) int mgmt_connected(u16 index, bdaddr_t *bdaddr)
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment