void
ble_sm_sc_confirm_exec(struct ble_sm_proc *proc, struct ble_sm_result *res)
{
struct ble_sm_pair_confirm cmd;
int rc;
rc = ble_sm_sc_gen_ri(proc);
if (rc != 0) {
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
return;
}
rc = ble_sm_alg_f4(ble_sm_sc_pub_key.u8, proc->pub_key_peer.x,
ble_sm_our_pair_rand(proc), proc->ri, cmd.value);
if (rc != 0) {
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
return;
}
rc = ble_sm_pair_confirm_tx(proc->conn_handle, &cmd);
if (rc != 0) {
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
return;
}
if (!(proc->flags & BLE_SM_PROC_F_INITIATOR)) {
proc->state = BLE_SM_PROC_STATE_RANDOM;
}
}
void
ble_sm_sc_dhkey_check_exec(struct ble_sm_proc *proc, struct ble_sm_result *res,
void *arg)
{
struct ble_sm_dhkey_check cmd;
const uint8_t *our_ota_addr;
const uint8_t *peer_ota_addr;
uint8_t peer_id_addr_type;
uint8_t our_id_addr_type;
uint8_t iocap[3];
int rc;
if (proc->flags & BLE_SM_PROC_F_INITIATOR) {
ble_sm_sc_dhkey_check_iocap(&proc->pair_req, iocap);
} else {
ble_sm_sc_dhkey_check_iocap(&proc->pair_rsp, iocap);
}
ble_sm_sc_dhkey_addrs(proc,
&our_id_addr_type, &our_ota_addr,
&peer_id_addr_type, &peer_ota_addr);
rc = ble_sm_alg_f6(proc->mackey, ble_sm_our_pair_rand(proc),
ble_sm_peer_pair_rand(proc), proc->tk, iocap,
our_id_addr_type, our_ota_addr,
peer_id_addr_type, peer_ota_addr,
cmd.value);
if (rc != 0) {
goto err;
}
rc = ble_sm_dhkey_check_tx(proc->conn_handle, &cmd);
if (rc != 0) {
goto err;
}
if (!(proc->flags & BLE_SM_PROC_F_INITIATOR)) {
proc->state = BLE_SM_PROC_STATE_LTK_START;
}
return;
err:
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
}
/**
* Advances the supplied procedure object to the next state after it has
* completed the random state.
*/
static int
ble_sm_sc_random_advance(struct ble_sm_proc *proc)
{
int rc;
if (proc->pair_alg != BLE_SM_PAIR_ALG_PASSKEY ||
proc->passkey_bits_exchanged >= BLE_SM_SC_PASSKEY_BITS) {
proc->state = BLE_SM_PROC_STATE_DHKEY_CHECK;
} else {
proc->state = BLE_SM_PROC_STATE_CONFIRM;
rc = ble_sm_gen_pair_rand(ble_sm_our_pair_rand(proc));
if (rc != 0) {
return rc;
}
}
return 0;
}
void
ble_sm_lgcy_random_exec(struct ble_sm_proc *proc, struct ble_sm_result *res)
{
struct ble_sm_pair_random cmd;
int rc;
memcpy(cmd.value, ble_sm_our_pair_rand(proc), 16);
rc = ble_sm_pair_random_tx(proc->conn_handle, &cmd);
if (rc != 0) {
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
return;
}
if (!(proc->flags & BLE_SM_PROC_F_INITIATOR)) {
proc->state = BLE_SM_PROC_STATE_LTK_START;
}
}
void
ble_sm_lgcy_confirm_exec(struct ble_sm_proc *proc, struct ble_sm_result *res)
{
struct ble_sm_pair_confirm cmd;
uint8_t preq[BLE_SM_HDR_SZ + BLE_SM_PAIR_CMD_SZ];
uint8_t pres[BLE_SM_HDR_SZ + BLE_SM_PAIR_CMD_SZ];
uint8_t k[16];
uint8_t ia[6];
uint8_t ra[6];
uint8_t iat;
uint8_t rat;
int rc;
rc = ble_sm_lgcy_confirm_prepare_args(proc, k, preq, pres,
&iat, &rat, ia, ra);
if (rc != 0) {
goto err;
}
rc = ble_sm_alg_c1(k, ble_sm_our_pair_rand(proc),
preq, pres, iat, rat, ia, ra, cmd.value);
if (rc != 0) {
goto err;
}
rc = ble_sm_pair_confirm_tx(proc->conn_handle, &cmd);
if (rc != 0) {
goto err;
}
if (!(proc->flags & BLE_SM_PROC_F_INITIATOR)) {
proc->state = BLE_SM_PROC_STATE_RANDOM;
}
return;
err:
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
}
void
ble_sm_sc_random_exec(struct ble_sm_proc *proc, struct ble_sm_result *res)
{
struct ble_sm_pair_random cmd;
uint8_t ioact;
int rc;
memcpy(cmd.value, ble_sm_our_pair_rand(proc), 16);
rc = ble_sm_pair_random_tx(proc->conn_handle, &cmd);
if (rc != 0) {
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
return;
}
if (!(proc->flags & BLE_SM_PROC_F_INITIATOR)) {
rc = ble_sm_sc_random_advance(proc);
if (rc != 0) {
res->app_status = rc;
res->enc_cb = 1;
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
return;
}
ioact = ble_sm_sc_io_action(proc);
if (ble_sm_ioact_state(ioact) == proc->state &&
!(proc->flags & BLE_SM_PROC_F_IO_INJECTED)) {
res->passkey_params.action = ioact;
BLE_HS_DBG_ASSERT(ioact == BLE_SM_IOACT_NUMCMP);
ble_sm_sc_gen_numcmp(proc, res);
}
}
}
static void
ble_sm_dhkey_check_process(struct ble_sm_proc *proc,
struct ble_sm_dhkey_check *cmd,
struct ble_sm_result *res)
{
uint8_t exp_value[16];
const uint8_t *peer_ota_addr;
const uint8_t *our_ota_addr;
uint8_t peer_id_addr_type;
uint8_t our_id_addr_type;
uint8_t iocap[3];
uint8_t ioact;
if (proc->flags & BLE_SM_PROC_F_INITIATOR) {
ble_sm_sc_dhkey_check_iocap(&proc->pair_rsp, iocap);
} else {
ble_sm_sc_dhkey_check_iocap(&proc->pair_req, iocap);
}
ble_sm_sc_dhkey_addrs(proc,
&our_id_addr_type,
&our_ota_addr,
&peer_id_addr_type,
&peer_ota_addr);
BLE_HS_LOG(DEBUG, "tk=");
ble_hs_log_flat_buf(proc->tk, 32);
BLE_HS_LOG(DEBUG, "\n");
res->app_status = ble_sm_alg_f6(proc->mackey,
ble_sm_peer_pair_rand(proc),
ble_sm_our_pair_rand(proc),
proc->tk, iocap,
peer_id_addr_type, peer_ota_addr,
our_id_addr_type, our_ota_addr,
exp_value);
if (res->app_status != 0) {
res->sm_err = BLE_SM_ERR_UNSPECIFIED;
res->enc_cb = 1;
return;
}
if (memcmp(cmd->value, exp_value, 16) != 0) {
/* Random number mismatch. */
res->sm_err = BLE_SM_ERR_DHKEY;
res->app_status = BLE_HS_SM_US_ERR(BLE_SM_ERR_DHKEY);
res->enc_cb = 1;
return;
}
ioact = ble_sm_sc_io_action(proc);
if (ble_sm_ioact_state(ioact) == proc->state) {
proc->flags |= BLE_SM_PROC_F_ADVANCE_ON_IO;
}
if (ble_sm_proc_can_advance(proc)) {
if (proc->flags & BLE_SM_PROC_F_INITIATOR) {
proc->state = BLE_SM_PROC_STATE_ENC_START;
}
res->execute = 1;
}
}
