mirror of https://github.com/arendst/Tasmota.git
548 lines
21 KiB
C++
548 lines
21 KiB
C++
/*
|
|
xsns_102_ld2410.ino - HLK-LD2410 24GHz smart wave motion sensor support for Tasmota
|
|
|
|
SPDX-FileCopyrightText: 2022 Theo Arends
|
|
|
|
SPDX-License-Identifier: GPL-3.0-only
|
|
*/
|
|
|
|
#ifdef USE_LD2410
|
|
/*********************************************************************************************\
|
|
* HLK-LD2410 24GHz smart wave motion sensor
|
|
*
|
|
* LD2410Duration 0 - Set factory default settings
|
|
* LD2410Duration 1..65535 - Set no-one duration in seconds (default 5)
|
|
* LD2410MovingSens 50,50,40,30,20,15,15,15,15 - Set moving distance sensitivity for up to 9 gates (at 0.75 meter interval)
|
|
* LD2410StaticSens 0,0,40,40,30,30,20,20,20 - Set static distance sensitivity for up to 9 gates (at 0.75 meter interval)
|
|
*
|
|
* Inspiration:
|
|
* https://community.home-assistant.io/t/mmwave-wars-one-sensor-module-to-rule-them-all/453260/2
|
|
* Resources:
|
|
* https://drive.google.com/drive/folders/1p4dhbEJA3YubyIjIIC7wwVsSo8x29Fq-?spm=a2g0o.detail.1000023.17.93465697yFwVxH
|
|
*
|
|
* Internal info:
|
|
* - After a LD2410 serial command a response takes about 10mS
|
|
* - After a LD2410 restart it takes at least 1000mS before commands are allowed
|
|
\*********************************************************************************************/
|
|
|
|
#define XSNS_102 102
|
|
|
|
#define LD2410_BUFFER_SIZE TM_SERIAL_BUFFER_SIZE // 64
|
|
#define LD2410_MAX_GATES 8 // 0 to 8 (= 9) - DO NOT CHANGE
|
|
|
|
#define LD2410_CMND_START_CONFIGURATION 0xFF
|
|
#define LD2410_CMND_END_CONFIGURATION 0xFE
|
|
#define LD2410_CMND_SET_DISTANCE 0x60
|
|
#define LD2410_CMND_READ_PARAMETERS 0x61
|
|
#define LD2410_CMND_START_ENGINEERING 0x62
|
|
#define LD2410_CMND_END_ENGINEERING 0x63
|
|
#define LD2410_CMND_SET_SENSITIVITY 0x64
|
|
#define LD2410_CMND_GET_FIRMWARE 0xA0
|
|
#define LD2410_CMND_SET_BAUDRATE 0xA1
|
|
#define LD2410_CMND_FACTORY_RESET 0xA2
|
|
#define LD2410_CMND_REBOOT 0xA3
|
|
#define LD2410_CMND_SET_BLUETOOTH 0xA4
|
|
#define LD2410_CMND_GET_BLUETOOTH_MAC 0xA5
|
|
|
|
const uint8_t LD2410_config_header[4] = {0xFD, 0xFC, 0xFB, 0xFA};
|
|
const uint8_t LD2410_config_footer[4] = {0x04, 0x03, 0x02, 0x01};
|
|
const uint8_t LD2410_target_header[4] = {0xF4, 0xF3, 0xF2, 0xF1};
|
|
const uint8_t LD2410_target_footer[4] = {0xF8, 0xF7, 0xF6, 0xF5};
|
|
|
|
#include <TasmotaSerial.h>
|
|
TasmotaSerial *LD2410Serial = nullptr;
|
|
|
|
struct {
|
|
uint8_t *buffer;
|
|
uint16_t moving_distance;
|
|
uint16_t static_distance;
|
|
uint16_t detect_distance;
|
|
uint16_t no_one_duration;
|
|
uint8_t moving_sensitivity[LD2410_MAX_GATES +1];
|
|
uint8_t static_sensitivity[LD2410_MAX_GATES +1];
|
|
uint8_t max_moving_distance_gate;
|
|
uint8_t max_static_distance_gate;
|
|
uint8_t moving_energy;
|
|
uint8_t static_energy;
|
|
uint8_t step;
|
|
uint8_t retry;
|
|
uint8_t settings;
|
|
uint8_t byte_counter;
|
|
bool valid_response;
|
|
} LD2410;
|
|
|
|
/********************************************************************************************/
|
|
|
|
uint32_t ToBcd(uint32_t value) {
|
|
return ((value >> 4) * 10) + (value & 0xF);
|
|
}
|
|
|
|
/********************************************************************************************/
|
|
|
|
void Ld1410HandleTargetData(void) {
|
|
if ((0x0D == LD2410.buffer[4]) && (0x55 == LD2410.buffer[17])) { // Add bad reception detection
|
|
// 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
|
|
// F4 F3 F2 F1 0D 00 02 AA 00 00 00 00 00 00 37 00 00 55 00 F8 F7 F6 F5 - No target
|
|
// F4 F3 F2 F1 0D 00 02 AA 00 45 00 3E 00 00 3A 00 00 55 00 F8 F7 F6 F5 - No target
|
|
// F4 F3 F2 F1 0D 00 02 AA 03 46 00 34 00 00 3C 00 00 55 00 F8 F7 F6 F5 - Movement and Stationary target
|
|
// F4 F3 F2 F1 0D 00 02 AA 02 54 00 00 00 00 64 00 00 55 00 F8 F7 F6 F5 - Stationary target
|
|
// F4 F3 F2 F1 0D 00 02 AA 02 96 00 00 00 00 36 00 00 55 00 F8 F7 F6 F5 - Stationary target
|
|
// F4 F3 F2 F1 0D 00 02 AA 03 2A 00 64 00 00 64 00 00 55 00 F8 F7 F6 F5 - Movement and Stationary target
|
|
// header |len |dt|hd|st|movin|me|stati|se|detec|tr|ck|trailer
|
|
if (LD2410.buffer[8] != 0x00) { // Movement and/or Stationary target
|
|
LD2410.moving_distance = LD2410.buffer[10] << 8 | LD2410.buffer[9];
|
|
LD2410.moving_energy = LD2410.buffer[11];
|
|
LD2410.static_distance = LD2410.buffer[13] << 8 | LD2410.buffer[12];
|
|
LD2410.static_energy = LD2410.buffer[14];
|
|
LD2410.detect_distance = LD2410.buffer[16] << 8 | LD2410.buffer[15];
|
|
/*
|
|
AddLog(LOG_LEVEL_DEBUG_MORE, PSTR("LD2: Type %d, State %d, Moving %d/%d%%, Static %d/%d%%, Detect %d"),
|
|
LD2410.buffer[6], LD2410.buffer[8],
|
|
LD2410.moving_distance, LD2410.moving_energy,
|
|
LD2410.static_distance, LD2410.static_energy,
|
|
LD2410.detect_distance);
|
|
*/
|
|
if (0x01 == LD2410.buffer[6]) { // Engineering mode data
|
|
// Adds 22 extra bytes of data
|
|
|
|
}
|
|
} else {
|
|
LD2410.moving_distance = 0;
|
|
LD2410.moving_energy = 0;
|
|
LD2410.static_distance = 0;
|
|
LD2410.static_energy = 0;
|
|
LD2410.detect_distance = 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
void Ld1410HandleConfigData(void) {
|
|
if (LD2410_CMND_READ_PARAMETERS == LD2410.buffer[6]) { // 0x61
|
|
// 0 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
|
|
// FD FC FB FA 1C 00 61 01 00 00 AA 08 08 08 32 32 28 1E 14 0F 0F 0F 0F 00 00 28 28 1E 1E 14 14 14 05 00 04 03 02 01 - Default
|
|
// header |len |cw cv|ack |hd|dd|md|sd|moving sensitivity 0..8 |static sensitivity 0..8 |timed|trailer
|
|
// | 28| | 0| | 8| 8| 8|50 50 40 30 20 15 15 15 15| 0 0 40 40 30 30 20 20 20| 5|
|
|
LD2410.max_moving_distance_gate = LD2410.buffer[12];
|
|
LD2410.max_static_distance_gate = LD2410.buffer[13];
|
|
for (uint32_t i = 0; i <= LD2410_MAX_GATES; i++) {
|
|
LD2410. moving_sensitivity[i] = LD2410.buffer[14 +i];
|
|
LD2410.static_sensitivity[i] = LD2410.buffer[23 +i];
|
|
}
|
|
LD2410.no_one_duration = LD2410.buffer[33] << 8 | LD2410.buffer[32];
|
|
}
|
|
else if (LD2410_CMND_START_CONFIGURATION == LD2410.buffer[6]) { // 0xFF
|
|
// 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17
|
|
// FD FC FB FA 08 00 FF 01 00 00 01 00 40 00 04 03 02 01
|
|
// header |len |ty |ack |protv|bsize|trailer
|
|
// | 8| | 0| 1| 64|
|
|
LD2410.valid_response = true;
|
|
}
|
|
else if (LD2410_CMND_GET_FIRMWARE == LD2410.buffer[6]) { // 0xA0
|
|
// 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
|
|
// FD FC FB FA 0C 00 A0 01 00 00 00 01 07 01 16 15 09 22 04 03 02 01
|
|
// header |len |ty|hd|ack |ftype|major|minor |trailer
|
|
// | 12| | 1| 0| 256| 1.7| 22091516|
|
|
AddLog(LOG_LEVEL_INFO, PSTR("LD2: Firmware version V%d.%02d.%02d%02d%02d%02d"), // Firmware version V1.07.22091516
|
|
ToBcd(LD2410.buffer[13]), ToBcd(LD2410.buffer[12]),
|
|
ToBcd(LD2410.buffer[17]), ToBcd(LD2410.buffer[16]), ToBcd(LD2410.buffer[15]), ToBcd(LD2410.buffer[14]));
|
|
}
|
|
}
|
|
|
|
bool Ld2410Match(const uint8_t *header, uint32_t offset) {
|
|
for (uint32_t i = 0; i < 4; i++) {
|
|
if (LD2410.buffer[offset +i] != header[i]) { return false; }
|
|
}
|
|
return true;
|
|
}
|
|
|
|
void Ld2410Input(void) {
|
|
/*
|
|
// Works with TasmotaSerial as SoftwareSerial but fails with HardwareSerial
|
|
uint32_t size = LD2410Serial->read(LD2410.buffer, LD2410_BUFFER_SIZE);
|
|
if (size) {
|
|
AddLog(LOG_LEVEL_DEBUG_MORE, PSTR("LD2: Rcvd %*_H"), size, LD2410.buffer);
|
|
|
|
bool target_header = (Ld2410Match(LD2410_target_header, 0)); // F4F3F2F1
|
|
bool config_header = (Ld2410Match(LD2410_config_header, 0)); // FDFCFBFA
|
|
if (target_header || config_header) {
|
|
uint32_t len = LD2410.buffer[4] +10; // Total packet size
|
|
if (size >= len) { // Handle only the first entry (if there are more)
|
|
if (target_header) { // F4F3F2F1
|
|
if (Ld2410Match(LD2410_target_footer, len -4)) { // F8F7F6F5
|
|
Ld1410HandleTargetData();
|
|
}
|
|
}
|
|
else if (config_header) { // FDFCFBFA
|
|
if (Ld2410Match(LD2410_config_footer, len -4)) { // 04030201
|
|
Ld1410HandleConfigData();
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
*/
|
|
// Works with TasmotaSerial and HardwareSerial
|
|
while (LD2410Serial->available()) {
|
|
yield(); // Fix watchdogs
|
|
|
|
LD2410.buffer[LD2410.byte_counter++] = LD2410Serial->read();
|
|
if (LD2410.byte_counter < 4) { continue; } // Need first four header bytes
|
|
|
|
uint32_t header_start = LD2410.byte_counter -4; // Fix interrupted header transmits
|
|
bool target_header = (Ld2410Match(LD2410_target_header, header_start)); // F4F3F2F1
|
|
bool config_header = (Ld2410Match(LD2410_config_header, header_start)); // FDFCFBFA
|
|
if ((target_header || config_header) && (header_start != 0)) {
|
|
memmove(LD2410.buffer, LD2410.buffer + header_start, 4); // Sync buffer with header
|
|
LD2410.byte_counter = 4;
|
|
}
|
|
if (LD2410.byte_counter < 6) { continue; } // Need packet size bytes
|
|
|
|
target_header = (Ld2410Match(LD2410_target_header, 0)); // F4F3F2F1
|
|
config_header = (Ld2410Match(LD2410_config_header, 0)); // FDFCFBFA
|
|
if (target_header || config_header) {
|
|
uint32_t len = LD2410.buffer[4] +10; // Total packet size
|
|
if (len > LD2410_BUFFER_SIZE) {
|
|
LD2410.byte_counter = 0; // Invalid data
|
|
break; // Exit loop to satisfy yields
|
|
}
|
|
if (LD2410.byte_counter < len) { continue; } // Need complete packet
|
|
|
|
AddLog(LOG_LEVEL_DEBUG_MORE, PSTR("LD2: Rcvd %*_H"), len, LD2410.buffer);
|
|
|
|
if (target_header) { // F4F3F2F1
|
|
|
|
// AddLog(LOG_LEVEL_DEBUG_MORE, PSTR("LD2: Rcvd %*_H"), len, LD2410.buffer);
|
|
|
|
if (Ld2410Match(LD2410_target_footer, len -4)) { // F8F7F6F5
|
|
Ld1410HandleTargetData();
|
|
}
|
|
}
|
|
else if (config_header) { // FDFCFBFA
|
|
|
|
// AddLog(LOG_LEVEL_DEBUG_MORE, PSTR("LD2: Rcvd %*_H"), len, LD2410.buffer);
|
|
|
|
if (Ld2410Match(LD2410_config_footer, len -4)) { // 04030201
|
|
Ld1410HandleConfigData();
|
|
LD2410Serial->setReadChunkMode(0); // Disable chunk mode fixing Hardware Watchdogs
|
|
}
|
|
}
|
|
}
|
|
LD2410.byte_counter = 0; // Finished or bad received footer
|
|
break; // Exit loop to satisfy yields
|
|
}
|
|
// If here then LD2410.byte_counter could still be partial correct for next loop
|
|
}
|
|
|
|
void Ld2410SendCommand(uint32_t command, uint8_t *val = nullptr, uint32_t val_len = 0);
|
|
void Ld2410SendCommand(uint32_t command, uint8_t *val, uint32_t val_len) {
|
|
uint32_t len = val_len +12;
|
|
uint8_t buffer[len];
|
|
buffer[0] = 0xFD;
|
|
buffer[1] = 0xFC;
|
|
buffer[2] = 0xFB;
|
|
buffer[3] = 0xFA;
|
|
buffer[4] = val_len +2;
|
|
buffer[5] = 0x00;
|
|
buffer[6] = command;
|
|
buffer[7] = 0x00;
|
|
if (val) {
|
|
for (uint32_t i = 0; i < val_len; i++) {
|
|
buffer[8 +i] = val[i];
|
|
}
|
|
}
|
|
buffer[8 +val_len] = 0x04;
|
|
buffer[9 +val_len] = 0x03;
|
|
buffer[10 +val_len] = 0x02;
|
|
buffer[11 +val_len] = 0x01;
|
|
|
|
AddLog(LOG_LEVEL_DEBUG_MORE, PSTR("LD2: Send %*_H"), len, buffer);
|
|
|
|
LD2410Serial->setReadChunkMode(1); // Enable chunk mode introducing possible Hardware Watchdogs
|
|
LD2410Serial->flush();
|
|
LD2410Serial->write(buffer, len);
|
|
}
|
|
|
|
void Ld2410SetConfigMode(void) { // 0xFF
|
|
uint8_t value[2] = { 0x01, 0x00 };
|
|
Ld2410SendCommand(LD2410_CMND_START_CONFIGURATION, value, sizeof(value));
|
|
}
|
|
|
|
void Ld2410SetMaxDistancesAndNoneDuration(uint32_t max_moving_distance_range, uint32_t max_static_distance_range, uint32_t no_one_duration) { // 0x60
|
|
// Distance range value can be set from 1 to 8 (distance gates of 0.75 meter)
|
|
// No-one duration value can be set from 1 to 65535 (seconds)
|
|
// 00 00 08 00 00 00 01 00 08 00 00 00 02 00 05 00 00 00
|
|
// motio| 8|stati| 8|durat|seconds
|
|
uint8_t lsb_nd = no_one_duration & 0xFF;
|
|
uint8_t msb_nd = (no_one_duration >> 8) & 0xFF;
|
|
uint8_t value[18] = { 0x00, 0x00, (uint8_t)max_moving_distance_range, 0x00, 0x00, 0x00, 0x01, 0x00, (uint8_t)max_static_distance_range, 0x00, 0x00, 0x00, 0x02, 0x00, lsb_nd, msb_nd, 0x00, 0x00 };
|
|
Ld2410SendCommand(LD2410_CMND_SET_DISTANCE, value, sizeof(value));
|
|
}
|
|
|
|
void Ld2410SetGateSensitivity(uint32_t gate, uint32_t moving_sensitivity, uint32_t static_sensitivity) { // 0x64
|
|
// Sensitivity value can be set from 0 to 100 (%) for gates 0 to 8
|
|
// 00 00 03 00 00 00 01 00 28 00 00 00 02 00 28 00 00 00
|
|
// gate | 3|motio| 40|stati| 40
|
|
uint8_t value[18] = { 0x00, 0x00, (uint8_t)gate, 0x00, 0x00, 0x00, 0x01, 0x00, (uint8_t)moving_sensitivity, 0x00, 0x00, 0x00, 0x02, 0x00, (uint8_t)static_sensitivity, 0x00, 0x00, 0x00 };
|
|
Ld2410SendCommand(LD2410_CMND_SET_SENSITIVITY, value, sizeof(value));
|
|
}
|
|
|
|
void Ld2410SetAllSensitivity(uint32_t sensitivity) { // 0x64
|
|
// Sensitivity value can be set from 0 to 100
|
|
// 00 00 FF FF 00 00 01 00 28 00 00 00 02 00 28 00 00 00
|
|
// gate |all gates |motio| 40|stati| 40
|
|
uint8_t value[18] = { 0x00, 0x00, 0xFF, 0xFF, 0x00, 0x00, 0x01, 0x00, (uint8_t)sensitivity, 0x00, 0x00, 0x00, 0x02, 0x00, (uint8_t)sensitivity, 0x00, 0x00, 0x00 };
|
|
Ld2410SendCommand(LD2410_CMND_SET_SENSITIVITY, value, sizeof(value));
|
|
}
|
|
|
|
void Ld2410SetBaudrate(uint32_t index) { // 0xA1
|
|
uint8_t value[2] = { (uint8_t)index, 0x00 };
|
|
Ld2410SendCommand(LD2410_CMND_SET_BAUDRATE, value, sizeof(value));
|
|
}
|
|
|
|
/********************************************************************************************/
|
|
|
|
void Ld2410Every100MSecond(void) {
|
|
if (LD2410.step) {
|
|
LD2410.step--;
|
|
switch (LD2410.step) {
|
|
// case 60: Set default settings
|
|
case 59:
|
|
Ld2410SetConfigMode(); // Stop running mode
|
|
break;
|
|
case 57:
|
|
Ld2410SendCommand(LD2410_CMND_FACTORY_RESET);
|
|
break;
|
|
case 56:
|
|
Ld2410SendCommand(LD2410_CMND_REBOOT); // Wait at least 1 second
|
|
break;
|
|
case 51:
|
|
LD2410.step = 12;
|
|
AddLog(LOG_LEVEL_DEBUG, PSTR("LD2: Settings factory reset"));
|
|
break;
|
|
|
|
// case 40: Save settings
|
|
case 39:
|
|
Ld2410SetConfigMode(); // Stop running mode
|
|
break;
|
|
case 37:
|
|
Ld2410SetMaxDistancesAndNoneDuration(8, 8, LD2410.no_one_duration);
|
|
break;
|
|
case 28 ... 36: {
|
|
uint32_t index = LD2410.step -28;
|
|
Ld2410SetGateSensitivity(index, LD2410.moving_sensitivity[index], LD2410.static_sensitivity[index]);
|
|
}
|
|
break;
|
|
case 27:
|
|
LD2410.step = 3;
|
|
AddLog(LOG_LEVEL_DEBUG, PSTR("LD2: Settings saved"));
|
|
break;
|
|
/*
|
|
// case 24: pre-POC using 57600 bps instead of default 256000 bps
|
|
case 23:
|
|
AddLog(LOG_LEVEL_DEBUG, PSTR("LD2: Switch to 57600 bps"));
|
|
LD2410Serial->flush();
|
|
LD2410Serial->begin(256000);
|
|
break;
|
|
case 21:
|
|
Ld2410SetConfigMode(); // Stop running mode
|
|
break;
|
|
case 19:
|
|
Ld2410SetBaudrate(4); // 57600 bps
|
|
break;
|
|
case 18:
|
|
Ld2410SendCommand(LD2410_CMND_REBOOT); // Wait at least 1 second
|
|
LD2410Serial->flush();
|
|
LD2410Serial->begin(57600);
|
|
break;
|
|
*/
|
|
// case 12: Init
|
|
case 5:
|
|
Ld2410SetConfigMode(); // Stop running mode
|
|
break;
|
|
case 3:
|
|
if (!LD2410.valid_response && LD2410.retry) {
|
|
LD2410.retry--;
|
|
if (LD2410.retry) {
|
|
// LD2410.step = 24; // Change baudrate
|
|
LD2410.step = 7; // Retry
|
|
} else {
|
|
LD2410.step = 0;
|
|
AddLog(LOG_LEVEL_DEBUG, PSTR("LD2: Not detected"));
|
|
}
|
|
} else {
|
|
Ld2410SendCommand(LD2410_CMND_GET_FIRMWARE);
|
|
}
|
|
break;
|
|
case 2:
|
|
Ld2410SendCommand(LD2410_CMND_READ_PARAMETERS);
|
|
break;
|
|
case 1:
|
|
Ld2410SendCommand(LD2410_CMND_END_CONFIGURATION);
|
|
break;
|
|
}
|
|
} else {
|
|
if (1 == LD2410.settings) {
|
|
LD2410.settings = 0;
|
|
LD2410.step = 40;
|
|
}
|
|
else if (2 == LD2410.settings) {
|
|
LD2410.settings = 0;
|
|
LD2410.step = 60;
|
|
}
|
|
}
|
|
}
|
|
|
|
void Ld2410EverySecond(void) {
|
|
if (LD2410.moving_energy) {
|
|
// Send state change to be captured by rules
|
|
// {"Time":"2022-11-26T10:48:16","Switch1":"ON","LD2410":{"Distance":[125.0,0.0,0.0],"Energy":[0,100]}}
|
|
MqttPublishSensor();
|
|
}
|
|
}
|
|
|
|
void Ld2410Detect(void) {
|
|
if (PinUsed(GPIO_LD2410_RX) && PinUsed(GPIO_LD2410_TX)) {
|
|
LD2410.buffer = (uint8_t*)malloc(LD2410_BUFFER_SIZE); // Default 64
|
|
if (!LD2410.buffer) { return; }
|
|
LD2410Serial = new TasmotaSerial(Pin(GPIO_LD2410_RX), Pin(GPIO_LD2410_TX), 2);
|
|
if (LD2410Serial->begin(256000)) {
|
|
if (LD2410Serial->hardwareSerial()) { ClaimSerial(); }
|
|
|
|
LD2410.retry = 4;
|
|
LD2410.step = 12;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*********************************************************************************************\
|
|
* Commands
|
|
\*********************************************************************************************/
|
|
|
|
const char kLd2410Commands[] PROGMEM = "LD2410|" // Prefix
|
|
"Duration|MovingSens|StaticSens";
|
|
|
|
void (* const Ld2410Command[])(void) PROGMEM = {
|
|
&CmndLd2410Duration, &CmndLd2410MovingSensitivity, &CmndLd2410StaticSensitivity };
|
|
|
|
void Ld2410Response(void) {
|
|
Response_P(PSTR("{\"LD2410\":{\"Duration\":%d,\"Moving\":{\"Gates\":%d,\"Sensitivity\":["),
|
|
LD2410.no_one_duration, LD2410.max_moving_distance_gate);
|
|
for (uint32_t i = 0; i <= LD2410_MAX_GATES; i++) {
|
|
ResponseAppend_P(PSTR("%s%d"), (i==0)?"":",", LD2410.moving_sensitivity[i]);
|
|
}
|
|
ResponseAppend_P(PSTR("]},\"Static\":{\"Gates\":%d,\"Sensitivity\":["), LD2410.max_static_distance_gate);
|
|
for (uint32_t i = 0; i <= LD2410_MAX_GATES; i++) {
|
|
ResponseAppend_P(PSTR("%s%d"), (i==0)?"":",", LD2410.static_sensitivity[i]);
|
|
}
|
|
ResponseAppend_P(PSTR("]}}}"));
|
|
}
|
|
|
|
void CmndLd2410Duration(void) {
|
|
// LD2410Duration 0 - Set default settings
|
|
if (0 == XdrvMailbox.payload) {
|
|
LD2410.settings = 2;
|
|
}
|
|
// LD2410Duration 5
|
|
else if ((XdrvMailbox.payload > 0) && (XdrvMailbox.payload <= 65535)) {
|
|
LD2410.no_one_duration = XdrvMailbox.payload;
|
|
LD2410.settings = 1;
|
|
}
|
|
Ld2410Response();
|
|
}
|
|
|
|
void CmndLd2410MovingSensitivity(void) {
|
|
// LD2410MovingSens 50,50,40,30,20,15,15,15,15
|
|
uint32_t parm[LD2410_MAX_GATES +1] = { 0 };
|
|
uint32_t count = ParseParameters(LD2410_MAX_GATES +1, parm);
|
|
if (count) {
|
|
for (uint32_t i = 0; i < count; i++) {
|
|
if ((parm[i] >= 0) && (parm[i] <= 100)) {
|
|
LD2410.moving_sensitivity[i] = parm[i];
|
|
}
|
|
}
|
|
LD2410.settings = 1;
|
|
}
|
|
Ld2410Response();
|
|
}
|
|
|
|
void CmndLd2410StaticSensitivity(void) {
|
|
// LD2410StaticSens 0,0,40,40,30,30,20,20,20
|
|
uint32_t parm[LD2410_MAX_GATES +1] = { 0 };
|
|
uint32_t count = ParseParameters(LD2410_MAX_GATES +1, parm);
|
|
if (count) {
|
|
for (uint32_t i = 0; i < count; i++) {
|
|
if ((parm[i] >= 0) && (parm[i] <= 100)) {
|
|
LD2410.static_sensitivity[i] = parm[i];
|
|
}
|
|
}
|
|
LD2410.settings = 1;
|
|
}
|
|
Ld2410Response();
|
|
}
|
|
|
|
/*********************************************************************************************\
|
|
* Presentation
|
|
\*********************************************************************************************/
|
|
|
|
#ifdef USE_WEBSERVER
|
|
const char HTTP_SNS_LD2410_CM[] PROGMEM =
|
|
"{s}LD2410 " D_MOVING_DISTANCE "{m}%1_f " D_UNIT_CENTIMETER "{e}"
|
|
"{s}LD2410 " D_STATIC_DISTANCE "{m}%1_f " D_UNIT_CENTIMETER "{e}"
|
|
"{s}LD2410 " D_DETECT_DISTANCE "{m}%1_f " D_UNIT_CENTIMETER "{e}";
|
|
#endif
|
|
|
|
void Ld2410Show(bool json) {
|
|
float moving_distance = LD2410.moving_distance;
|
|
float static_distance = LD2410.static_distance;
|
|
float detect_distance = LD2410.detect_distance;
|
|
if (json) {
|
|
// cm cm cm % %
|
|
ResponseAppend_P(PSTR(",\"LD2410\":{\"" D_JSON_DISTANCE "\":[%1_f,%1_f,%1_f],\"" D_JSON_ENERGY "\":[%d,%d]}"),
|
|
&moving_distance, &static_distance, &detect_distance, LD2410.moving_energy, LD2410.static_energy);
|
|
#ifdef USE_WEBSERVER
|
|
} else {
|
|
WSContentSend_PD(HTTP_SNS_LD2410_CM, &moving_distance, &static_distance, &detect_distance);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
/*********************************************************************************************\
|
|
* Interface
|
|
\*********************************************************************************************/
|
|
|
|
bool Xsns102(uint32_t function) {
|
|
bool result = false;
|
|
|
|
if (FUNC_INIT == function) {
|
|
Ld2410Detect();
|
|
}
|
|
else if (LD2410Serial) {
|
|
switch (function) {
|
|
case FUNC_LOOP:
|
|
case FUNC_SLEEP_LOOP:
|
|
Ld2410Input();
|
|
break;
|
|
case FUNC_EVERY_100_MSECOND:
|
|
Ld2410Every100MSecond();
|
|
break;
|
|
case FUNC_EVERY_SECOND:
|
|
Ld2410EverySecond();
|
|
break;
|
|
case FUNC_JSON_APPEND:
|
|
Ld2410Show(1);
|
|
break;
|
|
#ifdef USE_WEBSERVER
|
|
case FUNC_WEB_SENSOR:
|
|
Ld2410Show(0);
|
|
break;
|
|
#endif // USE_WEBSERVER
|
|
case FUNC_COMMAND:
|
|
result = DecodeCommand(kLd2410Commands, Ld2410Command);
|
|
break;
|
|
}
|
|
}
|
|
return result;
|
|
}
|
|
|
|
#endif // USE_LD2410
|