add filter
This commit is contained in:
parent
f1b4a26338
commit
c63b4d01f0
|
@ -17,4 +17,5 @@ monitor_speed = 115200
|
||||||
|
|
||||||
lib_deps =
|
lib_deps =
|
||||||
https://github.com/milesburton/Arduino-Temperature-Control-Library/
|
https://github.com/milesburton/Arduino-Temperature-Control-Library/
|
||||||
d03n3rfr1tz3/HC-SR04@^1.1.2
|
d03n3rfr1tz3/HC-SR04@^1.1.2
|
||||||
|
https://github.com/emilv/ArduinoSort/
|
75
src/main.cpp
75
src/main.cpp
|
@ -1,5 +1,5 @@
|
||||||
#include <Arduino.h>
|
#include <Arduino.h>
|
||||||
|
#include <ArduinoSort.h>
|
||||||
|
|
||||||
// ######## EC
|
// ######## EC
|
||||||
#define EC_PIN_ADC 4
|
#define EC_PIN_ADC 4
|
||||||
|
@ -48,6 +48,7 @@ float tempCmean_air[TEMPMEAN_SIZE];
|
||||||
#include <HCSR04.h>
|
#include <HCSR04.h>
|
||||||
#define HCSR04_PIN_ECHO 17
|
#define HCSR04_PIN_ECHO 17
|
||||||
#define HCSR04_PIN_TRIGGER 16
|
#define HCSR04_PIN_TRIGGER 16
|
||||||
|
#define HCSR04_TIMEOUT 5000 //default is 100000 (uS)
|
||||||
#define READINTERVAL_HCSR04 100
|
#define READINTERVAL_HCSR04 100
|
||||||
|
|
||||||
#define WATERLEVELMEAN_SIZE 32
|
#define WATERLEVELMEAN_SIZE 32
|
||||||
|
@ -76,8 +77,11 @@ float getMean(uint16_t *parray,uint16_t psize);
|
||||||
float getMeanf(float *parray,uint16_t psize);
|
float getMeanf(float *parray,uint16_t psize);
|
||||||
uint16_t getMin(uint16_t *parray, uint16_t psize);
|
uint16_t getMin(uint16_t *parray, uint16_t psize);
|
||||||
uint16_t getMax(uint16_t *parray, uint16_t psize);
|
uint16_t getMax(uint16_t *parray, uint16_t psize);
|
||||||
|
float getMaxf(float *parray,uint16_t psize);
|
||||||
|
float getMinf(float *parray, uint16_t psize);
|
||||||
bool isValueArrayOK(uint16_t *parray,uint16_t psize, uint16_t pcheck);
|
bool isValueArrayOK(uint16_t *parray,uint16_t psize, uint16_t pcheck);
|
||||||
bool isValueArrayOKf(float *parray,uint16_t psize, float pcheck);
|
bool isValueArrayOKf(float *parray,uint16_t psize, float pcheck);
|
||||||
|
float getFilteredf(float *parray,uint16_t psize, uint16_t pcutOff);
|
||||||
|
|
||||||
|
|
||||||
void printAddress(DeviceAddress deviceAddress);
|
void printAddress(DeviceAddress deviceAddress);
|
||||||
|
@ -96,7 +100,12 @@ void setup() {
|
||||||
ledcAttachPin(EC_PIN_FREQ, EC_PWM_CH);
|
ledcAttachPin(EC_PIN_FREQ, EC_PWM_CH);
|
||||||
ledcWrite(EC_PWM_CH, 127);
|
ledcWrite(EC_PWM_CH, 127);
|
||||||
|
|
||||||
HCSR04.begin(HCSR04_PIN_TRIGGER, HCSR04_PIN_ECHO);
|
//HCSR04.begin(HCSR04_PIN_TRIGGER, HCSR04_PIN_ECHO);
|
||||||
|
HCSR04.begin(HCSR04_PIN_TRIGGER, HCSR04_PIN_ECHO,HCSR04_TIMEOUT, HCSR04.eUltraSonicUnlock_t::unlockSkip);
|
||||||
|
for (uint16_t i=0;i<WATERLEVELMEAN_SIZE;i++) {
|
||||||
|
waterlevelMean[i]=-1; //-1 is also timeout value
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
//initialize mean array
|
//initialize mean array
|
||||||
for (uint16_t i=0;i<TEMPMEAN_SIZE;i++) {
|
for (uint16_t i=0;i<TEMPMEAN_SIZE;i++) {
|
||||||
|
@ -213,7 +222,6 @@ void loop() {
|
||||||
temperature=getMeanf(tempCmean_air,TEMPMEAN_SIZE);
|
temperature=getMeanf(tempCmean_air,TEMPMEAN_SIZE);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
double* distances = HCSR04.measureDistanceMm(temperature);
|
double* distances = HCSR04.measureDistanceMm(temperature);
|
||||||
|
|
||||||
waterlevelMean[waterlevelMean_pos]=distances[0];
|
waterlevelMean[waterlevelMean_pos]=distances[0];
|
||||||
|
@ -236,9 +244,14 @@ void loop() {
|
||||||
if (loopmillis>last_print+500) {
|
if (loopmillis>last_print+500) {
|
||||||
last_print=loopmillis;
|
last_print=loopmillis;
|
||||||
|
|
||||||
Serial.print("EC=");
|
if (isValueArrayOK(ec_array,EC_ARRAY_SIZE,0))
|
||||||
Serial.print(getMean(ec_array,EC_ARRAY_SIZE),3);
|
{
|
||||||
Serial.print("\t spread="); Serial.print(getMax(ec_array,EC_ARRAY_SIZE) - getMin(ec_array,EC_ARRAY_SIZE));
|
Serial.print("EC=");
|
||||||
|
Serial.print(getMean(ec_array,EC_ARRAY_SIZE),3);
|
||||||
|
Serial.print(" count (+- "); Serial.print( (getMax(ec_array,EC_ARRAY_SIZE) - getMin(ec_array,EC_ARRAY_SIZE))/2.0); Serial.print(")");
|
||||||
|
}else{
|
||||||
|
Serial.print("Waiting for EC");
|
||||||
|
}
|
||||||
|
|
||||||
if (isValueArrayOKf(tempCmean_reservoir,TEMPMEAN_SIZE,DEVICE_DISCONNECTED_C)){
|
if (isValueArrayOKf(tempCmean_reservoir,TEMPMEAN_SIZE,DEVICE_DISCONNECTED_C)){
|
||||||
Serial.print("\t Treservoir="); Serial.print(getMeanf(tempCmean_reservoir,TEMPMEAN_SIZE)); Serial.print("\t Tair="); Serial.print(getMeanf(tempCmean_air,TEMPMEAN_SIZE));
|
Serial.print("\t Treservoir="); Serial.print(getMeanf(tempCmean_reservoir,TEMPMEAN_SIZE)); Serial.print("\t Tair="); Serial.print(getMeanf(tempCmean_air,TEMPMEAN_SIZE));
|
||||||
|
@ -247,8 +260,16 @@ void loop() {
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
if (isValueArrayOKf(waterlevelMean,WATERLEVELMEAN_SIZE,0)){
|
if (isValueArrayOKf(waterlevelMean,WATERLEVELMEAN_SIZE,-1.0)){
|
||||||
Serial.print("\t Dist="); Serial.print(getMeanf(waterlevelMean,WATERLEVELMEAN_SIZE)); Serial.print("mm");
|
float _max=getMaxf(waterlevelMean,WATERLEVELMEAN_SIZE);
|
||||||
|
float _min=getMinf(waterlevelMean,WATERLEVELMEAN_SIZE);
|
||||||
|
|
||||||
|
float _filteredWaterlevel=getFilteredf(waterlevelMean,WATERLEVELMEAN_SIZE,8);
|
||||||
|
float _meanWaterlevel=getMeanf(waterlevelMean,WATERLEVELMEAN_SIZE);
|
||||||
|
|
||||||
|
|
||||||
|
Serial.print("\t Dist="); Serial.print(_filteredWaterlevel); Serial.print("mm"); Serial.print("(+- "); Serial.print((_max-_min)/2.0); Serial.print(")"); Serial.print(" [mean="); Serial.print(_meanWaterlevel); Serial.print("]");
|
||||||
|
|
||||||
}else{
|
}else{
|
||||||
Serial.print("\t waiting for distance");
|
Serial.print("\t waiting for distance");
|
||||||
}
|
}
|
||||||
|
@ -323,6 +344,28 @@ uint16_t getMax(uint16_t *parray,uint16_t psize) {
|
||||||
return max;
|
return max;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
float getMinf(float *parray, uint16_t psize) {
|
||||||
|
float min=65535;
|
||||||
|
for (uint16_t i=0;i<psize;i++) {
|
||||||
|
if (parray[i]<min) {
|
||||||
|
min=parray[i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return min;
|
||||||
|
}
|
||||||
|
|
||||||
|
float getMaxf(float *parray,uint16_t psize) {
|
||||||
|
float max=0;
|
||||||
|
for (uint16_t i=0;i<psize;i++) {
|
||||||
|
if (parray[i]>max) {
|
||||||
|
max=parray[i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return max;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
@ -340,4 +383,20 @@ void printAddress(DeviceAddress deviceAddress)
|
||||||
void IRAM_ATTR isr_flow() {
|
void IRAM_ATTR isr_flow() {
|
||||||
flow_counter++;
|
flow_counter++;
|
||||||
flow_counter_sum++;
|
flow_counter_sum++;
|
||||||
|
}
|
||||||
|
|
||||||
|
float getFilteredf(float *parray,uint16_t psize, uint16_t pcutOff) {
|
||||||
|
//cuts off lowest and highest pcutOff values from array, then returns the mean of the psize-2*pcutOff center values.
|
||||||
|
//pcutOff < psize/2
|
||||||
|
|
||||||
|
float _copy[psize];
|
||||||
|
std::copy(parray,parray + psize, _copy);
|
||||||
|
sortArray(_copy,psize);
|
||||||
|
|
||||||
|
double mean=0;
|
||||||
|
for (uint16_t i=pcutOff;i<psize-pcutOff;i++) {
|
||||||
|
mean+=_copy[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
return mean/(psize-2*pcutOff);
|
||||||
}
|
}
|
Loading…
Reference in New Issue