mirror of https://github.com/Lurkars/esp-ena.git
74 lines
1.9 KiB
C
74 lines
1.9 KiB
C
#include "esp_log.h"
|
|
#include "esp_bt.h"
|
|
|
|
#include "ena-crypto.h"
|
|
|
|
#include "ena-bluetooth-advertise.h"
|
|
|
|
static esp_ble_adv_params_t ena_adv_params = {
|
|
.adv_int_min = 0x140, // 200 ms
|
|
.adv_int_max = 0x190, // 250 ms
|
|
.adv_type = ADV_TYPE_NONCONN_IND,
|
|
.own_addr_type = BLE_ADDR_TYPE_RANDOM,
|
|
.channel_map = ADV_CHNL_ALL,
|
|
.adv_filter_policy = ADV_FILTER_ALLOW_SCAN_ANY_CON_ANY,
|
|
};
|
|
|
|
void ena_bluetooth_advertise_start(void)
|
|
{
|
|
ESP_ERROR_CHECK(esp_ble_gap_start_advertising(&ena_adv_params));
|
|
}
|
|
|
|
void ena_bluetooth_advertise_set_payload(uint32_t enin, uint8_t tek[])
|
|
{
|
|
uint8_t rpik[ENA_KEY_LENGTH] = {0};
|
|
uint8_t rpi[ENA_KEY_LENGTH] = {0};
|
|
uint8_t aemk[ENA_KEY_LENGTH] = {0};
|
|
uint8_t aem[ENA_AEM_METADATA_LENGTH] = {0};
|
|
|
|
ena_crypto_rpik(rpik, tek);
|
|
|
|
ena_crypto_rpi(rpi, rpik, enin);
|
|
|
|
ena_crypto_aemk(aemk, tek);
|
|
|
|
ena_crypto_aem(aem, aemk, rpi, esp_ble_tx_power_get(ESP_BLE_PWR_TYPE_ADV));
|
|
|
|
uint8_t adv_raw_data[31];
|
|
// FLAG??? skipped on sniffed android packages!?
|
|
adv_raw_data[0] = 0x02;
|
|
adv_raw_data[1] = 0x01;
|
|
adv_raw_data[2] = ENA_BLUETOOTH_TAG_DATA;
|
|
|
|
// SERVICE UUID
|
|
adv_raw_data[3] = 0x03;
|
|
adv_raw_data[4] = 0x03;
|
|
adv_raw_data[5] = 0x6F;
|
|
adv_raw_data[6] = 0xFD;
|
|
|
|
// SERVICE DATA
|
|
adv_raw_data[7] = 0x17;
|
|
adv_raw_data[8] = 0x16;
|
|
|
|
adv_raw_data[9] = 0x6F;
|
|
adv_raw_data[10] = 0xFD;
|
|
|
|
for (int i = 0; i < ENA_KEY_LENGTH; i++)
|
|
{
|
|
adv_raw_data[i + 11] = rpi[i];
|
|
}
|
|
for (int i = 0; i < ENA_AEM_METADATA_LENGTH; i++)
|
|
{
|
|
adv_raw_data[i + ENA_KEY_LENGTH + 11] = aem[i];
|
|
}
|
|
|
|
esp_ble_gap_config_adv_data_raw(adv_raw_data, sizeof(adv_raw_data));
|
|
|
|
ESP_LOGI(ENA_ADVERTISE_LOG, "payload for ENIN %u", enin);
|
|
ESP_LOG_BUFFER_HEXDUMP(ENA_ADVERTISE_LOG, adv_raw_data, sizeof(adv_raw_data), ESP_LOG_DEBUG);
|
|
}
|
|
|
|
void ena_bluetooth_advertise_stop(void)
|
|
{
|
|
ESP_ERROR_CHECK(esp_ble_gap_stop_advertising());
|
|
} |