50 lines
1.2 KiB
C++
50 lines
1.2 KiB
C++
#include "marlin2.h"
|
|
#include "esphome/core/log.h"
|
|
|
|
namespace esphome {
|
|
namespace serial {
|
|
|
|
static const char *TAG = "serial.marlin2";
|
|
|
|
void Marlin2::loop() {
|
|
while (this->available()) {
|
|
uint8_t c;
|
|
this->read_byte(&c);
|
|
if (c == '\r')
|
|
continue;
|
|
if (c == '\n')
|
|
this->parse_values_();
|
|
else
|
|
this->rx_message_.push_back(c);
|
|
}
|
|
}
|
|
|
|
void Marlin2::parse_values_() {
|
|
std::string s(this->rx_message_.begin(), this->rx_message_.end());
|
|
int spos = 0;
|
|
int epos = 0;
|
|
std::vector<float> values;
|
|
while (epos != std::string::npos) {
|
|
epos = s.find(',', spos);
|
|
int len = (epos == std::string::npos ? s.size() - spos : epos - spos);
|
|
values.push_back(parse_number<float>(s.substr(spos, len)).value_or(NAN));
|
|
if (epos != std::string::npos)
|
|
spos = epos + 1;
|
|
}
|
|
this->rx_message_.clear();
|
|
for (auto sens : this->sensors_) {
|
|
if (sens.first < values.size())
|
|
sens.second->publish_state(values[sens.first]);
|
|
}
|
|
}
|
|
|
|
void Marlin2::dump_config() {
|
|
ESP_LOGCONFIG("", "Serial CSV Reader");
|
|
for (auto sens : this->sensors_) {
|
|
ESP_LOGCONFIG(TAG, "Index %d", sens.first);
|
|
LOG_SENSOR(TAG, "", sens.second);
|
|
}
|
|
}
|
|
|
|
} // namespace serial
|
|
} // namespace esphome
|