mirror of
https://github.com/esphome/esphome.git
synced 2024-12-12 00:14:53 +01:00
Add: Seeed Studio MR60BHA2 mmWave Sensor (#7589)
Co-authored-by: Spencer Yan <spencer@spenyan.com> Co-authored-by: Jesse Hills <3060199+jesserockz@users.noreply.github.com>
This commit is contained in:
parent
97fd7493b5
commit
9d000e9abf
9 changed files with 364 additions and 0 deletions
|
@ -355,6 +355,7 @@ esphome/components/sdl/* @clydebarrow
|
||||||
esphome/components/sdm_meter/* @jesserockz @polyfaces
|
esphome/components/sdm_meter/* @jesserockz @polyfaces
|
||||||
esphome/components/sdp3x/* @Azimath
|
esphome/components/sdp3x/* @Azimath
|
||||||
esphome/components/seeed_mr24hpc1/* @limengdu
|
esphome/components/seeed_mr24hpc1/* @limengdu
|
||||||
|
esphome/components/seeed_mr60bha2/* @limengdu
|
||||||
esphome/components/seeed_mr60fda2/* @limengdu
|
esphome/components/seeed_mr60fda2/* @limengdu
|
||||||
esphome/components/selec_meter/* @sourabhjaiswal
|
esphome/components/selec_meter/* @sourabhjaiswal
|
||||||
esphome/components/select/* @esphome/core
|
esphome/components/select/* @esphome/core
|
||||||
|
|
41
esphome/components/seeed_mr60bha2/__init__.py
Normal file
41
esphome/components/seeed_mr60bha2/__init__.py
Normal file
|
@ -0,0 +1,41 @@
|
||||||
|
import esphome.codegen as cg
|
||||||
|
from esphome.components import uart
|
||||||
|
import esphome.config_validation as cv
|
||||||
|
from esphome.const import CONF_ID
|
||||||
|
|
||||||
|
CODEOWNERS = ["@limengdu"]
|
||||||
|
DEPENDENCIES = ["uart"]
|
||||||
|
MULTI_CONF = True
|
||||||
|
|
||||||
|
mr60bha2_ns = cg.esphome_ns.namespace("seeed_mr60bha2")
|
||||||
|
|
||||||
|
MR60BHA2Component = mr60bha2_ns.class_(
|
||||||
|
"MR60BHA2Component", cg.Component, uart.UARTDevice
|
||||||
|
)
|
||||||
|
|
||||||
|
CONF_MR60BHA2_ID = "mr60bha2_id"
|
||||||
|
|
||||||
|
CONFIG_SCHEMA = (
|
||||||
|
cv.Schema(
|
||||||
|
{
|
||||||
|
cv.GenerateID(): cv.declare_id(MR60BHA2Component),
|
||||||
|
}
|
||||||
|
)
|
||||||
|
.extend(uart.UART_DEVICE_SCHEMA)
|
||||||
|
.extend(cv.COMPONENT_SCHEMA)
|
||||||
|
)
|
||||||
|
|
||||||
|
FINAL_VALIDATE_SCHEMA = uart.final_validate_device_schema(
|
||||||
|
"seeed_mr60bha2",
|
||||||
|
require_tx=True,
|
||||||
|
require_rx=True,
|
||||||
|
baud_rate=115200,
|
||||||
|
parity="NONE",
|
||||||
|
stop_bits=1,
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
|
async def to_code(config):
|
||||||
|
var = cg.new_Pvariable(config[CONF_ID])
|
||||||
|
await cg.register_component(var, config)
|
||||||
|
await uart.register_uart_device(var, config)
|
173
esphome/components/seeed_mr60bha2/seeed_mr60bha2.cpp
Normal file
173
esphome/components/seeed_mr60bha2/seeed_mr60bha2.cpp
Normal file
|
@ -0,0 +1,173 @@
|
||||||
|
#include "seeed_mr60bha2.h"
|
||||||
|
#include "esphome/core/log.h"
|
||||||
|
|
||||||
|
#include <utility>
|
||||||
|
|
||||||
|
namespace esphome {
|
||||||
|
namespace seeed_mr60bha2 {
|
||||||
|
|
||||||
|
static const char *const TAG = "seeed_mr60bha2";
|
||||||
|
|
||||||
|
// Prints the component's configuration data. dump_config() prints all of the component's configuration
|
||||||
|
// items in an easy-to-read format, including the configuration key-value pairs.
|
||||||
|
void MR60BHA2Component::dump_config() {
|
||||||
|
ESP_LOGCONFIG(TAG, "MR60BHA2:");
|
||||||
|
#ifdef USE_SENSOR
|
||||||
|
LOG_SENSOR(" ", "Breath Rate Sensor", this->breath_rate_sensor_);
|
||||||
|
LOG_SENSOR(" ", "Heart Rate Sensor", this->heart_rate_sensor_);
|
||||||
|
LOG_SENSOR(" ", "Distance Sensor", this->distance_sensor_);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
// main loop
|
||||||
|
void MR60BHA2Component::loop() {
|
||||||
|
uint8_t byte;
|
||||||
|
|
||||||
|
// Is there data on the serial port
|
||||||
|
while (this->available()) {
|
||||||
|
this->read_byte(&byte);
|
||||||
|
this->rx_message_.push_back(byte);
|
||||||
|
if (!this->validate_message_()) {
|
||||||
|
this->rx_message_.clear();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Calculate the checksum for a byte array.
|
||||||
|
*
|
||||||
|
* This function calculates the checksum for the provided byte array using an
|
||||||
|
* XOR-based checksum algorithm.
|
||||||
|
*
|
||||||
|
* @param data The byte array to calculate the checksum for.
|
||||||
|
* @param len The length of the byte array.
|
||||||
|
* @return The calculated checksum.
|
||||||
|
*/
|
||||||
|
static uint8_t calculate_checksum(const uint8_t *data, size_t len) {
|
||||||
|
uint8_t checksum = 0;
|
||||||
|
for (size_t i = 0; i < len; i++) {
|
||||||
|
checksum ^= data[i];
|
||||||
|
}
|
||||||
|
checksum = ~checksum;
|
||||||
|
return checksum;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Validate the checksum of a byte array.
|
||||||
|
*
|
||||||
|
* This function validates the checksum of the provided byte array by comparing
|
||||||
|
* it to the expected checksum.
|
||||||
|
*
|
||||||
|
* @param data The byte array to validate.
|
||||||
|
* @param len The length of the byte array.
|
||||||
|
* @param expected_checksum The expected checksum.
|
||||||
|
* @return True if the checksum is valid, false otherwise.
|
||||||
|
*/
|
||||||
|
static bool validate_checksum(const uint8_t *data, size_t len, uint8_t expected_checksum) {
|
||||||
|
return calculate_checksum(data, len) == expected_checksum;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool MR60BHA2Component::validate_message_() {
|
||||||
|
size_t at = this->rx_message_.size() - 1;
|
||||||
|
auto *data = &this->rx_message_[0];
|
||||||
|
uint8_t new_byte = data[at];
|
||||||
|
|
||||||
|
if (at == 0) {
|
||||||
|
return new_byte == FRAME_HEADER_BUFFER;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (at <= 2) {
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
uint16_t frame_id = encode_uint16(data[1], data[2]);
|
||||||
|
|
||||||
|
if (at <= 4) {
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t length = encode_uint16(data[3], data[4]);
|
||||||
|
|
||||||
|
if (at <= 6) {
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t frame_type = encode_uint16(data[5], data[6]);
|
||||||
|
|
||||||
|
if (frame_type != BREATH_RATE_TYPE_BUFFER && frame_type != HEART_RATE_TYPE_BUFFER &&
|
||||||
|
frame_type != DISTANCE_TYPE_BUFFER) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t header_checksum = new_byte;
|
||||||
|
|
||||||
|
if (at == 7) {
|
||||||
|
if (!validate_checksum(data, 7, header_checksum)) {
|
||||||
|
ESP_LOGE(TAG, "HEAD_CKSUM_FRAME ERROR: 0x%02x", header_checksum);
|
||||||
|
ESP_LOGV(TAG, "GET FRAME: %s", format_hex_pretty(data, 8).c_str());
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Wait until all data is read
|
||||||
|
if (at - 8 < length) {
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t data_checksum = new_byte;
|
||||||
|
if (at == 8 + length) {
|
||||||
|
if (!validate_checksum(data + 8, length, data_checksum)) {
|
||||||
|
ESP_LOGE(TAG, "DATA_CKSUM_FRAME ERROR: 0x%02x", data_checksum);
|
||||||
|
ESP_LOGV(TAG, "GET FRAME: %s", format_hex_pretty(data, 8 + length).c_str());
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
const uint8_t *frame_data = data + 8;
|
||||||
|
ESP_LOGV(TAG, "Received Frame: ID: 0x%04x, Type: 0x%04x, Data: [%s] Raw Data: [%s]", frame_id, frame_type,
|
||||||
|
format_hex_pretty(frame_data, length).c_str(), format_hex_pretty(this->rx_message_).c_str());
|
||||||
|
this->process_frame_(frame_id, frame_type, data + 8, length);
|
||||||
|
|
||||||
|
// Return false to reset rx buffer
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
void MR60BHA2Component::process_frame_(uint16_t frame_id, uint16_t frame_type, const uint8_t *data, size_t length) {
|
||||||
|
switch (frame_type) {
|
||||||
|
case BREATH_RATE_TYPE_BUFFER:
|
||||||
|
if (this->breath_rate_sensor_ != nullptr && length >= 4) {
|
||||||
|
uint32_t current_breath_rate_int = encode_uint32(data[3], data[2], data[1], data[0]);
|
||||||
|
if (current_breath_rate_int != 0) {
|
||||||
|
float breath_rate_float;
|
||||||
|
memcpy(&breath_rate_float, ¤t_breath_rate_int, sizeof(float));
|
||||||
|
this->breath_rate_sensor_->publish_state(breath_rate_float);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case HEART_RATE_TYPE_BUFFER:
|
||||||
|
if (this->heart_rate_sensor_ != nullptr && length >= 4) {
|
||||||
|
uint32_t current_heart_rate_int = encode_uint32(data[3], data[2], data[1], data[0]);
|
||||||
|
if (current_heart_rate_int != 0) {
|
||||||
|
float heart_rate_float;
|
||||||
|
memcpy(&heart_rate_float, ¤t_heart_rate_int, sizeof(float));
|
||||||
|
this->heart_rate_sensor_->publish_state(heart_rate_float);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case DISTANCE_TYPE_BUFFER:
|
||||||
|
if (!data[0]) {
|
||||||
|
if (this->distance_sensor_ != nullptr && length >= 8) {
|
||||||
|
uint32_t current_distance_int = encode_uint32(data[7], data[6], data[5], data[4]);
|
||||||
|
float distance_float;
|
||||||
|
memcpy(&distance_float, ¤t_distance_int, sizeof(float));
|
||||||
|
this->distance_sensor_->publish_state(distance_float);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
} // namespace seeed_mr60bha2
|
||||||
|
} // namespace esphome
|
61
esphome/components/seeed_mr60bha2/seeed_mr60bha2.h
Normal file
61
esphome/components/seeed_mr60bha2/seeed_mr60bha2.h
Normal file
|
@ -0,0 +1,61 @@
|
||||||
|
#pragma once
|
||||||
|
#include "esphome/core/component.h"
|
||||||
|
#include "esphome/core/defines.h"
|
||||||
|
#ifdef USE_SENSOR
|
||||||
|
#include "esphome/components/sensor/sensor.h"
|
||||||
|
#endif
|
||||||
|
#include "esphome/components/uart/uart.h"
|
||||||
|
#include "esphome/core/automation.h"
|
||||||
|
#include "esphome/core/helpers.h"
|
||||||
|
|
||||||
|
#include <map>
|
||||||
|
|
||||||
|
namespace esphome {
|
||||||
|
namespace seeed_mr60bha2 {
|
||||||
|
|
||||||
|
static const uint8_t DATA_BUF_MAX_SIZE = 12;
|
||||||
|
static const uint8_t FRAME_BUF_MAX_SIZE = 21;
|
||||||
|
static const uint8_t LEN_TO_HEAD_CKSUM = 8;
|
||||||
|
static const uint8_t LEN_TO_DATA_FRAME = 9;
|
||||||
|
|
||||||
|
static const uint8_t FRAME_HEADER_BUFFER = 0x01;
|
||||||
|
static const uint16_t BREATH_RATE_TYPE_BUFFER = 0x0A14;
|
||||||
|
static const uint16_t HEART_RATE_TYPE_BUFFER = 0x0A15;
|
||||||
|
static const uint16_t DISTANCE_TYPE_BUFFER = 0x0A16;
|
||||||
|
|
||||||
|
enum FrameLocation {
|
||||||
|
LOCATE_FRAME_HEADER,
|
||||||
|
LOCATE_ID_FRAME1,
|
||||||
|
LOCATE_ID_FRAME2,
|
||||||
|
LOCATE_LENGTH_FRAME_H,
|
||||||
|
LOCATE_LENGTH_FRAME_L,
|
||||||
|
LOCATE_TYPE_FRAME1,
|
||||||
|
LOCATE_TYPE_FRAME2,
|
||||||
|
LOCATE_HEAD_CKSUM_FRAME, // Header checksum: [from the first byte to the previous byte of the HEAD_CKSUM bit]
|
||||||
|
LOCATE_DATA_FRAME,
|
||||||
|
LOCATE_DATA_CKSUM_FRAME, // Data checksum: [from the first to the previous byte of the DATA_CKSUM bit]
|
||||||
|
LOCATE_PROCESS_FRAME,
|
||||||
|
};
|
||||||
|
|
||||||
|
class MR60BHA2Component : public Component,
|
||||||
|
public uart::UARTDevice { // The class name must be the name defined by text_sensor.py
|
||||||
|
#ifdef USE_SENSOR
|
||||||
|
SUB_SENSOR(breath_rate);
|
||||||
|
SUB_SENSOR(heart_rate);
|
||||||
|
SUB_SENSOR(distance);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
public:
|
||||||
|
float get_setup_priority() const override { return esphome::setup_priority::LATE; }
|
||||||
|
void dump_config() override;
|
||||||
|
void loop() override;
|
||||||
|
|
||||||
|
protected:
|
||||||
|
bool validate_message_();
|
||||||
|
void process_frame_(uint16_t frame_id, uint16_t frame_type, const uint8_t *data, size_t length);
|
||||||
|
|
||||||
|
std::vector<uint8_t> rx_message_;
|
||||||
|
};
|
||||||
|
|
||||||
|
} // namespace seeed_mr60bha2
|
||||||
|
} // namespace esphome
|
57
esphome/components/seeed_mr60bha2/sensor.py
Normal file
57
esphome/components/seeed_mr60bha2/sensor.py
Normal file
|
@ -0,0 +1,57 @@
|
||||||
|
import esphome.codegen as cg
|
||||||
|
from esphome.components import sensor
|
||||||
|
import esphome.config_validation as cv
|
||||||
|
from esphome.const import (
|
||||||
|
CONF_DISTANCE,
|
||||||
|
DEVICE_CLASS_DISTANCE,
|
||||||
|
ICON_HEART_PULSE,
|
||||||
|
ICON_PULSE,
|
||||||
|
ICON_SIGNAL,
|
||||||
|
STATE_CLASS_MEASUREMENT,
|
||||||
|
UNIT_BEATS_PER_MINUTE,
|
||||||
|
UNIT_CENTIMETER,
|
||||||
|
)
|
||||||
|
|
||||||
|
from . import CONF_MR60BHA2_ID, MR60BHA2Component
|
||||||
|
|
||||||
|
DEPENDENCIES = ["seeed_mr60bha2"]
|
||||||
|
|
||||||
|
CONF_BREATH_RATE = "breath_rate"
|
||||||
|
CONF_HEART_RATE = "heart_rate"
|
||||||
|
|
||||||
|
CONFIG_SCHEMA = cv.Schema(
|
||||||
|
{
|
||||||
|
cv.GenerateID(CONF_MR60BHA2_ID): cv.use_id(MR60BHA2Component),
|
||||||
|
cv.Optional(CONF_BREATH_RATE): sensor.sensor_schema(
|
||||||
|
accuracy_decimals=2,
|
||||||
|
state_class=STATE_CLASS_MEASUREMENT,
|
||||||
|
icon=ICON_PULSE,
|
||||||
|
),
|
||||||
|
cv.Optional(CONF_HEART_RATE): sensor.sensor_schema(
|
||||||
|
accuracy_decimals=0,
|
||||||
|
icon=ICON_HEART_PULSE,
|
||||||
|
state_class=STATE_CLASS_MEASUREMENT,
|
||||||
|
unit_of_measurement=UNIT_BEATS_PER_MINUTE,
|
||||||
|
),
|
||||||
|
cv.Optional(CONF_DISTANCE): sensor.sensor_schema(
|
||||||
|
device_class=DEVICE_CLASS_DISTANCE,
|
||||||
|
state_class=STATE_CLASS_MEASUREMENT,
|
||||||
|
unit_of_measurement=UNIT_CENTIMETER,
|
||||||
|
accuracy_decimals=2,
|
||||||
|
icon=ICON_SIGNAL,
|
||||||
|
),
|
||||||
|
}
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
|
async def to_code(config):
|
||||||
|
mr60bha2_component = await cg.get_variable(config[CONF_MR60BHA2_ID])
|
||||||
|
if breath_rate_config := config.get(CONF_BREATH_RATE):
|
||||||
|
sens = await sensor.new_sensor(breath_rate_config)
|
||||||
|
cg.add(mr60bha2_component.set_breath_rate_sensor(sens))
|
||||||
|
if heart_rate_config := config.get(CONF_HEART_RATE):
|
||||||
|
sens = await sensor.new_sensor(heart_rate_config)
|
||||||
|
cg.add(mr60bha2_component.set_heart_rate_sensor(sens))
|
||||||
|
if distance_config := config.get(CONF_DISTANCE):
|
||||||
|
sens = await sensor.new_sensor(distance_config)
|
||||||
|
cg.add(mr60bha2_component.set_distance_sensor(sens))
|
|
@ -1001,6 +1001,7 @@ ICON_GRAIN = "mdi:grain"
|
||||||
ICON_GYROSCOPE_X = "mdi:axis-x-rotate-clockwise"
|
ICON_GYROSCOPE_X = "mdi:axis-x-rotate-clockwise"
|
||||||
ICON_GYROSCOPE_Y = "mdi:axis-y-rotate-clockwise"
|
ICON_GYROSCOPE_Y = "mdi:axis-y-rotate-clockwise"
|
||||||
ICON_GYROSCOPE_Z = "mdi:axis-z-rotate-clockwise"
|
ICON_GYROSCOPE_Z = "mdi:axis-z-rotate-clockwise"
|
||||||
|
ICON_HEART_PULSE = "mdi:heart-pulse"
|
||||||
ICON_HEATING_COIL = "mdi:heating-coil"
|
ICON_HEATING_COIL = "mdi:heating-coil"
|
||||||
ICON_KEY_PLUS = "mdi:key-plus"
|
ICON_KEY_PLUS = "mdi:key-plus"
|
||||||
ICON_LIGHTBULB = "mdi:lightbulb"
|
ICON_LIGHTBULB = "mdi:lightbulb"
|
||||||
|
@ -1040,6 +1041,7 @@ ICON_WEATHER_WINDY = "mdi:weather-windy"
|
||||||
ICON_WIFI = "mdi:wifi"
|
ICON_WIFI = "mdi:wifi"
|
||||||
|
|
||||||
UNIT_AMPERE = "A"
|
UNIT_AMPERE = "A"
|
||||||
|
UNIT_BEATS_PER_MINUTE = "bpm"
|
||||||
UNIT_BECQUEREL_PER_CUBIC_METER = "Bq/m³"
|
UNIT_BECQUEREL_PER_CUBIC_METER = "Bq/m³"
|
||||||
UNIT_BYTES = "B"
|
UNIT_BYTES = "B"
|
||||||
UNIT_CELSIUS = "°C"
|
UNIT_CELSIUS = "°C"
|
||||||
|
|
19
tests/components/seeed_mr60bha2/common.yaml
Normal file
19
tests/components/seeed_mr60bha2/common.yaml
Normal file
|
@ -0,0 +1,19 @@
|
||||||
|
uart:
|
||||||
|
- id: seeed_mr60fda2_uart
|
||||||
|
tx_pin: ${uart_tx_pin}
|
||||||
|
rx_pin: ${uart_rx_pin}
|
||||||
|
baud_rate: 115200
|
||||||
|
parity: NONE
|
||||||
|
stop_bits: 1
|
||||||
|
|
||||||
|
seeed_mr60bha2:
|
||||||
|
id: my_seeed_mr60bha2
|
||||||
|
|
||||||
|
sensor:
|
||||||
|
- platform: seeed_mr60bha2
|
||||||
|
breath_rate:
|
||||||
|
name: "Real-time respiratory rate"
|
||||||
|
heart_rate:
|
||||||
|
name: "Real-time heart rate"
|
||||||
|
distance:
|
||||||
|
name: "Distance to detection object"
|
5
tests/components/seeed_mr60bha2/test.esp32-c3-ard.yaml
Normal file
5
tests/components/seeed_mr60bha2/test.esp32-c3-ard.yaml
Normal file
|
@ -0,0 +1,5 @@
|
||||||
|
substitutions:
|
||||||
|
uart_tx_pin: GPIO5
|
||||||
|
uart_rx_pin: GPIO4
|
||||||
|
|
||||||
|
<<: !include common.yaml
|
5
tests/components/seeed_mr60bha2/test.esp32-c3-idf.yaml
Normal file
5
tests/components/seeed_mr60bha2/test.esp32-c3-idf.yaml
Normal file
|
@ -0,0 +1,5 @@
|
||||||
|
substitutions:
|
||||||
|
uart_tx_pin: GPIO5
|
||||||
|
uart_rx_pin: GPIO4
|
||||||
|
|
||||||
|
<<: !include common.yaml
|
Loading…
Reference in a new issue