|
@ -0,0 +1,220 @@ |
|
|
|
|
|
// ----------------------------------------------------------------------------- |
|
|
|
|
|
// Pulse Meter Power Monitor Sensor |
|
|
|
|
|
// Copyright (C) 2018 by Xose Pérez <xose dot perez at gmail dot com> |
|
|
|
|
|
// ----------------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
#if SENSOR_SUPPORT && PULSEMETER_SUPPORT |
|
|
|
|
|
|
|
|
|
|
|
#pragma once |
|
|
|
|
|
|
|
|
|
|
|
#include "Arduino.h" |
|
|
|
|
|
#include "BaseSensor.h" |
|
|
|
|
|
|
|
|
|
|
|
class PulseMeterSensor : public BaseSensor { |
|
|
|
|
|
|
|
|
|
|
|
public: |
|
|
|
|
|
|
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
// Public |
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
PulseMeterSensor(): BaseSensor() { |
|
|
|
|
|
_count = 2; |
|
|
|
|
|
_sensor_id = SENSOR_PULSEMETER_ID; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
~PulseMeterSensor() { |
|
|
|
|
|
_enableInterrupts(false); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void resetEnergy(double value = 0) { |
|
|
|
|
|
_energy = value; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
void setGPIO(unsigned char gpio) { |
|
|
|
|
|
if (_gpio == gpio) return; |
|
|
|
|
|
_gpio = gpio; |
|
|
|
|
|
_dirty = true; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void setEnergyRatio(unsigned long ratio) { |
|
|
|
|
|
_ratio = ratio; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
unsigned char getGPIO() { |
|
|
|
|
|
return _gpio; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
unsigned char getEnergyRatio() { |
|
|
|
|
|
return _ratio; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
// Sensors API |
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
// Initialization method, must be idempotent |
|
|
|
|
|
// Defined outside the class body |
|
|
|
|
|
void begin() { |
|
|
|
|
|
|
|
|
|
|
|
_enableInterrupts(true); |
|
|
|
|
|
_ready = true; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// Descriptive name of the sensor |
|
|
|
|
|
String description() { |
|
|
|
|
|
char buffer[20]; |
|
|
|
|
|
snprintf(buffer, sizeof(buffer), "PulseMeter @ GPIO(%u)", _gpio); |
|
|
|
|
|
return String(buffer); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// Descriptive name of the slot # index |
|
|
|
|
|
String slot(unsigned char index) { |
|
|
|
|
|
return description(); |
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
// Address of the sensor (it could be the GPIO or I2C address) |
|
|
|
|
|
String address(unsigned char index) { |
|
|
|
|
|
return String(gpio); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// Pre-read hook (usually to populate registers with up-to-date data) |
|
|
|
|
|
void pre() { |
|
|
|
|
|
|
|
|
|
|
|
static unsigned long _previous_pulses = 0; |
|
|
|
|
|
static unsigned long _previous_time = millis(); |
|
|
|
|
|
|
|
|
|
|
|
unsigned long lapse = millis() - _previous_time; |
|
|
|
|
|
_previous_time = millis(); |
|
|
|
|
|
unsigned long pulses = _pulses - _previous_pulses; |
|
|
|
|
|
_previous_pulses = _pulses; |
|
|
|
|
|
|
|
|
|
|
|
unsigned long _energy_delta = 1000 * 3600 * pulses / _ratio; |
|
|
|
|
|
_energy += _energy_delta; |
|
|
|
|
|
_active = 1000 * _energy_delta / lapse; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// Type for slot # index |
|
|
|
|
|
unsigned char type(unsigned char index) { |
|
|
|
|
|
if (index == 0) return MAGNITUDE_POWER_ACTIVE; |
|
|
|
|
|
if (index == 1) return MAGNITUDE_ENERGY; |
|
|
|
|
|
return MAGNITUDE_NONE; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// Current value for slot # index |
|
|
|
|
|
double value(unsigned char index) { |
|
|
|
|
|
if (index == 0) return _active; |
|
|
|
|
|
if (index == 1) return _energy; |
|
|
|
|
|
return 0; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// Handle interrupt calls |
|
|
|
|
|
void ICACHE_RAM_ATTR handleInterrupt(unsigned char gpio) { |
|
|
|
|
|
if (gpio == _gpio) { |
|
|
|
|
|
_pulses++; |
|
|
|
|
|
} |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
protected: |
|
|
|
|
|
|
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
// Interrupt management |
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
void _attach(PulseMeterSensor * instance, unsigned char gpio, unsigned char mode); |
|
|
|
|
|
void _detach(unsigned char gpio); |
|
|
|
|
|
|
|
|
|
|
|
void _enableInterrupts(bool value) { |
|
|
|
|
|
|
|
|
|
|
|
static unsigned char _previous = GPIO_NONE; |
|
|
|
|
|
|
|
|
|
|
|
if (value) { |
|
|
|
|
|
|
|
|
|
|
|
if (_gpio != _previous) { |
|
|
|
|
|
if (_previous != GPIO_NONE) _detach(_previous); |
|
|
|
|
|
_attach(this, _gpio, PULSEMETER_INTERRUPT_ON); |
|
|
|
|
|
_previous = _gpio; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
|
|
|
|
|
|
|
_detach(_previous); |
|
|
|
|
|
_previous = GPIO_NONE; |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// --------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
unsigned char _gpio = GPIO_NONE; |
|
|
|
|
|
unsigned long _ratio = 4000; |
|
|
|
|
|
|
|
|
|
|
|
double _active = 0; |
|
|
|
|
|
double _energy = 0; |
|
|
|
|
|
|
|
|
|
|
|
volatile unsigned long _pulses = 0; |
|
|
|
|
|
|
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
// ----------------------------------------------------------------------------- |
|
|
|
|
|
// Interrupt helpers |
|
|
|
|
|
// ----------------------------------------------------------------------------- |
|
|
|
|
|
|
|
|
|
|
|
PulseMeterSensor * _pulsemeter_sensor_instance[10] = {NULL}; |
|
|
|
|
|
|
|
|
|
|
|
void ICACHE_RAM_ATTR _pulseMeter_sensor_isr(unsigned char gpio) { |
|
|
|
|
|
unsigned char index = gpio > 5 ? gpio-6 : gpio; |
|
|
|
|
|
if (_pulsemeter_sensor_instance[index]) { |
|
|
|
|
|
_pulsemeter_sensor_instance[index]->handleInterrupt(gpio); |
|
|
|
|
|
} |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_0() { _pulsemeter_sensor_isr(0); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_1() { _pulsemeter_sensor_isr(1); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_2() { _pulsemeter_sensor_isr(2); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_3() { _pulsemeter_sensor_isr(3); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_4() { _pulsemeter_sensor_isr(4); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_5() { _pulsemeter_sensor_isr(5); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_12() { _pulsemeter_sensor_isr(12); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_13() { _pulsemeter_sensor_isr(13); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_14() { _pulsemeter_sensor_isr(14); } |
|
|
|
|
|
void ICACHE_RAM_ATTR _pulsemeter_sensor_isr_15() { _pulsemeter_sensor_isr(15); } |
|
|
|
|
|
|
|
|
|
|
|
static void (*_pulsemeter_sensor_isr_list[10])() = { |
|
|
|
|
|
_pulsemeter_sensor_isr_0, _pulsemeter_sensor_isr_1, _pulsemeter_sensor_isr_2, |
|
|
|
|
|
_pulsemeter_sensor_isr_3, _pulsemeter_sensor_isr_4, _pulsemeter_sensor_isr_5, |
|
|
|
|
|
_pulsemeter_sensor_isr_12, _pulsemeter_sensor_isr_13, _pulsemeter_sensor_isr_14, |
|
|
|
|
|
_pulsemeter_sensor_isr_15 |
|
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
void PulseMeterSensor::_attach(PulseMeterSensor * instance, unsigned char gpio, unsigned char mode) { |
|
|
|
|
|
if (!gpioValid(gpio)) return; |
|
|
|
|
|
_detach(gpio); |
|
|
|
|
|
unsigned char index = gpio > 5 ? gpio-6 : gpio; |
|
|
|
|
|
_pulsemeter_sensor_instance[index] = instance; |
|
|
|
|
|
attachInterrupt(gpio, _pulsemeter_sensor_isr_list[index], mode); |
|
|
|
|
|
#if SENSOR_DEBUG |
|
|
|
|
|
DEBUG_MSG_P(PSTR("[SENSOR] GPIO%u interrupt attached to %s\n"), gpio, instance->description().c_str()); |
|
|
|
|
|
#endif |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void PulseMeterSensor::_detach(unsigned char gpio) { |
|
|
|
|
|
if (!gpioValid(gpio)) return; |
|
|
|
|
|
unsigned char index = gpio > 5 ? gpio-6 : gpio; |
|
|
|
|
|
if (_pulsemeter_sensor_instance[index]) { |
|
|
|
|
|
detachInterrupt(gpio); |
|
|
|
|
|
#if SENSOR_DEBUG |
|
|
|
|
|
DEBUG_MSG_P(PSTR("[SENSOR] GPIO%u interrupt detached from %s\n"), gpio, _pulsemeter_sensor_instance[index]->description().c_str()); |
|
|
|
|
|
#endif |
|
|
|
|
|
_pulsemeter_sensor_instance[index] = NULL; |
|
|
|
|
|
} |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
#endif // SENSOR_SUPPORT && PULSEMETER_SUPPORT |