Lines Matching +full:y +full:- +full:rp
2 BlueZ - Bluetooth protocol stack for Linux
3 Copyright (C) 2011 Nokia Corporation and/or its subsidiary(-ies).
39 ((struct smp_dev *)((struct l2cap_chan *)((hdev)->smp_data))->data)
41 /* Low-level debug macros to be used for stuff that we don't want
53 #define SMP_ALLOW_CMD(smp, code) set_bit(code, &smp->allow_cmd)
162 dst[len - 1 - i] = src[i]; in swap_buf()
166 * AES-CMAC, f4, f5, f6, g2 and h6.
176 return -EFBIG; in aes_cmac()
180 return -EINVAL; in aes_cmac()
314 const u8 x[16], const u8 y[16], u32 *val) in smp_g2()
321 SMP_DBG("x %16phN y %16phN", x, y); in smp_g2()
323 memcpy(m, y, 16); in smp_g2()
500 struct l2cap_chan *chan = hdev->smp_data; in smp_irk_matches()
504 if (!chan || !chan->data) in smp_irk_matches()
509 err = smp_ah(irk, &bdaddr->b[3], hash); in smp_irk_matches()
513 return !crypto_memneq(bdaddr->b, hash, 3); in smp_irk_matches()
518 struct l2cap_chan *chan = hdev->smp_data; in smp_generate_rpa()
521 if (!chan || !chan->data) in smp_generate_rpa()
522 return -EOPNOTSUPP; in smp_generate_rpa()
524 get_random_bytes(&rpa->b[3], 3); in smp_generate_rpa()
526 rpa->b[5] &= 0x3f; /* Clear two most significant bits */ in smp_generate_rpa()
527 rpa->b[5] |= 0x40; /* Set second most significant bit */ in smp_generate_rpa()
529 err = smp_ah(irk, &rpa->b[3], rpa->b); in smp_generate_rpa()
540 struct l2cap_chan *chan = hdev->smp_data; in smp_generate_oob()
544 if (!chan || !chan->data) in smp_generate_oob()
545 return -EOPNOTSUPP; in smp_generate_oob()
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()
599 bt_dev_dbg(conn->hcon->hdev, "code 0x%2.2x", code); in smp_send_cmd()
613 if (!chan->data) in smp_send_cmd()
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()
653 struct hci_conn *hcon = conn->hcon; in build_pairing_cmd()
654 struct hci_dev *hdev = hcon->hdev; in build_pairing_cmd()
681 if (hcon->dst_type == ADDR_LE_DEV_PUBLIC) in build_pairing_cmd()
686 oob_data = hci_find_remote_oob_data(hdev, &hcon->dst, in build_pairing_cmd()
688 if (oob_data && oob_data->present) { in build_pairing_cmd()
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()
702 req->io_capability = conn->hcon->io_capability; in build_pairing_cmd()
703 req->oob_flag = oob_flag; in build_pairing_cmd()
704 req->max_key_size = hdev->le_max_key_size; in build_pairing_cmd()
705 req->init_key_dist = local_dist; in build_pairing_cmd()
706 req->resp_key_dist = remote_dist; in build_pairing_cmd()
707 req->auth_req = (authreq & AUTH_REQ_MASK(hdev)); in build_pairing_cmd()
709 smp->remote_key_dist = remote_dist; in build_pairing_cmd()
713 rsp->io_capability = conn->hcon->io_capability; in build_pairing_cmd()
714 rsp->oob_flag = oob_flag; in build_pairing_cmd()
715 rsp->max_key_size = hdev->le_max_key_size; in build_pairing_cmd()
716 rsp->init_key_dist = req->init_key_dist & remote_dist; in build_pairing_cmd()
717 rsp->resp_key_dist = req->resp_key_dist & local_dist; in build_pairing_cmd()
718 rsp->auth_req = (authreq & AUTH_REQ_MASK(hdev)); 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()
726 struct hci_dev *hdev = conn->hcon->hdev; in check_enc_key_size()
727 struct smp_chan *smp = chan->data; in check_enc_key_size()
729 if (conn->hcon->pending_sec_level == BT_SECURITY_FIPS && in check_enc_key_size()
733 if (max_key_size > hdev->le_max_key_size || in check_enc_key_size()
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()
746 struct hci_conn *hcon = conn->hcon; 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()
767 !hci_dev_test_flag(hcon->hdev, HCI_KEEP_DEBUG_KEYS)) { 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()
791 chan->data = NULL; in smp_chan_destroy()
798 struct hci_conn *hcon = conn->hcon; in smp_failure()
799 struct l2cap_chan *chan = conn->smp; in smp_failure()
807 if (chan->data) in smp_failure()
844 if (test_bit(SMP_FLAG_SC, &smp->flags)) in get_auth_method()
853 struct hci_conn *hcon = conn->hcon; in tk_request()
854 struct l2cap_chan *chan = conn->smp; in tk_request()
855 struct smp_chan *smp = chan->data; in tk_request()
860 memset(smp->tk, 0, sizeof(smp->tk)); in tk_request()
861 clear_bit(SMP_FLAG_TK_VALID, &smp->flags); in tk_request()
863 bt_dev_dbg(hcon->hdev, "auth:%u lcl:%u rem:%u", auth, local_io, in tk_request()
867 * request or use just-works for outgoing ones. The JUST_CFM 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()
884 hcon->io_capability == HCI_IO_NO_INPUT_OUTPUT) in tk_request()
885 smp->method = JUST_WORKS; in tk_request()
887 /* If Just Works, Continue with Zero TK and ask user-space for in tk_request()
889 if (smp->method == JUST_WORKS) { in tk_request()
890 ret = mgmt_user_confirm_request(hcon->hdev, &hcon->dst, in tk_request()
891 hcon->type, in tk_request()
892 hcon->dst_type, in tk_request()
896 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in tk_request()
900 /* If this function is used for SC -> legacy fallback we in tk_request()
901 * can only recover the just-works case. in tk_request()
903 if (test_bit(SMP_FLAG_SC, &smp->flags)) in tk_request()
904 return -EINVAL; in tk_request()
907 if (smp->method != JUST_CFM) { in tk_request()
908 set_bit(SMP_FLAG_MITM_AUTH, &smp->flags); in tk_request()
909 if (hcon->pending_sec_level < BT_SECURITY_HIGH) in tk_request()
910 hcon->pending_sec_level = BT_SECURITY_HIGH; in tk_request()
913 /* If both devices have Keyboard-Display I/O, the initiator in tk_request()
916 if (smp->method == OVERLAP) { in tk_request()
917 if (hcon->role == HCI_ROLE_MASTER) 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()
929 bt_dev_dbg(hcon->hdev, "PassKey: %u", passkey); in tk_request()
930 set_bit(SMP_FLAG_TK_VALID, &smp->flags); in tk_request()
933 if (smp->method == REQ_PASSKEY) in tk_request()
934 ret = mgmt_user_passkey_request(hcon->hdev, &hcon->dst, in tk_request()
935 hcon->type, hcon->dst_type); in tk_request()
936 else if (smp->method == JUST_CFM) in tk_request()
937 ret = mgmt_user_confirm_request(hcon->hdev, &hcon->dst, in tk_request()
938 hcon->type, hcon->dst_type, in tk_request()
941 ret = mgmt_user_passkey_notify(hcon->hdev, &hcon->dst, in tk_request()
942 hcon->type, hcon->dst_type, in tk_request()
950 struct l2cap_conn *conn = smp->conn; in smp_confirm()
954 bt_dev_dbg(conn->hcon->hdev, "conn %p", conn); in smp_confirm()
956 ret = smp_c1(smp->tk, smp->prnd, smp->preq, smp->prsp, in smp_confirm()
957 conn->hcon->init_addr_type, &conn->hcon->init_addr, in smp_confirm()
958 conn->hcon->resp_addr_type, &conn->hcon->resp_addr, 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 (conn->hcon->out) in smp_confirm()
977 struct l2cap_conn *conn = smp->conn; in smp_random()
978 struct hci_conn *hcon = conn->hcon; in smp_random()
982 bt_dev_dbg(conn->hcon->hdev, "conn %p %s", conn, in smp_random()
983 conn->hcon->out ? "initiator" : "responder"); in smp_random()
985 ret = smp_c1(smp->tk, smp->rrnd, smp->preq, smp->prsp, in smp_random()
986 hcon->init_addr_type, &hcon->init_addr, in smp_random()
987 hcon->resp_addr_type, &hcon->resp_addr, confirm); in smp_random()
991 if (crypto_memneq(smp->pcnf, confirm, sizeof(smp->pcnf))) { in smp_random()
992 bt_dev_err(hcon->hdev, "pairing failed " in smp_random()
997 if (hcon->out) { in smp_random()
1002 smp_s1(smp->tk, smp->rrnd, smp->prnd, stk); in smp_random()
1004 if (test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &hcon->flags)) in smp_random()
1007 hci_le_start_enc(hcon, ediv, rand, stk, smp->enc_key_size); in smp_random()
1008 hcon->enc_key_size = smp->enc_key_size; in smp_random()
1009 set_bit(HCI_CONN_STK_ENCRYPT, &hcon->flags); in smp_random()
1015 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_random()
1016 smp->prnd); in smp_random()
1018 smp_s1(smp->tk, smp->prnd, smp->rrnd, stk); in smp_random()
1020 if (hcon->pending_sec_level == BT_SECURITY_HIGH) in smp_random()
1029 hci_add_ltk(hcon->hdev, &hcon->dst, hcon->dst_type, in smp_random()
1030 SMP_STK, auth, stk, smp->enc_key_size, ediv, rand); in smp_random()
1038 struct l2cap_chan *chan = conn->smp; in smp_notify_keys()
1039 struct smp_chan *smp = chan->data; in smp_notify_keys()
1040 struct hci_conn *hcon = conn->hcon; in smp_notify_keys()
1041 struct hci_dev *hdev = hcon->hdev; in smp_notify_keys()
1042 struct smp_cmd_pairing *req = (void *) &smp->preq[1]; in smp_notify_keys()
1043 struct smp_cmd_pairing *rsp = (void *) &smp->prsp[1]; in smp_notify_keys()
1046 if (hcon->type == ACL_LINK) { in smp_notify_keys()
1047 if (hcon->key_type == HCI_LK_DEBUG_COMBINATION) in smp_notify_keys()
1051 &hcon->flags); in smp_notify_keys()
1057 persistent = !!((req->auth_req & rsp->auth_req) & in smp_notify_keys()
1061 if (smp->remote_irk) { in smp_notify_keys()
1062 smp->remote_irk->link_type = hcon->type; in smp_notify_keys()
1063 mgmt_new_irk(hdev, smp->remote_irk, persistent); in smp_notify_keys()
1069 if (hcon->type == LE_LINK) { 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()
1075 queue_delayed_work(hdev->workqueue, in smp_notify_keys()
1076 &conn->id_addr_timer, in smp_notify_keys()
1081 if (smp->csrk) { in smp_notify_keys()
1082 smp->csrk->link_type = hcon->type; in smp_notify_keys()
1083 smp->csrk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1084 bacpy(&smp->csrk->bdaddr, &hcon->dst); in smp_notify_keys()
1085 mgmt_new_csrk(hdev, smp->csrk, persistent); in smp_notify_keys()
1088 if (smp->responder_csrk) { in smp_notify_keys()
1089 smp->responder_csrk->link_type = hcon->type; in smp_notify_keys()
1090 smp->responder_csrk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1091 bacpy(&smp->responder_csrk->bdaddr, &hcon->dst); in smp_notify_keys()
1092 mgmt_new_csrk(hdev, smp->responder_csrk, persistent); in smp_notify_keys()
1095 if (smp->ltk) { in smp_notify_keys()
1096 smp->ltk->link_type = hcon->type; in smp_notify_keys()
1097 smp->ltk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1098 bacpy(&smp->ltk->bdaddr, &hcon->dst); in smp_notify_keys()
1099 mgmt_new_ltk(hdev, smp->ltk, persistent); in smp_notify_keys()
1102 if (smp->responder_ltk) { in smp_notify_keys()
1103 smp->responder_ltk->link_type = hcon->type; in smp_notify_keys()
1104 smp->responder_ltk->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1105 bacpy(&smp->responder_ltk->bdaddr, &hcon->dst); in smp_notify_keys()
1106 mgmt_new_ltk(hdev, smp->responder_ltk, persistent); in smp_notify_keys()
1109 if (smp->link_key) { in smp_notify_keys()
1113 if (test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags)) in smp_notify_keys()
1115 else if (hcon->sec_level == BT_SECURITY_FIPS) in smp_notify_keys()
1120 key = hci_add_link_key(hdev, smp->conn->hcon, &hcon->dst, in smp_notify_keys()
1121 smp->link_key, type, 0, &persistent); in smp_notify_keys()
1123 key->link_type = hcon->type; in smp_notify_keys()
1124 key->bdaddr_type = hcon->dst_type; in smp_notify_keys()
1131 key->type == HCI_LK_DEBUG_COMBINATION) { in smp_notify_keys()
1132 list_del_rcu(&key->list); in smp_notify_keys()
1141 struct hci_conn *hcon = smp->conn->hcon; in sc_add_ltk()
1144 if (test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags)) in sc_add_ltk()
1149 if (hcon->pending_sec_level == BT_SECURITY_FIPS) in sc_add_ltk()
1154 smp->ltk = hci_add_ltk(hcon->hdev, &hcon->dst, hcon->dst_type, in sc_add_ltk()
1155 key_type, auth, smp->tk, smp->enc_key_size, in sc_add_ltk()
1164 smp->link_key = kzalloc(16, GFP_KERNEL); in sc_generate_link_key()
1165 if (!smp->link_key) in sc_generate_link_key()
1168 if (test_bit(SMP_FLAG_CT2, &smp->flags)) { in sc_generate_link_key()
1172 if (smp_h7(smp->tfm_cmac, smp->tk, salt, smp->link_key)) { in sc_generate_link_key()
1173 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1174 smp->link_key = NULL; in sc_generate_link_key()
1181 if (smp_h6(smp->tfm_cmac, smp->tk, tmp1, smp->link_key)) { in sc_generate_link_key()
1182 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1183 smp->link_key = NULL; in sc_generate_link_key()
1188 if (smp_h6(smp->tfm_cmac, smp->link_key, lebr, smp->link_key)) { in sc_generate_link_key()
1189 kfree_sensitive(smp->link_key); in sc_generate_link_key()
1190 smp->link_key = NULL; in sc_generate_link_key()
1201 if (smp->remote_key_dist & SMP_DIST_ENC_KEY) in smp_allow_key_dist()
1203 else if (smp->remote_key_dist & SMP_DIST_ID_KEY) in smp_allow_key_dist()
1205 else if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_allow_key_dist()
1213 struct hci_conn *hcon = smp->conn->hcon; in sc_generate_ltk()
1214 struct hci_dev *hdev = hcon->hdev; in sc_generate_ltk()
1217 key = hci_find_link_key(hdev, &hcon->dst); in sc_generate_ltk()
1223 if (key->type == HCI_LK_DEBUG_COMBINATION) in sc_generate_ltk()
1224 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_generate_ltk()
1226 if (test_bit(SMP_FLAG_CT2, &smp->flags)) { in sc_generate_ltk()
1230 if (smp_h7(smp->tfm_cmac, key->val, salt, smp->tk)) in sc_generate_ltk()
1236 if (smp_h6(smp->tfm_cmac, key->val, tmp2, smp->tk)) in sc_generate_ltk()
1240 if (smp_h6(smp->tfm_cmac, smp->tk, brle, smp->tk)) in sc_generate_ltk()
1249 struct l2cap_conn *conn = smp->conn; in smp_distribute_keys()
1250 struct hci_conn *hcon = conn->hcon; in smp_distribute_keys()
1251 struct hci_dev *hdev = hcon->hdev; in smp_distribute_keys()
1256 rsp = (void *) &smp->prsp[1]; in smp_distribute_keys()
1259 if (hcon->out && (smp->remote_key_dist & KEY_DIST_MASK)) { in smp_distribute_keys()
1264 req = (void *) &smp->preq[1]; in smp_distribute_keys()
1266 if (hcon->out) { in smp_distribute_keys()
1267 keydist = &rsp->init_key_dist; in smp_distribute_keys()
1268 *keydist &= req->init_key_dist; in smp_distribute_keys()
1270 keydist = &rsp->resp_key_dist; in smp_distribute_keys()
1271 *keydist &= req->resp_key_dist; in smp_distribute_keys()
1274 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_distribute_keys()
1275 if (hcon->type == LE_LINK && (*keydist & SMP_DIST_LINK_KEY)) in smp_distribute_keys()
1277 if (hcon->type == ACL_LINK && (*keydist & SMP_DIST_ENC_KEY)) in smp_distribute_keys()
1298 get_random_bytes(enc.ltk, smp->enc_key_size); in smp_distribute_keys()
1299 memset(enc.ltk + smp->enc_key_size, 0, in smp_distribute_keys()
1300 sizeof(enc.ltk) - smp->enc_key_size); in smp_distribute_keys()
1307 authenticated = hcon->sec_level == BT_SECURITY_HIGH; in smp_distribute_keys()
1308 ltk = hci_add_ltk(hdev, &hcon->dst, hcon->dst_type, in smp_distribute_keys()
1310 smp->enc_key_size, ediv, rand); in smp_distribute_keys()
1311 smp->responder_ltk = ltk; in smp_distribute_keys()
1326 memcpy(idinfo.irk, hdev->irk, sizeof(idinfo.irk)); in smp_distribute_keys()
1336 bacpy(&addrinfo.bdaddr, &hcon->src); in smp_distribute_keys()
1337 addrinfo.addr_type = hcon->src_type; in smp_distribute_keys()
1354 if (hcon->sec_level > BT_SECURITY_MEDIUM) in smp_distribute_keys()
1355 csrk->type = MGMT_CSRK_LOCAL_AUTHENTICATED; in smp_distribute_keys()
1357 csrk->type = MGMT_CSRK_LOCAL_UNAUTHENTICATED; in smp_distribute_keys()
1358 memcpy(csrk->val, sign.csrk, sizeof(csrk->val)); in smp_distribute_keys()
1360 smp->responder_csrk = csrk; in smp_distribute_keys()
1368 if (smp->remote_key_dist & KEY_DIST_MASK) { in smp_distribute_keys()
1373 set_bit(SMP_FLAG_COMPLETE, &smp->flags); in smp_distribute_keys()
1383 struct l2cap_conn *conn = smp->conn; in smp_timeout()
1385 bt_dev_dbg(conn->hcon->hdev, "conn %p", conn); in smp_timeout()
1387 hci_disconnect(conn->hcon, HCI_ERROR_REMOTE_USER_TERM); in smp_timeout()
1392 struct hci_conn *hcon = conn->hcon; in smp_chan_create()
1393 struct l2cap_chan *chan = conn->smp; in smp_chan_create()
1400 smp->tfm_cmac = crypto_alloc_shash("cmac(aes)", 0, 0); in smp_chan_create()
1401 if (IS_ERR(smp->tfm_cmac)) { in smp_chan_create()
1402 bt_dev_err(hcon->hdev, "Unable to create CMAC crypto context"); in smp_chan_create()
1406 smp->tfm_ecdh = crypto_alloc_kpp("ecdh-nist-p256", 0, 0); in smp_chan_create()
1407 if (IS_ERR(smp->tfm_ecdh)) { in smp_chan_create()
1408 bt_dev_err(hcon->hdev, "Unable to create ECDH crypto context"); in smp_chan_create()
1412 smp->conn = conn; in smp_chan_create()
1413 chan->data = smp; in smp_chan_create()
1417 INIT_DELAYED_WORK(&smp->security_timer, smp_timeout); in smp_chan_create()
1424 crypto_free_shash(smp->tfm_cmac); in smp_chan_create()
1432 struct hci_conn *hcon = smp->conn->hcon; in sc_mackey_and_ltk()
1435 if (hcon->out) { in sc_mackey_and_ltk()
1436 na = smp->prnd; in sc_mackey_and_ltk()
1437 nb = smp->rrnd; in sc_mackey_and_ltk()
1439 na = smp->rrnd; in sc_mackey_and_ltk()
1440 nb = smp->prnd; in sc_mackey_and_ltk()
1443 memcpy(a, &hcon->init_addr, 6); in sc_mackey_and_ltk()
1444 memcpy(b, &hcon->resp_addr, 6); in sc_mackey_and_ltk()
1445 a[6] = hcon->init_addr_type; in sc_mackey_and_ltk()
1446 b[6] = hcon->resp_addr_type; in sc_mackey_and_ltk()
1448 return smp_f5(smp->tfm_cmac, smp->dhkey, na, nb, a, b, mackey, ltk); in sc_mackey_and_ltk()
1453 struct hci_conn *hcon = smp->conn->hcon; in sc_dhkey_check()
1458 memcpy(a, &hcon->init_addr, 6); in sc_dhkey_check()
1459 memcpy(b, &hcon->resp_addr, 6); in sc_dhkey_check()
1460 a[6] = hcon->init_addr_type; in sc_dhkey_check()
1461 b[6] = hcon->resp_addr_type; in sc_dhkey_check()
1463 if (hcon->out) { in sc_dhkey_check()
1466 memcpy(io_cap, &smp->preq[1], 3); in sc_dhkey_check()
1470 memcpy(io_cap, &smp->prsp[1], 3); in sc_dhkey_check()
1475 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in sc_dhkey_check()
1476 put_unaligned_le32(hcon->passkey_notify, r); in sc_dhkey_check()
1478 if (smp->method == REQ_OOB) in sc_dhkey_check()
1479 memcpy(r, smp->rr, 16); in sc_dhkey_check()
1481 smp_f6(smp->tfm_cmac, smp->mackey, smp->prnd, smp->rrnd, r, io_cap, in sc_dhkey_check()
1484 smp_send_cmd(smp->conn, SMP_CMD_DHKEY_CHECK, sizeof(check), &check); in sc_dhkey_check()
1489 struct l2cap_conn *conn = smp->conn; in sc_passkey_send_confirm()
1490 struct hci_conn *hcon = conn->hcon; in sc_passkey_send_confirm()
1494 r = ((hcon->passkey_notify >> smp->passkey_round) & 0x01); in sc_passkey_send_confirm()
1497 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in sc_passkey_send_confirm()
1499 if (smp_f4(smp->tfm_cmac, smp->local_pk, smp->remote_pk, smp->prnd, r, in sc_passkey_send_confirm()
1510 struct l2cap_conn *conn = smp->conn; in sc_passkey_round()
1511 struct hci_conn *hcon = conn->hcon; in sc_passkey_round()
1512 struct hci_dev *hdev = hcon->hdev; in sc_passkey_round()
1515 /* Ignore the PDU if we've already done 20 rounds (0 - 19) */ in sc_passkey_round()
1516 if (smp->passkey_round >= 20) in sc_passkey_round()
1521 r = ((hcon->passkey_notify >> smp->passkey_round) & 0x01); in sc_passkey_round()
1524 if (smp_f4(smp->tfm_cmac, smp->remote_pk, smp->local_pk, in sc_passkey_round()
1525 smp->rrnd, r, cfm)) in sc_passkey_round()
1528 if (crypto_memneq(smp->pcnf, cfm, 16)) in sc_passkey_round()
1531 smp->passkey_round++; in sc_passkey_round()
1533 if (smp->passkey_round == 20) { in sc_passkey_round()
1535 if (sc_mackey_and_ltk(smp, smp->mackey, smp->tk)) in sc_passkey_round()
1542 if (!hcon->out) { in sc_passkey_round()
1544 sizeof(smp->prnd), smp->prnd); in sc_passkey_round()
1545 if (smp->passkey_round == 20) in sc_passkey_round()
1553 if (smp->passkey_round != 20) in sc_passkey_round()
1556 /* Passkey rounds are complete - start DHKey Check */ in sc_passkey_round()
1563 if (test_bit(SMP_FLAG_WAIT_USER, &smp->flags)) { in sc_passkey_round()
1564 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in sc_passkey_round()
1570 if (hcon->out) { in sc_passkey_round()
1572 sizeof(smp->prnd), smp->prnd); in sc_passkey_round()
1581 if (!hcon->out) in sc_passkey_round()
1585 smp->passkey_round + 1); in sc_passkey_round()
1597 struct l2cap_conn *conn = smp->conn; in sc_user_reply()
1598 struct hci_conn *hcon = conn->hcon; in sc_user_reply()
1601 clear_bit(SMP_FLAG_WAIT_USER, &smp->flags); in sc_user_reply()
1605 smp_failure(smp->conn, SMP_PASSKEY_ENTRY_FAILED); in sc_user_reply()
1608 smp_failure(smp->conn, SMP_NUMERIC_COMP_FAILED); in sc_user_reply()
1611 hcon->passkey_notify = le32_to_cpu(passkey); in sc_user_reply()
1612 smp->passkey_round = 0; in sc_user_reply()
1614 if (test_and_clear_bit(SMP_FLAG_CFM_PENDING, &smp->flags)) in sc_user_reply()
1620 return -EIO; in sc_user_reply()
1626 if (hcon->out) { in sc_user_reply()
1629 } else if (test_and_clear_bit(SMP_FLAG_DHKEY_PENDING, &smp->flags)) { in sc_user_reply()
1639 struct l2cap_conn *conn = hcon->l2cap_data; in smp_user_confirm_reply()
1646 return -ENOTCONN; in smp_user_confirm_reply()
1648 bt_dev_dbg(conn->hcon->hdev, ""); in smp_user_confirm_reply()
1650 chan = conn->smp; in smp_user_confirm_reply()
1652 return -ENOTCONN; in smp_user_confirm_reply()
1655 if (!chan->data) { in smp_user_confirm_reply()
1656 err = -ENOTCONN; in smp_user_confirm_reply()
1660 smp = chan->data; in smp_user_confirm_reply()
1662 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_user_confirm_reply()
1670 memset(smp->tk, 0, sizeof(smp->tk)); in smp_user_confirm_reply()
1671 bt_dev_dbg(conn->hcon->hdev, "PassKey: %u", value); in smp_user_confirm_reply()
1672 put_unaligned_le32(value, smp->tk); in smp_user_confirm_reply()
1675 set_bit(SMP_FLAG_TK_VALID, &smp->flags); in smp_user_confirm_reply()
1684 err = -EOPNOTSUPP; in smp_user_confirm_reply()
1691 if (test_bit(SMP_FLAG_CFM_PENDING, &smp->flags)) { in smp_user_confirm_reply()
1706 struct l2cap_conn *conn = smp->conn; in build_bredr_pairing_cmd()
1707 struct hci_dev *hdev = conn->hcon->hdev; in build_bredr_pairing_cmd()
1724 req->auth_req = SMP_AUTH_CT2; in build_bredr_pairing_cmd()
1725 req->init_key_dist = local_dist; in build_bredr_pairing_cmd()
1726 req->resp_key_dist = remote_dist; in build_bredr_pairing_cmd()
1727 req->max_key_size = conn->hcon->enc_key_size; in build_bredr_pairing_cmd()
1729 smp->remote_key_dist = remote_dist; in build_bredr_pairing_cmd()
1736 rsp->auth_req = SMP_AUTH_CT2; in build_bredr_pairing_cmd()
1737 rsp->max_key_size = conn->hcon->enc_key_size; in build_bredr_pairing_cmd()
1738 rsp->init_key_dist = req->init_key_dist & remote_dist; in build_bredr_pairing_cmd()
1739 rsp->resp_key_dist = req->resp_key_dist & local_dist; in build_bredr_pairing_cmd()
1741 smp->remote_key_dist = rsp->init_key_dist; in build_bredr_pairing_cmd()
1746 struct smp_cmd_pairing rsp, *req = (void *) skb->data; in smp_cmd_pairing_req()
1747 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_req()
1748 struct hci_dev *hdev = conn->hcon->hdev; in smp_cmd_pairing_req()
1755 if (skb->len < sizeof(*req)) in smp_cmd_pairing_req()
1758 if (conn->hcon->role != HCI_ROLE_SLAVE) in smp_cmd_pairing_req()
1761 if (!chan->data) in smp_cmd_pairing_req()
1764 smp = chan->data; in smp_cmd_pairing_req()
1770 auth = req->auth_req & AUTH_REQ_MASK(hdev); in smp_cmd_pairing_req()
1779 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_cmd_pairing_req()
1780 memcpy(&smp->preq[1], req, sizeof(*req)); in smp_cmd_pairing_req()
1784 * successfully received our local OOB data - therefore set the in smp_cmd_pairing_req()
1787 if (req->oob_flag == SMP_OOB_PRESENT && SMP_DEV(hdev)->local_oob) in smp_cmd_pairing_req()
1788 set_bit(SMP_FLAG_LOCAL_OOB, &smp->flags); in smp_cmd_pairing_req()
1791 if (conn->hcon->type == ACL_LINK) { in smp_cmd_pairing_req()
1793 if (!test_bit(HCI_CONN_AES_CCM, &conn->hcon->flags) && in smp_cmd_pairing_req()
1797 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_req()
1801 if (req->auth_req & SMP_AUTH_CT2) in smp_cmd_pairing_req()
1802 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_req()
1804 key_size = min(req->max_key_size, rsp.max_key_size); in smp_cmd_pairing_req()
1809 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_req()
1811 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_req()
1812 memcpy(&smp->prsp[1], &rsp, sizeof(rsp)); in smp_cmd_pairing_req()
1822 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_req()
1825 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_req()
1828 if (conn->hcon->io_capability == HCI_IO_NO_INPUT_OUTPUT) in smp_cmd_pairing_req()
1833 if (sec_level > conn->hcon->pending_sec_level) in smp_cmd_pairing_req()
1834 conn->hcon->pending_sec_level = sec_level; in smp_cmd_pairing_req()
1837 if (conn->hcon->pending_sec_level >= BT_SECURITY_HIGH) { in smp_cmd_pairing_req()
1840 method = get_auth_method(smp, conn->hcon->io_capability, in smp_cmd_pairing_req()
1841 req->io_capability); in smp_cmd_pairing_req()
1846 key_size = min(req->max_key_size, rsp.max_key_size); in smp_cmd_pairing_req()
1850 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in smp_cmd_pairing_req()
1852 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_req()
1853 memcpy(&smp->prsp[1], &rsp, sizeof(rsp)); in smp_cmd_pairing_req()
1857 clear_bit(SMP_FLAG_INITIATOR, &smp->flags); in smp_cmd_pairing_req()
1866 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_req()
1869 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_req()
1875 ret = tk_request(conn, 0, auth, rsp.io_capability, req->io_capability); in smp_cmd_pairing_req()
1884 struct hci_dev *hdev = smp->conn->hcon->hdev; in sc_send_public_key()
1888 if (test_bit(SMP_FLAG_LOCAL_OOB, &smp->flags)) { in sc_send_public_key()
1889 struct l2cap_chan *chan = hdev->smp_data; in sc_send_public_key()
1892 if (!chan || !chan->data) in sc_send_public_key()
1895 smp_dev = chan->data; in sc_send_public_key()
1897 memcpy(smp->local_pk, smp_dev->local_pk, 64); in sc_send_public_key()
1898 memcpy(smp->lr, smp_dev->local_rand, 16); in sc_send_public_key()
1900 if (smp_dev->debug_key) in sc_send_public_key()
1901 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_send_public_key()
1908 if (set_ecdh_privkey(smp->tfm_ecdh, debug_sk)) in sc_send_public_key()
1910 memcpy(smp->local_pk, debug_pk, 64); in sc_send_public_key()
1911 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in sc_send_public_key()
1915 if (generate_ecdh_keys(smp->tfm_ecdh, smp->local_pk)) in sc_send_public_key()
1921 if (crypto_memneq(smp->local_pk, debug_pk, 64)) in sc_send_public_key()
1927 SMP_DBG("Local Public Key X: %32phN", smp->local_pk); in sc_send_public_key()
1928 SMP_DBG("Local Public Key Y: %32phN", smp->local_pk + 32); in sc_send_public_key()
1930 smp_send_cmd(smp->conn, SMP_CMD_PUBLIC_KEY, 64, smp->local_pk); in sc_send_public_key()
1937 struct smp_cmd_pairing *req, *rsp = (void *) skb->data; in smp_cmd_pairing_rsp()
1938 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_rsp()
1939 struct smp_chan *smp = chan->data; in smp_cmd_pairing_rsp()
1940 struct hci_dev *hdev = conn->hcon->hdev; in smp_cmd_pairing_rsp()
1946 if (skb->len < sizeof(*rsp)) in smp_cmd_pairing_rsp()
1949 if (conn->hcon->role != HCI_ROLE_MASTER) in smp_cmd_pairing_rsp()
1954 req = (void *) &smp->preq[1]; in smp_cmd_pairing_rsp()
1956 key_size = min(req->max_key_size, rsp->max_key_size); in smp_cmd_pairing_rsp()
1960 auth = rsp->auth_req & AUTH_REQ_MASK(hdev); in smp_cmd_pairing_rsp()
1966 * successfully received our local OOB data - therefore set the in smp_cmd_pairing_rsp()
1969 if (rsp->oob_flag == SMP_OOB_PRESENT && SMP_DEV(hdev)->local_oob) in smp_cmd_pairing_rsp()
1970 set_bit(SMP_FLAG_LOCAL_OOB, &smp->flags); in smp_cmd_pairing_rsp()
1972 smp->prsp[0] = SMP_CMD_PAIRING_RSP; in smp_cmd_pairing_rsp()
1973 memcpy(&smp->prsp[1], rsp, sizeof(*rsp)); in smp_cmd_pairing_rsp()
1978 smp->remote_key_dist &= rsp->resp_key_dist; in smp_cmd_pairing_rsp()
1980 if ((req->auth_req & SMP_AUTH_CT2) && (auth & SMP_AUTH_CT2)) in smp_cmd_pairing_rsp()
1981 set_bit(SMP_FLAG_CT2, &smp->flags); in smp_cmd_pairing_rsp()
1984 if (conn->hcon->type == ACL_LINK) { in smp_cmd_pairing_rsp()
1986 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_rsp()
1991 if ((req->auth_req & SMP_AUTH_SC) && (auth & SMP_AUTH_SC)) in smp_cmd_pairing_rsp()
1992 set_bit(SMP_FLAG_SC, &smp->flags); in smp_cmd_pairing_rsp()
1993 else if (conn->hcon->pending_sec_level > BT_SECURITY_HIGH) in smp_cmd_pairing_rsp()
1994 conn->hcon->pending_sec_level = BT_SECURITY_HIGH; in smp_cmd_pairing_rsp()
1997 if (conn->hcon->pending_sec_level >= BT_SECURITY_HIGH) { in smp_cmd_pairing_rsp()
2000 method = get_auth_method(smp, req->io_capability, in smp_cmd_pairing_rsp()
2001 rsp->io_capability); in smp_cmd_pairing_rsp()
2006 get_random_bytes(smp->prnd, sizeof(smp->prnd)); in smp_cmd_pairing_rsp()
2011 smp->remote_key_dist &= rsp->resp_key_dist; in smp_cmd_pairing_rsp()
2013 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_rsp()
2015 smp->remote_key_dist &= ~SMP_SC_NO_DIST; in smp_cmd_pairing_rsp()
2020 auth |= req->auth_req; in smp_cmd_pairing_rsp()
2022 ret = tk_request(conn, 0, auth, req->io_capability, rsp->io_capability); in smp_cmd_pairing_rsp()
2026 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_cmd_pairing_rsp()
2029 if (test_bit(SMP_FLAG_TK_VALID, &smp->flags)) in smp_cmd_pairing_rsp()
2037 struct l2cap_conn *conn = smp->conn; in sc_check_confirm()
2039 bt_dev_dbg(conn->hcon->hdev, ""); in sc_check_confirm()
2041 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in sc_check_confirm()
2044 if (conn->hcon->out) { in sc_check_confirm()
2045 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in sc_check_confirm()
2046 smp->prnd); in sc_check_confirm()
2053 /* Work-around for some implementations that incorrectly copy RFU bits
2059 struct l2cap_conn *conn = smp->conn; in fixup_sc_false_positive()
2060 struct hci_conn *hcon = conn->hcon; in fixup_sc_false_positive()
2061 struct hci_dev *hdev = hcon->hdev; in fixup_sc_false_positive()
2066 if (hcon->out) in fixup_sc_false_positive()
2070 bt_dev_err(hdev, "refusing legacy fallback in SC-only mode"); in fixup_sc_false_positive()
2076 req = (void *) &smp->preq[1]; in fixup_sc_false_positive()
2077 rsp = (void *) &smp->prsp[1]; in fixup_sc_false_positive()
2080 smp->remote_key_dist = (req->init_key_dist & rsp->resp_key_dist); in fixup_sc_false_positive()
2082 auth = req->auth_req & AUTH_REQ_MASK(hdev); in fixup_sc_false_positive()
2084 if (tk_request(conn, 0, auth, rsp->io_capability, req->io_capability)) { in fixup_sc_false_positive()
2089 clear_bit(SMP_FLAG_SC, &smp->flags); in fixup_sc_false_positive()
2096 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_confirm()
2097 struct smp_chan *smp = chan->data; in smp_cmd_pairing_confirm()
2098 struct hci_conn *hcon = conn->hcon; in smp_cmd_pairing_confirm()
2099 struct hci_dev *hdev = hcon->hdev; in smp_cmd_pairing_confirm()
2102 hcon->out ? "initiator" : "responder"); in smp_cmd_pairing_confirm()
2104 if (skb->len < sizeof(smp->pcnf)) in smp_cmd_pairing_confirm()
2107 memcpy(smp->pcnf, skb->data, sizeof(smp->pcnf)); in smp_cmd_pairing_confirm()
2108 skb_pull(skb, sizeof(smp->pcnf)); in smp_cmd_pairing_confirm()
2110 if (test_bit(SMP_FLAG_SC, &smp->flags)) { in smp_cmd_pairing_confirm()
2114 if (test_bit(SMP_FLAG_REMOTE_PK, &smp->flags)) in smp_cmd_pairing_confirm()
2124 if (conn->hcon->out) { in smp_cmd_pairing_confirm()
2125 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_cmd_pairing_confirm()
2126 smp->prnd); in smp_cmd_pairing_confirm()
2131 if (test_bit(SMP_FLAG_TK_VALID, &smp->flags)) in smp_cmd_pairing_confirm()
2134 set_bit(SMP_FLAG_CFM_PENDING, &smp->flags); in smp_cmd_pairing_confirm()
2141 struct l2cap_chan *chan = conn->smp; in smp_cmd_pairing_random()
2142 struct smp_chan *smp = chan->data; in smp_cmd_pairing_random()
2143 struct hci_conn *hcon = conn->hcon; in smp_cmd_pairing_random()
2148 bt_dev_dbg(hcon->hdev, "conn %p", conn); in smp_cmd_pairing_random()
2150 if (skb->len < sizeof(smp->rrnd)) in smp_cmd_pairing_random()
2153 memcpy(smp->rrnd, skb->data, sizeof(smp->rrnd)); in smp_cmd_pairing_random()
2154 skb_pull(skb, sizeof(smp->rrnd)); in smp_cmd_pairing_random()
2156 if (!test_bit(SMP_FLAG_SC, &smp->flags)) in smp_cmd_pairing_random()
2159 if (hcon->out) { in smp_cmd_pairing_random()
2160 pkax = smp->local_pk; in smp_cmd_pairing_random()
2161 pkbx = smp->remote_pk; in smp_cmd_pairing_random()
2162 na = smp->prnd; in smp_cmd_pairing_random()
2163 nb = smp->rrnd; in smp_cmd_pairing_random()
2165 pkax = smp->remote_pk; in smp_cmd_pairing_random()
2166 pkbx = smp->local_pk; in smp_cmd_pairing_random()
2167 na = smp->rrnd; in smp_cmd_pairing_random()
2168 nb = smp->prnd; in smp_cmd_pairing_random()
2171 if (smp->method == REQ_OOB) { in smp_cmd_pairing_random()
2172 if (!hcon->out) in smp_cmd_pairing_random()
2174 sizeof(smp->prnd), smp->prnd); in smp_cmd_pairing_random()
2180 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in smp_cmd_pairing_random()
2183 if (hcon->out) { in smp_cmd_pairing_random()
2186 err = smp_f4(smp->tfm_cmac, smp->remote_pk, smp->local_pk, in smp_cmd_pairing_random()
2187 smp->rrnd, 0, cfm); in smp_cmd_pairing_random()
2191 if (crypto_memneq(smp->pcnf, cfm, 16)) in smp_cmd_pairing_random()
2194 smp_send_cmd(conn, SMP_CMD_PAIRING_RANDOM, sizeof(smp->prnd), in smp_cmd_pairing_random()
2195 smp->prnd); in smp_cmd_pairing_random()
2198 /* Only Just-Works pairing requires extra checks */ in smp_cmd_pairing_random()
2199 if (smp->method != JUST_WORKS) in smp_cmd_pairing_random()
2206 if (hci_find_ltk(hcon->hdev, &hcon->dst, hcon->dst_type, in smp_cmd_pairing_random()
2207 hcon->role)) { in smp_cmd_pairing_random()
2219 err = sc_mackey_and_ltk(smp, smp->mackey, smp->tk); in smp_cmd_pairing_random()
2223 if (smp->method == REQ_OOB) { in smp_cmd_pairing_random()
2224 if (hcon->out) { in smp_cmd_pairing_random()
2231 err = smp_g2(smp->tfm_cmac, pkax, pkbx, na, nb, &passkey); in smp_cmd_pairing_random()
2238 if (smp->method == JUST_WORKS) in smp_cmd_pairing_random()
2241 err = mgmt_user_confirm_request(hcon->hdev, &hcon->dst, hcon->type, in smp_cmd_pairing_random()
2242 hcon->dst_type, passkey, confirm_hint); in smp_cmd_pairing_random()
2246 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in smp_cmd_pairing_random()
2254 struct hci_conn *hcon = conn->hcon; in smp_ltk_encrypt()
2256 key = hci_find_ltk(hcon->hdev, &hcon->dst, hcon->dst_type, hcon->role); in smp_ltk_encrypt()
2263 if (test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &hcon->flags)) in smp_ltk_encrypt()
2266 hci_le_start_enc(hcon, key->ediv, key->rand, key->val, key->enc_size); in smp_ltk_encrypt()
2267 hcon->enc_key_size = key->enc_size; in smp_ltk_encrypt()
2270 clear_bit(HCI_CONN_STK_ENCRYPT, &hcon->flags); in smp_ltk_encrypt()
2283 * connection to be re-encrypted with an LTK, even if the LTK in smp_sufficient_security()
2288 test_bit(HCI_CONN_STK_ENCRYPT, &hcon->flags) && in smp_sufficient_security()
2289 hci_find_ltk(hcon->hdev, &hcon->dst, hcon->dst_type, hcon->role)) in smp_sufficient_security()
2292 if (hcon->sec_level >= sec_level) in smp_sufficient_security()
2300 struct smp_cmd_security_req *rp = (void *) skb->data; in smp_cmd_security_req() local
2302 struct hci_conn *hcon = conn->hcon; in smp_cmd_security_req()
2303 struct hci_dev *hdev = hcon->hdev; in smp_cmd_security_req()
2309 if (skb->len < sizeof(*rp)) in smp_cmd_security_req()
2312 if (hcon->role != HCI_ROLE_MASTER) in smp_cmd_security_req()
2315 auth = rp->auth_req & AUTH_REQ_MASK(hdev); in smp_cmd_security_req()
2320 if (hcon->io_capability == HCI_IO_NO_INPUT_OUTPUT) in smp_cmd_security_req()
2330 smp_ltk_encrypt(conn, hcon->sec_level); in smp_cmd_security_req()
2334 if (sec_level > hcon->pending_sec_level) in smp_cmd_security_req()
2335 hcon->pending_sec_level = sec_level; in smp_cmd_security_req()
2337 if (smp_ltk_encrypt(conn, hcon->pending_sec_level)) in smp_cmd_security_req()
2348 skb_pull(skb, sizeof(*rp)); in smp_cmd_security_req()
2353 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_cmd_security_req()
2354 memcpy(&smp->preq[1], &cp, sizeof(cp)); in smp_cmd_security_req()
2364 struct l2cap_conn *conn = hcon->l2cap_data; in smp_conn_security()
2370 bt_dev_dbg(hcon->hdev, "conn %p hcon %p level 0x%2.2x", conn, hcon, in smp_conn_security()
2377 if (!hci_dev_test_flag(hcon->hdev, HCI_LE_ENABLED)) in smp_conn_security()
2383 if (sec_level > hcon->pending_sec_level) in smp_conn_security()
2384 hcon->pending_sec_level = sec_level; in smp_conn_security()
2386 if (hcon->role == HCI_ROLE_MASTER) in smp_conn_security()
2387 if (smp_ltk_encrypt(conn, hcon->pending_sec_level)) in smp_conn_security()
2390 chan = conn->smp; in smp_conn_security()
2392 bt_dev_err(hcon->hdev, "security requested but not available"); in smp_conn_security()
2399 if (chan->data) { in smp_conn_security()
2412 if (hci_dev_test_flag(hcon->hdev, HCI_SC_ENABLED)) { in smp_conn_security()
2414 if (hci_dev_test_flag(hcon->hdev, HCI_SSP_ENABLED)) in smp_conn_security()
2419 * Needed to pass certification test SM/MAS/PKE/BV-01-C in smp_conn_security()
2421 if (!hci_dev_test_flag(hcon->hdev, HCI_FORCE_NO_MITM)) { in smp_conn_security()
2425 if (hcon->io_capability != HCI_IO_NO_INPUT_OUTPUT || in smp_conn_security()
2426 hcon->pending_sec_level > BT_SECURITY_MEDIUM) in smp_conn_security()
2430 if (hcon->role == HCI_ROLE_MASTER) { in smp_conn_security()
2434 smp->preq[0] = SMP_CMD_PAIRING_REQ; in smp_conn_security()
2435 memcpy(&smp->preq[1], &cp, sizeof(cp)); in smp_conn_security()
2446 set_bit(SMP_FLAG_INITIATOR, &smp->flags); in smp_conn_security()
2470 conn = hcon->l2cap_data; in smp_cancel_and_remove_pairing()
2474 chan = conn->smp; in smp_cancel_and_remove_pairing()
2480 smp = chan->data; in smp_cancel_and_remove_pairing()
2484 smp->ltk = NULL; in smp_cancel_and_remove_pairing()
2485 smp->responder_ltk = NULL; in smp_cancel_and_remove_pairing()
2486 smp->remote_irk = NULL; in smp_cancel_and_remove_pairing()
2488 if (test_bit(SMP_FLAG_COMPLETE, &smp->flags)) in smp_cancel_and_remove_pairing()
2503 struct smp_cmd_encrypt_info *rp = (void *) skb->data; in smp_cmd_encrypt_info() local
2504 struct l2cap_chan *chan = conn->smp; in smp_cmd_encrypt_info()
2505 struct smp_chan *smp = chan->data; in smp_cmd_encrypt_info()
2507 bt_dev_dbg(conn->hcon->hdev, "conn %p", conn); in smp_cmd_encrypt_info()
2509 if (skb->len < sizeof(*rp)) in smp_cmd_encrypt_info()
2513 if (hci_is_blocked_key(conn->hcon->hdev, HCI_BLOCKED_KEY_TYPE_LTK, in smp_cmd_encrypt_info()
2514 rp->ltk)) { in smp_cmd_encrypt_info()
2515 bt_dev_warn_ratelimited(conn->hcon->hdev, in smp_cmd_encrypt_info()
2517 &conn->hcon->dst); in smp_cmd_encrypt_info()
2523 skb_pull(skb, sizeof(*rp)); in smp_cmd_encrypt_info()
2525 memcpy(smp->tk, rp->ltk, sizeof(smp->tk)); in smp_cmd_encrypt_info()
2532 struct smp_cmd_initiator_ident *rp = (void *)skb->data; in smp_cmd_initiator_ident() local
2533 struct l2cap_chan *chan = conn->smp; in smp_cmd_initiator_ident()
2534 struct smp_chan *smp = chan->data; in smp_cmd_initiator_ident()
2535 struct hci_dev *hdev = conn->hcon->hdev; in smp_cmd_initiator_ident()
2536 struct hci_conn *hcon = conn->hcon; in smp_cmd_initiator_ident()
2542 if (skb->len < sizeof(*rp)) in smp_cmd_initiator_ident()
2546 smp->remote_key_dist &= ~SMP_DIST_ENC_KEY; in smp_cmd_initiator_ident()
2548 if (smp->remote_key_dist & SMP_DIST_ID_KEY) in smp_cmd_initiator_ident()
2550 else if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_cmd_initiator_ident()
2553 skb_pull(skb, sizeof(*rp)); in smp_cmd_initiator_ident()
2555 authenticated = (hcon->sec_level == BT_SECURITY_HIGH); in smp_cmd_initiator_ident()
2556 ltk = hci_add_ltk(hdev, &hcon->dst, hcon->dst_type, SMP_LTK, in smp_cmd_initiator_ident()
2557 authenticated, smp->tk, smp->enc_key_size, in smp_cmd_initiator_ident()
2558 rp->ediv, rp->rand); in smp_cmd_initiator_ident()
2559 smp->ltk = ltk; in smp_cmd_initiator_ident()
2560 if (!(smp->remote_key_dist & KEY_DIST_MASK)) in smp_cmd_initiator_ident()
2568 struct smp_cmd_ident_info *info = (void *) skb->data; in smp_cmd_ident_info()
2569 struct l2cap_chan *chan = conn->smp; in smp_cmd_ident_info()
2570 struct smp_chan *smp = chan->data; in smp_cmd_ident_info()
2572 bt_dev_dbg(conn->hcon->hdev, ""); in smp_cmd_ident_info()
2574 if (skb->len < sizeof(*info)) in smp_cmd_ident_info()
2578 if (hci_is_blocked_key(conn->hcon->hdev, HCI_BLOCKED_KEY_TYPE_IRK, in smp_cmd_ident_info()
2579 info->irk)) { in smp_cmd_ident_info()
2580 bt_dev_warn_ratelimited(conn->hcon->hdev, in smp_cmd_ident_info()
2582 &conn->hcon->dst); in smp_cmd_ident_info()
2590 memcpy(smp->irk, info->irk, 16); in smp_cmd_ident_info()
2598 struct smp_cmd_ident_addr_info *info = (void *) skb->data; in smp_cmd_ident_addr_info()
2599 struct l2cap_chan *chan = conn->smp; in smp_cmd_ident_addr_info()
2600 struct smp_chan *smp = chan->data; in smp_cmd_ident_addr_info()
2601 struct hci_conn *hcon = conn->hcon; in smp_cmd_ident_addr_info()
2604 bt_dev_dbg(hcon->hdev, ""); in smp_cmd_ident_addr_info()
2606 if (skb->len < sizeof(*info)) in smp_cmd_ident_addr_info()
2610 smp->remote_key_dist &= ~SMP_DIST_ID_KEY; in smp_cmd_ident_addr_info()
2612 if (smp->remote_key_dist & SMP_DIST_SIGN) in smp_cmd_ident_addr_info()
2627 if (!bacmp(&info->bdaddr, BDADDR_ANY) || in smp_cmd_ident_addr_info()
2628 !hci_is_identity_address(&info->bdaddr, info->addr_type)) { in smp_cmd_ident_addr_info()
2629 bt_dev_err(hcon->hdev, "ignoring IRK with no identity address"); in smp_cmd_ident_addr_info()
2638 if (hci_is_identity_address(&hcon->dst, hcon->dst_type) && in smp_cmd_ident_addr_info()
2639 (bacmp(&info->bdaddr, &hcon->dst) || in smp_cmd_ident_addr_info()
2640 info->addr_type != hcon->dst_type)) { in smp_cmd_ident_addr_info()
2641 bt_dev_err(hcon->hdev, in smp_cmd_ident_addr_info()
2646 bacpy(&smp->id_addr, &info->bdaddr); in smp_cmd_ident_addr_info()
2647 smp->id_addr_type = info->addr_type; in smp_cmd_ident_addr_info()
2649 if (hci_bdaddr_is_rpa(&hcon->dst, hcon->dst_type)) in smp_cmd_ident_addr_info()
2650 bacpy(&rpa, &hcon->dst); in smp_cmd_ident_addr_info()
2654 smp->remote_irk = hci_add_irk(conn->hcon->hdev, &smp->id_addr, in smp_cmd_ident_addr_info()
2655 smp->id_addr_type, smp->irk, &rpa); in smp_cmd_ident_addr_info()
2658 if (!(smp->remote_key_dist & KEY_DIST_MASK)) in smp_cmd_ident_addr_info()
2666 struct smp_cmd_sign_info *rp = (void *) skb->data; in smp_cmd_sign_info() local
2667 struct l2cap_chan *chan = conn->smp; in smp_cmd_sign_info()
2668 struct smp_chan *smp = chan->data; in smp_cmd_sign_info()
2671 bt_dev_dbg(conn->hcon->hdev, "conn %p", conn); in smp_cmd_sign_info()
2673 if (skb->len < sizeof(*rp)) in smp_cmd_sign_info()
2677 smp->remote_key_dist &= ~SMP_DIST_SIGN; in smp_cmd_sign_info()
2679 skb_pull(skb, sizeof(*rp)); in smp_cmd_sign_info()
2683 if (conn->hcon->sec_level > BT_SECURITY_MEDIUM) in smp_cmd_sign_info()
2684 csrk->type = MGMT_CSRK_REMOTE_AUTHENTICATED; in smp_cmd_sign_info()
2686 csrk->type = MGMT_CSRK_REMOTE_UNAUTHENTICATED; in smp_cmd_sign_info()
2687 memcpy(csrk->val, rp->csrk, sizeof(csrk->val)); in smp_cmd_sign_info()
2689 smp->csrk = csrk; in smp_cmd_sign_info()
2697 struct l2cap_conn *conn = smp->conn; in sc_select_method()
2698 struct hci_conn *hcon = conn->hcon; in sc_select_method()
2702 if (test_bit(SMP_FLAG_REMOTE_OOB, &smp->flags) || in sc_select_method()
2703 test_bit(SMP_FLAG_LOCAL_OOB, &smp->flags)) in sc_select_method()
2711 if (hcon->out) { in sc_select_method()
2712 local = (void *) &smp->preq[1]; in sc_select_method()
2713 remote = (void *) &smp->prsp[1]; in sc_select_method()
2715 local = (void *) &smp->prsp[1]; in sc_select_method()
2716 remote = (void *) &smp->preq[1]; in sc_select_method()
2719 local_io = local->io_capability; in sc_select_method()
2720 remote_io = remote->io_capability; in sc_select_method()
2722 local_mitm = (local->auth_req & SMP_AUTH_MITM); in sc_select_method()
2723 remote_mitm = (remote->auth_req & SMP_AUTH_MITM); in sc_select_method()
2734 if (method == JUST_CFM && test_bit(SMP_FLAG_INITIATOR, &smp->flags)) in sc_select_method()
2742 struct smp_cmd_public_key *key = (void *) skb->data; in smp_cmd_public_key()
2743 struct hci_conn *hcon = conn->hcon; in smp_cmd_public_key()
2744 struct l2cap_chan *chan = conn->smp; in smp_cmd_public_key()
2745 struct smp_chan *smp = chan->data; in smp_cmd_public_key()
2746 struct hci_dev *hdev = hcon->hdev; in smp_cmd_public_key()
2753 if (skb->len < sizeof(*key)) in smp_cmd_public_key()
2759 if (!test_bit(SMP_FLAG_DEBUG_KEY, &smp->flags) && in smp_cmd_public_key()
2760 !crypto_memneq(key, smp->local_pk, 64)) { in smp_cmd_public_key()
2765 memcpy(smp->remote_pk, key, 64); in smp_cmd_public_key()
2767 if (test_bit(SMP_FLAG_REMOTE_OOB, &smp->flags)) { in smp_cmd_public_key()
2768 err = smp_f4(smp->tfm_cmac, smp->remote_pk, smp->remote_pk, in smp_cmd_public_key()
2769 smp->rr, 0, cfm.confirm_val); in smp_cmd_public_key()
2773 if (crypto_memneq(cfm.confirm_val, smp->pcnf, 16)) in smp_cmd_public_key()
2777 /* Non-initiating device sends its public key after receiving in smp_cmd_public_key()
2780 if (!hcon->out) { in smp_cmd_public_key()
2786 SMP_DBG("Remote Public Key X: %32phN", smp->remote_pk); in smp_cmd_public_key()
2787 SMP_DBG("Remote Public Key Y: %32phN", smp->remote_pk + 32); in smp_cmd_public_key()
2792 if (test_bit(SMP_FLAG_LOCAL_OOB, &smp->flags)) { in smp_cmd_public_key()
2793 struct l2cap_chan *hchan = hdev->smp_data; in smp_cmd_public_key()
2796 if (!hchan || !hchan->data) in smp_cmd_public_key()
2799 smp_dev = hchan->data; in smp_cmd_public_key()
2801 tfm_ecdh = smp_dev->tfm_ecdh; in smp_cmd_public_key()
2803 tfm_ecdh = smp->tfm_ecdh; in smp_cmd_public_key()
2806 if (compute_ecdh_secret(tfm_ecdh, smp->remote_pk, smp->dhkey)) in smp_cmd_public_key()
2809 SMP_DBG("DHKey %32phN", smp->dhkey); in smp_cmd_public_key()
2811 set_bit(SMP_FLAG_REMOTE_PK, &smp->flags); in smp_cmd_public_key()
2813 smp->method = sc_select_method(smp); in smp_cmd_public_key()
2815 bt_dev_dbg(hdev, "selected method 0x%02x", smp->method); in smp_cmd_public_key()
2818 if (smp->method == JUST_WORKS || smp->method == JUST_CFM) in smp_cmd_public_key()
2819 hcon->pending_sec_level = BT_SECURITY_MEDIUM; in smp_cmd_public_key()
2821 hcon->pending_sec_level = BT_SECURITY_FIPS; in smp_cmd_public_key()
2823 if (!crypto_memneq(debug_pk, smp->remote_pk, 64)) in smp_cmd_public_key()
2824 set_bit(SMP_FLAG_DEBUG_KEY, &smp->flags); in smp_cmd_public_key()
2826 if (smp->method == DSP_PASSKEY) { in smp_cmd_public_key()
2827 get_random_bytes(&hcon->passkey_notify, in smp_cmd_public_key()
2828 sizeof(hcon->passkey_notify)); in smp_cmd_public_key()
2829 hcon->passkey_notify %= 1000000; in smp_cmd_public_key()
2830 hcon->passkey_entered = 0; in smp_cmd_public_key()
2831 smp->passkey_round = 0; in smp_cmd_public_key()
2832 if (mgmt_user_passkey_notify(hdev, &hcon->dst, hcon->type, in smp_cmd_public_key()
2833 hcon->dst_type, in smp_cmd_public_key()
2834 hcon->passkey_notify, in smp_cmd_public_key()
2835 hcon->passkey_entered)) in smp_cmd_public_key()
2841 if (smp->method == REQ_OOB) { in smp_cmd_public_key()
2842 if (hcon->out) in smp_cmd_public_key()
2844 sizeof(smp->prnd), smp->prnd); in smp_cmd_public_key()
2851 if (hcon->out) in smp_cmd_public_key()
2854 if (smp->method == REQ_PASSKEY) { in smp_cmd_public_key()
2855 if (mgmt_user_passkey_request(hdev, &hcon->dst, hcon->type, in smp_cmd_public_key()
2856 hcon->dst_type)) in smp_cmd_public_key()
2859 set_bit(SMP_FLAG_WAIT_USER, &smp->flags); in smp_cmd_public_key()
2863 /* The Initiating device waits for the non-initiating device to in smp_cmd_public_key()
2866 if (conn->hcon->out) in smp_cmd_public_key()
2869 err = smp_f4(smp->tfm_cmac, smp->local_pk, smp->remote_pk, smp->prnd, in smp_cmd_public_key()
2882 struct smp_cmd_dhkey_check *check = (void *) skb->data; in smp_cmd_dhkey_check()
2883 struct l2cap_chan *chan = conn->smp; in smp_cmd_dhkey_check()
2884 struct hci_conn *hcon = conn->hcon; in smp_cmd_dhkey_check()
2885 struct smp_chan *smp = chan->data; in smp_cmd_dhkey_check()
2890 bt_dev_dbg(hcon->hdev, "conn %p", conn); in smp_cmd_dhkey_check()
2892 if (skb->len < sizeof(*check)) in smp_cmd_dhkey_check()
2895 memcpy(a, &hcon->init_addr, 6); in smp_cmd_dhkey_check()
2896 memcpy(b, &hcon->resp_addr, 6); in smp_cmd_dhkey_check()
2897 a[6] = hcon->init_addr_type; in smp_cmd_dhkey_check()
2898 b[6] = hcon->resp_addr_type; in smp_cmd_dhkey_check()
2900 if (hcon->out) { in smp_cmd_dhkey_check()
2903 memcpy(io_cap, &smp->prsp[1], 3); in smp_cmd_dhkey_check()
2907 memcpy(io_cap, &smp->preq[1], 3); in smp_cmd_dhkey_check()
2912 if (smp->method == REQ_PASSKEY || smp->method == DSP_PASSKEY) in smp_cmd_dhkey_check()
2913 put_unaligned_le32(hcon->passkey_notify, r); in smp_cmd_dhkey_check()
2914 else if (smp->method == REQ_OOB) in smp_cmd_dhkey_check()
2915 memcpy(r, smp->lr, 16); in smp_cmd_dhkey_check()
2917 err = smp_f6(smp->tfm_cmac, smp->mackey, smp->rrnd, smp->prnd, r, in smp_cmd_dhkey_check()
2922 if (crypto_memneq(check->e, e, 16)) in smp_cmd_dhkey_check()
2925 if (!hcon->out) { in smp_cmd_dhkey_check()
2926 if (test_bit(SMP_FLAG_WAIT_USER, &smp->flags)) { in smp_cmd_dhkey_check()
2927 set_bit(SMP_FLAG_DHKEY_PENDING, &smp->flags); in smp_cmd_dhkey_check()
2937 if (hcon->out) { in smp_cmd_dhkey_check()
2938 hci_le_start_enc(hcon, 0, 0, smp->tk, smp->enc_key_size); in smp_cmd_dhkey_check()
2939 hcon->enc_key_size = smp->enc_key_size; in smp_cmd_dhkey_check()
2948 struct smp_cmd_keypress_notify *kp = (void *) skb->data; in smp_cmd_keypress_notify()
2950 bt_dev_dbg(conn->hcon->hdev, "value 0x%02x", kp->value); in smp_cmd_keypress_notify()
2957 struct l2cap_conn *conn = chan->conn; in smp_sig_channel()
2958 struct hci_conn *hcon = conn->hcon; in smp_sig_channel()
2963 if (skb->len < 1) in smp_sig_channel()
2964 return -EILSEQ; in smp_sig_channel()
2966 if (!hci_dev_test_flag(hcon->hdev, HCI_LE_ENABLED)) { in smp_sig_channel()
2971 code = skb->data[0]; in smp_sig_channel()
2974 smp = chan->data; in smp_sig_channel()
2979 if (smp && !test_and_clear_bit(code, &smp->allow_cmd)) in smp_sig_channel()
2995 err = -EPERM; in smp_sig_channel()
3047 bt_dev_dbg(hcon->hdev, "Unknown command code 0x%2.2x", code); in smp_sig_channel()
3062 bt_dev_err(hcon->hdev, "unexpected SMP command 0x%02x from %pMR", in smp_sig_channel()
3063 code, &hcon->dst); in smp_sig_channel()
3070 struct l2cap_conn *conn = chan->conn; in smp_teardown_cb()
3072 bt_dev_dbg(conn->hcon->hdev, "chan %p", chan); in smp_teardown_cb()
3074 if (chan->data) in smp_teardown_cb()
3077 conn->smp = NULL; in smp_teardown_cb()
3083 struct l2cap_conn *conn = chan->conn; in bredr_pairing()
3084 struct hci_conn *hcon = conn->hcon; in bredr_pairing()
3085 struct hci_dev *hdev = hcon->hdev; in bredr_pairing()
3092 if (!test_bit(HCI_CONN_NEW_LINK_KEY, &hcon->flags)) in bredr_pairing()
3096 if (!test_bit(HCI_CONN_ENCRYPT, &hcon->flags)) in bredr_pairing()
3100 if (hcon->role != HCI_ROLE_MASTER) in bredr_pairing()
3108 if (!test_bit(HCI_CONN_AES_CCM, &hcon->flags) && in bredr_pairing()
3121 if (!(conn->remote_fixed_chan & L2CAP_FC_SMP_BREDR)) in bredr_pairing()
3125 if (chan->data) in bredr_pairing()
3134 set_bit(SMP_FLAG_SC, &smp->flags); in bredr_pairing()
3141 smp->preq[0] = SMP_CMD_PAIRING_REQ; in bredr_pairing()
3142 memcpy(&smp->preq[1], &req, sizeof(req)); in bredr_pairing()
3150 struct smp_chan *smp = chan->data; in smp_resume_cb()
3151 struct l2cap_conn *conn = chan->conn; in smp_resume_cb()
3152 struct hci_conn *hcon = conn->hcon; in smp_resume_cb()
3154 bt_dev_dbg(hcon->hdev, "chan %p", chan); in smp_resume_cb()
3156 if (hcon->type == ACL_LINK) { in smp_resume_cb()
3164 if (!test_bit(HCI_CONN_ENCRYPT, &hcon->flags)) in smp_resume_cb()
3167 cancel_delayed_work(&smp->security_timer); in smp_resume_cb()
3174 struct l2cap_conn *conn = chan->conn; in smp_ready_cb()
3175 struct hci_conn *hcon = conn->hcon; in smp_ready_cb()
3177 bt_dev_dbg(hcon->hdev, "chan %p", chan); in smp_ready_cb()
3185 conn->smp = chan; in smp_ready_cb()
3187 if (hcon->type == ACL_LINK && test_bit(HCI_CONN_ENCRYPT, &hcon->flags)) in smp_ready_cb()
3195 bt_dev_dbg(chan->conn->hcon->hdev, "chan %p", chan); in smp_recv_cb()
3199 struct smp_chan *smp = chan->data; in smp_recv_cb()
3202 cancel_delayed_work_sync(&smp->security_timer); in smp_recv_cb()
3204 hci_disconnect(chan->conn->hcon, HCI_ERROR_AUTH_FAILURE); in smp_recv_cb()
3218 return ERR_PTR(-ENOMEM); in smp_alloc_skb_cb()
3220 skb->priority = HCI_PRIO_MAX; in smp_alloc_skb_cb()
3221 bt_cb(skb)->l2cap.chan = chan; in smp_alloc_skb_cb()
3253 chan->chan_type = pchan->chan_type; in smp_new_conn_cb()
3254 chan->ops = &smp_chan_ops; in smp_new_conn_cb()
3255 chan->scid = pchan->scid; in smp_new_conn_cb()
3256 chan->dcid = chan->scid; in smp_new_conn_cb()
3257 chan->imtu = pchan->imtu; in smp_new_conn_cb()
3258 chan->omtu = pchan->omtu; in smp_new_conn_cb()
3259 chan->mode = pchan->mode; in smp_new_conn_cb()
3266 atomic_set(&chan->nesting, L2CAP_NESTING_SMP); in smp_new_conn_cb()
3305 return ERR_PTR(-ENOMEM); in smp_add_cid()
3314 tfm_ecdh = crypto_alloc_kpp("ecdh-nist-p256", 0, 0); in smp_add_cid()
3322 smp->local_oob = false; in smp_add_cid()
3323 smp->tfm_cmac = tfm_cmac; in smp_add_cid()
3324 smp->tfm_ecdh = tfm_ecdh; in smp_add_cid()
3330 crypto_free_shash(smp->tfm_cmac); in smp_add_cid()
3331 crypto_free_kpp(smp->tfm_ecdh); in smp_add_cid()
3334 return ERR_PTR(-ENOMEM); in smp_add_cid()
3337 chan->data = smp; in smp_add_cid()
3346 hci_copy_identity_address(hdev, &chan->src, &bdaddr_type); in smp_add_cid()
3349 chan->src_type = BDADDR_LE_PUBLIC; in smp_add_cid()
3351 chan->src_type = BDADDR_LE_RANDOM; in smp_add_cid()
3353 bacpy(&chan->src, &hdev->bdaddr); in smp_add_cid()
3354 chan->src_type = BDADDR_BREDR; in smp_add_cid()
3357 chan->state = BT_LISTEN; in smp_add_cid()
3358 chan->mode = L2CAP_MODE_BASIC; in smp_add_cid()
3359 chan->imtu = L2CAP_DEFAULT_MTU; in smp_add_cid()
3360 chan->ops = &smp_root_chan_ops; in smp_add_cid()
3363 atomic_set(&chan->nesting, L2CAP_NESTING_PARENT); in smp_add_cid()
3374 smp = chan->data; in smp_del_chan()
3376 chan->data = NULL; in smp_del_chan()
3377 crypto_free_shash(smp->tfm_cmac); in smp_del_chan()
3378 crypto_free_kpp(smp->tfm_ecdh); in smp_del_chan()
3388 return -EALREADY; in smp_force_bredr()
3397 hdev->smp_bredr_data = chan; in smp_force_bredr()
3401 chan = hdev->smp_bredr_data; in smp_force_bredr()
3402 hdev->smp_bredr_data = NULL; in smp_force_bredr()
3423 if (WARN_ON(hdev->smp_data)) { in smp_register()
3424 chan = hdev->smp_data; in smp_register()
3425 hdev->smp_data = NULL; in smp_register()
3433 hdev->smp_data = chan; in smp_register()
3441 if (WARN_ON(hdev->smp_bredr_data)) { in smp_register()
3442 chan = hdev->smp_bredr_data; in smp_register()
3443 hdev->smp_bredr_data = NULL; in smp_register()
3450 chan = hdev->smp_data; in smp_register()
3451 hdev->smp_data = NULL; in smp_register()
3456 hdev->smp_bredr_data = chan; in smp_register()
3465 if (hdev->smp_bredr_data) { in smp_unregister()
3466 chan = hdev->smp_bredr_data; in smp_unregister()
3467 hdev->smp_bredr_data = NULL; in smp_unregister()
3471 if (hdev->smp_data) { in smp_unregister()
3472 chan = hdev->smp_data; in smp_unregister()
3473 hdev->smp_data = NULL; in smp_unregister()
3494 return -EINVAL; in test_debug_key()
3514 return -EINVAL; in test_ah()
3544 return -EINVAL; in test_c1()
3569 return -EINVAL; in test_s1()
3601 return -EINVAL; in test_f4()
3635 return -EINVAL; in test_f5()
3638 return -EINVAL; in test_f5()
3671 return -EINVAL; in test_f6()
3691 const u8 y[16] = { in test_g2() local
3698 err = smp_g2(tfm_cmac, u, v, x, y, &val); in test_g2()
3703 return -EINVAL; in test_g2()
3725 return -EINVAL; in test_h6()
3839 tfm_ecdh = crypto_alloc_kpp("ecdh-nist-p256", 0, 0); in bt_selftest_smp()