Fork of the espurna firmware for `mhsw` switches
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

696 lines
23 KiB

7 years ago
7 years ago
7 years ago
  1. /*
  2. SENSOR MODULE
  3. Copyright (C) 2016-2017 by Xose Pérez <xose dot perez at gmail dot com>
  4. */
  5. #include <vector>
  6. #include "filters/MaxFilter.h"
  7. #include "filters/MedianFilter.h"
  8. #include "filters/MovingAverageFilter.h"
  9. #include "sensors/BaseSensor.h"
  10. typedef struct {
  11. BaseSensor * sensor;
  12. unsigned char local; // Local index in its provider
  13. magnitude_t type; // Type of measurement
  14. unsigned char global; // Global index in its type
  15. double current; // Current (last) value, unfiltered
  16. double filtered; // Filtered (averaged) value
  17. double reported; // Last reported value
  18. double min_change; // Minimum value change to report
  19. BaseFilter * filter; // Filter object
  20. } sensor_magnitude_t;
  21. std::vector<BaseSensor *> _sensors;
  22. std::vector<sensor_magnitude_t> _magnitudes;
  23. unsigned char _counts[MAGNITUDE_MAX];
  24. bool _sensor_realtime = API_REAL_TIME_VALUES;
  25. unsigned char _sensor_temperature_units = SENSOR_TEMPERATURE_UNITS;
  26. double _sensor_temperature_correction = SENSOR_TEMPERATURE_CORRECTION;
  27. // -----------------------------------------------------------------------------
  28. // Private
  29. // -----------------------------------------------------------------------------
  30. String _sensorTopic(magnitude_t type) {
  31. if (type == MAGNITUDE_TEMPERATURE) return String(MAGNITUDE_TEMPERATURE_TOPIC);
  32. if (type == MAGNITUDE_HUMIDITY) return String(MAGNITUDE_HUMIDITY_TOPIC);
  33. if (type == MAGNITUDE_PRESSURE) return String(MAGNITUDE_PRESSURE_TOPIC);
  34. if (type == MAGNITUDE_CURRENT) return String(MAGNITUDE_CURRENT_TOPIC);
  35. if (type == MAGNITUDE_VOLTAGE) return String(MAGNITUDE_VOLTAGE_TOPIC);
  36. if (type == MAGNITUDE_POWER_ACTIVE) return String(MAGNITUDE_ACTIVE_POWER_TOPIC);
  37. if (type == MAGNITUDE_POWER_APPARENT) return String(MAGNITUDE_APPARENT_POWER_TOPIC);
  38. if (type == MAGNITUDE_POWER_REACTIVE) return String(MAGNITUDE_REACTIVE_POWER_TOPIC);
  39. if (type == MAGNITUDE_POWER_FACTOR) return String(MAGNITUDE_POWER_FACTOR_TOPIC);
  40. if (type == MAGNITUDE_ENERGY) return String(MAGNITUDE_ENERGY_TOPIC);
  41. if (type == MAGNITUDE_ENERGY_DELTA) return String(MAGNITUDE_ENERGY_DELTA_TOPIC);
  42. if (type == MAGNITUDE_ANALOG) return String(MAGNITUDE_ANALOG_TOPIC);
  43. if (type == MAGNITUDE_DIGITAL) return String(MAGNITUDE_DIGITAL_TOPIC);
  44. if (type == MAGNITUDE_EVENTS) return String(MAGNITUDE_EVENTS_TOPIC);
  45. if (type == MAGNITUDE_PM1dot0) return String(MAGNITUDE_PM1dot0_TOPIC);
  46. if (type == MAGNITUDE_PM2dot5) return String(MAGNITUDE_PM2dot5_TOPIC);
  47. if (type == MAGNITUDE_PM10) return String(MAGNITUDE_PM10_TOPIC);
  48. if (type == MAGNITUDE_CO2) return String(MAGNITUDE_CO2_TOPIC);
  49. return String(MAGNITUDE_UNKNOWN_TOPIC);
  50. }
  51. unsigned char _sensorDecimals(magnitude_t type) {
  52. if (type == MAGNITUDE_TEMPERATURE) return MAGNITUDE_TEMPERATURE_DECIMALS;
  53. if (type == MAGNITUDE_HUMIDITY) return MAGNITUDE_HUMIDITY_DECIMALS;
  54. if (type == MAGNITUDE_PRESSURE) return MAGNITUDE_PRESSURE_DECIMALS;
  55. if (type == MAGNITUDE_CURRENT) return MAGNITUDE_CURRENT_DECIMALS;
  56. if (type == MAGNITUDE_VOLTAGE) return MAGNITUDE_VOLTAGE_DECIMALS;
  57. if (type == MAGNITUDE_POWER_ACTIVE) return MAGNITUDE_POWER_DECIMALS;
  58. if (type == MAGNITUDE_POWER_APPARENT) return MAGNITUDE_POWER_DECIMALS;
  59. if (type == MAGNITUDE_POWER_REACTIVE) return MAGNITUDE_POWER_DECIMALS;
  60. if (type == MAGNITUDE_POWER_FACTOR) return MAGNITUDE_POWER_FACTOR_DECIMALS;
  61. if (type == MAGNITUDE_ENERGY) return MAGNITUDE_ENERGY_DECIMALS;
  62. if (type == MAGNITUDE_ENERGY_DELTA) return MAGNITUDE_ENERGY_DECIMALS;
  63. if (type == MAGNITUDE_ANALOG) return MAGNITUDE_ANALOG_DECIMALS;
  64. if (type == MAGNITUDE_EVENTS) return MAGNITUDE_EVENTS_DECIMALS;
  65. if (type == MAGNITUDE_PM1dot0) return MAGNITUDE_PM1dot0_DECIMALS;
  66. if (type == MAGNITUDE_PM2dot5) return MAGNITUDE_PM2dot5_DECIMALS;
  67. if (type == MAGNITUDE_PM10) return MAGNITUDE_PM10_DECIMALS;
  68. if (type == MAGNITUDE_CO2) return MAGNITUDE_CO2_DECIMALS;
  69. return 0;
  70. }
  71. String _sensorUnits(magnitude_t type) {
  72. if (type == MAGNITUDE_TEMPERATURE) return (_sensor_temperature_units == TMP_CELSIUS) ? String("C") : String("F");
  73. if (type == MAGNITUDE_HUMIDITY) return String("%");
  74. if (type == MAGNITUDE_PRESSURE) return String("hPa");
  75. if (type == MAGNITUDE_CURRENT) return String("A");
  76. if (type == MAGNITUDE_VOLTAGE) return String("V");
  77. if (type == MAGNITUDE_POWER_ACTIVE) return String("W");
  78. if (type == MAGNITUDE_POWER_APPARENT) return String("W");
  79. if (type == MAGNITUDE_POWER_REACTIVE) return String("W");
  80. if (type == MAGNITUDE_POWER_FACTOR) return String("%");
  81. if (type == MAGNITUDE_ENERGY) return String("J");
  82. if (type == MAGNITUDE_ENERGY_DELTA) return String("J");
  83. if (type == MAGNITUDE_EVENTS) return String("/min");
  84. if (type == MAGNITUDE_PM1dot0) return String("µg/m3");
  85. if (type == MAGNITUDE_PM2dot5) return String("µg/m3");
  86. if (type == MAGNITUDE_PM10) return String("µg/m3");
  87. if (type == MAGNITUDE_CO2) return String("ppm");
  88. return String();
  89. }
  90. double _sensorProcess(magnitude_t type, double value) {
  91. if (type == MAGNITUDE_TEMPERATURE) {
  92. if (_sensor_temperature_units == TMP_FAHRENHEIT) value = value * 1.8 + 32;
  93. value = value + _sensor_temperature_correction;
  94. }
  95. return roundTo(value, _sensorDecimals(type));
  96. }
  97. #if WEB_SUPPORT
  98. void _sensorWebSocketSendData(JsonObject& root) {
  99. char buffer[10];
  100. bool hasTemperature = false;
  101. JsonArray& list = root.createNestedArray("magnitudes");
  102. for (unsigned char i=0; i<_magnitudes.size(); i++) {
  103. sensor_magnitude_t magnitude = _magnitudes[i];
  104. unsigned char decimals = _sensorDecimals(magnitude.type);
  105. dtostrf(magnitude.current, 1-sizeof(buffer), decimals, buffer);
  106. JsonObject& element = list.createNestedObject();
  107. element["type"] = int(magnitude.type);
  108. element["value"] = String(buffer);
  109. element["units"] = _sensorUnits(magnitude.type);
  110. element["description"] = magnitude.sensor->slot(magnitude.local);
  111. element["error"] = magnitude.sensor->error();
  112. if (magnitude.type == MAGNITUDE_TEMPERATURE) hasTemperature = true;
  113. }
  114. //root["apiRealTime"] = _sensor_realtime;
  115. root["tmpUnits"] = _sensor_temperature_units;
  116. root["tmpCorrection"] = _sensor_temperature_correction;
  117. if (hasTemperature) root["temperatureVisible"] = 1;
  118. }
  119. void _sensorWebSocketStart(JsonObject& root) {
  120. bool hasSensors = false;
  121. for (unsigned char i=0; i<_sensors.size(); i++) {
  122. BaseSensor * sensor = _sensors[i];
  123. #if EMON_ANALOG_SUPPORT
  124. if (sensor->getID() == SENSOR_EMON_ANALOG_ID) {
  125. root["emonVisible"] = 1;
  126. root["pwrVoltage"] = ((EmonAnalogSensor *) sensor)->getVoltage();
  127. hasSensors = true;
  128. }
  129. #endif
  130. #if HLW8012_SUPPORT
  131. if (sensor->getID() == SENSOR_HLW8012_ID) {
  132. root["hlwVisible"] = 1;
  133. hasSensors = true;
  134. }
  135. #endif
  136. }
  137. if (hasSensors) root["sensorsVisible"] = 1;
  138. /*
  139. // Sensors manifest
  140. JsonArray& manifest = root.createNestedArray("manifest");
  141. #if BMX280_SUPPORT
  142. BMX280Sensor::manifest(manifest);
  143. #endif
  144. // Sensors configuration
  145. JsonArray& sensors = root.createNestedArray("sensors");
  146. for (unsigned char i; i<_sensors.size(); i++) {
  147. JsonObject& sensor = sensors.createNestedObject();
  148. sensor["index"] = i;
  149. sensor["id"] = _sensors[i]->getID();
  150. _sensors[i]->getConfig(sensor);
  151. }
  152. */
  153. }
  154. void _sensorAPISetup() {
  155. for (unsigned char magnitude_id=0; magnitude_id<_magnitudes.size(); magnitude_id++) {
  156. sensor_magnitude_t magnitude = _magnitudes[magnitude_id];
  157. String topic = _sensorTopic(magnitude.type);
  158. if (SENSOR_USE_INDEX || (_counts[magnitude.type] > 1)) topic = topic + "/" + String(magnitude.global);
  159. apiRegister(topic.c_str(), topic.c_str(), [magnitude_id](char * buffer, size_t len) {
  160. sensor_magnitude_t magnitude = _magnitudes[magnitude_id];
  161. unsigned char decimals = _sensorDecimals(magnitude.type);
  162. double value = _sensor_realtime ? magnitude.current : magnitude.filtered;
  163. dtostrf(value, 1-len, decimals, buffer);
  164. });
  165. }
  166. }
  167. #endif
  168. void _sensorTick() {
  169. for (unsigned char i=0; i<_sensors.size(); i++) {
  170. _sensors[i]->tick();
  171. }
  172. }
  173. void _sensorPre() {
  174. for (unsigned char i=0; i<_sensors.size(); i++) {
  175. _sensors[i]->pre();
  176. if (!_sensors[i]->status()) {
  177. DEBUG_MSG("[SENSOR] Error reading data from %s (error: %d)\n",
  178. _sensors[i]->description().c_str(),
  179. _sensors[i]->error()
  180. );
  181. }
  182. }
  183. }
  184. void _sensorPost() {
  185. for (unsigned char i=0; i<_sensors.size(); i++) {
  186. _sensors[i]->post();
  187. }
  188. }
  189. // -----------------------------------------------------------------------------
  190. // Sensor initialization
  191. // -----------------------------------------------------------------------------
  192. void _sensorInit() {
  193. #if ANALOG_SUPPORT
  194. {
  195. AnalogSensor * sensor = new AnalogSensor();
  196. _sensors.push_back(sensor);
  197. }
  198. #endif
  199. #if BMX280_SUPPORT
  200. {
  201. BMX280Sensor * sensor = new BMX280Sensor();
  202. sensor->setAddress(BMX280_ADDRESS);
  203. _sensors.push_back(sensor);
  204. }
  205. #endif
  206. #if DALLAS_SUPPORT
  207. {
  208. DallasSensor * sensor = new DallasSensor();
  209. sensor->setGPIO(DALLAS_PIN);
  210. _sensors.push_back(sensor);
  211. }
  212. #endif
  213. #if DHT_SUPPORT
  214. {
  215. DHTSensor * sensor = new DHTSensor();
  216. sensor->setGPIO(DHT_PIN);
  217. sensor->setType(DHT_TYPE);
  218. _sensors.push_back(sensor);
  219. }
  220. #endif
  221. #if DIGITAL_SUPPORT
  222. {
  223. DigitalSensor * sensor = new DigitalSensor();
  224. sensor->setGPIO(DIGITAL_PIN);
  225. sensor->setMode(DIGITAL_PIN_MODE);
  226. sensor->setDefault(DIGITAL_DEFAULT_STATE);
  227. _sensors.push_back(sensor);
  228. }
  229. #endif
  230. #if ECH1560_SUPPORT
  231. {
  232. ECH1560Sensor * sensor = new ECH1560Sensor();
  233. sensor->setCLK(ECH1560_CLK_PIN);
  234. sensor->setMISO(ECH1560_MISO_PIN);
  235. sensor->setInverted(ECH1560_INVERTED);
  236. _sensors.push_back(sensor);
  237. }
  238. #endif
  239. #if EMON_ADC121_SUPPORT
  240. {
  241. EmonADC121Sensor * sensor = new EmonADC121Sensor();
  242. sensor->setAddress(EMON_ADC121_I2C_ADDRESS);
  243. sensor->setVoltage(EMON_MAINS_VOLTAGE);
  244. sensor->setReference(EMON_REFERENCE_VOLTAGE);
  245. sensor->setCurrentRatio(0, EMON_CURRENT_RATIO);
  246. _sensors.push_back(sensor);
  247. }
  248. #endif
  249. #if EMON_ADS1X15_SUPPORT
  250. {
  251. EmonADS1X15Sensor * sensor = new EmonADS1X15Sensor();
  252. sensor->setAddress(EMON_ADS1X15_I2C_ADDRESS);
  253. sensor->setType(EMON_ADS1X15_TYPE);
  254. sensor->setMask(EMON_ADS1X15_MASK);
  255. sensor->setGain(EMON_ADS1X15_GAIN);
  256. sensor->setVoltage(EMON_MAINS_VOLTAGE);
  257. sensor->setCurrentRatio(0, EMON_CURRENT_RATIO);
  258. sensor->setCurrentRatio(1, EMON_CURRENT_RATIO);
  259. sensor->setCurrentRatio(2, EMON_CURRENT_RATIO);
  260. sensor->setCurrentRatio(3, EMON_CURRENT_RATIO);
  261. _sensors.push_back(sensor);
  262. }
  263. #endif
  264. #if EMON_ANALOG_SUPPORT
  265. {
  266. EmonAnalogSensor * sensor = new EmonAnalogSensor();
  267. sensor->setVoltage(EMON_MAINS_VOLTAGE);
  268. sensor->setReference(EMON_REFERENCE_VOLTAGE);
  269. sensor->setCurrentRatio(0, EMON_CURRENT_RATIO);
  270. _sensors.push_back(sensor);
  271. }
  272. #endif
  273. #if EVENTS_SUPPORT
  274. {
  275. EventSensor * sensor = new EventSensor();
  276. sensor->setGPIO(EVENTS_PIN);
  277. sensor->setMode(EVENTS_PIN_MODE);
  278. sensor->setDebounceTime(EVENTS_DEBOUNCE);
  279. sensor->setInterruptMode(EVENTS_INTERRUPT_MODE);
  280. _sensors.push_back(sensor);
  281. }
  282. #endif
  283. #if HLW8012_SUPPORT
  284. {
  285. HLW8012Sensor * sensor = new HLW8012Sensor();
  286. sensor->setSEL(HLW8012_SEL_PIN);
  287. sensor->setCF(HLW8012_CF_PIN);
  288. sensor->setCF1(HLW8012_CF1_PIN);
  289. sensor->setSELCurrent(HLW8012_SEL_CURRENT);
  290. _sensors.push_back(sensor);
  291. }
  292. #endif
  293. #if MHZ19_SUPPORT
  294. {
  295. MHZ19Sensor * sensor = new MHZ19Sensor();
  296. sensor->setRX(MHZ19_RX_PIN);
  297. sensor->setTX(MHZ19_TX_PIN);
  298. _sensors.push_back(sensor);
  299. }
  300. #endif
  301. #if PMSX003_SUPPORT
  302. {
  303. PMSX003Sensor * sensor = new PMSX003Sensor();
  304. sensor->setRX(PMS_RX_PIN);
  305. sensor->setTX(PMS_TX_PIN);
  306. _sensors.push_back(sensor);
  307. }
  308. #endif
  309. #if SHT3X_I2C_SUPPORT
  310. {
  311. SHT3XI2CSensor * sensor = new SHT3XI2CSensor();
  312. sensor->setAddress(SHT3X_I2C_ADDRESS);
  313. _sensors.push_back(sensor);
  314. }
  315. #endif
  316. #if SI7021_SUPPORT
  317. {
  318. SI7021Sensor * sensor = new SI7021Sensor();
  319. sensor->setAddress(SI7021_ADDRESS);
  320. _sensors.push_back(sensor);
  321. }
  322. #endif
  323. #if V9261F_SUPPORT
  324. {
  325. V9261FSensor * sensor = new V9261FSensor();
  326. sensor->setRX(V9261F_PIN);
  327. sensor->setInverted(V9261F_PIN_INVERSE);
  328. _sensors.push_back(sensor);
  329. }
  330. #endif
  331. }
  332. void _sensorConfigure() {
  333. double value;
  334. for (unsigned char i=0; i<_sensors.size(); i++) {
  335. #if EMON_ANALOG_SUPPORT
  336. if (_sensors[i]->getID() == SENSOR_EMON_ANALOG_ID) {
  337. EmonAnalogSensor * sensor = (EmonAnalogSensor *) _sensors[i];
  338. if (value = getSetting("pwrExpectedP", 0).toInt() == 0) {
  339. value = getSetting("pwrRatioC", EMON_CURRENT_RATIO).toFloat();
  340. if (value > 0) sensor->setCurrentRatio(0, value);
  341. } else {
  342. sensor->expectedPower(0, value);
  343. setSetting("pwrRatioC", sensor->getCurrentRatio(0));
  344. }
  345. if (getSetting("pwrResetCalibration", 0).toInt() == 1) {
  346. sensor->setCurrentRatio(0, EMON_CURRENT_RATIO);
  347. delSetting("pwrRatioC");
  348. }
  349. sensor->setVoltage(getSetting("pwrVoltage", EMON_MAINS_VOLTAGE).toInt());
  350. }
  351. #endif // EMON_ANALOG_SUPPORT
  352. // Force sensor to reload config
  353. _sensors[i]->begin();
  354. #if HLW8012_SUPPORT
  355. if (_sensors[i]->getID() == SENSOR_HLW8012_ID) {
  356. HLW8012Sensor * sensor = (HLW8012Sensor *) _sensors[i];
  357. if (value = getSetting("pwrExpectedC", 0).toFloat()) {
  358. sensor->expectedCurrent(value);
  359. setSetting("pwrRatioC", sensor->getCurrentRatio());
  360. } else {
  361. value = getSetting("pwrRatioC", 0).toFloat();
  362. if (value > 0) sensor->setCurrentRatio(value);
  363. }
  364. if (value = getSetting("pwrExpectedV", 0).toInt()) {
  365. sensor->expectedVoltage(value);
  366. setSetting("pwrRatioV", sensor->getVoltageRatio());
  367. } else {
  368. value = getSetting("pwrRatioV", 0).toFloat();
  369. if (value > 0) sensor->setVoltageRatio(value);
  370. }
  371. if (value = getSetting("pwrExpectedP", 0).toInt()) {
  372. sensor->expectedPower(value);
  373. setSetting("pwrRatioP", sensor->getPowerRatio());
  374. } else {
  375. value = getSetting("pwrRatioP", 0).toFloat();
  376. if (value > 0) sensor->setPowerRatio(value);
  377. }
  378. if (getSetting("pwrResetCalibration", 0).toInt() == 1) {
  379. sensor->resetRatios();
  380. delSetting("pwrRatioC");
  381. delSetting("pwrRatioV");
  382. delSetting("pwrRatioP");
  383. }
  384. }
  385. #endif // HLW8012_SUPPORT
  386. }
  387. // General sensor settings
  388. _sensor_realtime = getSetting("apiRealTime", API_REAL_TIME_VALUES).toInt() == 1;
  389. _sensor_temperature_units = getSetting("tmpUnits", SENSOR_TEMPERATURE_UNITS).toInt();
  390. _sensor_temperature_correction = getSetting("tmpCorrection", SENSOR_TEMPERATURE_CORRECTION).toFloat();
  391. // Save settings
  392. delSetting("pwrExpectedP");
  393. delSetting("pwrExpectedC");
  394. delSetting("pwrExpectedV");
  395. delSetting("pwrResetCalibration");
  396. //saveSettings();
  397. }
  398. void _magnitudesInit() {
  399. for (unsigned char i=0; i<_sensors.size(); i++) {
  400. BaseSensor * sensor = _sensors[i];
  401. DEBUG_MSG("[SENSOR] %s\n", sensor->description().c_str());
  402. if (sensor->error() != 0) DEBUG_MSG("[SENSOR] -> ERROR %d\n", sensor->error());
  403. for (unsigned char k=0; k<sensor->count(); k++) {
  404. magnitude_t type = sensor->type(k);
  405. sensor_magnitude_t new_magnitude;
  406. new_magnitude.sensor = sensor;
  407. new_magnitude.local = k;
  408. new_magnitude.type = type;
  409. new_magnitude.global = _counts[type];
  410. new_magnitude.current = 0;
  411. new_magnitude.filtered = 0;
  412. new_magnitude.reported = 0;
  413. new_magnitude.min_change = 0;
  414. if (type == MAGNITUDE_DIGITAL) {
  415. new_magnitude.filter = new MaxFilter();
  416. } else if (type == MAGNITUDE_EVENTS) {
  417. new_magnitude.filter = new MovingAverageFilter();
  418. } else {
  419. new_magnitude.filter = new MedianFilter();
  420. }
  421. _magnitudes.push_back(new_magnitude);
  422. DEBUG_MSG("[SENSOR] -> %s:%d\n", _sensorTopic(type).c_str(), _counts[type]);
  423. _counts[type] = _counts[type] + 1;
  424. }
  425. }
  426. }
  427. // -----------------------------------------------------------------------------
  428. // Public
  429. // -----------------------------------------------------------------------------
  430. unsigned char sensorCount() {
  431. return _sensors.size();
  432. }
  433. unsigned char magnitudeCount() {
  434. return _magnitudes.size();
  435. }
  436. String magnitudeName(unsigned char index) {
  437. if (index < _magnitudes.size()) {
  438. sensor_magnitude_t magnitude = _magnitudes[index];
  439. return magnitude.sensor->slot(magnitude.local);
  440. }
  441. return String();
  442. }
  443. unsigned char magnitudeType(unsigned char index) {
  444. if (index < _magnitudes.size()) {
  445. return int(_magnitudes[index].type);
  446. }
  447. return MAGNITUDE_NONE;
  448. }
  449. // -----------------------------------------------------------------------------
  450. void sensorSetup() {
  451. // Load sensors
  452. _sensorInit();
  453. // Configure stored values
  454. _sensorConfigure();
  455. // Load magnitudes
  456. _magnitudesInit();
  457. #if WEB_SUPPORT
  458. // Websockets
  459. wsOnSendRegister(_sensorWebSocketStart);
  460. wsOnSendRegister(_sensorWebSocketSendData);
  461. wsOnAfterParseRegister(_sensorConfigure);
  462. // API
  463. _sensorAPISetup();
  464. #endif
  465. }
  466. void sensorLoop() {
  467. static unsigned long last_update = 0;
  468. static unsigned long report_count = 0;
  469. // Tick hook
  470. _sensorTick();
  471. // Check if we should read new data
  472. if (millis() - last_update > SENSOR_READ_INTERVAL) {
  473. last_update = millis();
  474. report_count = (report_count + 1) % SENSOR_REPORT_EVERY;
  475. double current;
  476. double filtered;
  477. char buffer[64];
  478. // Pre-read hook
  479. _sensorPre();
  480. // Get readings
  481. for (unsigned char i=0; i<_magnitudes.size(); i++) {
  482. sensor_magnitude_t magnitude = _magnitudes[i];
  483. if (magnitude.sensor->status()) {
  484. unsigned char decimals = _sensorDecimals(magnitude.type);
  485. current = magnitude.sensor->value(magnitude.local);
  486. magnitude.filter->add(current);
  487. // Special case
  488. if (magnitude.type == MAGNITUDE_EVENTS) current = magnitude.filter->result();
  489. current = _sensorProcess(magnitude.type, current);
  490. _magnitudes[i].current = current;
  491. // Debug
  492. #if SENSOR_DEBUG
  493. {
  494. dtostrf(current, 1-sizeof(buffer), decimals, buffer);
  495. DEBUG_MSG("[SENSOR] %s - %s: %s%s\n",
  496. magnitude.sensor->slot(magnitude.local).c_str(),
  497. _sensorTopic(magnitude.type).c_str(),
  498. buffer,
  499. _sensorUnits(magnitude.type).c_str()
  500. );
  501. }
  502. #endif
  503. // Time to report (we do it every SENSOR_REPORT_EVERY readings)
  504. if (report_count == 0) {
  505. filtered = magnitude.filter->result();
  506. magnitude.filter->reset();
  507. filtered = _sensorProcess(magnitude.type, filtered);
  508. _magnitudes[i].filtered = filtered;
  509. // Check if there is a minimum change threshold to report
  510. if (fabs(filtered - magnitude.reported) >= magnitude.min_change) {
  511. _magnitudes[i].reported = filtered;
  512. dtostrf(filtered, 1-sizeof(buffer), decimals, buffer);
  513. #if MQTT_SUPPORT
  514. if (SENSOR_USE_INDEX || (_counts[magnitude.type] > 1)) {
  515. mqttSend(_sensorTopic(magnitude.type).c_str(), magnitude.global, buffer);
  516. } else {
  517. mqttSend(_sensorTopic(magnitude.type).c_str(), buffer);
  518. }
  519. #endif
  520. #if INFLUXDB_SUPPORT
  521. if (SENSOR_USE_INDEX || (_counts[magnitude.type] > 1)) {
  522. idbSend(_sensorTopic(magnitude.type).c_str(), magnitude.global, buffer);
  523. } else {
  524. idbSend(_sensorTopic(magnitude.type).c_str(), buffer);
  525. }
  526. #endif
  527. #if DOMOTICZ_SUPPORT
  528. {
  529. char key[15];
  530. snprintf_P(key, sizeof(key), PSTR("dczSensor%d"), i);
  531. if (magnitude.type == MAGNITUDE_HUMIDITY) {
  532. int status;
  533. if (filtered > 70) {
  534. status = HUMIDITY_WET;
  535. } else if (filtered > 45) {
  536. status = HUMIDITY_COMFORTABLE;
  537. } else if (filtered > 30) {
  538. status = HUMIDITY_NORMAL;
  539. } else {
  540. status = HUMIDITY_DRY;
  541. }
  542. char status_buf[5];
  543. itoa(status, status_buf, 10);
  544. domoticzSend(key, buffer, status_buf);
  545. } else {
  546. domoticzSend(key, 0, buffer);
  547. }
  548. }
  549. #endif
  550. } // if (fabs(filtered - magnitude.reported) >= magnitude.min_change)
  551. } // if (report_count == 0)
  552. } // if (magnitude.sensor->status())
  553. } // for (unsigned char i=0; i<_magnitudes.size(); i++)
  554. // Post-read hook
  555. _sensorPost();
  556. #if WEB_SUPPORT
  557. wsSend(_sensorWebSocketSendData);
  558. #endif
  559. }
  560. }