uint32_t conn_mw_ble_gap_sec_params_reply(uint8_t const * const p_rx_buf, uint32_t rx_buf_len, uint8_t * const p_tx_buf, uint32_t * const p_tx_buf_len) { SER_ASSERT_NOT_NULL(p_rx_buf); SER_ASSERT_NOT_NULL(p_tx_buf); SER_ASSERT_NOT_NULL(p_tx_buf_len); uint32_t err_code = NRF_SUCCESS; uint32_t sd_err_code; uint16_t conn_handle; uint8_t sec_status; ble_gap_sec_params_t sec_params; ble_gap_sec_params_t * p_sec_params = &sec_params; err_code = ble_gap_sec_params_reply_req_dec(p_rx_buf, rx_buf_len, &conn_handle, &sec_status, &p_sec_params); SER_ASSERT(err_code == NRF_SUCCESS, err_code); sd_err_code = sd_ble_gap_sec_params_reply(conn_handle, sec_status, p_sec_params); err_code = ble_gap_sec_params_reply_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len); SER_ASSERT(err_code == NRF_SUCCESS, err_code); return err_code; }
uint32_t conn_mw_ble_gap_sec_params_reply(uint8_t const * const p_rx_buf, uint32_t rx_buf_len, uint8_t * const p_tx_buf, uint32_t * const p_tx_buf_len) { SER_ASSERT_NOT_NULL(p_rx_buf); SER_ASSERT_NOT_NULL(p_tx_buf); SER_ASSERT_NOT_NULL(p_tx_buf_len); uint32_t err_code = NRF_SUCCESS; uint32_t sd_err_code; uint32_t sec_tab_index = 0; uint16_t * p_conn_handle; uint8_t sec_status; ble_gap_sec_params_t sec_params; ble_gap_sec_params_t * p_sec_params = &sec_params; // Allocate global security context for soft device err_code = conn_ble_gap_sec_context_create(&sec_tab_index); SER_ASSERT(err_code == NRF_SUCCESS, err_code); p_conn_handle = &(m_conn_keys_table[sec_tab_index].conn_handle); // Set up global structure for command decoder ble_gap_sec_keyset_t * p_sec_keyset = &(m_conn_keys_table[sec_tab_index].keyset); p_sec_keyset->keys_own.p_enc_key = &(m_conn_keys_table[sec_tab_index].enc_key_own); p_sec_keyset->keys_own.p_id_key = &(m_conn_keys_table[sec_tab_index].id_key_own); p_sec_keyset->keys_own.p_sign_key = &(m_conn_keys_table[sec_tab_index].sign_key_own); p_sec_keyset->keys_own.p_pk = &(m_conn_keys_table[sec_tab_index].pk_own); p_sec_keyset->keys_peer.p_enc_key = &(m_conn_keys_table[sec_tab_index].enc_key_peer); p_sec_keyset->keys_peer.p_id_key = &(m_conn_keys_table[sec_tab_index].id_key_peer); p_sec_keyset->keys_peer.p_sign_key = &(m_conn_keys_table[sec_tab_index].sign_key_peer); p_sec_keyset->keys_peer.p_pk = &(m_conn_keys_table[sec_tab_index].pk_peer); err_code = ble_gap_sec_params_reply_req_dec(p_rx_buf, rx_buf_len, p_conn_handle, &sec_status, &p_sec_params, &p_sec_keyset); SER_ASSERT(err_code == NRF_SUCCESS, err_code); if (p_sec_keyset == NULL) { //If no keyset was sent destroy the context. err_code = conn_ble_gap_sec_context_destroy(*p_conn_handle); SER_ASSERT(err_code == NRF_SUCCESS, err_code); } sd_err_code = sd_ble_gap_sec_params_reply(*p_conn_handle, sec_status, p_sec_params, p_sec_keyset); err_code = ble_gap_sec_params_reply_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, p_sec_keyset); SER_ASSERT(err_code == NRF_SUCCESS, err_code); return err_code; }