/* * 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 <assert.h> #include <stdio.h> #include <string.h> #include "host/ble_hs.h" #include "host/ble_uuid.h" #include "blecent.h" /** * Utility function to log an array of bytes. */ void print_bytes(const uint8_t *bytes, int len) { int i; for (i = 0; i < len; i++) { MODLOG_DFLT(DEBUG, "%s0x%02x", i != 0 ? ":" : "", bytes[i]); } } void print_mbuf(const struct os_mbuf *om) { int colon, i; colon = 0; while (om != NULL) { if (colon) { MODLOG_DFLT(INFO, ":"); } else { colon = 1; } for (i = 0; i < om->om_len; i++) { MODLOG_DFLT(INFO, "%s0x%02x", i != 0 ? ":" : "", om->om_data[i]); } om = SLIST_NEXT(om, om_next); } } char * addr_str(const void *addr) { static char buf[6 * 2 + 5 + 1]; const uint8_t *u8p; u8p = addr; sprintf(buf, "%02x:%02x:%02x:%02x:%02x:%02x", u8p[5], u8p[4], u8p[3], u8p[2], u8p[1], u8p[0]); return buf; } void print_uuid(const ble_uuid_t *uuid) { char buf[BLE_UUID_STR_LEN]; MODLOG_DFLT(DEBUG, "%s", ble_uuid_to_str(uuid, buf)); } /** * Logs information about a connection to the console. */ void print_conn_desc(const struct ble_gap_conn_desc *desc) { MODLOG_DFLT(DEBUG, "handle=%d our_ota_addr_type=%d our_ota_addr=%s ", desc->conn_handle, desc->our_ota_addr.type, addr_str(desc->our_ota_addr.val)); MODLOG_DFLT(DEBUG, "our_id_addr_type=%d our_id_addr=%s ", desc->our_id_addr.type, addr_str(desc->our_id_addr.val)); MODLOG_DFLT(DEBUG, "peer_ota_addr_type=%d peer_ota_addr=%s ", desc->peer_ota_addr.type, addr_str(desc->peer_ota_addr.val)); MODLOG_DFLT(DEBUG, "peer_id_addr_type=%d peer_id_addr=%s ", desc->peer_id_addr.type, addr_str(desc->peer_id_addr.val)); MODLOG_DFLT(DEBUG, "conn_itvl=%d conn_latency=%d supervision_timeout=%d " "encrypted=%d authenticated=%d bonded=%d", desc->conn_itvl, desc->conn_latency, desc->supervision_timeout, desc->sec_state.encrypted, desc->sec_state.authenticated, desc->sec_state.bonded); } void print_adv_fields(const struct ble_hs_adv_fields *fields) { char s[BLE_HS_ADV_MAX_SZ]; const uint8_t *u8p; int i; if (fields->flags != 0) { MODLOG_DFLT(DEBUG, " flags=0x%02x\n", fields->flags); } if (fields->uuids16 != NULL) { MODLOG_DFLT(DEBUG, " uuids16(%scomplete)=", fields->uuids16_is_complete ? "" : "in"); for (i = 0; i < fields->num_uuids16; i++) { print_uuid(&fields->uuids16[i].u); MODLOG_DFLT(DEBUG, " "); } MODLOG_DFLT(DEBUG, "\n"); } if (fields->uuids32 != NULL) { MODLOG_DFLT(DEBUG, " uuids32(%scomplete)=", fields->uuids32_is_complete ? "" : "in"); for (i = 0; i < fields->num_uuids32; i++) { print_uuid(&fields->uuids32[i].u); MODLOG_DFLT(DEBUG, " "); } MODLOG_DFLT(DEBUG, "\n"); } if (fields->uuids128 != NULL) { MODLOG_DFLT(DEBUG, " uuids128(%scomplete)=", fields->uuids128_is_complete ? "" : "in"); for (i = 0; i < fields->num_uuids128; i++) { print_uuid(&fields->uuids128[i].u); MODLOG_DFLT(DEBUG, " "); } MODLOG_DFLT(DEBUG, "\n"); } if (fields->name != NULL) { assert(fields->name_len < sizeof s - 1); memcpy(s, fields->name, fields->name_len); s[fields->name_len] = '\0'; MODLOG_DFLT(DEBUG, " name(%scomplete)=%s\n", fields->name_is_complete ? "" : "in", s); } if (fields->tx_pwr_lvl_is_present) { MODLOG_DFLT(DEBUG, " tx_pwr_lvl=%d\n", fields->tx_pwr_lvl); } if (fields->slave_itvl_range != NULL) { MODLOG_DFLT(DEBUG, " slave_itvl_range="); print_bytes(fields->slave_itvl_range, BLE_HS_ADV_SLAVE_ITVL_RANGE_LEN); MODLOG_DFLT(DEBUG, "\n"); } if (fields->svc_data_uuid16 != NULL) { MODLOG_DFLT(DEBUG, " svc_data_uuid16="); print_bytes(fields->svc_data_uuid16, fields->svc_data_uuid16_len); MODLOG_DFLT(DEBUG, "\n"); } if (fields->public_tgt_addr != NULL) { MODLOG_DFLT(DEBUG, " public_tgt_addr="); u8p = fields->public_tgt_addr; for (i = 0; i < fields->num_public_tgt_addrs; i++) { MODLOG_DFLT(DEBUG, "public_tgt_addr=%s ", addr_str(u8p)); u8p += BLE_HS_ADV_PUBLIC_TGT_ADDR_ENTRY_LEN; } MODLOG_DFLT(DEBUG, "\n"); } if (fields->appearance_is_present) { MODLOG_DFLT(DEBUG, " appearance=0x%04x\n", fields->appearance); } if (fields->adv_itvl_is_present) { MODLOG_DFLT(DEBUG, " adv_itvl=0x%04x\n", fields->adv_itvl); } if (fields->svc_data_uuid32 != NULL) { MODLOG_DFLT(DEBUG, " svc_data_uuid32="); print_bytes(fields->svc_data_uuid32, fields->svc_data_uuid32_len); MODLOG_DFLT(DEBUG, "\n"); } if (fields->svc_data_uuid128 != NULL) { MODLOG_DFLT(DEBUG, " svc_data_uuid128="); print_bytes(fields->svc_data_uuid128, fields->svc_data_uuid128_len); MODLOG_DFLT(DEBUG, "\n"); } if (fields->uri != NULL) { MODLOG_DFLT(DEBUG, " uri="); print_bytes(fields->uri, fields->uri_len); MODLOG_DFLT(DEBUG, "\n"); } if (fields->mfg_data != NULL) { MODLOG_DFLT(DEBUG, " mfg_data="); print_bytes(fields->mfg_data, fields->mfg_data_len); MODLOG_DFLT(DEBUG, "\n"); } }