1
0
mirror of https://github.com/esphome/esphome.git synced 2025-03-20 01:28:16 +00:00
Igor Mammedov 62e57aeac3 mhz19: report received responce if it's invalid
Signed-off-by: Igor Mammedov <imammedo@redhat.com>
2019-07-24 00:08:02 +08:00

84 lines
2.5 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;
}
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) {
ESP_LOGD(TAG, "cmd [%s]", dump_data_buf(command));
this->write_array(command, MHZ19_PDU_LENGTH);
this->flush();
if (response == nullptr)
return true;
bool 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));
this->status_set_warning();
return false;
}
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