main/Beacon.cpp - master - darvik/robot-espidf

main/Beacon.cpp
75 строк3 KB
Ivan Kishchenko
Beacon support
06 мар 2024, 08:30
06 мар 2024, 08:30b087a37
//
// Created by Ivan Kishchenko on 05/03/2024.
//

#include <cmath>
#include "Beacon.h"
#include <bluetooth/BTUtils.h>

#define RSSI_N 2

const uint8_t Beacon::S_BEACON_UUID[ESP_UUID_LEN_128] = {
        0xfd, 0xa5, 0x06, 0x93,
        0xa4, 0xe2, 0x4f, 0xb1,
        0xaf, 0xcf, 0xc6, 0xeb,
        0x07, 0x64, 0x78, 0x25
};

Beacon::Beacon(Registry &registry) : TService(registry) {
    _timer.fire<UserTid_Beacon>(10000, true);
}

void Beacon::handle(const BleScanResult &msg) {
    if (msg.serviceData.size() == sizeof(BeaconServiceData)) {
        auto sdata = reinterpret_cast<const BeaconServiceData *>(msg.serviceData.data());
        esp_logi(beacon, "uuid: 0x%04x, battery: %d, model: %d", sdata->uuid, sdata->battery, sdata->productModel);
    }
    auto mdata = reinterpret_cast<const BeaconManufacturerType *>(msg.manufacturerType.data());
    auto dist = std::pow(10.0f, (static_cast<double>((int) mdata->rssi1m - msg.rssi)) / (10 * RSSI_N));
    esp_logi(beacon, "%s:%s, major: 0x%04x, minor: 0x%04x, rssi1m: %d, rssi: %d, dist: %f", msg.bda.c_str(),
             msg.name.c_str(), mdata->major, mdata->minor, mdata->rssi1m, msg.rssi, dist);
            esp_log_buffer_hex("uuid:", mdata->uuid128, ESP_UUID_LEN_128);
    _beacons.emplace(msg.bda, BeaconInfo{
            .bda = msg.bda,
            .name = msg.name,
            .rssi = msg.rssi,
            .rssi1m = mdata->rssi1m,
            .distance = dist
    });
}

void Beacon::handle(const BleScanDone &msg) {
    uint8_t addrType{};
    esp_bd_addr_t bda{};
    esp_ble_gap_get_local_used_addr(bda, &addrType);
    LocationTagReport report;
    report.bda = BTUtils::bda2str(bda);
    for (const auto &item: _beacons) {
        report.beacons.push_back(item.second);
        esp_logw(beacon, "%s:%s, distance: %f", item.first.c_str(), item.second.name.c_str(), item.second.distance);
    }
    getDefaultEventBus().send(report);

    _beacons.clear();
}

void Beacon::handle(const TimerEvent<UserTid_Beacon> &msg) {
    getDefaultEventBus().post(BleDiscoveryRequest{
        .duration = 5,
    });
}

const BleDiscoveryFilter Beacon::getFilter() {
    return BleDiscoveryFilter{
            .manufacturerSpecificTypeFilter = [](const uint8_t *ptr, size_t len) {
                if (ptr && len == sizeof(BeaconManufacturerType)) {
                    auto mdata = reinterpret_cast<const BeaconManufacturerType *>(ptr);
                    if (0 == memcmp(mdata->uuid128, S_BEACON_UUID, ESP_UUID_LEN_128)) {
                        return true;
                    }
                }

                return false;
            }
    };
}