sensor/patchedBLE/src/BLEEddystoneTLM.cpp


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150

/*
 * BLEEddystoneTLM.cpp
 *
 *  Created on: Mar 12, 2018
 *      Author: pcbreflux
 */
#include "sdkconfig.h"
#if defined(CONFIG_BT_ENABLED)
#include <string.h>
#include <sstream>
#include <esp_log.h>
#include "BLEEddystoneTLM.h"
 
static const char LOG_TAG[] = "BLEEddystoneTLM";
#define ENDIAN_CHANGE_U16(x) ((((x)&0xFF00)>>8) + (((x)&0xFF)<<8))
#define ENDIAN_CHANGE_U32(x) ((((x)&0xFF000000)>>24) + (((x)&0x00FF0000)>>8)) + ((((x)&0xFF00)<<8) + (((x)&0xFF)<<24))
 
BLEEddystoneTLM::BLEEddystoneTLM() {
	beaconUUID = 0xFEAA;
	m_eddystoneData.frameType = EDDYSTONE_TLM_FRAME_TYPE;
	m_eddystoneData.version = 0;
	m_eddystoneData.volt = 3300; // 3300mV = 3.3V 
	m_eddystoneData.temp = (uint16_t) ((float) 23.00);
	m_eddystoneData.advCount = 0;
	m_eddystoneData.tmil = 0;
} // BLEEddystoneTLM 
 
std::string BLEEddystoneTLM::getData() {
	return std::string((char*) &m_eddystoneData, sizeof(m_eddystoneData));
} // getData 
 
BLEUUID BLEEddystoneTLM::getUUID() {
	return BLEUUID(beaconUUID);
} // getUUID 
 
uint8_t BLEEddystoneTLM::getVersion() {
	return m_eddystoneData.version;
} // getVersion 
 
uint16_t BLEEddystoneTLM::getVolt() {
	return m_eddystoneData.volt;
} // getVolt 
 
float BLEEddystoneTLM::getTemp() {
	return (float)m_eddystoneData.temp;
} // getTemp 
 
uint32_t BLEEddystoneTLM::getCount() {
	return m_eddystoneData.advCount;
} // getCount 
 
uint32_t BLEEddystoneTLM::getTime() {
	return m_eddystoneData.tmil;
} // getTime 
 
std::string BLEEddystoneTLM::toString() {
	std::stringstream ss;
	std::string out = "";
  uint32_t rawsec;
  ss << "Version ";
  ss << std::dec << m_eddystoneData.version;
  ss << "\n";
 
  ss << "Battery Voltage ";
  ss << std::dec << ENDIAN_CHANGE_U16(m_eddystoneData.volt);
  ss << " mV\n";
 
  ss << "Temperature ";
  ss << (float) m_eddystoneData.temp;
  ss << " °C\n";
 
  ss << "Adv. Count ";
  ss << std::dec << ENDIAN_CHANGE_U32(m_eddystoneData.advCount);
 
  ss << "\n";
 
  ss << "Time ";
 
  rawsec = ENDIAN_CHANGE_U32(m_eddystoneData.tmil);
  std::stringstream buffstream;
  buffstream << "0000";
  buffstream << std::dec << rawsec / 864000;
  std::string buff = buffstream.str();
 
  ss << buff.substr(buff.length() - 4, buff.length());
  ss << ".";
 
  buffstream.str("");
  buffstream.clear();
  buffstream << "00";
  buffstream << std::dec << (rawsec / 36000) % 24;
  buff = buffstream.str();
  ss << buff.substr(buff.length()-2, buff.length());
  ss << ":";
 
  buffstream.str("");
  buffstream.clear();
  buffstream << "00";
  buffstream << std::dec << (rawsec / 600) % 60;
  buff = buffstream.str();
  ss << buff.substr(buff.length() - 2, buff.length());
  ss << ":";
 
  buffstream.str("");
  buffstream.clear();
  buffstream << "00";
  buffstream << std::dec << (rawsec / 10) % 60;
  buff = buffstream.str();
  ss << buff.substr(buff.length() - 2, buff.length());
  ss << "\n";
 
  return ss.str();
} // toString 
 
/**
 * Set the raw data for the beacon record.
 */
void BLEEddystoneTLM::setData(std::string data) {
	if (data.length() != sizeof(m_eddystoneData)) {
		ESP_LOGE(LOG_TAG, "Unable to set the data ... length passed in was %d and expected %d", data.length(), sizeof(m_eddystoneData));
		return;
	}
  memcpy(&m_eddystoneData, data.data(), data.length());
} // setData 
 
void BLEEddystoneTLM::setUUID(BLEUUID l_uuid) {
	beaconUUID = l_uuid.getNative()->uuid.uuid16;
} // setUUID 
 
void BLEEddystoneTLM::setVersion(uint8_t version) {
	m_eddystoneData.version = version;
} // setVersion 
 
void BLEEddystoneTLM::setVolt(uint16_t volt) {
	m_eddystoneData.volt = volt;
} // setVolt 
 
void BLEEddystoneTLM::setTemp(float temp) {
	m_eddystoneData.temp = (uint16_t)temp;
} // setTemp 
 
void BLEEddystoneTLM::setCount(uint32_t advCount) {
	m_eddystoneData.advCount = advCount;
} // setCount 
 
void BLEEddystoneTLM::setTime(uint32_t tmil) {
	m_eddystoneData.tmil = tmil;
} // setTime 
 
#endif