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.
104 lines
2.8 KiB
104 lines
2.8 KiB
// -----------------------------------------------------------------------------
|
|
// Eergy monitor sensor
|
|
// -----------------------------------------------------------------------------
|
|
|
|
#pragma once
|
|
|
|
#include "Arduino.h"
|
|
#include "BaseSensor.h"
|
|
|
|
class EmonSensor : public BaseSensor {
|
|
|
|
public:
|
|
|
|
EmonSensor(double voltage, unsigned char bits, double ref, double ratio): BaseSensor() {
|
|
|
|
// Cache
|
|
_voltage = voltage;
|
|
_adc_counts = 1 << bits;
|
|
_pivot = _adc_counts >> 1;
|
|
_count = 2;
|
|
|
|
// Calculate factor
|
|
_current_factor = ratio * ref / _adc_counts;
|
|
|
|
// Calculate multiplier
|
|
calculateMultiplier();
|
|
|
|
}
|
|
|
|
protected:
|
|
|
|
virtual unsigned int readADC(unsigned char port) {}
|
|
|
|
void calculateMultiplier() {
|
|
unsigned int s = 1;
|
|
unsigned int i = 1;
|
|
unsigned int m = s * i;
|
|
while (m * _current_factor < 1) {
|
|
_multiplier = m;
|
|
i = (i == 1) ? 2 : (i == 2) ? 5 : 1;
|
|
if (i == 1) s *= 10;
|
|
m = s * i;
|
|
}
|
|
}
|
|
|
|
double read(unsigned long value, unsigned char mode, unsigned char port) {
|
|
|
|
int sample;
|
|
int max = 0;
|
|
int min = _adc_counts;
|
|
double filtered;
|
|
double sum = 0;
|
|
|
|
unsigned long start = millis();
|
|
unsigned long samples = 0;
|
|
|
|
while (true) {
|
|
|
|
// Read analog value
|
|
sample = readADC(port);
|
|
if (sample > max) max = sample;
|
|
if (sample < min) min = sample;
|
|
|
|
// Digital low pass filter extracts the VDC offset
|
|
_pivot = (_pivot + (sample - _pivot) / EMON_FILTER_SPEED);
|
|
filtered = sample - _pivot;
|
|
|
|
// Root-mean-square method
|
|
sum += (filtered * filtered);
|
|
++samples;
|
|
|
|
// Exit condition
|
|
if (mode == EMON_MODE_SAMPLES) {
|
|
if (samples >= value) break;
|
|
} else {
|
|
if (millis() - start >= value) break;
|
|
}
|
|
|
|
yield();
|
|
|
|
}
|
|
|
|
// Quick fix
|
|
if (_pivot < min || max < _pivot) {
|
|
_pivot = (max + min) / 2.0;
|
|
}
|
|
|
|
double rms = samples > 0 ? sqrt(sum / samples) : 0;
|
|
double current = _current_factor * rms;
|
|
current = (double) (round(current * _multiplier) - 1) / _multiplier;
|
|
if (current < 0) current = 0;
|
|
|
|
return current;
|
|
|
|
}
|
|
|
|
double _voltage;
|
|
unsigned int _adc_counts;
|
|
unsigned int _multiplier = 1;
|
|
double _current_factor;
|
|
double _pivot;
|
|
|
|
|
|
};
|