Lines Matching full:smp
36 #include "smp.h"
53 #define SMP_ALLOW_CMD(smp, code) set_bit(code, &smp->allow_cmd) argument
101 u8 preq[7]; /* SMP Pairing Request */
102 u8 prsp[7]; /* SMP Pairing Response */
103 u8 prnd[16]; /* SMP Pairing Random (local) */
104 u8 rrnd[16]; /* SMP Pairing Random (remote) */
105 u8 pcnf[16]; /* SMP Pairing Confirm */
106 u8 tk[16]; /* SMP Temporary Key */
134 /* These debug key values are defined in the SMP section of the core
165 /* The following functions map to the LE SC SMP crypto functions
237 * the SMP section of the Bluetooth core specification. In ASCII in smp_f5()
371 /* The following functions map to the legacy SMP crypto functions e, c1,
541 struct smp_dev *smp; in smp_generate_oob() local
547 smp = chan->data; in smp_generate_oob()
551 err = set_ecdh_privkey(smp->tfm_ecdh, debug_sk); in smp_generate_oob()
554 memcpy(smp->local_pk, debug_pk, 64); in smp_generate_oob()
555 smp->debug_key = true; in smp_generate_oob()
559 err = generate_ecdh_keys(smp->tfm_ecdh, smp->local_pk); in smp_generate_oob()
566 if (crypto_memneq(smp->local_pk, debug_pk, 64)) in smp_generate_oob()
569 smp->debug_key = false; in smp_generate_oob()
572 SMP_DBG("OOB Public Key X: %32phN", smp->local_pk); in smp_generate_oob()
573 SMP_DBG("OOB Public Key Y: %32phN", smp->local_pk + 32); in smp_generate_oob()
575 get_random_bytes(smp->local_rand, 16); in smp_generate_oob()
577 err = smp_f4(smp->tfm_cmac, smp->local_pk, smp->local_pk, in smp_generate_oob()
578 smp->local_rand, 0, hash); in smp_generate_oob()
582 memcpy(rand, smp->local_rand, 16); in smp_generate_oob()
584 smp->local_oob = true; in smp_generate_oob()
591 struct l2cap_chan *chan = conn->smp; in smp_send_cmd()
592 struct smp_chan *smp; in smp_send_cmd() local
616 smp = chan->data; in smp_send_cmd()
618 cancel_delayed_work_sync(&smp->security_timer); in smp_send_cmd()
619 schedule_delayed_work(&smp->security_timer, SMP_TIMEOUT); in smp_send_cmd()
651 struct l2cap_chan *chan = conn->smp; in build_pairing_cmd()
652 struct smp_chan *smp = chan->data; in build_pairing_cmd() local
689 set_bit(SMP_FLAG_REMOTE_OOB, &smp->flags); in build_pairing_cmd()
691 memcpy(smp->rr, oob_data->rand256, 16); in build_pairing_cmd()
692 memcpy(smp->pcnf, oob_data->hash256, 16); in build_pairing_cmd()
693 SMP_DBG("OOB Remote Confirmation: %16phN", smp->pcnf); in build_pairing_cmd()
694 SMP_DBG("OOB Remote Random: %16phN", smp->rr); in build_pairing_cmd()
709 smp->remote_key_dist = remote_dist; in build_pairing_cmd()
720 smp->remote_key_dist = rsp->init_key_dist; in build_pairing_cmd()
725 struct l2cap_chan *chan = conn->smp; in check_enc_key_size()
727 struct smp_chan *smp = chan->data; in check_enc_key_size() local
737 smp->enc_key_size = max_key_size; in check_enc_key_size()
744 struct l2cap_chan *chan = conn->smp; in smp_chan_destroy()
745 struct smp_chan *smp = chan->data; in smp_chan_destroy() local
749 BUG_ON(!smp); in smp_chan_destroy()
751 cancel_delayed_work_sync(&smp->security_timer); in smp_chan_destroy()
753 complete = test_bit(SMP_FLAG_COMPLETE, &smp->flags); in smp_chan_destroy()
756 kfree_sensitive(smp->csrk); in smp_chan_destroy()
757 kfree_sensitive(smp->responder_csrk); in smp_chan_destroy()
758 kfree_sensitive(smp->link_key); in smp_chan_destroy()
760 crypto_free_shash(smp->tfm_cmac); in smp_chan_destroy()
761 crypto_free_kpp(smp->tfm_ecdh); in smp_chan_destroy()
766 if (smp->ltk && smp->ltk->type == SMP_LTK_P256_DEBUG && in smp_chan_destroy()
768 list_del_rcu(&smp->ltk->list); in smp_chan_destroy()
769 kfree_rcu(smp->ltk, rcu); in smp_chan_destroy()
770 smp->ltk = NULL; in smp_chan_destroy()
775 if (smp->ltk) { in smp_chan_destroy()
776 list_del_rcu(&smp->ltk->list); in smp_chan_destroy()
777 kfree_rcu(smp->ltk, rcu); in smp_chan_destroy()
780 if (smp->responder_ltk) { in smp_chan_destroy()
781 list_del_rcu(&smp->responder_ltk->list); in smp_chan_destroy()
782 kfree_rcu(smp->responder_ltk, rcu); in smp_chan_destroy()
785 if (smp->remote_irk) { in smp_chan_destroy()
786 list_del_rcu(&smp->remote_irk->list); in smp_chan_destroy()
787 kfree_rcu(smp->remote_irk, rcu); in smp_chan_destroy()
792 kfree_sensitive(smp); in smp_chan_destroy()
799 struct l2cap_chan *chan = conn->smp; in smp_failure()
835 static u8 get_auth_method(struct smp_chan *smp, u8 local_io, u8 remote_io) in get_auth_method() argument
844 if (test_bit(SMP_FLAG_SC, &smp->flags)) in get_auth_method()
854 struct l2cap_chan *chan = conn->smp; in tk_request()
855 struct smp_chan *smp = chan->data; in tk_request() local
860 memset(smp->tk, 0, sizeof(smp->tk)); in tk_request()
861 clear_bit(SMP_FLAG_TK_VALID, &smp->flags); in tk_request()
873 smp->method = JUST_CFM; in tk_request()
875 smp->method = get_auth_method(smp, local_io, remote_io); in tk_request()
878 if (smp->method == JUST_CFM && test_bit(SMP_FLAG_INITIATOR, in tk_request()
879 &smp->flags)) in tk_request()
880 smp->method = JUST_WORKS; in tk_request()
883 if (smp->method == JUST_CFM && in tk_request()
885 smp->method = JUST_WORKS; in tk_request()
889 if (smp->method == JUST_WORKS) { in tk_request()
896 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in tk_request()
903 if (test_bit(SMP_FLAG_SC, &smp->flags)) in tk_request()
907 if (smp->method != JUST_CFM) { in tk_request()
908 set_bit(SMP_FLAG_MITM_AUTH, &smp->flags); in tk_request()
916 if (smp->method == OVERLAP) { in tk_request()
917 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in tk_request()
918 smp->method = CFM_PASSKEY; in tk_request()
920 smp->method = REQ_PASSKEY; in tk_request()
924 if (smp->method == CFM_PASSKEY) { in tk_request()
925 memset(smp->tk, 0, sizeof(smp->tk)); in tk_request()
928 put_unaligned_le32(passkey, smp->tk); in tk_request()
930 set_bit(SMP_FLAG_TK_VALID, &smp->flags); in tk_request()
933 if (smp->method == REQ_PASSKEY) in tk_request()
936 else if (smp->method == JUST_CFM) in tk_request()
948 static u8 smp_confirm(struct smp_chan *smp) in smp_confirm() argument
950 struct l2cap_conn *conn = smp->conn; in smp_confirm()
956 ret = smp_c1(smp->tk, smp->prnd, smp->preq, smp->prsp, in smp_confirm()
963 clear_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_confirm()
965 smp_send_cmd(smp->conn, SMP_CMD_PAIRING_CONFIRM, sizeof(cp), &cp); in smp_confirm()
967 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in smp_confirm()
968 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in smp_confirm()
970 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in smp_confirm()
975 static u8 smp_random(struct smp_chan *smp) in smp_random() argument
977 struct l2cap_conn *conn = smp->conn; in smp_random()
983 test_bit(SMP_FLAG_INITIATOR, &smp->flags) ? "initiator" : in smp_random()
986 ret = smp_c1(smp->tk, smp->rrnd, smp->preq, smp->prsp, in smp_random()
992 if (crypto_memneq(smp->pcnf, confirm, sizeof(smp->pcnf))) { in smp_random()
998 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_random()
1003 smp_s1(smp->tk, smp->rrnd, smp->prnd, stk); in smp_random()
1008 hci_le_start_enc(hcon, ediv, rand, stk, smp->enc_key_size); in smp_random()
1009 hcon->enc_key_size = smp->enc_key_size; in smp_random()
1016 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_random()
1017 smp->prnd); in smp_random()
1019 smp_s1(smp->tk, smp->prnd, smp->rrnd, stk); in smp_random()
1031 SMP_STK, auth, stk, smp->enc_key_size, ediv, rand); in smp_random()
1039 struct l2cap_chan *chan = conn->smp; in smp_notify_keys()
1040 struct smp_chan *smp = chan->data; in smp_notify_keys() local
1043 struct smp_cmd_pairing *req = (void *) &smp->preq[1]; in smp_notify_keys()
1044 struct smp_cmd_pairing *rsp = (void *) &smp->prsp[1]; in smp_notify_keys()
1062 if (smp->remote_irk) { in smp_notify_keys()
1063 mgmt_new_irk(hdev, smp->remote_irk, persistent); in smp_notify_keys()
1070 bacpy(&hcon->dst, &smp->remote_irk->bdaddr); in smp_notify_keys()
1071 hcon->dst_type = smp->remote_irk->addr_type; in smp_notify_keys()
1081 if (smp->csrk) { in smp_notify_keys()
1082 smp->csrk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1083 bacpy(&smp->csrk->bdaddr, &hcon->dst); in smp_notify_keys()
1084 mgmt_new_csrk(hdev, smp->csrk, persistent); in smp_notify_keys()
1087 if (smp->responder_csrk) { in smp_notify_keys()
1088 smp->responder_csrk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1089 bacpy(&smp->responder_csrk->bdaddr, &hcon->dst); in smp_notify_keys()
1090 mgmt_new_csrk(hdev, smp->responder_csrk, persistent); in smp_notify_keys()
1093 if (smp->ltk) { in smp_notify_keys()
1094 smp->ltk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1095 bacpy(&smp->ltk->bdaddr, &hcon->dst); in smp_notify_keys()
1096 mgmt_new_ltk(hdev, smp->ltk, persistent); in smp_notify_keys()
1099 if (smp->responder_ltk) { in smp_notify_keys()
1100 smp->responder_ltk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1101 bacpy(&smp->responder_ltk->bdaddr, &hcon->dst); in smp_notify_keys()
1102 mgmt_new_ltk(hdev, smp->responder_ltk, persistent); in smp_notify_keys()
1105 if (smp->link_key) { in smp_notify_keys()
1109 if (test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags)) in smp_notify_keys()
1116 key = hci_add_link_key(hdev, smp->conn->hcon, &hcon->dst, in smp_notify_keys()
1117 smp->link_key, type, 0, &persistent); in smp_notify_keys()
1133 static void sc_add_ltk(struct smp_chan *smp) in sc_add_ltk() argument
1135 struct hci_conn *hcon = smp->conn->hcon; in sc_add_ltk()
1138 if (test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags)) in sc_add_ltk()
1148 smp->ltk = hci_add_ltk(hcon->hdev, &hcon->dst, hcon->dst_type, in sc_add_ltk()
1149 key_type, auth, smp->tk, smp->enc_key_size, in sc_add_ltk()
1153 static void sc_generate_link_key(struct smp_chan *smp) in sc_generate_link_key() argument
1158 smp->link_key = kzalloc(16, GFP_KERNEL); in sc_generate_link_key()
1159 if (!smp->link_key) in sc_generate_link_key()
1162 if (test_bit(SMP_FLAG_CT2, &smp->flags)) { in sc_generate_link_key()
1166 if (smp_h7(smp->tfm_cmac, smp->tk, salt, smp->link_key)) { in sc_generate_link_key()
1167 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1168 smp->link_key = NULL; in sc_generate_link_key()
1175 if (smp_h6(smp->tfm_cmac, smp->tk, tmp1, smp->link_key)) { in sc_generate_link_key()
1176 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1177 smp->link_key = NULL; in sc_generate_link_key()
1182 if (smp_h6(smp->tfm_cmac, smp->link_key, lebr, smp->link_key)) { in sc_generate_link_key()
1183 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1184 smp->link_key = NULL; in sc_generate_link_key()
1189 static void smp_allow_key_dist(struct smp_chan *smp) in smp_allow_key_dist() argument
1195 if (smp->remote_key_dist & SMP_DIST_ENC_KEY) in smp_allow_key_dist()
1196 SMP_ALLOW_CMD(smp, SMP_CMD_ENCRYPT_INFO); in smp_allow_key_dist()
1197 else if (smp->remote_key_dist & SMP_DIST_ID_KEY) in smp_allow_key_dist()
1198 SMP_ALLOW_CMD(smp, SMP_CMD_IDENT_INFO); in smp_allow_key_dist()
1199 else if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_allow_key_dist()
1200 SMP_ALLOW_CMD(smp, SMP_CMD_SIGN_INFO); in smp_allow_key_dist()
1203 static void sc_generate_ltk(struct smp_chan *smp) in sc_generate_ltk() argument
1207 struct hci_conn *hcon = smp->conn->hcon; in sc_generate_ltk()
1218 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_generate_ltk()
1220 if (test_bit(SMP_FLAG_CT2, &smp->flags)) { in sc_generate_ltk()
1224 if (smp_h7(smp->tfm_cmac, key->val, salt, smp->tk)) in sc_generate_ltk()
1230 if (smp_h6(smp->tfm_cmac, key->val, tmp2, smp->tk)) in sc_generate_ltk()
1234 if (smp_h6(smp->tfm_cmac, smp->tk, brle, smp->tk)) in sc_generate_ltk()
1237 sc_add_ltk(smp); in sc_generate_ltk()
1240 static void smp_distribute_keys(struct smp_chan *smp) in smp_distribute_keys() argument
1243 struct l2cap_conn *conn = smp->conn; in smp_distribute_keys()
1250 rsp = (void *) &smp->prsp[1]; in smp_distribute_keys()
1253 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags) && in smp_distribute_keys()
1254 (smp->remote_key_dist & KEY_DIST_MASK)) { in smp_distribute_keys()
1255 smp_allow_key_dist(smp); in smp_distribute_keys()
1259 req = (void *) &smp->preq[1]; in smp_distribute_keys()
1261 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_distribute_keys()
1269 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_distribute_keys()
1271 sc_generate_link_key(smp); in smp_distribute_keys()
1273 sc_generate_ltk(smp); in smp_distribute_keys()
1293 get_random_bytes(enc.ltk, smp->enc_key_size); in smp_distribute_keys()
1294 memset(enc.ltk + smp->enc_key_size, 0, in smp_distribute_keys()
1295 sizeof(enc.ltk) - smp->enc_key_size); in smp_distribute_keys()
1305 smp->enc_key_size, ediv, rand); in smp_distribute_keys()
1306 smp->responder_ltk = ltk; in smp_distribute_keys()
1355 smp->responder_csrk = csrk; in smp_distribute_keys()
1363 if (smp->remote_key_dist & KEY_DIST_MASK) { in smp_distribute_keys()
1364 smp_allow_key_dist(smp); in smp_distribute_keys()
1368 set_bit(SMP_FLAG_COMPLETE, &smp->flags); in smp_distribute_keys()
1376 struct smp_chan *smp = container_of(work, struct smp_chan, in smp_timeout() local
1378 struct l2cap_conn *conn = smp->conn; in smp_timeout()
1388 struct l2cap_chan *chan = conn->smp; in smp_chan_create()
1389 struct smp_chan *smp; in smp_chan_create() local
1391 smp = kzalloc(sizeof(*smp), GFP_ATOMIC); in smp_chan_create()
1392 if (!smp) in smp_chan_create()
1395 smp->tfm_cmac = crypto_alloc_shash("cmac(aes)", 0, 0); in smp_chan_create()
1396 if (IS_ERR(smp->tfm_cmac)) { in smp_chan_create()
1401 smp->tfm_ecdh = crypto_alloc_kpp("ecdh-nist-p256", 0, 0); in smp_chan_create()
1402 if (IS_ERR(smp->tfm_ecdh)) { in smp_chan_create()
1407 smp->conn = conn; in smp_chan_create()
1408 chan->data = smp; in smp_chan_create()
1410 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_FAIL); in smp_chan_create()
1412 INIT_DELAYED_WORK(&smp->security_timer, smp_timeout); in smp_chan_create()
1416 return smp; in smp_chan_create()
1419 crypto_free_shash(smp->tfm_cmac); in smp_chan_create()
1421 kfree_sensitive(smp); in smp_chan_create()
1425 static int sc_mackey_and_ltk(struct smp_chan *smp, u8 mackey[16], u8 ltk[16]) in sc_mackey_and_ltk() argument
1427 struct hci_conn *hcon = smp->conn->hcon; in sc_mackey_and_ltk()
1430 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in sc_mackey_and_ltk()
1431 na = smp->prnd; in sc_mackey_and_ltk()
1432 nb = smp->rrnd; in sc_mackey_and_ltk()
1434 na = smp->rrnd; in sc_mackey_and_ltk()
1435 nb = smp->prnd; in sc_mackey_and_ltk()
1443 return smp_f5(smp->tfm_cmac, smp->dhkey, na, nb, a, b, mackey, ltk); in sc_mackey_and_ltk()
1446 static void sc_dhkey_check(struct smp_chan *smp) in sc_dhkey_check() argument
1448 struct hci_conn *hcon = smp->conn->hcon; in sc_dhkey_check()
1458 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in sc_dhkey_check()
1461 memcpy(io_cap, &smp->preq[1], 3); in sc_dhkey_check()
1465 memcpy(io_cap, &smp->prsp[1], 3); in sc_dhkey_check()
1470 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in sc_dhkey_check()
1473 if (smp->method == REQ_OOB) in sc_dhkey_check()
1474 memcpy(r, smp->rr, 16); in sc_dhkey_check()
1476 smp_f6(smp->tfm_cmac, smp->mackey, smp->prnd, smp->rrnd, r, io_cap, in sc_dhkey_check()
1479 smp_send_cmd(smp->conn, SMP_CMD_DHKEY_CHECK, sizeof(check), &check); in sc_dhkey_check()
1482 static u8 sc_passkey_send_confirm(struct smp_chan *smp) in sc_passkey_send_confirm() argument
1484 struct l2cap_conn *conn = smp->conn; in sc_passkey_send_confirm()
1489 r = ((hcon->passkey_notify >> smp->passkey_round) & 0x01); in sc_passkey_send_confirm()
1492 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in sc_passkey_send_confirm()
1494 if (smp_f4(smp->tfm_cmac, smp->local_pk, smp->remote_pk, smp->prnd, r, in sc_passkey_send_confirm()
1503 static u8 sc_passkey_round(struct smp_chan *smp, u8 smp_op) in sc_passkey_round() argument
1505 struct l2cap_conn *conn = smp->conn; in sc_passkey_round()
1511 if (smp->passkey_round >= 20) in sc_passkey_round()
1516 r = ((hcon->passkey_notify >> smp->passkey_round) & 0x01); in sc_passkey_round()
1519 if (smp_f4(smp->tfm_cmac, smp->remote_pk, smp->local_pk, in sc_passkey_round()
1520 smp->rrnd, r, cfm)) in sc_passkey_round()
1523 if (crypto_memneq(smp->pcnf, cfm, 16)) in sc_passkey_round()
1526 smp->passkey_round++; in sc_passkey_round()
1528 if (smp->passkey_round == 20) { in sc_passkey_round()
1530 if (sc_mackey_and_ltk(smp, smp->mackey, smp->tk)) in sc_passkey_round()
1537 if (!test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in sc_passkey_round()
1539 sizeof(smp->prnd), smp->prnd); in sc_passkey_round()
1540 if (smp->passkey_round == 20) in sc_passkey_round()
1541 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in sc_passkey_round()
1543 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in sc_passkey_round()
1548 if (smp->passkey_round != 20) in sc_passkey_round()
1549 return sc_passkey_round(smp, 0); in sc_passkey_round()
1552 sc_dhkey_check(smp); in sc_passkey_round()
1553 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in sc_passkey_round()
1558 if (test_bit(SMP_FLAG_WAIT_USER, &smp->flags)) { in sc_passkey_round()
1559 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in sc_passkey_round()
1563 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in sc_passkey_round()
1565 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in sc_passkey_round()
1567 sizeof(smp->prnd), smp->prnd); in sc_passkey_round()
1571 return sc_passkey_send_confirm(smp); in sc_passkey_round()
1576 if (!test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in sc_passkey_round()
1580 smp->passkey_round + 1); in sc_passkey_round()
1582 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in sc_passkey_round()
1584 return sc_passkey_send_confirm(smp); in sc_passkey_round()
1590 static int sc_user_reply(struct smp_chan *smp, u16 mgmt_op, __le32 passkey) in sc_user_reply() argument
1592 struct l2cap_conn *conn = smp->conn; in sc_user_reply()
1596 clear_bit(SMP_FLAG_WAIT_USER, &smp->flags); in sc_user_reply()
1600 smp_failure(smp->conn, SMP_PASSKEY_ENTRY_FAILED); in sc_user_reply()
1603 smp_failure(smp->conn, SMP_NUMERIC_COMP_FAILED); in sc_user_reply()
1607 smp->passkey_round = 0; in sc_user_reply()
1609 if (test_and_clear_bit(SMP_FLAG_CFM_PENDING, &smp->flags)) in sc_user_reply()
1614 if (sc_passkey_round(smp, smp_op)) in sc_user_reply()
1621 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in sc_user_reply()
1622 sc_dhkey_check(smp); in sc_user_reply()
1623 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in sc_user_reply()
1624 } else if (test_and_clear_bit(SMP_FLAG_DHKEY_PENDING, &smp->flags)) { in sc_user_reply()
1625 sc_dhkey_check(smp); in sc_user_reply()
1626 sc_add_ltk(smp); in sc_user_reply()
1636 struct smp_chan *smp; in smp_user_confirm_reply() local
1645 chan = conn->smp; in smp_user_confirm_reply()
1655 smp = chan->data; in smp_user_confirm_reply()
1657 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_user_confirm_reply()
1658 err = sc_user_reply(smp, mgmt_op, passkey); in smp_user_confirm_reply()
1665 memset(smp->tk, 0, sizeof(smp->tk)); in smp_user_confirm_reply()
1667 put_unaligned_le32(value, smp->tk); in smp_user_confirm_reply()
1670 set_bit(SMP_FLAG_TK_VALID, &smp->flags); in smp_user_confirm_reply()
1686 if (test_bit(SMP_FLAG_CFM_PENDING, &smp->flags)) { in smp_user_confirm_reply()
1687 u8 rsp = smp_confirm(smp); in smp_user_confirm_reply()
1697 static void build_bredr_pairing_cmd(struct smp_chan *smp, in build_bredr_pairing_cmd() argument
1701 struct l2cap_conn *conn = smp->conn; in build_bredr_pairing_cmd()
1724 smp->remote_key_dist = remote_dist; in build_bredr_pairing_cmd()
1736 smp->remote_key_dist = rsp->init_key_dist; in build_bredr_pairing_cmd()
1742 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_req()
1744 struct smp_chan *smp = chan->data; in smp_cmd_pairing_req() local
1753 if (smp && test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in smp_cmd_pairing_req()
1756 if (!smp) { in smp_cmd_pairing_req()
1757 smp = smp_chan_create(conn); in smp_cmd_pairing_req()
1758 if (!smp) in smp_cmd_pairing_req()
1772 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_cmd_pairing_req()
1773 memcpy(&smp->preq[1], req, sizeof(*req)); in smp_cmd_pairing_req()
1781 set_bit(SMP_FLAG_LOCAL_OOB, &smp->flags); in smp_cmd_pairing_req()
1783 /* SMP over BR/EDR requires special treatment */ in smp_cmd_pairing_req()
1790 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_req()
1792 build_bredr_pairing_cmd(smp, req, &rsp); in smp_cmd_pairing_req()
1795 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_req()
1802 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_req()
1804 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_req()
1805 memcpy(&smp->prsp[1], &rsp, sizeof(rsp)); in smp_cmd_pairing_req()
1808 smp_distribute_keys(smp); in smp_cmd_pairing_req()
1815 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_req()
1818 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_req()
1833 method = get_auth_method(smp, conn->hcon->io_capability, in smp_cmd_pairing_req()
1843 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in smp_cmd_pairing_req()
1845 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_req()
1846 memcpy(&smp->prsp[1], &rsp, sizeof(rsp)); in smp_cmd_pairing_req()
1850 clear_bit(SMP_FLAG_INITIATOR, &smp->flags); in smp_cmd_pairing_req()
1857 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in smp_cmd_pairing_req()
1859 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_req()
1860 SMP_ALLOW_CMD(smp, SMP_CMD_PUBLIC_KEY); in smp_cmd_pairing_req()
1862 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_req()
1875 static u8 sc_send_public_key(struct smp_chan *smp) in sc_send_public_key() argument
1877 struct hci_dev *hdev = smp->conn->hcon->hdev; in sc_send_public_key()
1881 if (test_bit(SMP_FLAG_LOCAL_OOB, &smp->flags)) { in sc_send_public_key()
1890 memcpy(smp->local_pk, smp_dev->local_pk, 64); in sc_send_public_key()
1891 memcpy(smp->lr, smp_dev->local_rand, 16); in sc_send_public_key()
1894 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_send_public_key()
1901 if (set_ecdh_privkey(smp->tfm_ecdh, debug_sk)) in sc_send_public_key()
1903 memcpy(smp->local_pk, debug_pk, 64); in sc_send_public_key()
1904 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_send_public_key()
1908 if (generate_ecdh_keys(smp->tfm_ecdh, smp->local_pk)) in sc_send_public_key()
1914 if (crypto_memneq(smp->local_pk, debug_pk, 64)) in sc_send_public_key()
1920 SMP_DBG("Local Public Key X: %32phN", smp->local_pk); in sc_send_public_key()
1921 SMP_DBG("Local Public Key Y: %32phN", smp->local_pk + 32); in sc_send_public_key()
1923 smp_send_cmd(smp->conn, SMP_CMD_PUBLIC_KEY, 64, smp->local_pk); in sc_send_public_key()
1931 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_rsp()
1932 struct smp_chan *smp = chan->data; in smp_cmd_pairing_rsp() local
1942 if (!test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in smp_cmd_pairing_rsp()
1947 req = (void *) &smp->preq[1]; in smp_cmd_pairing_rsp()
1963 set_bit(SMP_FLAG_LOCAL_OOB, &smp->flags); in smp_cmd_pairing_rsp()
1965 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_rsp()
1966 memcpy(&smp->prsp[1], rsp, sizeof(*rsp)); in smp_cmd_pairing_rsp()
1971 smp->remote_key_dist &= rsp->resp_key_dist; in smp_cmd_pairing_rsp()
1974 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_rsp()
1979 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_rsp()
1980 smp_distribute_keys(smp); in smp_cmd_pairing_rsp()
1985 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_rsp()
1993 method = get_auth_method(smp, req->io_capability, in smp_cmd_pairing_rsp()
1999 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in smp_cmd_pairing_rsp()
2004 smp->remote_key_dist &= rsp->resp_key_dist; in smp_cmd_pairing_rsp()
2006 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_rsp()
2008 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_rsp()
2009 SMP_ALLOW_CMD(smp, SMP_CMD_PUBLIC_KEY); in smp_cmd_pairing_rsp()
2010 return sc_send_public_key(smp); in smp_cmd_pairing_rsp()
2019 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_cmd_pairing_rsp()
2022 if (test_bit(SMP_FLAG_TK_VALID, &smp->flags)) in smp_cmd_pairing_rsp()
2023 return smp_confirm(smp); in smp_cmd_pairing_rsp()
2028 static u8 sc_check_confirm(struct smp_chan *smp) in sc_check_confirm() argument
2030 struct l2cap_conn *conn = smp->conn; in sc_check_confirm()
2034 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in sc_check_confirm()
2035 return sc_passkey_round(smp, SMP_CMD_PAIRING_CONFIRM); in sc_check_confirm()
2037 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in sc_check_confirm()
2038 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in sc_check_confirm()
2039 smp->prnd); in sc_check_confirm()
2040 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in sc_check_confirm()
2050 static int fixup_sc_false_positive(struct smp_chan *smp) in fixup_sc_false_positive() argument
2052 struct l2cap_conn *conn = smp->conn; in fixup_sc_false_positive()
2059 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in fixup_sc_false_positive()
2067 bt_dev_err(hdev, "trying to fall back to legacy SMP"); in fixup_sc_false_positive()
2069 req = (void *) &smp->preq[1]; in fixup_sc_false_positive()
2070 rsp = (void *) &smp->prsp[1]; in fixup_sc_false_positive()
2073 smp->remote_key_dist = (req->init_key_dist & rsp->resp_key_dist); in fixup_sc_false_positive()
2078 bt_dev_err(hdev, "failed to fall back to legacy SMP"); in fixup_sc_false_positive()
2082 clear_bit(SMP_FLAG_SC, &smp->flags); in fixup_sc_false_positive()
2089 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_confirm()
2090 struct smp_chan *smp = chan->data; in smp_cmd_pairing_confirm() local
2095 test_bit(SMP_FLAG_INITIATOR, &smp->flags) ? "initiator" : in smp_cmd_pairing_confirm()
2098 if (skb->len < sizeof(smp->pcnf)) in smp_cmd_pairing_confirm()
2101 memcpy(smp->pcnf, skb->data, sizeof(smp->pcnf)); in smp_cmd_pairing_confirm()
2102 skb_pull(skb, sizeof(smp->pcnf)); in smp_cmd_pairing_confirm()
2104 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_confirm()
2108 if (test_bit(SMP_FLAG_REMOTE_PK, &smp->flags)) in smp_cmd_pairing_confirm()
2109 return sc_check_confirm(smp); in smp_cmd_pairing_confirm()
2111 bt_dev_err(hdev, "Unexpected SMP Pairing Confirm"); in smp_cmd_pairing_confirm()
2113 ret = fixup_sc_false_positive(smp); in smp_cmd_pairing_confirm()
2118 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_pairing_confirm()
2119 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_cmd_pairing_confirm()
2120 smp->prnd); in smp_cmd_pairing_confirm()
2121 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in smp_cmd_pairing_confirm()
2125 if (test_bit(SMP_FLAG_TK_VALID, &smp->flags)) in smp_cmd_pairing_confirm()
2126 return smp_confirm(smp); in smp_cmd_pairing_confirm()
2128 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_cmd_pairing_confirm()
2135 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_random()
2136 struct smp_chan *smp = chan->data; in smp_cmd_pairing_random() local
2144 if (skb->len < sizeof(smp->rrnd)) in smp_cmd_pairing_random()
2147 memcpy(smp->rrnd, skb->data, sizeof(smp->rrnd)); in smp_cmd_pairing_random()
2148 skb_pull(skb, sizeof(smp->rrnd)); in smp_cmd_pairing_random()
2150 if (!test_bit(SMP_FLAG_SC, &smp->flags)) in smp_cmd_pairing_random()
2151 return smp_random(smp); in smp_cmd_pairing_random()
2153 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_pairing_random()
2154 pkax = smp->local_pk; in smp_cmd_pairing_random()
2155 pkbx = smp->remote_pk; in smp_cmd_pairing_random()
2156 na = smp->prnd; in smp_cmd_pairing_random()
2157 nb = smp->rrnd; in smp_cmd_pairing_random()
2159 pkax = smp->remote_pk; in smp_cmd_pairing_random()
2160 pkbx = smp->local_pk; in smp_cmd_pairing_random()
2161 na = smp->rrnd; in smp_cmd_pairing_random()
2162 nb = smp->prnd; in smp_cmd_pairing_random()
2165 if (smp->method == REQ_OOB) { in smp_cmd_pairing_random()
2166 if (!test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in smp_cmd_pairing_random()
2168 sizeof(smp->prnd), smp->prnd); in smp_cmd_pairing_random()
2169 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in smp_cmd_pairing_random()
2174 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in smp_cmd_pairing_random()
2175 return sc_passkey_round(smp, SMP_CMD_PAIRING_RANDOM); in smp_cmd_pairing_random()
2177 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_pairing_random()
2180 err = smp_f4(smp->tfm_cmac, smp->remote_pk, smp->local_pk, in smp_cmd_pairing_random()
2181 smp->rrnd, 0, cfm); in smp_cmd_pairing_random()
2185 if (crypto_memneq(smp->pcnf, cfm, 16)) in smp_cmd_pairing_random()
2188 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_cmd_pairing_random()
2189 smp->prnd); in smp_cmd_pairing_random()
2190 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in smp_cmd_pairing_random()
2193 if (smp->method != JUST_WORKS) in smp_cmd_pairing_random()
2213 err = sc_mackey_and_ltk(smp, smp->mackey, smp->tk); in smp_cmd_pairing_random()
2217 if (smp->method == REQ_OOB) { in smp_cmd_pairing_random()
2218 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_pairing_random()
2219 sc_dhkey_check(smp); in smp_cmd_pairing_random()
2220 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in smp_cmd_pairing_random()
2225 err = smp_g2(smp->tfm_cmac, pkax, pkbx, na, nb, &passkey); in smp_cmd_pairing_random()
2232 if (smp->method == JUST_WORKS) in smp_cmd_pairing_random()
2240 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in smp_cmd_pairing_random()
2292 static void smp_send_pairing_req(struct smp_chan *smp, __u8 auth) in smp_send_pairing_req() argument
2296 if (smp->conn->hcon->type == ACL_LINK) in smp_send_pairing_req()
2297 build_bredr_pairing_cmd(smp, &cp, NULL); in smp_send_pairing_req()
2299 build_pairing_cmd(smp->conn, &cp, NULL, auth); in smp_send_pairing_req()
2301 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_send_pairing_req()
2302 memcpy(&smp->preq[1], &cp, sizeof(cp)); in smp_send_pairing_req()
2304 smp_send_cmd(smp->conn, SMP_CMD_PAIRING_REQ, sizeof(cp), &cp); in smp_send_pairing_req()
2305 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RSP); in smp_send_pairing_req()
2307 set_bit(SMP_FLAG_INITIATOR, &smp->flags); in smp_send_pairing_req()
2315 struct smp_chan *smp; in smp_cmd_security_req() local
2351 smp = smp_chan_create(conn); in smp_cmd_security_req()
2352 if (!smp) in smp_cmd_security_req()
2361 smp_send_pairing_req(smp, auth); in smp_cmd_security_req()
2366 static void smp_send_security_req(struct smp_chan *smp, __u8 auth) in smp_send_security_req() argument
2371 smp_send_cmd(smp->conn, SMP_CMD_SECURITY_REQ, sizeof(cp), &cp); in smp_send_security_req()
2372 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_REQ); in smp_send_security_req()
2374 clear_bit(SMP_FLAG_INITIATOR, &smp->flags); in smp_send_security_req()
2381 struct smp_chan *smp; in smp_conn_security() local
2405 chan = conn->smp; in smp_conn_security()
2413 /* If SMP is already in progress ignore this request */ in smp_conn_security()
2419 smp = smp_chan_create(conn); in smp_conn_security()
2420 if (!smp) { in smp_conn_security()
2446 smp_send_pairing_req(smp, authreq); in smp_conn_security()
2448 smp_send_security_req(smp, authreq); in smp_conn_security()
2463 struct smp_chan *smp; in smp_cancel_and_remove_pairing() local
2477 chan = conn->smp; in smp_cancel_and_remove_pairing()
2483 smp = chan->data; in smp_cancel_and_remove_pairing()
2484 if (smp) { in smp_cancel_and_remove_pairing()
2487 smp->ltk = NULL; in smp_cancel_and_remove_pairing()
2488 smp->responder_ltk = NULL; in smp_cancel_and_remove_pairing()
2489 smp->remote_irk = NULL; in smp_cancel_and_remove_pairing()
2491 if (test_bit(SMP_FLAG_COMPLETE, &smp->flags)) in smp_cancel_and_remove_pairing()
2507 struct l2cap_chan *chan = conn->smp; in smp_cmd_encrypt_info()
2508 struct smp_chan *smp = chan->data; in smp_cmd_encrypt_info() local
2524 SMP_ALLOW_CMD(smp, SMP_CMD_INITIATOR_IDENT); in smp_cmd_encrypt_info()
2528 memcpy(smp->tk, rp->ltk, sizeof(smp->tk)); in smp_cmd_encrypt_info()
2536 struct l2cap_chan *chan = conn->smp; in smp_cmd_initiator_ident()
2537 struct smp_chan *smp = chan->data; in smp_cmd_initiator_ident() local
2549 smp->remote_key_dist &= ~SMP_DIST_ENC_KEY; in smp_cmd_initiator_ident()
2551 if (smp->remote_key_dist & SMP_DIST_ID_KEY) in smp_cmd_initiator_ident()
2552 SMP_ALLOW_CMD(smp, SMP_CMD_IDENT_INFO); in smp_cmd_initiator_ident()
2553 else if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_cmd_initiator_ident()
2554 SMP_ALLOW_CMD(smp, SMP_CMD_SIGN_INFO); in smp_cmd_initiator_ident()
2560 authenticated, smp->tk, smp->enc_key_size, in smp_cmd_initiator_ident()
2562 smp->ltk = ltk; in smp_cmd_initiator_ident()
2563 if (!(smp->remote_key_dist & KEY_DIST_MASK)) in smp_cmd_initiator_ident()
2564 smp_distribute_keys(smp); in smp_cmd_initiator_ident()
2572 struct l2cap_chan *chan = conn->smp; in smp_cmd_ident_info()
2573 struct smp_chan *smp = chan->data; in smp_cmd_ident_info() local
2589 SMP_ALLOW_CMD(smp, SMP_CMD_IDENT_ADDR_INFO); in smp_cmd_ident_info()
2593 memcpy(smp->irk, info->irk, 16); in smp_cmd_ident_info()
2602 struct l2cap_chan *chan = conn->smp; in smp_cmd_ident_addr_info()
2603 struct smp_chan *smp = chan->data; in smp_cmd_ident_addr_info() local
2613 smp->remote_key_dist &= ~SMP_DIST_ID_KEY; in smp_cmd_ident_addr_info()
2615 if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_cmd_ident_addr_info()
2616 SMP_ALLOW_CMD(smp, SMP_CMD_SIGN_INFO); in smp_cmd_ident_addr_info()
2649 bacpy(&smp->id_addr, &info->bdaddr); in smp_cmd_ident_addr_info()
2650 smp->id_addr_type = info->addr_type; in smp_cmd_ident_addr_info()
2657 smp->remote_irk = hci_add_irk(conn->hcon->hdev, &smp->id_addr, in smp_cmd_ident_addr_info()
2658 smp->id_addr_type, smp->irk, &rpa); in smp_cmd_ident_addr_info()
2661 if (!(smp->remote_key_dist & KEY_DIST_MASK)) in smp_cmd_ident_addr_info()
2662 smp_distribute_keys(smp); in smp_cmd_ident_addr_info()
2670 struct l2cap_chan *chan = conn->smp; in smp_cmd_sign_info()
2671 struct smp_chan *smp = chan->data; in smp_cmd_sign_info() local
2680 smp->remote_key_dist &= ~SMP_DIST_SIGN; in smp_cmd_sign_info()
2692 smp->csrk = csrk; in smp_cmd_sign_info()
2693 smp_distribute_keys(smp); in smp_cmd_sign_info()
2698 static u8 sc_select_method(struct smp_chan *smp) in sc_select_method() argument
2703 if (test_bit(SMP_FLAG_REMOTE_OOB, &smp->flags) || in sc_select_method()
2704 test_bit(SMP_FLAG_LOCAL_OOB, &smp->flags)) in sc_select_method()
2712 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in sc_select_method()
2713 local = (void *) &smp->preq[1]; in sc_select_method()
2714 remote = (void *) &smp->prsp[1]; in sc_select_method()
2716 local = (void *) &smp->prsp[1]; in sc_select_method()
2717 remote = (void *) &smp->preq[1]; in sc_select_method()
2730 method = get_auth_method(smp, local_io, remote_io); in sc_select_method()
2735 if (method == JUST_CFM && test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in sc_select_method()
2745 struct l2cap_chan *chan = conn->smp; in smp_cmd_public_key()
2746 struct smp_chan *smp = chan->data; in smp_cmd_public_key() local
2760 if (!test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags) && in smp_cmd_public_key()
2761 !crypto_memneq(key, smp->local_pk, 64)) { in smp_cmd_public_key()
2766 memcpy(smp->remote_pk, key, 64); in smp_cmd_public_key()
2768 if (test_bit(SMP_FLAG_REMOTE_OOB, &smp->flags)) { in smp_cmd_public_key()
2769 err = smp_f4(smp->tfm_cmac, smp->remote_pk, smp->remote_pk, in smp_cmd_public_key()
2770 smp->rr, 0, cfm.confirm_val); in smp_cmd_public_key()
2774 if (crypto_memneq(cfm.confirm_val, smp->pcnf, 16)) in smp_cmd_public_key()
2781 if (!test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_public_key()
2782 err = sc_send_public_key(smp); in smp_cmd_public_key()
2787 SMP_DBG("Remote Public Key X: %32phN", smp->remote_pk); in smp_cmd_public_key()
2788 SMP_DBG("Remote Public Key Y: %32phN", smp->remote_pk + 32); in smp_cmd_public_key()
2793 if (test_bit(SMP_FLAG_LOCAL_OOB, &smp->flags)) { in smp_cmd_public_key()
2804 tfm_ecdh = smp->tfm_ecdh; in smp_cmd_public_key()
2807 if (compute_ecdh_secret(tfm_ecdh, smp->remote_pk, smp->dhkey)) in smp_cmd_public_key()
2810 SMP_DBG("DHKey %32phN", smp->dhkey); in smp_cmd_public_key()
2812 set_bit(SMP_FLAG_REMOTE_PK, &smp->flags); in smp_cmd_public_key()
2814 smp->method = sc_select_method(smp); in smp_cmd_public_key()
2816 bt_dev_dbg(hdev, "selected method 0x%02x", smp->method); in smp_cmd_public_key()
2819 if (smp->method == JUST_WORKS || smp->method == JUST_CFM) in smp_cmd_public_key()
2824 if (!crypto_memneq(debug_pk, smp->remote_pk, 64)) in smp_cmd_public_key()
2825 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in smp_cmd_public_key()
2827 if (smp->method == DSP_PASSKEY) { in smp_cmd_public_key()
2832 smp->passkey_round = 0; in smp_cmd_public_key()
2838 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in smp_cmd_public_key()
2839 return sc_passkey_round(smp, SMP_CMD_PUBLIC_KEY); in smp_cmd_public_key()
2842 if (smp->method == REQ_OOB) { in smp_cmd_public_key()
2843 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in smp_cmd_public_key()
2845 sizeof(smp->prnd), smp->prnd); in smp_cmd_public_key()
2847 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in smp_cmd_public_key()
2852 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in smp_cmd_public_key()
2853 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in smp_cmd_public_key()
2855 if (smp->method == REQ_PASSKEY) { in smp_cmd_public_key()
2859 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in smp_cmd_public_key()
2860 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in smp_cmd_public_key()
2867 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in smp_cmd_public_key()
2870 err = smp_f4(smp->tfm_cmac, smp->local_pk, smp->remote_pk, smp->prnd, in smp_cmd_public_key()
2876 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in smp_cmd_public_key()
2884 struct l2cap_chan *chan = conn->smp; in smp_cmd_dhkey_check()
2886 struct smp_chan *smp = chan->data; in smp_cmd_dhkey_check() local
2901 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_dhkey_check()
2904 memcpy(io_cap, &smp->prsp[1], 3); in smp_cmd_dhkey_check()
2908 memcpy(io_cap, &smp->preq[1], 3); in smp_cmd_dhkey_check()
2913 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in smp_cmd_dhkey_check()
2915 else if (smp->method == REQ_OOB) in smp_cmd_dhkey_check()
2916 memcpy(r, smp->lr, 16); in smp_cmd_dhkey_check()
2918 err = smp_f6(smp->tfm_cmac, smp->mackey, smp->rrnd, smp->prnd, r, in smp_cmd_dhkey_check()
2926 if (!test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_dhkey_check()
2927 if (test_bit(SMP_FLAG_WAIT_USER, &smp->flags)) { in smp_cmd_dhkey_check()
2928 set_bit(SMP_FLAG_DHKEY_PENDING, &smp->flags); in smp_cmd_dhkey_check()
2933 sc_dhkey_check(smp); in smp_cmd_dhkey_check()
2936 sc_add_ltk(smp); in smp_cmd_dhkey_check()
2938 if (test_bit(SMP_FLAG_INITIATOR, &smp->flags)) { in smp_cmd_dhkey_check()
2939 hci_le_start_enc(hcon, 0, 0, smp->tk, smp->enc_key_size); in smp_cmd_dhkey_check()
2940 hcon->enc_key_size = smp->enc_key_size; in smp_cmd_dhkey_check()
2960 struct smp_chan *smp; in smp_sig_channel() local
2975 smp = chan->data; in smp_sig_channel()
2980 if (smp && !test_and_clear_bit(code, &smp->allow_cmd)) in smp_sig_channel()
2986 if (!smp && code != SMP_CMD_PAIRING_REQ && code != SMP_CMD_SECURITY_REQ) in smp_sig_channel()
3063 bt_dev_err(hcon->hdev, "unexpected SMP command 0x%02x from %pMR", in smp_sig_channel()
3078 conn->smp = NULL; in smp_teardown_cb()
3087 struct smp_chan *smp; in bredr_pairing() local
3099 /* Only initiator may initiate SMP over BR/EDR */ in bredr_pairing()
3107 /* BR/EDR must use Secure Connections for SMP */ in bredr_pairing()
3120 /* Remote must support SMP fixed chan for BR/EDR */ in bredr_pairing()
3124 /* Don't bother if SMP is already ongoing */ in bredr_pairing()
3128 smp = smp_chan_create(conn); in bredr_pairing()
3129 if (!smp) { in bredr_pairing()
3130 bt_dev_err(hdev, "unable to create SMP context for BR/EDR"); in bredr_pairing()
3134 set_bit(SMP_FLAG_SC, &smp->flags); in bredr_pairing()
3136 bt_dev_dbg(hdev, "starting SMP over BR/EDR"); in bredr_pairing()
3138 smp_send_pairing_req(smp, 0x00); in bredr_pairing()
3143 struct smp_chan *smp = chan->data; in smp_resume_cb() local
3154 if (!smp) in smp_resume_cb()
3160 cancel_delayed_work(&smp->security_timer); in smp_resume_cb()
3162 smp_distribute_keys(smp); in smp_resume_cb()
3178 conn->smp = chan; in smp_ready_cb()
3192 struct smp_chan *smp = chan->data; in smp_recv_cb() local
3194 if (smp) in smp_recv_cb()
3195 cancel_delayed_work_sync(&smp->security_timer); in smp_recv_cb()
3254 /* Other L2CAP channels may request SMP routines in order to in smp_new_conn_cb()
3255 * change the security level. This means that the SMP channel in smp_new_conn_cb()
3287 struct smp_dev *smp; in smp_add_cid() local
3292 smp = NULL; in smp_add_cid()
3296 smp = kzalloc(sizeof(*smp), GFP_KERNEL); in smp_add_cid()
3297 if (!smp) in smp_add_cid()
3303 kfree_sensitive(smp); in smp_add_cid()
3311 kfree_sensitive(smp); in smp_add_cid()
3315 smp->local_oob = false; in smp_add_cid()
3316 smp->tfm_cmac = tfm_cmac; in smp_add_cid()
3317 smp->tfm_ecdh = tfm_ecdh; in smp_add_cid()
3322 if (smp) { in smp_add_cid()
3323 crypto_free_shash(smp->tfm_cmac); in smp_add_cid()
3324 crypto_free_kpp(smp->tfm_ecdh); in smp_add_cid()
3325 kfree_sensitive(smp); in smp_add_cid()
3330 chan->data = smp; in smp_add_cid()
3363 struct smp_dev *smp; in smp_del_chan() local
3367 smp = chan->data; in smp_del_chan()
3368 if (smp) { in smp_del_chan()
3370 crypto_free_shash(smp->tfm_cmac); in smp_del_chan()
3371 crypto_free_kpp(smp->tfm_ecdh); in smp_del_chan()
3372 kfree_sensitive(smp); in smp_del_chan()
3411 * there is also no need to register any SMP channel. in smp_register()
3805 BT_INFO("SMP test passed in %llu usecs", duration); in run_selftests()