17#define SAFE_PUBLISH_SENSOR(sensor, value) (sensor).publish_state_if_not_dup(value)
19#define SAFE_PUBLISH_SENSOR_UNKNOWN(sensor) (sensor).publish_state_unknown()
21#define highbyte(val) (uint8_t) ((val) >> 8)
22#define lowbyte(val) (uint8_t) ((val) & 0xff)
27template<
typename T,
size_t N> optional<size_t>
find_index(
const T (&arr)[N], T
value) {
28 static_assert(
sizeof(T) == 1 ||
sizeof(T) == 4,
"flash tables are read as bytes or aligned 32 bit words");
29 for (
size_t i = 0; i < N; i++) {
31 if constexpr (
sizeof(T) == 1) {
43inline const char *
format_mac_str(
const uint8_t *mac_address, std::span<char, MAC_ADDRESS_PRETTY_BUFFER_SIZE>
buffer) {
46 uint8_t any_set = 0x00;
47 uint8_t all_set = 0xFF;
48 for (
size_t i = 0; i < MAC_ADDRESS_SIZE; i++) {
49 any_set |= mac_address[i];
50 all_set &= mac_address[i];
52 if (any_set != 0x00 && all_set != 0xFF) {
55 ESPHOME_strncpy_P(
buffer.data(), ESPHOME_PSTR(
"unknown"),
buffer.size());
61static constexpr uint8_t NO_MAC[MAC_ADDRESS_SIZE] PROGMEM = {0x08, 0x05, 0x04, 0x03, 0x02, 0x01};
64inline bool store_mac(
const uint8_t *reported, uint8_t *mac_address) {
65 uint8_t no_mac[MAC_ADDRESS_SIZE];
67 if (std::memcmp(reported, no_mac, MAC_ADDRESS_SIZE) == 0) {
68 std::memset(mac_address, 0, MAC_ADDRESS_SIZE);
71 std::memcpy(mac_address, reported, MAC_ADDRESS_SIZE);
78 ESPHOME_snprintf_P(
buffer.data(),
buffer.size(), ESPHOME_PSTR(
"%u.%02X.%02X%02X%02X%02X"), version[1], version[0],
79 version[5], version[4], version[3], version[2]);
83static constexpr uint8_t HEADER_FOOTER_SIZE = 4;
84static constexpr uint8_t CMD_FRAME_HEADER[HEADER_FOOTER_SIZE] = {0xFD, 0xFC, 0xFB, 0xFA};
85static constexpr uint8_t CMD_FRAME_FOOTER[HEADER_FOOTER_SIZE] = {0x04, 0x03, 0x02, 0x01};
88 return std::memcmp(header_footer,
buffer, HEADER_FOOTER_SIZE) == 0;
93 if (
count < HEADER_FOOTER_SIZE + 2) {
101 for (; from <
count; from++) {
102 const size_t n = std::min<size_t>(HEADER_FOOTER_SIZE,
count - from);
103 if (std::memcmp(&
buffer[from], CMD_FRAME_HEADER, n) == 0 || std::memcmp(&
buffer[from], data_header, n) == 0) {
115template<
size_t N,
typename LengthFn,
typename HandleFn,
typename DropFn>
117 LengthFn frame_length, HandleFn handle_frame, DropFn on_drop) {
119 if (
pos > 0 &&
pos < HEADER_FOOTER_SIZE) {
120 const uint8_t *header =
buffer[0] == data_header[0] ? data_header : CMD_FRAME_HEADER;
121 if (
byte != header[
pos]) {
125 if (
pos == 0 &&
byte != data_header[0] &&
byte != CMD_FRAME_HEADER[0]) {
132 if (frame_len == 0 || (frame_len <= N &&
pos < frame_len)) {
135 const uint8_t total =
pos;
138 if (frame_len <= N && handle_frame(
static_cast<uint8_t
>(frame_len))) {
bool store_mac(const uint8_t *reported, uint8_t *mac_address)
uint8_t drop_to_next_header(uint8_t *buffer, uint8_t count, uint8_t from, const uint8_t *data_header)
void format_version_str(const uint8_t *version, std::span< char, 20 > buffer)
bool validate_header_footer(const uint8_t *header_footer, const uint8_t *buffer)
const char * format_mac_str(const uint8_t *mac_address, std::span< char, MAC_ADDRESS_PRETTY_BUFFER_SIZE > buffer)
void feed_frame_byte(uint8_t(&buffer)[N], uint8_t &pos, uint8_t byte, const uint8_t *data_header, LengthFn frame_length, HandleFn handle_frame, DropFn on_drop)
optional< size_t > find_index(const T(&arr)[N], T value)
uint32_t cmd_frame_length(const uint8_t *buffer, uint8_t count)
void progmem_memcpy(void *dst, const void *src, size_t len)
constexpr T encode_value_le(const uint8_t *bytes)
Encode a value from its constituent bytes (from least to most significant) in an array with length si...
char * format_mac_addr_upper(const uint8_t *mac, char *output)
Format MAC address as XX:XX:XX:XX:XX:XX (uppercase, colon separators)
uint8_t progmem_read_byte(const uint8_t *addr)