mirror of
https://github.com/esphome/esphome.git
synced 2025-03-25 03:58:23 +00:00
45 lines
1.3 KiB
C++
45 lines
1.3 KiB
C++
// Datasheet https://wiki.dfrobot.com/A01NYUB%20Waterproof%20Ultrasonic%20Sensor%20SKU:%20SEN0313
|
|
|
|
#include "a01nyub.h"
|
|
#include "esphome/core/helpers.h"
|
|
#include "esphome/core/log.h"
|
|
|
|
namespace esphome {
|
|
namespace a01nyub {
|
|
|
|
static const char *const TAG = "a01nyub.sensor";
|
|
|
|
void A01nyubComponent::loop() {
|
|
uint8_t data;
|
|
while (this->available() > 0) {
|
|
this->read_byte(&data);
|
|
if (this->buffer_.empty() && (data != 0xff))
|
|
continue;
|
|
buffer_.push_back(data);
|
|
if (this->buffer_.size() == 4)
|
|
this->check_buffer_();
|
|
}
|
|
}
|
|
|
|
void A01nyubComponent::check_buffer_() {
|
|
uint8_t checksum = this->buffer_[0] + this->buffer_[1] + this->buffer_[2];
|
|
if (this->buffer_[3] == checksum) {
|
|
float distance = (this->buffer_[1] << 8) + this->buffer_[2];
|
|
if (distance > 280) {
|
|
float meters = distance / 1000.0;
|
|
ESP_LOGV(TAG, "Distance from sensor: %f mm, %f m", distance, meters);
|
|
this->publish_state(meters);
|
|
} else {
|
|
ESP_LOGW(TAG, "Invalid data read from sensor: %s", format_hex_pretty(this->buffer_).c_str());
|
|
}
|
|
} else {
|
|
ESP_LOGW(TAG, "checksum failed: %02x != %02x", checksum, this->buffer_[3]);
|
|
}
|
|
this->buffer_.clear();
|
|
}
|
|
|
|
void A01nyubComponent::dump_config() { LOG_SENSOR("", "A01nyub Sensor", this); }
|
|
|
|
} // namespace a01nyub
|
|
} // namespace esphome
|