mirror of
https://github.com/espressif/esp-idf.git
synced 2024-10-05 20:47:46 -04:00
4345e15f23
For the CID10564,10384,10280,10098,10038,The memory was released in other place. For the CID10365,it release the memory in the function when sent successfully. For the CID10268,10011, we need not change the code.
811 lines
43 KiB
C
811 lines
43 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright (C) 2003-2012 Broadcom Corporation
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at:
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*
|
|
******************************************************************************/
|
|
|
|
#include "common/bt_target.h"
|
|
|
|
#if SMP_INCLUDED == TRUE
|
|
|
|
#include <string.h>
|
|
#include "smp_int.h"
|
|
|
|
const char *const smp_state_name [] = {
|
|
"SMP_STATE_IDLE",
|
|
"SMP_STATE_WAIT_APP_RSP",
|
|
"SMP_STATE_SEC_REQ_PENDING",
|
|
"SMP_STATE_PAIR_REQ_RSP",
|
|
"SMP_STATE_WAIT_CONFIRM",
|
|
"SMP_STATE_CONFIRM",
|
|
"SMP_STATE_RAND",
|
|
"SMP_STATE_PUBLIC_KEY_EXCH",
|
|
"SMP_STATE_SEC_CONN_PHS1_START",
|
|
"SMP_STATE_WAIT_COMMITMENT",
|
|
"SMP_STATE_WAIT_NONCE",
|
|
"SMP_STATE_SEC_CONN_PHS2_START",
|
|
"SMP_STATE_WAIT_DHK_CHECK",
|
|
"SMP_STATE_DHK_CHECK",
|
|
"SMP_STATE_ENCRYPTION_PENDING",
|
|
"SMP_STATE_BOND_PENDING",
|
|
"SMP_STATE_CREATE_LOCAL_SEC_CONN_OOB_DATA",
|
|
"SMP_STATE_MAX"
|
|
};
|
|
|
|
const char *const smp_event_name [] = {
|
|
"PAIRING_REQ_EVT",
|
|
"PAIRING_RSP_EVT",
|
|
"CONFIRM_EVT",
|
|
"RAND_EVT",
|
|
"PAIRING_FAILED_EVT",
|
|
"ENC_INFO_EVT",
|
|
"MASTER_ID_EVT",
|
|
"ID_INFO_EVT",
|
|
"ID_ADDR_EVT",
|
|
"SIGN_INFO_EVT",
|
|
"SECURITY_REQ_EVT",
|
|
"PAIR_PUBLIC_KEY_EVT",
|
|
"PAIR_DHKEY_CHECK_EVT",
|
|
"PAIR_KEYPRESS_NOTIFICATION_EVT",
|
|
"PAIR_COMMITMENT_EVT",
|
|
"KEY_READY_EVT",
|
|
"ENCRYPTED_EVT",
|
|
"L2CAP_CONN_EVT",
|
|
"L2CAP_DISCONN_EVT",
|
|
"API_IO_RSP_EVT",
|
|
"API_SEC_GRANT_EVT",
|
|
"TK_REQ_EVT",
|
|
"AUTH_CMPL_EVT",
|
|
"ENC_REQ_EVT",
|
|
"BOND_REQ_EVT",
|
|
"DISCARD_SEC_REQ_EVT",
|
|
"PUBLIC_KEY_EXCHANGE_REQ_EVT",
|
|
"LOCAL_PUBLIC_KEY_CRTD_EVT",
|
|
"BOTH_PUBLIC_KEYS_RCVD_EVT",
|
|
"SEC_CONN_DHKEY_COMPLETE_EVT",
|
|
"HAVE_LOCAL_NONCE_EVT",
|
|
"SEC_CONN_PHASE1_CMPLT_EVT",
|
|
"SEC_CONN_CALC_NC_EVT",
|
|
"SEC_CONN_DISPLAY_NC_EVT",
|
|
"SEC_CONN_OK_EVT",
|
|
"SEC_CONN_2_DHCK_CHECKS_PRESENT_EVT",
|
|
"SEC_CONN_KEY_READY_EVT",
|
|
"KEYPRESS_NOTIFICATION_EVT",
|
|
"SEC_CONN_OOB_DATA_EVT",
|
|
"CREATE_LOCAL_SEC_CONN_OOB_DATA_EVT",
|
|
"OUT_OF_RANGE_EVT"
|
|
};
|
|
|
|
const char *smp_get_event_name(tSMP_EVENT event);
|
|
const char *smp_get_state_name(tSMP_STATE state);
|
|
|
|
#define SMP_SM_IGNORE 0
|
|
#define SMP_NUM_ACTIONS 2
|
|
#define SMP_SME_NEXT_STATE 2
|
|
#define SMP_SM_NUM_COLS 3
|
|
|
|
typedef const UINT8(*tSMP_SM_TBL)[SMP_SM_NUM_COLS];
|
|
|
|
enum {
|
|
SMP_PROC_SEC_REQ,
|
|
SMP_SEND_PAIR_REQ,
|
|
SMP_SEND_PAIR_RSP,
|
|
SMP_SEND_CONFIRM,
|
|
SMP_SEND_PAIR_FAIL,
|
|
SMP_SEND_RAND,
|
|
SMP_SEND_ENC_INFO,
|
|
SMP_SEND_ID_INFO,
|
|
SMP_SEND_LTK_REPLY,
|
|
SMP_PROC_PAIR_CMD,
|
|
SMP_PROC_PAIR_FAIL,
|
|
SMP_PROC_CONFIRM,
|
|
SMP_PROC_RAND,
|
|
SMP_PROC_ENC_INFO,
|
|
SMP_PROC_MASTER_ID,
|
|
SMP_PROC_ID_INFO,
|
|
SMP_PROC_ID_ADDR,
|
|
SMP_PROC_SRK_INFO,
|
|
SMP_PROC_SEC_GRANT,
|
|
SMP_PROC_SL_KEY,
|
|
SMP_PROC_COMPARE,
|
|
SMP_PROC_IO_RSP,
|
|
SMP_GENERATE_COMPARE,
|
|
SMP_GENERATE_CONFIRM,
|
|
SMP_GENERATE_STK,
|
|
SMP_KEY_DISTRIBUTE,
|
|
SMP_START_ENC,
|
|
SMP_PAIRING_CMPL,
|
|
SMP_DECIDE_ASSO_MODEL,
|
|
SMP_SEND_APP_CBACK,
|
|
SMP_CHECK_AUTH_REQ,
|
|
SMP_PAIR_TERMINATE,
|
|
SMP_ENC_CMPL,
|
|
SMP_PROC_DISCARD,
|
|
SMP_CREATE_PRIVATE_KEY,
|
|
SMP_USE_OOB_PRIVATE_KEY,
|
|
SMP_SEND_PAIR_PUBLIC_KEY,
|
|
SMP_PROCESS_PAIR_PUBLIC_KEY,
|
|
SMP_HAVE_BOTH_PUBLIC_KEYS,
|
|
SMP_START_SEC_CONN_PHASE1,
|
|
SMP_PROCESS_LOCAL_NONCE,
|
|
SMP_SEND_COMMITMENT,
|
|
SMP_PROCESS_PAIRING_COMMITMENT,
|
|
SMP_PROCESS_PEER_NONCE,
|
|
SMP_CALCULATE_LOCAL_DHKEY_CHECK,
|
|
SMP_SEND_DHKEY_CHECK,
|
|
SMP_PROCESS_DHKEY_CHECK,
|
|
SMP_CALCULATE_PEER_DHKEY_CHECK,
|
|
SMP_MATCH_DHKEY_CHECKS,
|
|
SMP_CALCULATE_NUMERIC_COMPARISON_DISPLAY_NUMBER,
|
|
SMP_MOVE_TO_SEC_CONN_PHASE2,
|
|
SMP_PH2_DHKEY_CHECKS_ARE_PRESENT,
|
|
SMP_WAIT_FOR_BOTH_PUBLIC_KEYS,
|
|
SMP_START_PASSKEY_VERIFICATION,
|
|
SMP_SEND_KEYPRESS_NOTIFICATION,
|
|
SMP_PROCESS_KEYPRESS_NOTIFICATION,
|
|
SMP_PROCESS_SECURE_CONNECTION_OOB_DATA,
|
|
SMP_SET_LOCAL_OOB_KEYS,
|
|
SMP_SET_LOCAL_OOB_RAND_COMMITMENT,
|
|
SMP_IDLE_TERMINATE,
|
|
SMP_FAST_CONN_PARAM,
|
|
SMP_SM_NO_ACTION
|
|
};
|
|
|
|
#if (BLE_INCLUDED == TRUE)
|
|
static const tSMP_ACT smp_sm_action[SMP_SM_NO_ACTION] = {
|
|
smp_proc_sec_req,
|
|
smp_send_pair_req,
|
|
smp_send_pair_rsp,
|
|
smp_send_confirm,
|
|
smp_send_pair_fail,
|
|
smp_send_rand,
|
|
smp_send_enc_info,
|
|
smp_send_id_info,
|
|
smp_send_ltk_reply,
|
|
smp_proc_pair_cmd,
|
|
smp_proc_pair_fail,
|
|
smp_proc_confirm,
|
|
smp_proc_rand,
|
|
smp_proc_enc_info,
|
|
smp_proc_master_id,
|
|
smp_proc_id_info,
|
|
smp_proc_id_addr,
|
|
smp_proc_srk_info,
|
|
smp_proc_sec_grant,
|
|
smp_proc_sl_key,
|
|
smp_proc_compare,
|
|
smp_process_io_response,
|
|
smp_generate_compare,
|
|
smp_generate_srand_mrand_confirm,
|
|
smp_generate_stk,
|
|
smp_key_distribution,
|
|
smp_start_enc,
|
|
smp_pairing_cmpl,
|
|
smp_decide_association_model,
|
|
smp_send_app_cback,
|
|
smp_check_auth_req,
|
|
smp_pair_terminate,
|
|
smp_enc_cmpl,
|
|
smp_proc_discard,
|
|
smp_create_private_key,
|
|
smp_use_oob_private_key,
|
|
smp_send_pair_public_key,
|
|
smp_process_pairing_public_key,
|
|
smp_both_have_public_keys,
|
|
smp_start_secure_connection_phase1,
|
|
smp_process_local_nonce,
|
|
smp_send_commitment,
|
|
smp_process_pairing_commitment,
|
|
smp_process_peer_nonce,
|
|
smp_calculate_local_dhkey_check,
|
|
smp_send_dhkey_check,
|
|
smp_process_dhkey_check,
|
|
smp_calculate_peer_dhkey_check,
|
|
smp_match_dhkey_checks,
|
|
smp_calculate_numeric_comparison_display_number,
|
|
smp_move_to_secure_connections_phase2,
|
|
smp_phase_2_dhkey_checks_are_present,
|
|
smp_wait_for_both_public_keys,
|
|
smp_start_passkey_verification,
|
|
smp_send_keypress_notification,
|
|
smp_process_keypress_notification,
|
|
smp_process_secure_connection_oob_data,
|
|
smp_set_local_oob_keys,
|
|
smp_set_local_oob_random_commitment,
|
|
smp_idle_terminate,
|
|
smp_fast_conn_param
|
|
};
|
|
#else
|
|
static const tSMP_ACT smp_sm_action[SMP_SM_NO_ACTION] = {NULL};
|
|
#endif ///BLE_INCLUDED == TRUE
|
|
|
|
/************ SMP Master FSM State/Event Indirection Table **************/
|
|
static const UINT8 smp_master_entry_map[][SMP_STATE_MAX] = {
|
|
/* state name: Idle WaitApp SecReq Pair Wait Confirm Rand PublKey SCPhs1 Wait Wait SCPhs2 Wait DHKChk Enc Bond CrLocSc
|
|
Rsp Pend ReqRsp Cfm Exch Strt Cmtm Nonce Strt DHKChk Pend Pend OobData */
|
|
/* PAIR_REQ */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_RSP */{ 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* CONFIRM */{ 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* RAND */{ 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_FAIL */{ 0, 0x81, 0, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0, 0x81, 0 },
|
|
/* ENC_INFO */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0 },
|
|
/* MASTER_ID */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 4, 0 },
|
|
/* ID_INFO */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2, 0 },
|
|
/* ID_ADDR */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 5, 0 },
|
|
/* SIGN_INFO */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3, 0 },
|
|
/* SEC_REQ */{ 2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_PUBLIC_KEY */{ 0, 0, 0, 0, 0, 0, 0, 2, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_DHKEY_CHCK */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0 },
|
|
/* PAIR_KEYPR_NOTIF */{ 0, 8, 0, 0, 0, 0, 0, 0, 5, 2, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_COMMITM */{ 0, 0, 0, 0, 0, 0, 0, 0, 6, 1, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* KEY_READY */{ 0, 3, 0, 3, 1, 0, 2, 0, 4, 0, 0, 0, 0, 0, 1, 6, 0 },
|
|
/* ENC_CMPL */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2, 0, 0 },
|
|
/* L2C_CONN */{ 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* L2C_DISC */{ 3, 0x83, 0, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0 },
|
|
/* IO_RSP */{ 0, 2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SEC_GRANT */{ 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* TK_REQ */{ 0, 0, 0, 2, 0, 0, 0, 0, 3, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* AUTH_CMPL */{ 4, 0x82, 0, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0 },
|
|
/* ENC_REQ */{ 0, 4, 0, 0, 0, 0, 3, 0, 0, 0, 0, 0, 0, 2, 0, 0, 0 },
|
|
/* BOND_REQ */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3, 0, 0 },
|
|
/* DISCARD_SEC_REQ */{ 0, 5, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3, 0, 0 },
|
|
/* PUBL_KEY_EXCH_REQ */{ 0, 0, 0, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* LOC_PUBL_KEY_CRTD */{ 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 1 },
|
|
/* BOTH_PUBL_KEYS_RCVD */{ 0, 0, 0, 0, 0, 0, 0, 3, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_DHKEY_CMPLT */{ 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* HAVE_LOC_NONCE */{ 0, 0, 0, 0, 0, 0, 0, 0, 2, 0, 0, 0, 0, 0, 0, 0, 2 },
|
|
/* SC_PHASE1_CMPLT */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0 },
|
|
/* SC_CALC_NC */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_DSPL_NC */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_NC_OK */{ 0, 6, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_2_DHCK_CHKS_PRES */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_KEY_READY */{ 0, 7, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0 },
|
|
/* KEYPR_NOTIF */{ 0, 9, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_OOB_DATA */{ 0, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* CR_LOC_SC_OOB_DATA */{ 5, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
};
|
|
|
|
static const UINT8 smp_all_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* PAIR_FAIL */ {SMP_PROC_PAIR_FAIL, SMP_PAIRING_CMPL, SMP_STATE_IDLE},
|
|
/* AUTH_CMPL */ {SMP_SEND_PAIR_FAIL, SMP_PAIRING_CMPL, SMP_STATE_IDLE},
|
|
/* L2C_DISC */ {SMP_PAIR_TERMINATE, SMP_SM_NO_ACTION, SMP_STATE_IDLE}
|
|
};
|
|
|
|
static const UINT8 smp_master_idle_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* L2C_CONN */ {SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* SEC_REQ */ {SMP_PROC_SEC_REQ, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_APP_RSP},
|
|
/* L2C_DISC */ {SMP_IDLE_TERMINATE, SMP_SM_NO_ACTION, SMP_STATE_IDLE},
|
|
/* AUTH_CMPL */ {SMP_PAIRING_CMPL, SMP_SM_NO_ACTION, SMP_STATE_IDLE}
|
|
/* CR_LOC_SC_OOB_DATA */ , {SMP_CREATE_PRIVATE_KEY, SMP_SM_NO_ACTION, SMP_STATE_CREATE_LOCAL_SEC_CONN_OOB_DATA}
|
|
|
|
};
|
|
|
|
static const UINT8 smp_master_wait_for_app_response_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* SEC_GRANT */ {SMP_PROC_SEC_GRANT, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_APP_RSP},
|
|
/* IO_RSP */ {SMP_SEND_PAIR_REQ, SMP_FAST_CONN_PARAM, SMP_STATE_PAIR_REQ_RSP},
|
|
|
|
/* TK ready */
|
|
/* KEY_READY */ {SMP_GENERATE_CONFIRM, SMP_SM_NO_ACTION, SMP_STATE_WAIT_CONFIRM},
|
|
|
|
/* start enc mode setup */
|
|
/* ENC_REQ */ { SMP_START_ENC, SMP_FAST_CONN_PARAM, SMP_STATE_ENCRYPTION_PENDING},
|
|
/* DISCARD_SEC_REQ */ { SMP_PROC_DISCARD, SMP_SM_NO_ACTION, SMP_STATE_IDLE}
|
|
/* user confirms NC 'OK', i.e. phase 1 is completed */
|
|
/* SC_NC_OK */, { SMP_MOVE_TO_SEC_CONN_PHASE2, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS2_START},
|
|
/* user-provided passkey is rcvd */
|
|
/* SC_KEY_READY */ { SMP_START_PASSKEY_VERIFICATION, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/* PAIR_KEYPR_NOTIF */ { SMP_PROCESS_KEYPRESS_NOTIFICATION, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_APP_RSP},
|
|
/* KEYPR_NOTIF */ { SMP_SEND_KEYPRESS_NOTIFICATION, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* SC_OOB_DATA */ { SMP_USE_OOB_PRIVATE_KEY, SMP_SM_NO_ACTION, SMP_STATE_PUBLIC_KEY_EXCH}
|
|
};
|
|
|
|
static const UINT8 smp_master_pair_request_response_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* PAIR_RSP */ { SMP_PROC_PAIR_CMD, SMP_SM_NO_ACTION, SMP_STATE_PAIR_REQ_RSP},
|
|
/* TK_REQ */ { SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
|
|
/* TK ready */
|
|
/* KEY_READY */{ SMP_GENERATE_CONFIRM, SMP_SM_NO_ACTION, SMP_STATE_WAIT_CONFIRM}
|
|
/* PUBL_KEY_EXCH_REQ */, { SMP_CREATE_PRIVATE_KEY, SMP_SM_NO_ACTION, SMP_STATE_PUBLIC_KEY_EXCH}
|
|
};
|
|
|
|
static const UINT8 smp_master_wait_for_confirm_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* KEY_READY*/ {SMP_SEND_CONFIRM, SMP_SM_NO_ACTION, SMP_STATE_CONFIRM}/* CONFIRM ready */
|
|
};
|
|
|
|
static const UINT8 smp_master_confirm_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* CONFIRM */ { SMP_PROC_CONFIRM, SMP_SEND_RAND, SMP_STATE_RAND}
|
|
};
|
|
|
|
static const UINT8 smp_master_rand_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* RAND */ { SMP_PROC_RAND, SMP_GENERATE_COMPARE, SMP_STATE_RAND},
|
|
/* KEY_READY*/ { SMP_PROC_COMPARE, SMP_SM_NO_ACTION, SMP_STATE_RAND}, /* Compare ready */
|
|
/* ENC_REQ */ { SMP_GENERATE_STK, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING}
|
|
};
|
|
|
|
static const UINT8 smp_master_public_key_exchange_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* LOC_PUBL_KEY_CRTD */{ SMP_SEND_PAIR_PUBLIC_KEY, SMP_SM_NO_ACTION, SMP_STATE_PUBLIC_KEY_EXCH},
|
|
/* PAIR_PUBLIC_KEY */{ SMP_PROCESS_PAIR_PUBLIC_KEY, SMP_SM_NO_ACTION, SMP_STATE_PUBLIC_KEY_EXCH},
|
|
/* BOTH_PUBL_KEYS_RCVD */{ SMP_HAVE_BOTH_PUBLIC_KEYS, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
};
|
|
|
|
static const UINT8 smp_master_sec_conn_phs1_start_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* SC_DHKEY_CMPLT */{ SMP_START_SEC_CONN_PHASE1, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/* HAVE_LOC_NONCE */{ SMP_PROCESS_LOCAL_NONCE, SMP_SM_NO_ACTION, SMP_STATE_WAIT_COMMITMENT},
|
|
/* TK_REQ */{ SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* SMP_MODEL_SEC_CONN_PASSKEY_DISP model, passkey is sent up to display,*/
|
|
/* It's time to start commitment calculation */
|
|
/* KEY_READY */{ SMP_START_PASSKEY_VERIFICATION, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/* PAIR_KEYPR_NOTIF */{ SMP_PROCESS_KEYPRESS_NOTIFICATION, SMP_SEND_APP_CBACK, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/* PAIR_COMMITM */{ SMP_PROCESS_PAIRING_COMMITMENT, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
};
|
|
|
|
static const UINT8 smp_master_wait_commitment_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* PAIR_COMMITM */{ SMP_PROCESS_PAIRING_COMMITMENT, SMP_SEND_RAND, SMP_STATE_WAIT_NONCE},
|
|
/* PAIR_KEYPR_NOTIF */{ SMP_PROCESS_KEYPRESS_NOTIFICATION, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_COMMITMENT},
|
|
};
|
|
|
|
static const UINT8 smp_master_wait_nonce_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* peer nonce is received */
|
|
/* RAND */{SMP_PROC_RAND, SMP_PROCESS_PEER_NONCE, SMP_STATE_SEC_CONN_PHS2_START},
|
|
/* NC model, time to calculate number for NC */
|
|
/* SC_CALC_NC */{SMP_CALCULATE_NUMERIC_COMPARISON_DISPLAY_NUMBER, SMP_SM_NO_ACTION, SMP_STATE_WAIT_NONCE},
|
|
/* NC model, time to display calculated number for NC to the user */
|
|
/* SC_DSPL_NC */{SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
};
|
|
|
|
static const UINT8 smp_master_sec_conn_phs2_start_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* SC_PHASE1_CMPLT */{SMP_CALCULATE_LOCAL_DHKEY_CHECK, SMP_SEND_DHKEY_CHECK, SMP_STATE_WAIT_DHK_CHECK},
|
|
};
|
|
|
|
static const UINT8 smp_master_wait_dhk_check_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* PAIR_DHKEY_CHCK */{SMP_PROCESS_DHKEY_CHECK, SMP_CALCULATE_PEER_DHKEY_CHECK, SMP_STATE_DHK_CHECK},
|
|
};
|
|
|
|
static const UINT8 smp_master_dhk_check_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* locally calculated peer dhkey check is ready -> compare it withs DHKey Check actually received from peer */
|
|
/* SC_KEY_READY */{SMP_MATCH_DHKEY_CHECKS, SMP_SM_NO_ACTION, SMP_STATE_DHK_CHECK},
|
|
/* locally calculated peer dhkey check is ready -> calculate STK, go to sending */
|
|
/* HCI LE Start Encryption command */
|
|
/* ENC_REQ */{SMP_GENERATE_STK, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING},
|
|
};
|
|
|
|
static const UINT8 smp_master_enc_pending_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* STK ready */
|
|
/* KEY_READY */ { SMP_START_ENC, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING},
|
|
/* ENCRYPTED */ { SMP_CHECK_AUTH_REQ, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING},
|
|
/* BOND_REQ */ { SMP_KEY_DISTRIBUTE, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING}
|
|
};
|
|
static const UINT8 smp_master_bond_pending_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* ENC_INFO */ { SMP_PROC_ENC_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* ID_INFO */ { SMP_PROC_ID_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* SIGN_INFO*/ { SMP_PROC_SRK_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* MASTER_ID*/ { SMP_PROC_MASTER_ID, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* ID_ADDR */ { SMP_PROC_ID_ADDR, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* KEY_READY */{SMP_SEND_ENC_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING} /* LTK ready */
|
|
};
|
|
|
|
static const UINT8 smp_master_create_local_sec_conn_oob_data[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* LOC_PUBL_KEY_CRTD */ {SMP_SET_LOCAL_OOB_KEYS, SMP_SM_NO_ACTION, SMP_STATE_CREATE_LOCAL_SEC_CONN_OOB_DATA},
|
|
/* HAVE_LOC_NONCE */ {SMP_SET_LOCAL_OOB_RAND_COMMITMENT, SMP_SM_NO_ACTION, SMP_STATE_IDLE}
|
|
};
|
|
|
|
|
|
/************ SMP Slave FSM State/Event Indirection Table **************/
|
|
static const UINT8 smp_slave_entry_map[][SMP_STATE_MAX] = {
|
|
/* state name: Idle WaitApp SecReq Pair Wait Confirm Rand PublKey SCPhs1 Wait Wait SCPhs2 Wait DHKChk Enc Bond CrLocSc
|
|
Rsp Pend ReqRsp Cfm Exch Strt Cmtm Nonce Strt DHKChk Pend Pend OobData */
|
|
/* PAIR_REQ */{ 2, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_RSP */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* CONFIRM */{ 0, 4, 0, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* RAND */{ 0, 0, 0, 0, 0, 1, 2, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_FAIL */{ 0, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0x81, 0, 0 },
|
|
/* ENC_INFO */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3, 0 },
|
|
/* MASTER_ID */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 5, 0 },
|
|
/* ID_INFO */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 4, 0 },
|
|
/* ID_ADDR */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 6, 0 },
|
|
/* SIGN_INFO */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2, 0 },
|
|
/* SEC_REQ */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_PUBLIC_KEY */{ 0, 0, 0, 5, 0, 0, 0, 2, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_DHKEY_CHCK */{ 0, 5, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2, 1, 2, 0, 0, 0 },
|
|
/* PAIR_KEYPR_NOTIF */{ 0, 9, 0, 0, 0, 0, 0, 0, 5, 2, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PAIR_COMMITM */{ 0, 8, 0, 0, 0, 0, 0, 0, 6, 1, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* KEY_READY */{ 0, 3, 0, 3, 2, 2, 1, 0, 4, 0, 0, 0, 0, 0, 2, 1, 0 },
|
|
/* ENC_CMPL */{ 0, 0, 2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3, 0, 0 },
|
|
/* L2C_CONN */{ 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* L2C_DISC */{ 0, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0x83, 0 },
|
|
/* IO_RSP */{ 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SEC_GRANT */{ 0, 2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* TK_REQ */{ 0, 0, 0, 2, 0, 0, 0, 0, 3, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* AUTH_CMPL */{ 0, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0x82, 0 },
|
|
/* ENC_REQ */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0 },
|
|
/* BOND_REQ */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 4, 0, 0 },
|
|
/* DISCARD_SEC_REQ */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* PUBL_KEY_EXCH_REQ */{ 0, 0, 0, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* LOC_PUBL_KEY_CRTD */{ 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 1 },
|
|
/* BOTH_PUBL_KEYS_RCVD */{ 0, 0, 0, 0, 0, 0, 0, 3, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_DHKEY_CMPLT */{ 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* HAVE_LOC_NONCE */{ 0, 0, 0, 0, 0, 0, 0, 0, 2, 0, 0, 0, 0, 0, 0, 0, 2 },
|
|
/* SC_PHASE1_CMPLT */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 0 },
|
|
/* SC_CALC_NC */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_DSPL_NC */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 3, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_NC_OK */{ 0, 6, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_2_DHCK_CHKS_PRES */{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 2, 0, 0, 0, 0 },
|
|
/* SC_KEY_READY */{ 0, 7, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 0, 0 },
|
|
/* KEYPR_NOTIF */{ 0, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* SC_OOB_DATA */{ 0, 11, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
/* CR_LOC_SC_OOB_DATA */{ 3, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 },
|
|
};
|
|
|
|
static const UINT8 smp_slave_idle_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* L2C_CONN */ {SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* PAIR_REQ */ {SMP_PROC_PAIR_CMD, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_APP_RSP}
|
|
/* CR_LOC_SC_OOB_DATA */ , {SMP_CREATE_PRIVATE_KEY, SMP_SM_NO_ACTION, SMP_STATE_CREATE_LOCAL_SEC_CONN_OOB_DATA}
|
|
};
|
|
|
|
static const UINT8 smp_slave_wait_for_app_response_table [][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* IO_RSP */ {SMP_PROC_IO_RSP, SMP_FAST_CONN_PARAM, SMP_STATE_PAIR_REQ_RSP},
|
|
/* SEC_GRANT */ {SMP_PROC_SEC_GRANT, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_APP_RSP},
|
|
|
|
/* TK ready */
|
|
/* KEY_READY */ {SMP_PROC_SL_KEY, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* CONFIRM */ {SMP_PROC_CONFIRM, SMP_SM_NO_ACTION, SMP_STATE_CONFIRM}
|
|
/* DHKey Check from master is received before phase 1 is completed - race */
|
|
/* PAIR_DHKEY_CHCK */, {SMP_PROCESS_DHKEY_CHECK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* user confirms NC 'OK', i.e. phase 1 is completed */
|
|
/* SC_NC_OK */ {SMP_MOVE_TO_SEC_CONN_PHASE2, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS2_START},
|
|
/* user-provided passkey is rcvd */
|
|
/* SC_KEY_READY */ {SMP_START_PASSKEY_VERIFICATION, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/* PAIR_COMMITM */ {SMP_PROCESS_PAIRING_COMMITMENT, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* PAIR_KEYPR_NOTIF */ {SMP_PROCESS_KEYPRESS_NOTIFICATION, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_APP_RSP},
|
|
/* KEYPR_NOTIF */ {SMP_SEND_KEYPRESS_NOTIFICATION, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* SC_OOB_DATA */ {SMP_SEND_PAIR_RSP, SMP_SM_NO_ACTION, SMP_STATE_PAIR_REQ_RSP},
|
|
};
|
|
|
|
static const UINT8 smp_slave_sec_request_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* PAIR_REQ */{SMP_PROC_PAIR_CMD, SMP_SM_NO_ACTION, SMP_STATE_PAIR_REQ_RSP},
|
|
/* ENCRYPTED*/{SMP_ENC_CMPL, SMP_SM_NO_ACTION, SMP_STATE_PAIR_REQ_RSP},
|
|
};
|
|
|
|
static const UINT8 smp_slave_pair_request_response_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* CONFIRM */ {SMP_PROC_CONFIRM, SMP_SM_NO_ACTION, SMP_STATE_CONFIRM},
|
|
/* TK_REQ */ {SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* TK/Confirm ready */
|
|
/* KEY_READY */{SMP_PROC_SL_KEY, SMP_SM_NO_ACTION, SMP_STATE_PAIR_REQ_RSP}
|
|
/* PUBL_KEY_EXCH_REQ */, { SMP_CREATE_PRIVATE_KEY, SMP_SM_NO_ACTION, SMP_STATE_PUBLIC_KEY_EXCH},
|
|
/* PAIR_PUBLIC_KEY */ { SMP_PROCESS_PAIR_PUBLIC_KEY, SMP_SM_NO_ACTION, SMP_STATE_PAIR_REQ_RSP},
|
|
};
|
|
|
|
static const UINT8 smp_slave_wait_confirm_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* CONFIRM */ {SMP_PROC_CONFIRM, SMP_SEND_CONFIRM, SMP_STATE_CONFIRM},
|
|
/* KEY_READY*/ {SMP_PROC_SL_KEY, SMP_SM_NO_ACTION, SMP_STATE_WAIT_CONFIRM}
|
|
};
|
|
|
|
static const UINT8 smp_slave_confirm_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* RAND */ {SMP_PROC_RAND, SMP_GENERATE_COMPARE, SMP_STATE_RAND},
|
|
|
|
/* TK/Confirm ready */
|
|
/* KEY_READY*/ {SMP_PROC_SL_KEY, SMP_SM_NO_ACTION, SMP_STATE_CONFIRM}
|
|
};
|
|
|
|
static const UINT8 smp_slave_rand_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* KEY_READY */ {SMP_PROC_COMPARE, SMP_SM_NO_ACTION, SMP_STATE_RAND}, /* compare match */
|
|
/* RAND */ {SMP_SEND_RAND, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING}
|
|
};
|
|
|
|
static const UINT8 smp_slave_public_key_exch_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* LOC_PUBL_KEY_CRTD */{ SMP_WAIT_FOR_BOTH_PUBLIC_KEYS, SMP_SM_NO_ACTION, SMP_STATE_PUBLIC_KEY_EXCH},
|
|
/* PAIR_PUBLIC_KEY */{ SMP_PROCESS_PAIR_PUBLIC_KEY, SMP_SM_NO_ACTION, SMP_STATE_PUBLIC_KEY_EXCH},
|
|
/* BOTH_PUBL_KEYS_RCVD */{ SMP_HAVE_BOTH_PUBLIC_KEYS, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
};
|
|
|
|
static const UINT8 smp_slave_sec_conn_phs1_start_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* SC_DHKEY_CMPLT */{ SMP_START_SEC_CONN_PHASE1, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/* HAVE_LOC_NONCE */{ SMP_PROCESS_LOCAL_NONCE, SMP_SM_NO_ACTION, SMP_STATE_WAIT_COMMITMENT},
|
|
/* TK_REQ */{ SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
/* SMP_MODEL_SEC_CONN_PASSKEY_DISP model, passkey is sent up to display, it's time to start */
|
|
/* commitment calculation */
|
|
/* KEY_READY */{ SMP_START_PASSKEY_VERIFICATION, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/* PAIR_KEYPR_NOTIF */{ SMP_PROCESS_KEYPRESS_NOTIFICATION, SMP_SEND_APP_CBACK, SMP_STATE_SEC_CONN_PHS1_START},
|
|
/*COMMIT*/{SMP_PROCESS_PAIRING_COMMITMENT, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS1_START},
|
|
};
|
|
|
|
static const UINT8 smp_slave_wait_commitment_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* PAIR_COMMITM */{SMP_PROCESS_PAIRING_COMMITMENT, SMP_SEND_COMMITMENT, SMP_STATE_WAIT_NONCE},
|
|
/* PAIR_KEYPR_NOTIF */{SMP_PROCESS_KEYPRESS_NOTIFICATION, SMP_SEND_APP_CBACK, SMP_STATE_WAIT_COMMITMENT},
|
|
};
|
|
|
|
static const UINT8 smp_slave_wait_nonce_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* peer nonce is received */
|
|
/* RAND */{SMP_PROC_RAND, SMP_PROCESS_PEER_NONCE, SMP_STATE_SEC_CONN_PHS2_START},
|
|
/* NC model, time to calculate number for NC */
|
|
/* SC_CALC_NC */{SMP_CALCULATE_NUMERIC_COMPARISON_DISPLAY_NUMBER, SMP_SM_NO_ACTION, SMP_STATE_WAIT_NONCE},
|
|
/* NC model, time to display calculated number for NC to the user */
|
|
/* SC_DSPL_NC */{SMP_SEND_APP_CBACK, SMP_SM_NO_ACTION, SMP_STATE_WAIT_APP_RSP},
|
|
};
|
|
|
|
static const UINT8 smp_slave_sec_conn_phs2_start_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* SC_PHASE1_CMPLT */{SMP_CALCULATE_LOCAL_DHKEY_CHECK, SMP_PH2_DHKEY_CHECKS_ARE_PRESENT, SMP_STATE_WAIT_DHK_CHECK},
|
|
/* DHKey Check from master is received before slave DHKey calculation is completed - race */
|
|
/* PAIR_DHKEY_CHCK */{SMP_PROCESS_DHKEY_CHECK, SMP_SM_NO_ACTION, SMP_STATE_SEC_CONN_PHS2_START},
|
|
};
|
|
|
|
static const UINT8 smp_slave_wait_dhk_check_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* PAIR_DHKEY_CHCK */{SMP_PROCESS_DHKEY_CHECK, SMP_CALCULATE_PEER_DHKEY_CHECK, SMP_STATE_DHK_CHECK},
|
|
/* DHKey Check from master was received before slave came to this state */
|
|
/* SC_2_DHCK_CHKS_PRES */{SMP_CALCULATE_PEER_DHKEY_CHECK, SMP_SM_NO_ACTION, SMP_STATE_DHK_CHECK},
|
|
};
|
|
|
|
static const UINT8 smp_slave_dhk_check_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
|
|
/* locally calculated peer dhkey check is ready -> compare it withs DHKey Check */
|
|
/* actually received from peer */
|
|
/* SC_KEY_READY */{SMP_MATCH_DHKEY_CHECKS, SMP_SM_NO_ACTION, SMP_STATE_DHK_CHECK},
|
|
|
|
/* dhkey checks match -> send local dhkey check to master, go to wait for HCI LE */
|
|
/* Long Term Key Request Event */
|
|
/* PAIR_DHKEY_CHCK */{SMP_SEND_DHKEY_CHECK, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING},
|
|
};
|
|
|
|
static const UINT8 smp_slave_enc_pending_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* ENC_REQ */ {SMP_GENERATE_STK, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING},
|
|
|
|
/* STK ready */
|
|
/* KEY_READY */ {SMP_SEND_LTK_REPLY, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING},
|
|
/* ENCRYPTED */ {SMP_CHECK_AUTH_REQ, SMP_SM_NO_ACTION, SMP_STATE_ENCRYPTION_PENDING},
|
|
/* BOND_REQ */ {SMP_KEY_DISTRIBUTE, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING}
|
|
};
|
|
static const UINT8 smp_slave_bond_pending_table[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
|
|
/* LTK ready */
|
|
/* KEY_READY */{ SMP_SEND_ENC_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
|
|
/* rev SRK */
|
|
/* SIGN_INFO */{ SMP_PROC_SRK_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* ENC_INFO */ { SMP_PROC_ENC_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* ID_INFO */ { SMP_PROC_ID_INFO, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* MASTER_ID*/ { SMP_PROC_MASTER_ID, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING},
|
|
/* ID_ADDR */ { SMP_PROC_ID_ADDR, SMP_SM_NO_ACTION, SMP_STATE_BOND_PENDING}
|
|
|
|
};
|
|
|
|
static const UINT8 smp_slave_create_local_sec_conn_oob_data[][SMP_SM_NUM_COLS] = {
|
|
/* Event Action Next State */
|
|
/* LOC_PUBL_KEY_CRTD */ {SMP_SET_LOCAL_OOB_KEYS, SMP_SM_NO_ACTION, SMP_STATE_CREATE_LOCAL_SEC_CONN_OOB_DATA},
|
|
/* HAVE_LOC_NONCE */ {SMP_SET_LOCAL_OOB_RAND_COMMITMENT, SMP_SM_NO_ACTION, SMP_STATE_IDLE}
|
|
};
|
|
|
|
static const tSMP_SM_TBL smp_state_table[][2] = {
|
|
/* SMP_STATE_IDLE */
|
|
{smp_master_idle_table, smp_slave_idle_table},
|
|
|
|
/* SMP_STATE_WAIT_APP_RSP */
|
|
{smp_master_wait_for_app_response_table, smp_slave_wait_for_app_response_table},
|
|
|
|
/* SMP_STATE_SEC_REQ_PENDING */
|
|
{NULL, smp_slave_sec_request_table},
|
|
|
|
/* SMP_STATE_PAIR_REQ_RSP */
|
|
{smp_master_pair_request_response_table, smp_slave_pair_request_response_table},
|
|
|
|
/* SMP_STATE_WAIT_CONFIRM */
|
|
{smp_master_wait_for_confirm_table, smp_slave_wait_confirm_table},
|
|
|
|
/* SMP_STATE_CONFIRM */
|
|
{smp_master_confirm_table, smp_slave_confirm_table},
|
|
|
|
/* SMP_STATE_RAND */
|
|
{smp_master_rand_table, smp_slave_rand_table},
|
|
|
|
/* SMP_STATE_PUBLIC_KEY_EXCH */
|
|
{smp_master_public_key_exchange_table, smp_slave_public_key_exch_table},
|
|
|
|
/* SMP_STATE_SEC_CONN_PHS1_START */
|
|
{smp_master_sec_conn_phs1_start_table, smp_slave_sec_conn_phs1_start_table},
|
|
|
|
/* SMP_STATE_WAIT_COMMITMENT */
|
|
{smp_master_wait_commitment_table, smp_slave_wait_commitment_table},
|
|
|
|
/* SMP_STATE_WAIT_NONCE */
|
|
{smp_master_wait_nonce_table, smp_slave_wait_nonce_table},
|
|
|
|
/* SMP_STATE_SEC_CONN_PHS2_START */
|
|
{smp_master_sec_conn_phs2_start_table, smp_slave_sec_conn_phs2_start_table},
|
|
|
|
/* SMP_STATE_WAIT_DHK_CHECK */
|
|
{smp_master_wait_dhk_check_table, smp_slave_wait_dhk_check_table},
|
|
|
|
/* SMP_STATE_DHK_CHECK */
|
|
{smp_master_dhk_check_table, smp_slave_dhk_check_table},
|
|
|
|
/* SMP_STATE_ENCRYPTION_PENDING */
|
|
{smp_master_enc_pending_table, smp_slave_enc_pending_table},
|
|
|
|
/* SMP_STATE_BOND_PENDING */
|
|
{smp_master_bond_pending_table, smp_slave_bond_pending_table},
|
|
|
|
/* SMP_STATE_CREATE_LOCAL_SEC_CONN_OOB_DATA */
|
|
{smp_master_create_local_sec_conn_oob_data, smp_slave_create_local_sec_conn_oob_data}
|
|
};
|
|
|
|
typedef const UINT8 (*tSMP_ENTRY_TBL)[SMP_STATE_MAX];
|
|
static const tSMP_ENTRY_TBL smp_entry_table[] = {
|
|
smp_master_entry_map,
|
|
smp_slave_entry_map
|
|
};
|
|
|
|
#if SMP_DYNAMIC_MEMORY == FALSE
|
|
tSMP_CB smp_cb;
|
|
#else
|
|
tSMP_CB *smp_cb_ptr;
|
|
#endif
|
|
#define SMP_ALL_TBL_MASK 0x80
|
|
|
|
/*******************************************************************************
|
|
** Function smp_set_state
|
|
** Returns None
|
|
*******************************************************************************/
|
|
void smp_set_state(tSMP_STATE state)
|
|
{
|
|
if (state < SMP_STATE_MAX) {
|
|
SMP_TRACE_DEBUG( "State change: %s(%d) ==> %s(%d)",
|
|
smp_get_state_name(smp_cb.state), smp_cb.state,
|
|
smp_get_state_name(state), state );
|
|
smp_cb.state = state;
|
|
} else {
|
|
SMP_TRACE_DEBUG("smp_set_state invalid state =%d", state );
|
|
}
|
|
}
|
|
|
|
/*******************************************************************************
|
|
** Function smp_get_state
|
|
** Returns The smp state
|
|
*******************************************************************************/
|
|
tSMP_STATE smp_get_state(void)
|
|
{
|
|
return smp_cb.state;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
**
|
|
** Function smp_sm_event
|
|
**
|
|
** Description Handle events to the state machine. It looks up the entry
|
|
** in the smp_entry_table array.
|
|
** If it is a valid entry, it gets the state table.Set the next state,
|
|
** if not NULL state.Execute the action function according to the
|
|
** state table. If the state returned by action function is not NULL
|
|
** state, adjust the new state to the returned state.If (api_evt != MAX),
|
|
** call callback function.
|
|
**
|
|
** Returns void.
|
|
**
|
|
*******************************************************************************/
|
|
void smp_sm_event(tSMP_CB *p_cb, tSMP_EVENT event, void *p_data)
|
|
{
|
|
UINT8 curr_state = p_cb->state;
|
|
tSMP_SM_TBL state_table;
|
|
UINT8 action, entry, i;
|
|
tSMP_ENTRY_TBL entry_table = smp_entry_table[p_cb->role];
|
|
|
|
SMP_TRACE_EVENT("main smp_sm_event\n");
|
|
if (curr_state >= SMP_STATE_MAX) {
|
|
SMP_TRACE_DEBUG( "Invalid state: %d\n", curr_state) ;
|
|
return;
|
|
}
|
|
|
|
SMP_TRACE_DEBUG( "SMP Role: %s State: [%s (%d)], Event: [%s (%d)]", \
|
|
(p_cb->role == 0x01) ? "Slave" : "Master\n", smp_get_state_name( p_cb->state),
|
|
p_cb->state, smp_get_event_name(event), event) ;
|
|
|
|
/* look up the state table for the current state */
|
|
/* lookup entry /w event & curr_state */
|
|
/* If entry is ignore, return.
|
|
* Otherwise, get state table (according to curr_state or all_state) */
|
|
if ((event <= SMP_MAX_EVT) && ( (entry = entry_table[event - 1][curr_state]) != SMP_SM_IGNORE )) {
|
|
if (entry & SMP_ALL_TBL_MASK) {
|
|
entry &= ~SMP_ALL_TBL_MASK;
|
|
state_table = smp_all_table;
|
|
} else {
|
|
state_table = smp_state_table[curr_state][p_cb->role ? 1 : 0];
|
|
}
|
|
} else {
|
|
SMP_TRACE_DEBUG( "Ignore event [%s (%d)] in state [%s (%d)]\n",
|
|
smp_get_event_name(event), event, smp_get_state_name(curr_state),
|
|
curr_state);
|
|
return;
|
|
}
|
|
|
|
/* Get possible next state from state table. */
|
|
|
|
smp_set_state(state_table[entry - 1][SMP_SME_NEXT_STATE]);
|
|
|
|
/* If action is not ignore, clear param, exec action and get next state.
|
|
* The action function may set the Param for cback.
|
|
* Depending on param, call cback or free buffer. */
|
|
/* execute action */
|
|
/* execute action functions */
|
|
for (i = 0; i < SMP_NUM_ACTIONS; i++) {
|
|
if ((action = state_table[entry - 1][i]) != SMP_SM_NO_ACTION && smp_sm_action[action] != NULL) {
|
|
(*smp_sm_action[action])(p_cb, (tSMP_INT_DATA *)p_data);
|
|
} else {
|
|
break;
|
|
}
|
|
}
|
|
SMP_TRACE_DEBUG( "result state = %s\n", smp_get_state_name( p_cb->state ) ) ;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
** Function smp_get_state_name
|
|
** Returns The smp state name.
|
|
*******************************************************************************/
|
|
const char *smp_get_state_name(tSMP_STATE state)
|
|
{
|
|
const char *p_str = smp_state_name[SMP_STATE_MAX];
|
|
|
|
if (state < SMP_STATE_MAX) {
|
|
p_str = smp_state_name[state];
|
|
}
|
|
return p_str;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
** Function smp_get_event_name
|
|
** Returns The smp event name.
|
|
*******************************************************************************/
|
|
const char *smp_get_event_name(tSMP_EVENT event)
|
|
{
|
|
const char *p_str = smp_event_name[SMP_MAX_EVT];
|
|
|
|
if (event <= SMP_MAX_EVT) {
|
|
p_str = smp_event_name[event - 1];
|
|
}
|
|
return p_str;
|
|
}
|
|
|
|
#endif
|