163 lines
4.0 KiB
C
163 lines
4.0 KiB
C
/*
|
|
* Licensed to the Apache Software Foundation (ASF) under one
|
|
* or more contributor license agreements. See the NOTICE file
|
|
* distributed with this work for additional information
|
|
* regarding copyright ownership. The ASF licenses this file
|
|
* to you 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 <string.h>
|
|
#include <errno.h>
|
|
#include "nimble/ble.h"
|
|
#include "nimble/nimble_opt.h"
|
|
#include "host/ble_sm.h"
|
|
#include "ble_hs_priv.h"
|
|
|
|
void *
|
|
ble_sm_cmd_get(uint8_t opcode, size_t len, struct os_mbuf **txom)
|
|
{
|
|
struct ble_sm_hdr *hdr;
|
|
|
|
*txom = ble_hs_mbuf_l2cap_pkt();
|
|
if (*txom == NULL) {
|
|
return NULL;
|
|
}
|
|
|
|
if (os_mbuf_extend(*txom, sizeof(*hdr) + len) == NULL) {
|
|
os_mbuf_free_chain(*txom);
|
|
return NULL;
|
|
}
|
|
|
|
hdr = (struct ble_sm_hdr *)(*txom)->om_data;
|
|
|
|
hdr->opcode = opcode;
|
|
|
|
return hdr->data;
|
|
}
|
|
|
|
/* this function consumes tx os_mbuf */
|
|
int
|
|
ble_sm_tx(uint16_t conn_handle, struct os_mbuf *txom)
|
|
{
|
|
struct ble_l2cap_chan *chan;
|
|
struct ble_hs_conn *conn;
|
|
int rc;
|
|
|
|
BLE_HS_DBG_ASSERT(ble_hs_locked_by_cur_task());
|
|
|
|
STATS_INC(ble_l2cap_stats, sm_tx);
|
|
|
|
rc = ble_hs_misc_conn_chan_find_reqd(conn_handle, BLE_L2CAP_CID_SM,
|
|
&conn, &chan);
|
|
if (rc == 0) {
|
|
rc = ble_l2cap_tx(conn, chan, txom);
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
#if NIMBLE_BLE_SM
|
|
void
|
|
ble_sm_pair_cmd_log(struct ble_sm_pair_cmd *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "io_cap=%d oob_data_flag=%d authreq=0x%02x "
|
|
"mac_enc_key_size=%d init_key_dist=%d "
|
|
"resp_key_dist=%d",
|
|
cmd->io_cap, cmd->oob_data_flag, cmd->authreq,
|
|
cmd->max_enc_key_size, cmd->init_key_dist,
|
|
cmd->resp_key_dist);
|
|
}
|
|
|
|
void
|
|
ble_sm_pair_confirm_log(struct ble_sm_pair_confirm *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "value=");
|
|
ble_hs_log_flat_buf(cmd->value, sizeof cmd->value);
|
|
}
|
|
|
|
void
|
|
ble_sm_pair_random_log(struct ble_sm_pair_random *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "value=");
|
|
ble_hs_log_flat_buf(cmd->value, sizeof cmd->value);
|
|
}
|
|
|
|
void
|
|
ble_sm_pair_fail_log(struct ble_sm_pair_fail *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "reason=%d", cmd->reason);
|
|
}
|
|
|
|
void
|
|
ble_sm_enc_info_log(struct ble_sm_enc_info *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "ltk=");
|
|
ble_hs_log_flat_buf(cmd->ltk, sizeof cmd->ltk);
|
|
}
|
|
|
|
void
|
|
ble_sm_master_id_log(struct ble_sm_master_id *cmd)
|
|
{
|
|
/* These get logged separately to accommodate a bug in the va_args
|
|
* implementation related to 64-bit integers.
|
|
*/
|
|
BLE_HS_LOG(DEBUG, "ediv=0x%04x ", cmd->ediv);
|
|
BLE_HS_LOG(DEBUG, "rand=0x%016llx", cmd->rand_val);
|
|
}
|
|
|
|
void
|
|
ble_sm_id_info_log(struct ble_sm_id_info *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "irk=");
|
|
ble_hs_log_flat_buf(cmd->irk, sizeof cmd->irk);
|
|
}
|
|
|
|
void
|
|
ble_sm_id_addr_info_log(struct ble_sm_id_addr_info *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "addr_type=%d addr=", cmd->addr_type);
|
|
BLE_HS_LOG_ADDR(DEBUG, cmd->bd_addr);
|
|
}
|
|
|
|
void
|
|
ble_sm_sign_info_log(struct ble_sm_sign_info *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "sig_key=");
|
|
ble_hs_log_flat_buf(cmd->sig_key, sizeof cmd->sig_key);
|
|
}
|
|
|
|
void
|
|
ble_sm_sec_req_log(struct ble_sm_sec_req *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "authreq=0x%02x", cmd->authreq);
|
|
}
|
|
|
|
void
|
|
ble_sm_public_key_log(struct ble_sm_public_key *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "x=");
|
|
ble_hs_log_flat_buf(cmd->x, sizeof cmd->x);
|
|
BLE_HS_LOG(DEBUG, "y=");
|
|
ble_hs_log_flat_buf(cmd->y, sizeof cmd->y);
|
|
}
|
|
|
|
void
|
|
ble_sm_dhkey_check_log(struct ble_sm_dhkey_check *cmd)
|
|
{
|
|
BLE_HS_LOG(DEBUG, "value=");
|
|
ble_hs_log_flat_buf(cmd->value, sizeof cmd->value);
|
|
}
|
|
|
|
#endif
|