254 lines
8.1 KiB
C
254 lines
8.1 KiB
C
/*
|
|
This example code is in the Public Domain (or CC0 licensed, at your option.)
|
|
|
|
Unless required by applicable law or agreed to in writing, this
|
|
software is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR
|
|
CONDITIONS OF ANY KIND, either express or implied.
|
|
*/
|
|
|
|
|
|
/****************************************************************************
|
|
*
|
|
* This file is used to decode eddystone information.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#include <stdio.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include <stdbool.h>
|
|
|
|
#include "esp_err.h"
|
|
#include "esp_gap_ble_api.h"
|
|
#include "esp_eddystone_protocol.h"
|
|
#include "esp_eddystone_api.h"
|
|
|
|
|
|
/* Declare static functions */
|
|
static esp_err_t esp_eddystone_uid_received(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res);
|
|
static esp_err_t esp_eddystone_url_received(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res);
|
|
static char* esp_eddystone_resolve_url_scheme(const uint8_t* url_start, const uint8_t* url_end);
|
|
static esp_err_t esp_eddystone_tlm_received(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res);
|
|
static esp_err_t esp_eddystone_get_inform(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res);
|
|
|
|
/* Eddystone-URL scheme prefixes */
|
|
static const char* eddystone_url_prefix[4] = {
|
|
"http://www.",
|
|
"https://www.",
|
|
"http://",
|
|
"https://"
|
|
};
|
|
|
|
/* Eddystone-URL HTTP URL encoding */
|
|
static const char* eddystone_url_encoding[14] = {
|
|
".com/",
|
|
".org/",
|
|
".edu/",
|
|
".net/",
|
|
".info/",
|
|
".biz/",
|
|
".gov/",
|
|
".com",
|
|
".org",
|
|
".edu",
|
|
".net",
|
|
".info",
|
|
".biz",
|
|
".gov"
|
|
};
|
|
|
|
/****************** Eddystone-UID **************
|
|
Byte offset Field Description
|
|
0 Frame Type Value = 0x00
|
|
1 Ranging Data Calibrated Tx power at 0 m
|
|
2 NID[0] 10-byte Namespace
|
|
3 NID[1]
|
|
4 NID[2]
|
|
5 NID[3]
|
|
6 NID[4]
|
|
7 NID[5]
|
|
8 NID[6]
|
|
9 NID[7]
|
|
10 NID[8]
|
|
11 NID[9]
|
|
12 BID[0] 6-byte Instance
|
|
13 BID[1]
|
|
14 BID[2]
|
|
15 BID[3]
|
|
16 BID[4]
|
|
17 BID[5]
|
|
18 RFU Reserved for future use, must be0x00
|
|
19 RFU Reserved for future use, must be0x00
|
|
*********************************************/
|
|
/* decode and store received UID */
|
|
static esp_err_t esp_eddystone_uid_received(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res)
|
|
{
|
|
uint8_t pos = 0;
|
|
//1-byte Ranging Data + 10-byte Namespace + 6-byte Instance
|
|
if((len != EDDYSTONE_UID_DATA_LEN) && (len != (EDDYSTONE_UID_RFU_LEN+EDDYSTONE_UID_DATA_LEN))) {
|
|
//ERROR:uid len wrong
|
|
return -1;
|
|
}
|
|
res->inform.uid.ranging_data = buf[pos++];
|
|
for(int i=0; i<EDDYSTONE_UID_NAMESPACE_LEN; i++) {
|
|
res->inform.uid.namespace_id[i] = buf[pos++];
|
|
}
|
|
for(int i=0; i<EDDYSTONE_UID_INSTANCE_LEN; i++) {
|
|
res->inform.uid.instance_id[i] = buf[pos++];
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* resolve received URL to url_res pointer */
|
|
static char* esp_eddystone_resolve_url_scheme(const uint8_t *url_start, const uint8_t *url_end)
|
|
{
|
|
int pos = 0;
|
|
static char url_buf[100] = {0};
|
|
const uint8_t *p = url_start;
|
|
|
|
pos += sprintf(&url_buf[pos], "%s", eddystone_url_prefix[*p++]);
|
|
|
|
for (; p <= url_end; p++) {
|
|
if (esp_eddystone_is_char_invalid((*p))) {
|
|
pos += sprintf(&url_buf[pos], "%s", eddystone_url_encoding[*p]);
|
|
} else {
|
|
pos += sprintf(&url_buf[pos], "%c", *p);
|
|
}
|
|
}
|
|
return url_buf;
|
|
}
|
|
|
|
/************************** Eddystone-URL *************
|
|
Frame Specification
|
|
Byte offset Field Description
|
|
0 Frame Type Value = 0x10
|
|
1 TX Power Calibrated Tx power at 0 m
|
|
2 URL Scheme Encoded Scheme Prefix
|
|
3+ Encoded URL Length 1-17
|
|
*******************************************************/
|
|
/* decode and store received URL, the pointer url_res points to the resolved url */
|
|
static esp_err_t esp_eddystone_url_received(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res)
|
|
{
|
|
char *url_res = NULL;
|
|
uint8_t pos = 0;
|
|
if(len-EDDYSTONE_URL_TX_POWER_LEN > EDDYSTONE_URL_MAX_LEN) {
|
|
//ERROR:too long url
|
|
return -1;
|
|
}
|
|
res->inform.url.tx_power = buf[pos++];
|
|
url_res = esp_eddystone_resolve_url_scheme(buf+pos, buf+len-1);
|
|
memcpy(&res->inform.url.url, url_res, strlen(url_res));
|
|
res->inform.url.url[strlen(url_res)] = '\0';
|
|
return 0;
|
|
}
|
|
|
|
/****************** eddystone-tlm ***************
|
|
* Unencrypted TLM Frame Specification
|
|
Byte offset Field Description
|
|
0 Frame Type Value = 0x20
|
|
1 Version TLM version, value = 0x00
|
|
2 VBATT[0] Battery voltage, 1 mV/bit
|
|
3 VBATT[1]
|
|
4 TEMP[0] Beacon temperature
|
|
5 TEMP[1]
|
|
6 ADV_CNT[0] Advertising PDU count
|
|
7 ADV_CNT[1]
|
|
8 ADV_CNT[2]
|
|
9 ADV_CNT[3]
|
|
10 SEC_CNT[0] Time since power-on or reboot
|
|
11 SEC_CNT[1]
|
|
12 SEC_CNT[2]
|
|
13 SEC_CNT[3]
|
|
************************************************/
|
|
/* decode and store received TLM */
|
|
static esp_err_t esp_eddystone_tlm_received(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res)
|
|
{
|
|
uint8_t pos = 0;
|
|
if(len > EDDYSTONE_TLM_DATA_LEN) {
|
|
//ERROR:TLM too long
|
|
return -1;
|
|
}
|
|
res->inform.tlm.version = buf[pos++];
|
|
res->inform.tlm.battery_voltage = big_endian_read_16(buf, pos);
|
|
pos += 2;
|
|
uint16_t temp = big_endian_read_16(buf, pos);
|
|
int8_t temp_integral = (int8_t)((temp >> 8) & 0xff);
|
|
float temp_decimal = (temp & 0xff) / 256.0;
|
|
res->inform.tlm.temperature = temp_integral + temp_decimal;
|
|
pos += 2;
|
|
res->inform.tlm.adv_count = big_endian_read_32(buf, pos);
|
|
pos += 4;
|
|
res->inform.tlm.time = big_endian_read_32(buf, pos);
|
|
return 0;
|
|
}
|
|
|
|
static esp_err_t esp_eddystone_get_inform(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res)
|
|
{
|
|
static esp_err_t ret=-1;
|
|
switch(res->common.frame_type)
|
|
{
|
|
case EDDYSTONE_FRAME_TYPE_UID: {
|
|
ret = esp_eddystone_uid_received(buf, len, res);
|
|
break;
|
|
}
|
|
case EDDYSTONE_FRAME_TYPE_URL: {
|
|
ret = esp_eddystone_url_received(buf, len, res);
|
|
break;
|
|
}
|
|
case EDDYSTONE_FRAME_TYPE_TLM: {
|
|
ret = esp_eddystone_tlm_received(buf, len, res);
|
|
break;
|
|
}
|
|
default:
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
esp_err_t esp_eddystone_decode(const uint8_t* buf, uint8_t len, esp_eddystone_result_t* res)
|
|
{
|
|
if (len == 0 || buf == NULL || res == NULL) {
|
|
return -1;
|
|
}
|
|
uint8_t pos=0;
|
|
while(res->common.srv_data_type != EDDYSTONE_SERVICE_UUID)
|
|
{
|
|
pos++;
|
|
if(pos >= len ) {
|
|
return -1;
|
|
}
|
|
uint8_t ad_type = buf[pos++];
|
|
switch(ad_type)
|
|
{
|
|
case ESP_BLE_AD_TYPE_FLAG: {
|
|
res->common.flags = buf[pos++];
|
|
break;
|
|
}
|
|
case ESP_BLE_AD_TYPE_16SRV_CMPL: {
|
|
uint16_t uuid = little_endian_read_16(buf, pos);
|
|
if(uuid != EDDYSTONE_SERVICE_UUID) {
|
|
return -1;
|
|
}
|
|
res->common.srv_uuid = uuid;
|
|
pos += 2;
|
|
break;
|
|
}
|
|
case ESP_BLE_AD_TYPE_SERVICE_DATA: {
|
|
uint16_t type = little_endian_read_16(buf, pos);
|
|
pos += 2;
|
|
uint8_t frame_type = buf[pos++];
|
|
if(type != EDDYSTONE_SERVICE_UUID || !(frame_type == EDDYSTONE_FRAME_TYPE_UID || frame_type == EDDYSTONE_FRAME_TYPE_URL ||
|
|
frame_type == EDDYSTONE_FRAME_TYPE_TLM)) {
|
|
return -1;
|
|
}
|
|
res->common.srv_data_type = type;
|
|
res->common.frame_type = frame_type;
|
|
break;
|
|
}
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
return esp_eddystone_get_inform(buf+pos, len-pos, res);
|
|
}
|
|
|