ESPHome 2026.11.0b6
Loading...
Searching...
No Matches
seeed_mr60bha2.cpp
Go to the documentation of this file.
1#include "seeed_mr60bha2.h"
3#include "esphome/core/log.h"
4
5#include <cinttypes>
6#include <utility>
7
9
10ESPHOME_LOG_TAG(TAG, "seeed_mr60bha2");
11
12// Maximum bytes to log in verbose hex output
13static constexpr size_t MR60BHA2_MAX_LOG_BYTES = 64;
14
15// Prints the component's configuration data. dump_config() prints all of the component's configuration
16// items in an easy-to-read format, including the configuration key-value pairs.
18 ESP_LOGCONFIG(TAG, "MR60BHA2:");
19#ifdef USE_BINARY_SENSOR
20 LOG_BINARY_SENSOR(" ", "People Exist Binary Sensor", this->has_target_binary_sensor_);
21#endif
22#ifdef USE_SENSOR
23 LOG_SENSOR(" ", "Breath Rate Sensor", this->breath_rate_sensor_);
24 LOG_SENSOR(" ", "Heart Rate Sensor", this->heart_rate_sensor_);
25 LOG_SENSOR(" ", "Distance Sensor", this->distance_sensor_);
26 LOG_SENSOR(" ", "Target Number Sensor", this->num_targets_sensor_);
27#endif
28}
29
30// main loop
32 this->read_available([this](uint8_t b) {
33 this->rx_message_.push_back(b);
34 if (!this->validate_message_()) {
35 this->rx_message_.clear();
36 }
37 });
38}
39
51static bool validate_checksum(const uint8_t *data, size_t len, uint8_t expected_checksum) {
52 return static_cast<uint8_t>(~xor_bytes(data, len)) == expected_checksum;
53}
54
56 size_t at = this->rx_message_.size() - 1;
57 auto *data = &this->rx_message_[0];
58 uint8_t new_byte = data[at];
59
60 if (at == 0) {
61 return new_byte == FRAME_HEADER_BUFFER;
62 }
63
64 if (at <= 2) {
65 return true;
66 }
67 uint16_t frame_id = encode_uint16(data[1], data[2]);
68
69 if (at <= 4) {
70 return true;
71 }
72
73 uint16_t length = encode_uint16(data[3], data[4]);
74
75 if (at <= 6) {
76 return true;
77 }
78
79 uint16_t frame_type = encode_uint16(data[5], data[6]);
80
81 if (frame_type != BREATH_RATE_TYPE_BUFFER && frame_type != HEART_RATE_TYPE_BUFFER &&
82 frame_type != DISTANCE_TYPE_BUFFER && frame_type != PEOPLE_EXIST_TYPE_BUFFER &&
83 frame_type != PRINT_CLOUD_BUFFER) {
84 return false;
85 }
86
87 uint8_t header_checksum = new_byte;
88
89 if (at == 7) {
90 if (!validate_checksum(data, 7, header_checksum)) {
91 ESP_LOGE(TAG, "HEAD_CKSUM_FRAME ERROR: 0x%02x", header_checksum);
92 ESP_LOGV_HEX(TAG, data, 8, MR60BHA2_MAX_LOG_BYTES, "GET FRAME: %s");
93 return false;
94 }
95 return true;
96 }
97
98 // Wait until all data is read
99 if (at - 8 < length) {
100 return true;
101 }
102
103 uint8_t data_checksum = new_byte;
104 if (at == 8 + length) {
105 if (!validate_checksum(data + 8, length, data_checksum)) {
106 ESP_LOGE(TAG, "DATA_CKSUM_FRAME ERROR: 0x%02x", data_checksum);
107 ESP_LOGV_HEX(TAG, data, 8 + length, MR60BHA2_MAX_LOG_BYTES, "GET FRAME: %s");
108 return false;
109 }
110 }
111
112 const uint8_t *frame_data = data + 8;
113#if ESPHOME_LOG_LEVEL >= ESPHOME_LOG_LEVEL_VERBOSE
114 char hex_buf1[format_hex_pretty_size(MR60BHA2_MAX_LOG_BYTES)];
115 char hex_buf2[format_hex_pretty_size(MR60BHA2_MAX_LOG_BYTES)];
116#endif
117 ESP_LOGV(TAG, "Received Frame: ID: 0x%04x, Type: 0x%04x, Data: [%s] Raw Data: [%s]", frame_id, frame_type,
118 format_hex_pretty_to(hex_buf1, sizeof(hex_buf1), frame_data, length),
119 format_hex_pretty_to(hex_buf2, sizeof(hex_buf2), this->rx_message_.data(), this->rx_message_.size()));
120 this->process_frame_(frame_id, frame_type, data + 8, length);
121
122 // Return false to reset rx buffer
123 return false;
124}
125
126void MR60BHA2Component::process_frame_(uint16_t frame_id, uint16_t frame_type, const uint8_t *data, size_t length) {
127 switch (frame_type) {
128 case BREATH_RATE_TYPE_BUFFER:
129#ifdef USE_SENSOR
130 if (this->breath_rate_sensor_ != nullptr && length >= 4) {
131 uint32_t current_breath_rate_int = encode_uint32(data[3], data[2], data[1], data[0]);
132 if (current_breath_rate_int != 0) {
133 float breath_rate_float;
134 memcpy(&breath_rate_float, &current_breath_rate_int, sizeof(float));
135 this->breath_rate_sensor_->publish_state(breath_rate_float);
136 }
137 }
138#endif
139 break;
140 case PEOPLE_EXIST_TYPE_BUFFER:
141#ifdef USE_BINARY_SENSOR
142 if (this->has_target_binary_sensor_ != nullptr && length >= 2) {
143 uint16_t has_target_int = encode_uint16(data[1], data[0]);
144 this->has_target_binary_sensor_->publish_state(has_target_int);
145#ifdef USE_SENSOR
146 if (has_target_int == 0) {
147 PUBLISH_STATE(this->breath_rate_sensor_, 0.0);
148 PUBLISH_STATE(this->heart_rate_sensor_, 0.0);
149 PUBLISH_STATE(this->distance_sensor_, 0.0);
150 PUBLISH_STATE(this->num_targets_sensor_, 0);
151 }
152#endif
153 }
154#endif
155 break;
156 case HEART_RATE_TYPE_BUFFER:
157#ifdef USE_SENSOR
158 if (this->heart_rate_sensor_ != nullptr && length >= 4) {
159 uint32_t current_heart_rate_int = encode_uint32(data[3], data[2], data[1], data[0]);
160 if (current_heart_rate_int != 0) {
161 float heart_rate_float;
162 memcpy(&heart_rate_float, &current_heart_rate_int, sizeof(float));
163 this->heart_rate_sensor_->publish_state(heart_rate_float);
164 }
165 }
166#endif
167 break;
168 case DISTANCE_TYPE_BUFFER:
169#ifdef USE_SENSOR
170 if (length >= 1 && data[0] != 0) {
171 if (this->distance_sensor_ != nullptr && length >= 8) {
172 uint32_t current_distance_int = encode_uint32(data[7], data[6], data[5], data[4]);
173 float distance_float;
174 memcpy(&distance_float, &current_distance_int, sizeof(float));
175 this->distance_sensor_->publish_state(distance_float);
176 }
177 }
178#endif
179 break;
180 case PRINT_CLOUD_BUFFER:
181#ifdef USE_SENSOR
182 if (this->num_targets_sensor_ != nullptr && length >= 4) {
183 uint32_t current_num_targets_int = encode_uint32(data[3], data[2], data[1], data[0]);
184 this->num_targets_sensor_->publish_state(current_num_targets_int);
185 }
186#endif
187 break;
188 default:
189 break;
190 }
191}
192
193} // namespace esphome::seeed_mr60bha2
void process_frame_(uint16_t frame_id, uint16_t frame_type, const uint8_t *data, size_t length)
bool read_available(F &&on_byte)
Same as read_available_chunks(), calling on_byte(uint8_t) once per byte.
Definition uart.h:77
ESPHOME_LOG_TAG(TAG, "seeed_mr60bha2")
const void size_t len
Definition hal.h:68
char * format_hex_pretty_to(char *buffer, size_t buffer_size, const uint8_t *data, size_t length, char separator)
Format byte array as uppercase hex to buffer (base implementation).
Definition helpers.cpp:498
constexpr size_t format_hex_pretty_size(size_t byte_count)
Calculate buffer size needed for format_hex_pretty_to with separator: "XX:XX:...:XX\0".
Definition helpers.h:1687
constexpr uint32_t encode_uint32(uint8_t byte1, uint8_t byte2, uint8_t byte3, uint8_t byte4)
Encode a 32-bit value given four bytes in most to least significant byte order.
Definition helpers.h:1051
constexpr uint16_t encode_uint16(uint8_t msb, uint8_t lsb)
Encode a 16-bit value given the most and least significant byte.
Definition helpers.h:1043
static void uint32_t
uint16_t length
Definition tt21100.cpp:0