mirror of
https://github.com/esphome/esphome.git
synced 2025-03-20 01:28:16 +00:00
3545803c87
Reported CO2 might be not correct while sensor is booting and while it boots it reports value 15000 in response at offset 6-7. So skip reporting till this value is being reurned. Signed-off-by: Igor Mammedov <imammedo@redhat.com>
110 lines
3.2 KiB
C++
110 lines
3.2 KiB
C++
#include "mhz19.h"
|
|
#include "esphome/core/log.h"
|
|
|
|
namespace esphome {
|
|
namespace mhz19 {
|
|
|
|
static const char *TAG = "mhz19";
|
|
static const uint8_t MHZ19_PDU_LENGTH = 9;
|
|
static const uint8_t MHZ19_COMMAND_GET_PPM[] = {0xFF, 0x01, 0x86, 0x00, 0x00, 0x00, 0x00, 0x00, 0x79};
|
|
|
|
uint8_t mhz19_checksum(const uint8_t *command) {
|
|
uint8_t sum = 0;
|
|
for (uint8_t i = 1; i < MHZ19_PDU_LENGTH - 1; i++) {
|
|
sum += command[i];
|
|
}
|
|
return 0xFF - sum + 0x01;
|
|
}
|
|
|
|
static char hex_buf[MHZ19_PDU_LENGTH * 3 + 1];
|
|
const char *dump_data_buf(const uint8_t *data) {
|
|
memset(hex_buf, '\0', sizeof(hex_buf));
|
|
for (int i = 0; i < MHZ19_PDU_LENGTH; i++) {
|
|
sprintf(hex_buf, "%s%0x%s", hex_buf, data[i], i == MHZ19_PDU_LENGTH - 1 ? "" : " ");
|
|
}
|
|
return hex_buf;
|
|
}
|
|
|
|
void MHZ19Component::update() {
|
|
uint8_t response[MHZ19_PDU_LENGTH];
|
|
if (!this->mhz19_write_command_(MHZ19_COMMAND_GET_PPM, response)) {
|
|
ESP_LOGW(TAG, "Reading data from MHZ19 failed!");
|
|
this->status_set_warning();
|
|
return;
|
|
}
|
|
|
|
if (response[0] != 0xFF || response[1] != 0x86) {
|
|
ESP_LOGW(TAG, "Invalid response from MHZ19! [%s]", dump_data_buf(response));
|
|
this->status_set_warning();
|
|
return;
|
|
}
|
|
|
|
/* Sensor reports U(15000) during boot, ingnore reported CO2 until it boots */
|
|
uint16_t u = (response[6] << 8) + response[7];
|
|
if (u == 15000) {
|
|
ESP_LOGD(TAG, "Sensor is booting");
|
|
return;
|
|
}
|
|
|
|
this->status_clear_warning();
|
|
const uint16_t ppm = (uint16_t(response[2]) << 8) | response[3];
|
|
const int temp = int(response[4]) - 40;
|
|
const uint8_t status = response[5];
|
|
|
|
ESP_LOGD(TAG, "MHZ19 Received CO₂=%uppm Temperature=%d°C Status=0x%02X", ppm, temp, status);
|
|
if (this->co2_sensor_ != nullptr)
|
|
this->co2_sensor_->publish_state(ppm);
|
|
if (this->temperature_sensor_ != nullptr)
|
|
this->temperature_sensor_->publish_state(temp);
|
|
}
|
|
|
|
bool MHZ19Component::mhz19_write_command_(const uint8_t *command, uint8_t *response) {
|
|
bool ret;
|
|
int rx_error = 0;
|
|
|
|
do {
|
|
ESP_LOGD(TAG, "cmd [%s]", dump_data_buf(command));
|
|
this->write_array(command, MHZ19_PDU_LENGTH);
|
|
this->flush();
|
|
|
|
if (response == nullptr)
|
|
return true;
|
|
|
|
memset(response, 0, MHZ19_PDU_LENGTH);
|
|
ret = this->read_array(response, MHZ19_PDU_LENGTH);
|
|
ESP_LOGD(TAG, "resp [%s]", dump_data_buf(response));
|
|
|
|
uint8_t checksum = mhz19_checksum(response);
|
|
if (checksum != response[8]) {
|
|
ESP_LOGW(TAG, "MHZ19 Checksum doesn't match: 0x%02X!=0x%02X [%s]",
|
|
response[8], checksum, dump_data_buf(response));
|
|
|
|
/*
|
|
* UART0 in NodeMCU v2, sometimes on boot has junk in RX buffer,
|
|
* check for it and drain all of it before sending commands to sensor
|
|
*/
|
|
this->drain();
|
|
ret = false;
|
|
if (++rx_error > 2) {
|
|
this->status_set_warning();
|
|
/* give up trying to recover, hope that it will be fine next update cycle */
|
|
rx_error = 0;
|
|
}
|
|
delay(100);
|
|
} else {
|
|
rx_error = 0;
|
|
}
|
|
} while (rx_error);
|
|
|
|
return ret;
|
|
}
|
|
float MHZ19Component::get_setup_priority() const { return setup_priority::DATA; }
|
|
void MHZ19Component::dump_config() {
|
|
ESP_LOGCONFIG(TAG, "MH-Z19:");
|
|
LOG_SENSOR(" ", "CO2", this->co2_sensor_);
|
|
LOG_SENSOR(" ", "Temperature", this->temperature_sensor_);
|
|
}
|
|
|
|
} // namespace mhz19
|
|
} // namespace esphome
|