Bluetooth: Add support for storing the LTK

Now when the LTK is received from the remote or generated it is stored,
so it can later be used.

Signed-off-by: Vinicius Costa Gomes <vinicius.gomes@openbossa.org>
Signed-off-by: Gustavo F. Padovan <padovan@profusion.mobi>

1 files changed, 14 insertions, 6 deletions

diff --git a/net/bluetooth/smp.c b/net/bluetooth/smp.c
index ffbfdd9e5738..600a70b95a00 100644
--- a/net/bluetooth/smp.c
+++ b/net/bluetooth/smp.c
@@ -496,18 +496,23 @@ int smp_conn_security(struct l2cap_conn *conn, __u8 sec_level)
 
 static int smp_cmd_encrypt_info(struct l2cap_conn *conn, struct sk_buff *skb)
 {
-        BT_DBG("conn %p", conn);
-        /* FIXME: store the ltk */
+        struct smp_cmd_encrypt_info *rp = (void *) skb->data;
+
+        skb_pull(skb, sizeof(*rp));
+
+        memcpy(conn->tk, rp->ltk, sizeof(conn->tk));
+
         return 0;
 }
 
 static int smp_cmd_master_ident(struct l2cap_conn *conn, struct sk_buff *skb)
 {
-        struct smp_cmd_pairing *paircmd = (void *) &conn->prsp[1];
-        u8 keydist = paircmd->init_key_dist;
+        struct smp_cmd_master_ident *rp = (void *) skb->data;
+
+        skb_pull(skb, sizeof(*rp));
 
-        BT_DBG("keydist 0x%x", keydist);
-        /* FIXME: store ediv and rand */
+        hci_add_ltk(conn->hcon->hdev, 1, conn->src, rp->ediv,
+                                                rp->rand, conn->tk);
 
         smp_distribute_keys(conn, 1);
 
@@ -632,6 +637,9 @@ int smp_distribute_keys(struct l2cap_conn *conn, __u8 force)
 
                 smp_send_cmd(conn, SMP_CMD_ENCRYPT_INFO, sizeof(enc), &enc);
 
+                hci_add_ltk(conn->hcon->hdev, 1, conn->dst, ediv,
+                                                        ident.rand, enc.ltk);
+
                 ident.ediv = cpu_to_le16(ediv);
 
                 smp_send_cmd(conn, SMP_CMD_MASTER_IDENT, sizeof(ident), &ident);