• Home
  • Raw
  • Download

Lines Matching full:smp

37 #include "smp.h"
54 #define SMP_ALLOW_CMD(smp, code) set_bit(code, &smp->allow_cmd) argument
102 u8 preq[7]; /* SMP Pairing Request */
103 u8 prsp[7]; /* SMP Pairing Response */
104 u8 prnd[16]; /* SMP Pairing Random (local) */
105 u8 rrnd[16]; /* SMP Pairing Random (remote) */
106 u8 pcnf[16]; /* SMP Pairing Confirm */
107 u8 tk[16]; /* SMP Temporary Key */
135 /* These debug key values are defined in the SMP section of the core
166 /* The following functions map to the LE SC SMP crypto functions
238 * the SMP section of the Bluetooth core specification. In ASCII in smp_f5()
372 /* The following functions map to the legacy SMP crypto functions e, c1,
542 struct smp_dev *smp; in smp_generate_oob() local
548 smp = chan->data; in smp_generate_oob()
552 err = set_ecdh_privkey(smp->tfm_ecdh, debug_sk); in smp_generate_oob()
555 memcpy(smp->local_pk, debug_pk, 64); in smp_generate_oob()
556 smp->debug_key = true; in smp_generate_oob()
560 err = generate_ecdh_keys(smp->tfm_ecdh, smp->local_pk); in smp_generate_oob()
567 if (crypto_memneq(smp->local_pk, debug_pk, 64)) in smp_generate_oob()
570 smp->debug_key = false; in smp_generate_oob()
573 SMP_DBG("OOB Public Key X: %32phN", smp->local_pk); in smp_generate_oob()
574 SMP_DBG("OOB Public Key Y: %32phN", smp->local_pk + 32); in smp_generate_oob()
576 get_random_bytes(smp->local_rand, 16); in smp_generate_oob()
578 err = smp_f4(smp->tfm_cmac, smp->local_pk, smp->local_pk, in smp_generate_oob()
579 smp->local_rand, 0, hash); in smp_generate_oob()
583 memcpy(rand, smp->local_rand, 16); in smp_generate_oob()
585 smp->local_oob = true; in smp_generate_oob()
592 struct l2cap_chan *chan = conn->smp; in smp_send_cmd()
593 struct smp_chan *smp; in smp_send_cmd() local
617 smp = chan->data; in smp_send_cmd()
619 cancel_delayed_work_sync(&smp->security_timer); in smp_send_cmd()
620 schedule_delayed_work(&smp->security_timer, SMP_TIMEOUT); in smp_send_cmd()
652 struct l2cap_chan *chan = conn->smp; in build_pairing_cmd()
653 struct smp_chan *smp = chan->data; in build_pairing_cmd() local
690 set_bit(SMP_FLAG_REMOTE_OOB, &smp->flags); in build_pairing_cmd()
692 memcpy(smp->rr, oob_data->rand256, 16); in build_pairing_cmd()
693 memcpy(smp->pcnf, oob_data->hash256, 16); in build_pairing_cmd()
694 SMP_DBG("OOB Remote Confirmation: %16phN", smp->pcnf); in build_pairing_cmd()
695 SMP_DBG("OOB Remote Random: %16phN", smp->rr); in build_pairing_cmd()
710 smp->remote_key_dist = remote_dist; in build_pairing_cmd()
721 smp->remote_key_dist = rsp->init_key_dist; in build_pairing_cmd()
726 struct l2cap_chan *chan = conn->smp; in check_enc_key_size()
728 struct smp_chan *smp = chan->data; in check_enc_key_size() local
738 smp->enc_key_size = max_key_size; in check_enc_key_size()
745 struct l2cap_chan *chan = conn->smp; in smp_chan_destroy()
746 struct smp_chan *smp = chan->data; in smp_chan_destroy() local
750 BUG_ON(!smp); in smp_chan_destroy()
752 cancel_delayed_work_sync(&smp->security_timer); in smp_chan_destroy()
754 complete = test_bit(SMP_FLAG_COMPLETE, &smp->flags); in smp_chan_destroy()
757 kfree_sensitive(smp->csrk); in smp_chan_destroy()
758 kfree_sensitive(smp->responder_csrk); in smp_chan_destroy()
759 kfree_sensitive(smp->link_key); in smp_chan_destroy()
761 crypto_free_shash(smp->tfm_cmac); in smp_chan_destroy()
762 crypto_free_kpp(smp->tfm_ecdh); in smp_chan_destroy()
767 if (smp->ltk && smp->ltk->type == SMP_LTK_P256_DEBUG && in smp_chan_destroy()
769 list_del_rcu(&smp->ltk->list); in smp_chan_destroy()
770 kfree_rcu(smp->ltk, rcu); in smp_chan_destroy()
771 smp->ltk = NULL; in smp_chan_destroy()
776 if (smp->ltk) { in smp_chan_destroy()
777 list_del_rcu(&smp->ltk->list); in smp_chan_destroy()
778 kfree_rcu(smp->ltk, rcu); in smp_chan_destroy()
781 if (smp->responder_ltk) { in smp_chan_destroy()
782 list_del_rcu(&smp->responder_ltk->list); in smp_chan_destroy()
783 kfree_rcu(smp->responder_ltk, rcu); in smp_chan_destroy()
786 if (smp->remote_irk) { in smp_chan_destroy()
787 list_del_rcu(&smp->remote_irk->list); in smp_chan_destroy()
788 kfree_rcu(smp->remote_irk, rcu); in smp_chan_destroy()
793 kfree_sensitive(smp); in smp_chan_destroy()
800 struct l2cap_chan *chan = conn->smp; in smp_failure()
836 static u8 get_auth_method(struct smp_chan *smp, u8 local_io, u8 remote_io) in get_auth_method() argument
845 if (test_bit(SMP_FLAG_SC, &smp->flags)) in get_auth_method()
855 struct l2cap_chan *chan = conn->smp; in tk_request()
856 struct smp_chan *smp = chan->data; in tk_request() local
861 memset(smp->tk, 0, sizeof(smp->tk)); in tk_request()
862 clear_bit(SMP_FLAG_TK_VALID, &smp->flags); in tk_request()
874 smp->method = JUST_CFM; in tk_request()
876 smp->method = get_auth_method(smp, local_io, remote_io); in tk_request()
879 if (smp->method == JUST_CFM && test_bit(SMP_FLAG_INITIATOR, in tk_request()
880 &smp->flags)) in tk_request()
881 smp->method = JUST_WORKS; in tk_request()
884 if (smp->method == JUST_CFM && in tk_request()
886 smp->method = JUST_WORKS; in tk_request()
890 if (smp->method == JUST_WORKS) { in tk_request()
897 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in tk_request()
904 if (test_bit(SMP_FLAG_SC, &smp->flags)) in tk_request()
908 if (smp->method != JUST_CFM) { in tk_request()
909 set_bit(SMP_FLAG_MITM_AUTH, &smp->flags); in tk_request()
917 if (smp->method == OVERLAP) { in tk_request()
919 smp->method = CFM_PASSKEY; in tk_request()
921 smp->method = REQ_PASSKEY; in tk_request()
925 if (smp->method == CFM_PASSKEY) { in tk_request()
926 memset(smp->tk, 0, sizeof(smp->tk)); in tk_request()
929 put_unaligned_le32(passkey, smp->tk); in tk_request()
931 set_bit(SMP_FLAG_TK_VALID, &smp->flags); in tk_request()
934 if (smp->method == REQ_PASSKEY) in tk_request()
937 else if (smp->method == JUST_CFM) in tk_request()
949 static u8 smp_confirm(struct smp_chan *smp) in smp_confirm() argument
951 struct l2cap_conn *conn = smp->conn; in smp_confirm()
957 ret = smp_c1(smp->tk, smp->prnd, smp->preq, smp->prsp, in smp_confirm()
964 clear_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_confirm()
966 smp_send_cmd(smp->conn, SMP_CMD_PAIRING_CONFIRM, sizeof(cp), &cp); in smp_confirm()
969 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in smp_confirm()
971 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in smp_confirm()
976 static u8 smp_random(struct smp_chan *smp) in smp_random() argument
978 struct l2cap_conn *conn = smp->conn; 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()
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 smp->remote_irk->link_type = hcon->type; in smp_notify_keys()
1064 mgmt_new_irk(hdev, smp->remote_irk, persistent); in smp_notify_keys()
1071 bacpy(&hcon->dst, &smp->remote_irk->bdaddr); in smp_notify_keys()
1072 hcon->dst_type = smp->remote_irk->addr_type; in smp_notify_keys()
1082 if (smp->csrk) { in smp_notify_keys()
1083 smp->csrk->link_type = hcon->type; in smp_notify_keys()
1084 smp->csrk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1085 bacpy(&smp->csrk->bdaddr, &hcon->dst); in smp_notify_keys()
1086 mgmt_new_csrk(hdev, smp->csrk, persistent); in smp_notify_keys()
1089 if (smp->responder_csrk) { in smp_notify_keys()
1090 smp->responder_csrk->link_type = hcon->type; in smp_notify_keys()
1091 smp->responder_csrk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1092 bacpy(&smp->responder_csrk->bdaddr, &hcon->dst); in smp_notify_keys()
1093 mgmt_new_csrk(hdev, smp->responder_csrk, persistent); in smp_notify_keys()
1096 if (smp->ltk) { in smp_notify_keys()
1097 smp->ltk->link_type = hcon->type; in smp_notify_keys()
1098 smp->ltk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1099 bacpy(&smp->ltk->bdaddr, &hcon->dst); in smp_notify_keys()
1100 mgmt_new_ltk(hdev, smp->ltk, persistent); in smp_notify_keys()
1103 if (smp->responder_ltk) { in smp_notify_keys()
1104 smp->responder_ltk->link_type = hcon->type; in smp_notify_keys()
1105 smp->responder_ltk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1106 bacpy(&smp->responder_ltk->bdaddr, &hcon->dst); in smp_notify_keys()
1107 mgmt_new_ltk(hdev, smp->responder_ltk, persistent); in smp_notify_keys()
1110 if (smp->link_key) { in smp_notify_keys()
1114 if (test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags)) in smp_notify_keys()
1121 key = hci_add_link_key(hdev, smp->conn->hcon, &hcon->dst, in smp_notify_keys()
1122 smp->link_key, type, 0, &persistent); in smp_notify_keys()
1140 static void sc_add_ltk(struct smp_chan *smp) in sc_add_ltk() argument
1142 struct hci_conn *hcon = smp->conn->hcon; in sc_add_ltk()
1145 if (test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags)) in sc_add_ltk()
1155 smp->ltk = hci_add_ltk(hcon->hdev, &hcon->dst, hcon->dst_type, in sc_add_ltk()
1156 key_type, auth, smp->tk, smp->enc_key_size, in sc_add_ltk()
1160 static void sc_generate_link_key(struct smp_chan *smp) in sc_generate_link_key() argument
1165 smp->link_key = kzalloc(16, GFP_KERNEL); in sc_generate_link_key()
1166 if (!smp->link_key) in sc_generate_link_key()
1169 if (test_bit(SMP_FLAG_CT2, &smp->flags)) { in sc_generate_link_key()
1173 if (smp_h7(smp->tfm_cmac, smp->tk, salt, smp->link_key)) { in sc_generate_link_key()
1174 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1175 smp->link_key = NULL; in sc_generate_link_key()
1182 if (smp_h6(smp->tfm_cmac, smp->tk, tmp1, 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 if (smp_h6(smp->tfm_cmac, smp->link_key, lebr, smp->link_key)) { in sc_generate_link_key()
1190 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1191 smp->link_key = NULL; in sc_generate_link_key()
1196 static void smp_allow_key_dist(struct smp_chan *smp) in smp_allow_key_dist() argument
1202 if (smp->remote_key_dist & SMP_DIST_ENC_KEY) in smp_allow_key_dist()
1203 SMP_ALLOW_CMD(smp, SMP_CMD_ENCRYPT_INFO); in smp_allow_key_dist()
1204 else if (smp->remote_key_dist & SMP_DIST_ID_KEY) in smp_allow_key_dist()
1205 SMP_ALLOW_CMD(smp, SMP_CMD_IDENT_INFO); in smp_allow_key_dist()
1206 else if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_allow_key_dist()
1207 SMP_ALLOW_CMD(smp, SMP_CMD_SIGN_INFO); in smp_allow_key_dist()
1210 static void sc_generate_ltk(struct smp_chan *smp) in sc_generate_ltk() argument
1214 struct hci_conn *hcon = smp->conn->hcon; in sc_generate_ltk()
1225 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_generate_ltk()
1227 if (test_bit(SMP_FLAG_CT2, &smp->flags)) { in sc_generate_ltk()
1231 if (smp_h7(smp->tfm_cmac, key->val, salt, smp->tk)) in sc_generate_ltk()
1237 if (smp_h6(smp->tfm_cmac, key->val, tmp2, smp->tk)) in sc_generate_ltk()
1241 if (smp_h6(smp->tfm_cmac, smp->tk, brle, smp->tk)) in sc_generate_ltk()
1244 sc_add_ltk(smp); in sc_generate_ltk()
1247 static void smp_distribute_keys(struct smp_chan *smp) in smp_distribute_keys() argument
1250 struct l2cap_conn *conn = smp->conn; in smp_distribute_keys()
1257 rsp = (void *) &smp->prsp[1]; in smp_distribute_keys()
1260 if (hcon->out && (smp->remote_key_dist & KEY_DIST_MASK)) { in smp_distribute_keys()
1261 smp_allow_key_dist(smp); in smp_distribute_keys()
1265 req = (void *) &smp->preq[1]; in smp_distribute_keys()
1275 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_distribute_keys()
1277 sc_generate_link_key(smp); in smp_distribute_keys()
1279 sc_generate_ltk(smp); in smp_distribute_keys()
1299 get_random_bytes(enc.ltk, smp->enc_key_size); in smp_distribute_keys()
1300 memset(enc.ltk + smp->enc_key_size, 0, in smp_distribute_keys()
1301 sizeof(enc.ltk) - smp->enc_key_size); in smp_distribute_keys()
1311 smp->enc_key_size, ediv, rand); in smp_distribute_keys()
1312 smp->responder_ltk = ltk; in smp_distribute_keys()
1361 smp->responder_csrk = csrk; in smp_distribute_keys()
1369 if (smp->remote_key_dist & KEY_DIST_MASK) { in smp_distribute_keys()
1370 smp_allow_key_dist(smp); in smp_distribute_keys()
1374 set_bit(SMP_FLAG_COMPLETE, &smp->flags); in smp_distribute_keys()
1382 struct smp_chan *smp = container_of(work, struct smp_chan, in smp_timeout() local
1384 struct l2cap_conn *conn = smp->conn; in smp_timeout()
1394 struct l2cap_chan *chan = conn->smp; in smp_chan_create()
1395 struct smp_chan *smp; in smp_chan_create() local
1397 smp = kzalloc(sizeof(*smp), GFP_ATOMIC); in smp_chan_create()
1398 if (!smp) in smp_chan_create()
1401 smp->tfm_cmac = crypto_alloc_shash("cmac(aes)", 0, 0); in smp_chan_create()
1402 if (IS_ERR(smp->tfm_cmac)) { in smp_chan_create()
1407 smp->tfm_ecdh = crypto_alloc_kpp("ecdh-nist-p256", 0, 0); in smp_chan_create()
1408 if (IS_ERR(smp->tfm_ecdh)) { in smp_chan_create()
1413 smp->conn = conn; in smp_chan_create()
1414 chan->data = smp; in smp_chan_create()
1416 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_FAIL); in smp_chan_create()
1418 INIT_DELAYED_WORK(&smp->security_timer, smp_timeout); in smp_chan_create()
1422 return smp; in smp_chan_create()
1425 crypto_free_shash(smp->tfm_cmac); in smp_chan_create()
1427 kfree_sensitive(smp); in smp_chan_create()
1431 static int sc_mackey_and_ltk(struct smp_chan *smp, u8 mackey[16], u8 ltk[16]) in sc_mackey_and_ltk() argument
1433 struct hci_conn *hcon = smp->conn->hcon; in sc_mackey_and_ltk()
1437 na = smp->prnd; in sc_mackey_and_ltk()
1438 nb = smp->rrnd; in sc_mackey_and_ltk()
1440 na = smp->rrnd; in sc_mackey_and_ltk()
1441 nb = smp->prnd; in sc_mackey_and_ltk()
1449 return smp_f5(smp->tfm_cmac, smp->dhkey, na, nb, a, b, mackey, ltk); in sc_mackey_and_ltk()
1452 static void sc_dhkey_check(struct smp_chan *smp) in sc_dhkey_check() argument
1454 struct hci_conn *hcon = smp->conn->hcon; in sc_dhkey_check()
1467 memcpy(io_cap, &smp->preq[1], 3); in sc_dhkey_check()
1471 memcpy(io_cap, &smp->prsp[1], 3); in sc_dhkey_check()
1476 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in sc_dhkey_check()
1479 if (smp->method == REQ_OOB) in sc_dhkey_check()
1480 memcpy(r, smp->rr, 16); in sc_dhkey_check()
1482 smp_f6(smp->tfm_cmac, smp->mackey, smp->prnd, smp->rrnd, r, io_cap, in sc_dhkey_check()
1485 smp_send_cmd(smp->conn, SMP_CMD_DHKEY_CHECK, sizeof(check), &check); in sc_dhkey_check()
1488 static u8 sc_passkey_send_confirm(struct smp_chan *smp) in sc_passkey_send_confirm() argument
1490 struct l2cap_conn *conn = smp->conn; in sc_passkey_send_confirm()
1495 r = ((hcon->passkey_notify >> smp->passkey_round) & 0x01); in sc_passkey_send_confirm()
1498 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in sc_passkey_send_confirm()
1500 if (smp_f4(smp->tfm_cmac, smp->local_pk, smp->remote_pk, smp->prnd, r, in sc_passkey_send_confirm()
1509 static u8 sc_passkey_round(struct smp_chan *smp, u8 smp_op) in sc_passkey_round() argument
1511 struct l2cap_conn *conn = smp->conn; in sc_passkey_round()
1517 if (smp->passkey_round >= 20) in sc_passkey_round()
1522 r = ((hcon->passkey_notify >> smp->passkey_round) & 0x01); in sc_passkey_round()
1525 if (smp_f4(smp->tfm_cmac, smp->remote_pk, smp->local_pk, in sc_passkey_round()
1526 smp->rrnd, r, cfm)) in sc_passkey_round()
1529 if (crypto_memneq(smp->pcnf, cfm, 16)) in sc_passkey_round()
1532 smp->passkey_round++; in sc_passkey_round()
1534 if (smp->passkey_round == 20) { in sc_passkey_round()
1536 if (sc_mackey_and_ltk(smp, smp->mackey, smp->tk)) in sc_passkey_round()
1545 sizeof(smp->prnd), smp->prnd); in sc_passkey_round()
1546 if (smp->passkey_round == 20) in sc_passkey_round()
1547 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in sc_passkey_round()
1549 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in sc_passkey_round()
1554 if (smp->passkey_round != 20) in sc_passkey_round()
1555 return sc_passkey_round(smp, 0); in sc_passkey_round()
1558 sc_dhkey_check(smp); in sc_passkey_round()
1559 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in sc_passkey_round()
1564 if (test_bit(SMP_FLAG_WAIT_USER, &smp->flags)) { in sc_passkey_round()
1565 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in sc_passkey_round()
1569 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in sc_passkey_round()
1573 sizeof(smp->prnd), smp->prnd); in sc_passkey_round()
1577 return sc_passkey_send_confirm(smp); in sc_passkey_round()
1586 smp->passkey_round + 1); in sc_passkey_round()
1588 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in sc_passkey_round()
1590 return sc_passkey_send_confirm(smp); in sc_passkey_round()
1596 static int sc_user_reply(struct smp_chan *smp, u16 mgmt_op, __le32 passkey) in sc_user_reply() argument
1598 struct l2cap_conn *conn = smp->conn; in sc_user_reply()
1602 clear_bit(SMP_FLAG_WAIT_USER, &smp->flags); in sc_user_reply()
1606 smp_failure(smp->conn, SMP_PASSKEY_ENTRY_FAILED); in sc_user_reply()
1609 smp_failure(smp->conn, SMP_NUMERIC_COMP_FAILED); in sc_user_reply()
1613 smp->passkey_round = 0; in sc_user_reply()
1615 if (test_and_clear_bit(SMP_FLAG_CFM_PENDING, &smp->flags)) in sc_user_reply()
1620 if (sc_passkey_round(smp, smp_op)) in sc_user_reply()
1628 sc_dhkey_check(smp); in sc_user_reply()
1629 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in sc_user_reply()
1630 } else if (test_and_clear_bit(SMP_FLAG_DHKEY_PENDING, &smp->flags)) { in sc_user_reply()
1631 sc_dhkey_check(smp); in sc_user_reply()
1632 sc_add_ltk(smp); in sc_user_reply()
1642 struct smp_chan *smp; in smp_user_confirm_reply() local
1651 chan = conn->smp; in smp_user_confirm_reply()
1661 smp = chan->data; in smp_user_confirm_reply()
1663 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_user_confirm_reply()
1664 err = sc_user_reply(smp, mgmt_op, passkey); in smp_user_confirm_reply()
1671 memset(smp->tk, 0, sizeof(smp->tk)); in smp_user_confirm_reply()
1673 put_unaligned_le32(value, smp->tk); in smp_user_confirm_reply()
1676 set_bit(SMP_FLAG_TK_VALID, &smp->flags); in smp_user_confirm_reply()
1692 if (test_bit(SMP_FLAG_CFM_PENDING, &smp->flags)) { in smp_user_confirm_reply()
1693 u8 rsp = smp_confirm(smp); in smp_user_confirm_reply()
1703 static void build_bredr_pairing_cmd(struct smp_chan *smp, in build_bredr_pairing_cmd() argument
1707 struct l2cap_conn *conn = smp->conn; in build_bredr_pairing_cmd()
1730 smp->remote_key_dist = remote_dist; in build_bredr_pairing_cmd()
1742 smp->remote_key_dist = rsp->init_key_dist; in build_bredr_pairing_cmd()
1748 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_req()
1750 struct smp_chan *smp; in smp_cmd_pairing_req() local
1763 smp = smp_chan_create(conn); in smp_cmd_pairing_req()
1765 smp = chan->data; in smp_cmd_pairing_req()
1767 if (!smp) in smp_cmd_pairing_req()
1780 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_cmd_pairing_req()
1781 memcpy(&smp->preq[1], req, sizeof(*req)); in smp_cmd_pairing_req()
1789 set_bit(SMP_FLAG_LOCAL_OOB, &smp->flags); in smp_cmd_pairing_req()
1791 /* SMP over BR/EDR requires special treatment */ in smp_cmd_pairing_req()
1798 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_req()
1800 build_bredr_pairing_cmd(smp, req, &rsp); in smp_cmd_pairing_req()
1803 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_req()
1810 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_req()
1812 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_req()
1813 memcpy(&smp->prsp[1], &rsp, sizeof(rsp)); in smp_cmd_pairing_req()
1816 smp_distribute_keys(smp); in smp_cmd_pairing_req()
1823 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_req()
1826 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_req()
1841 method = get_auth_method(smp, conn->hcon->io_capability, in smp_cmd_pairing_req()
1851 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in smp_cmd_pairing_req()
1853 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_req()
1854 memcpy(&smp->prsp[1], &rsp, sizeof(rsp)); in smp_cmd_pairing_req()
1858 clear_bit(SMP_FLAG_INITIATOR, &smp->flags); in smp_cmd_pairing_req()
1865 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_CONFIRM); in smp_cmd_pairing_req()
1867 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_req()
1868 SMP_ALLOW_CMD(smp, SMP_CMD_PUBLIC_KEY); in smp_cmd_pairing_req()
1870 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_req()
1883 static u8 sc_send_public_key(struct smp_chan *smp) in sc_send_public_key() argument
1885 struct hci_dev *hdev = smp->conn->hcon->hdev; in sc_send_public_key()
1889 if (test_bit(SMP_FLAG_LOCAL_OOB, &smp->flags)) { in sc_send_public_key()
1898 memcpy(smp->local_pk, smp_dev->local_pk, 64); in sc_send_public_key()
1899 memcpy(smp->lr, smp_dev->local_rand, 16); in sc_send_public_key()
1902 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_send_public_key()
1909 if (set_ecdh_privkey(smp->tfm_ecdh, debug_sk)) in sc_send_public_key()
1911 memcpy(smp->local_pk, debug_pk, 64); in sc_send_public_key()
1912 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_send_public_key()
1916 if (generate_ecdh_keys(smp->tfm_ecdh, smp->local_pk)) in sc_send_public_key()
1922 if (crypto_memneq(smp->local_pk, debug_pk, 64)) in sc_send_public_key()
1928 SMP_DBG("Local Public Key X: %32phN", smp->local_pk); in sc_send_public_key()
1929 SMP_DBG("Local Public Key Y: %32phN", smp->local_pk + 32); in sc_send_public_key()
1931 smp_send_cmd(smp->conn, SMP_CMD_PUBLIC_KEY, 64, smp->local_pk); in sc_send_public_key()
1939 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_rsp()
1940 struct smp_chan *smp = chan->data; in smp_cmd_pairing_rsp() local
1955 req = (void *) &smp->preq[1]; in smp_cmd_pairing_rsp()
1971 set_bit(SMP_FLAG_LOCAL_OOB, &smp->flags); in smp_cmd_pairing_rsp()
1973 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_rsp()
1974 memcpy(&smp->prsp[1], rsp, sizeof(*rsp)); in smp_cmd_pairing_rsp()
1979 smp->remote_key_dist &= rsp->resp_key_dist; in smp_cmd_pairing_rsp()
1982 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_rsp()
1987 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_rsp()
1988 smp_distribute_keys(smp); in smp_cmd_pairing_rsp()
1993 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_rsp()
2001 method = get_auth_method(smp, req->io_capability, in smp_cmd_pairing_rsp()
2007 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in smp_cmd_pairing_rsp()
2012 smp->remote_key_dist &= rsp->resp_key_dist; in smp_cmd_pairing_rsp()
2014 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_rsp()
2016 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_rsp()
2017 SMP_ALLOW_CMD(smp, SMP_CMD_PUBLIC_KEY); in smp_cmd_pairing_rsp()
2018 return sc_send_public_key(smp); in smp_cmd_pairing_rsp()
2027 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_cmd_pairing_rsp()
2030 if (test_bit(SMP_FLAG_TK_VALID, &smp->flags)) in smp_cmd_pairing_rsp()
2031 return smp_confirm(smp); in smp_cmd_pairing_rsp()
2036 static u8 sc_check_confirm(struct smp_chan *smp) in sc_check_confirm() argument
2038 struct l2cap_conn *conn = smp->conn; in sc_check_confirm()
2042 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in sc_check_confirm()
2043 return sc_passkey_round(smp, SMP_CMD_PAIRING_CONFIRM); in sc_check_confirm()
2046 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in sc_check_confirm()
2047 smp->prnd); in sc_check_confirm()
2048 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in sc_check_confirm()
2058 static int fixup_sc_false_positive(struct smp_chan *smp) in fixup_sc_false_positive() argument
2060 struct l2cap_conn *conn = smp->conn; in fixup_sc_false_positive()
2075 bt_dev_err(hdev, "trying to fall back to legacy SMP"); in fixup_sc_false_positive()
2077 req = (void *) &smp->preq[1]; in fixup_sc_false_positive()
2078 rsp = (void *) &smp->prsp[1]; in fixup_sc_false_positive()
2081 smp->remote_key_dist = (req->init_key_dist & rsp->resp_key_dist); in fixup_sc_false_positive()
2086 bt_dev_err(hdev, "failed to fall back to legacy SMP"); in fixup_sc_false_positive()
2090 clear_bit(SMP_FLAG_SC, &smp->flags); in fixup_sc_false_positive()
2097 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_confirm()
2098 struct smp_chan *smp = chan->data; in smp_cmd_pairing_confirm() local
2105 if (skb->len < sizeof(smp->pcnf)) in smp_cmd_pairing_confirm()
2108 memcpy(smp->pcnf, skb->data, sizeof(smp->pcnf)); in smp_cmd_pairing_confirm()
2109 skb_pull(skb, sizeof(smp->pcnf)); in smp_cmd_pairing_confirm()
2111 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_confirm()
2115 if (test_bit(SMP_FLAG_REMOTE_PK, &smp->flags)) in smp_cmd_pairing_confirm()
2116 return sc_check_confirm(smp); in smp_cmd_pairing_confirm()
2118 bt_dev_err(hdev, "Unexpected SMP Pairing Confirm"); in smp_cmd_pairing_confirm()
2120 ret = fixup_sc_false_positive(smp); in smp_cmd_pairing_confirm()
2126 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_cmd_pairing_confirm()
2127 smp->prnd); in smp_cmd_pairing_confirm()
2128 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RANDOM); in smp_cmd_pairing_confirm()
2132 if (test_bit(SMP_FLAG_TK_VALID, &smp->flags)) in smp_cmd_pairing_confirm()
2133 return smp_confirm(smp); in smp_cmd_pairing_confirm()
2135 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_cmd_pairing_confirm()
2142 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_random()
2143 struct smp_chan *smp = chan->data; in smp_cmd_pairing_random() local
2151 if (skb->len < sizeof(smp->rrnd)) in smp_cmd_pairing_random()
2154 memcpy(smp->rrnd, skb->data, sizeof(smp->rrnd)); in smp_cmd_pairing_random()
2155 skb_pull(skb, sizeof(smp->rrnd)); in smp_cmd_pairing_random()
2157 if (!test_bit(SMP_FLAG_SC, &smp->flags)) in smp_cmd_pairing_random()
2158 return smp_random(smp); in smp_cmd_pairing_random()
2161 pkax = smp->local_pk; in smp_cmd_pairing_random()
2162 pkbx = smp->remote_pk; in smp_cmd_pairing_random()
2163 na = smp->prnd; in smp_cmd_pairing_random()
2164 nb = smp->rrnd; in smp_cmd_pairing_random()
2166 pkax = smp->remote_pk; in smp_cmd_pairing_random()
2167 pkbx = smp->local_pk; in smp_cmd_pairing_random()
2168 na = smp->rrnd; in smp_cmd_pairing_random()
2169 nb = smp->prnd; in smp_cmd_pairing_random()
2172 if (smp->method == REQ_OOB) { in smp_cmd_pairing_random()
2175 sizeof(smp->prnd), smp->prnd); in smp_cmd_pairing_random()
2176 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in smp_cmd_pairing_random()
2181 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in smp_cmd_pairing_random()
2182 return sc_passkey_round(smp, SMP_CMD_PAIRING_RANDOM); in smp_cmd_pairing_random()
2187 err = smp_f4(smp->tfm_cmac, smp->remote_pk, smp->local_pk, in smp_cmd_pairing_random()
2188 smp->rrnd, 0, cfm); in smp_cmd_pairing_random()
2192 if (crypto_memneq(smp->pcnf, cfm, 16)) in smp_cmd_pairing_random()
2195 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_cmd_pairing_random()
2196 smp->prnd); in smp_cmd_pairing_random()
2197 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in smp_cmd_pairing_random()
2200 if (smp->method != JUST_WORKS) in smp_cmd_pairing_random()
2220 err = sc_mackey_and_ltk(smp, smp->mackey, smp->tk); in smp_cmd_pairing_random()
2224 if (smp->method == REQ_OOB) { in smp_cmd_pairing_random()
2226 sc_dhkey_check(smp); in smp_cmd_pairing_random()
2227 SMP_ALLOW_CMD(smp, SMP_CMD_DHKEY_CHECK); in smp_cmd_pairing_random()
2232 err = smp_g2(smp->tfm_cmac, pkax, pkbx, na, nb, &passkey); in smp_cmd_pairing_random()
2239 if (smp->method == JUST_WORKS) in smp_cmd_pairing_random()
2247 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in smp_cmd_pairing_random()
2305 struct smp_chan *smp; in smp_cmd_security_req() local
2341 smp = smp_chan_create(conn); in smp_cmd_security_req()
2342 if (!smp) in smp_cmd_security_req()
2354 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_cmd_security_req()
2355 memcpy(&smp->preq[1], &cp, sizeof(cp)); in smp_cmd_security_req()
2358 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RSP); in smp_cmd_security_req()
2367 struct smp_chan *smp; in smp_conn_security() local
2391 chan = conn->smp; in smp_conn_security()
2399 /* If SMP is already in progress ignore this request */ in smp_conn_security()
2405 smp = smp_chan_create(conn); in smp_conn_security()
2406 if (!smp) { in smp_conn_security()
2435 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_conn_security()
2436 memcpy(&smp->preq[1], &cp, sizeof(cp)); in smp_conn_security()
2439 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RSP); in smp_conn_security()
2444 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_REQ); in smp_conn_security()
2447 set_bit(SMP_FLAG_INITIATOR, &smp->flags); in smp_conn_security()
2461 struct smp_chan *smp; in smp_cancel_and_remove_pairing() local
2475 chan = conn->smp; in smp_cancel_and_remove_pairing()
2481 smp = chan->data; in smp_cancel_and_remove_pairing()
2482 if (smp) { in smp_cancel_and_remove_pairing()
2485 smp->ltk = NULL; in smp_cancel_and_remove_pairing()
2486 smp->responder_ltk = NULL; in smp_cancel_and_remove_pairing()
2487 smp->remote_irk = NULL; in smp_cancel_and_remove_pairing()
2489 if (test_bit(SMP_FLAG_COMPLETE, &smp->flags)) in smp_cancel_and_remove_pairing()
2505 struct l2cap_chan *chan = conn->smp; in smp_cmd_encrypt_info()
2506 struct smp_chan *smp = chan->data; in smp_cmd_encrypt_info() local
2522 SMP_ALLOW_CMD(smp, SMP_CMD_INITIATOR_IDENT); in smp_cmd_encrypt_info()
2526 memcpy(smp->tk, rp->ltk, sizeof(smp->tk)); in smp_cmd_encrypt_info()
2534 struct l2cap_chan *chan = conn->smp; in smp_cmd_initiator_ident()
2535 struct smp_chan *smp = chan->data; in smp_cmd_initiator_ident() local
2547 smp->remote_key_dist &= ~SMP_DIST_ENC_KEY; in smp_cmd_initiator_ident()
2549 if (smp->remote_key_dist & SMP_DIST_ID_KEY) in smp_cmd_initiator_ident()
2550 SMP_ALLOW_CMD(smp, SMP_CMD_IDENT_INFO); in smp_cmd_initiator_ident()
2551 else if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_cmd_initiator_ident()
2552 SMP_ALLOW_CMD(smp, SMP_CMD_SIGN_INFO); in smp_cmd_initiator_ident()
2558 authenticated, smp->tk, smp->enc_key_size, in smp_cmd_initiator_ident()
2560 smp->ltk = ltk; in smp_cmd_initiator_ident()
2561 if (!(smp->remote_key_dist & KEY_DIST_MASK)) in smp_cmd_initiator_ident()
2562 smp_distribute_keys(smp); in smp_cmd_initiator_ident()
2570 struct l2cap_chan *chan = conn->smp; in smp_cmd_ident_info()
2571 struct smp_chan *smp = chan->data; in smp_cmd_ident_info() local
2587 SMP_ALLOW_CMD(smp, SMP_CMD_IDENT_ADDR_INFO); in smp_cmd_ident_info()
2591 memcpy(smp->irk, info->irk, 16); in smp_cmd_ident_info()
2600 struct l2cap_chan *chan = conn->smp; in smp_cmd_ident_addr_info()
2601 struct smp_chan *smp = chan->data; in smp_cmd_ident_addr_info() local
2611 smp->remote_key_dist &= ~SMP_DIST_ID_KEY; in smp_cmd_ident_addr_info()
2613 if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_cmd_ident_addr_info()
2614 SMP_ALLOW_CMD(smp, SMP_CMD_SIGN_INFO); in smp_cmd_ident_addr_info()
2647 bacpy(&smp->id_addr, &info->bdaddr); in smp_cmd_ident_addr_info()
2648 smp->id_addr_type = info->addr_type; in smp_cmd_ident_addr_info()
2655 smp->remote_irk = hci_add_irk(conn->hcon->hdev, &smp->id_addr, in smp_cmd_ident_addr_info()
2656 smp->id_addr_type, smp->irk, &rpa); in smp_cmd_ident_addr_info()
2659 if (!(smp->remote_key_dist & KEY_DIST_MASK)) in smp_cmd_ident_addr_info()
2660 smp_distribute_keys(smp); in smp_cmd_ident_addr_info()
2668 struct l2cap_chan *chan = conn->smp; in smp_cmd_sign_info()
2669 struct smp_chan *smp = chan->data; in smp_cmd_sign_info() local
2678 smp->remote_key_dist &= ~SMP_DIST_SIGN; in smp_cmd_sign_info()
2690 smp->csrk = csrk; in smp_cmd_sign_info()
2691 smp_distribute_keys(smp); in smp_cmd_sign_info()
2696 static u8 sc_select_method(struct smp_chan *smp) in sc_select_method() argument
2698 struct l2cap_conn *conn = smp->conn; in sc_select_method()
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()
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()
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()
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()
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()
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
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()
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()
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()
3088 struct smp_chan *smp; in bredr_pairing() local
3100 /* Only initiator may initiate SMP over BR/EDR */ in bredr_pairing()
3108 /* BR/EDR must use Secure Connections for SMP */ in bredr_pairing()
3121 /* Remote must support SMP fixed chan for BR/EDR */ in bredr_pairing()
3125 /* Don't bother if SMP is already ongoing */ in bredr_pairing()
3129 smp = smp_chan_create(conn); in bredr_pairing()
3130 if (!smp) { in bredr_pairing()
3131 bt_dev_err(hdev, "unable to create SMP context for BR/EDR"); in bredr_pairing()
3135 set_bit(SMP_FLAG_SC, &smp->flags); in bredr_pairing()
3137 bt_dev_dbg(hdev, "starting SMP over BR/EDR"); in bredr_pairing()
3139 /* Prepare and send the BR/EDR SMP Pairing Request */ in bredr_pairing()
3140 build_bredr_pairing_cmd(smp, &req, NULL); in bredr_pairing()
3142 smp->preq[0] = SMP_CMD_PAIRING_REQ; in bredr_pairing()
3143 memcpy(&smp->preq[1], &req, sizeof(req)); in bredr_pairing()
3146 SMP_ALLOW_CMD(smp, SMP_CMD_PAIRING_RSP); in bredr_pairing()
3151 struct smp_chan *smp = chan->data; in smp_resume_cb() local
3162 if (!smp) in smp_resume_cb()
3168 cancel_delayed_work(&smp->security_timer); in smp_resume_cb()
3170 smp_distribute_keys(smp); in smp_resume_cb()
3186 conn->smp = chan; in smp_ready_cb()
3200 struct smp_chan *smp = chan->data; in smp_recv_cb() local
3202 if (smp) in smp_recv_cb()
3203 cancel_delayed_work_sync(&smp->security_timer); in smp_recv_cb()
3262 /* Other L2CAP channels may request SMP routines in order to in smp_new_conn_cb()
3263 * change the security level. This means that the SMP channel in smp_new_conn_cb()
3295 struct smp_dev *smp; in smp_add_cid() local
3300 smp = NULL; in smp_add_cid()
3304 smp = kzalloc(sizeof(*smp), GFP_KERNEL); in smp_add_cid()
3305 if (!smp) in smp_add_cid()
3311 kfree_sensitive(smp); in smp_add_cid()
3319 kfree_sensitive(smp); in smp_add_cid()
3323 smp->local_oob = false; in smp_add_cid()
3324 smp->tfm_cmac = tfm_cmac; in smp_add_cid()
3325 smp->tfm_ecdh = tfm_ecdh; in smp_add_cid()
3330 if (smp) { in smp_add_cid()
3331 crypto_free_shash(smp->tfm_cmac); in smp_add_cid()
3332 crypto_free_kpp(smp->tfm_ecdh); in smp_add_cid()
3333 kfree_sensitive(smp); in smp_add_cid()
3338 chan->data = smp; in smp_add_cid()
3371 struct smp_dev *smp; in smp_del_chan() local
3375 smp = chan->data; in smp_del_chan()
3376 if (smp) { in smp_del_chan()
3378 crypto_free_shash(smp->tfm_cmac); in smp_del_chan()
3379 crypto_free_kpp(smp->tfm_ecdh); in smp_del_chan()
3380 kfree_sensitive(smp); in smp_del_chan()
3419 * there is also no need to register any SMP channel. in smp_register()
3813 BT_INFO("SMP test passed in %llu usecs", duration); in run_selftests()