hydroponic-controller/include/waterlevel.h

87 lines
2.7 KiB
C
Raw Normal View History

2023-04-17 19:32:34 +00:00
#ifndef _WATERLEVEL_H_
#define _WATERLEVEL_H_
2023-06-20 18:06:41 +00:00
#include <Wire.h>
#include <VL6180X.h>
2023-04-17 19:32:34 +00:00
2023-06-20 18:06:41 +00:00
VL6180X sensor;
// To try different scaling factors, change the following define.
// Valid scaling factors are 1, 2, or 3.
#define SCALING 1
#define READINTERVAL_WATERLEVEL 200
2023-04-17 19:32:34 +00:00
#define WATERLEVELMEAN_SIZE 32
2023-05-09 21:20:47 +00:00
#define WATERLEVELMEAN_FILTER_CUTOFF 8 //max value is around WATERLEVELMEAN_SIZE/2
float waterlevelMean_array[WATERLEVELMEAN_SIZE];
uint16_t waterlevelMean_array_pos=0;
#define WATERLEVEL_UNAVAILABLE -1
2023-05-09 21:20:47 +00:00
float waterlevel=WATERLEVEL_UNAVAILABLE; //distance from floor to water surface [mm]
float watervolume=WATERLEVEL_UNAVAILABLE; //calculated Volume in Reservoir
2023-04-17 19:32:34 +00:00
2023-05-09 21:20:47 +00:00
//Calibration
float waterlevel_calib_offset_measured=0; //Sollwert
2023-06-20 18:06:41 +00:00
float waterlevel_calib_offset_sensor=0; //Istwert
2023-05-09 21:20:47 +00:00
float waterlevel_calib_reservoirArea=27*36.5; //area in cm^2
float waterlevel_heightToVolume(float distance);
2023-04-17 19:32:34 +00:00
void waterlevel_setup() {
2023-06-20 18:06:41 +00:00
Wire.begin();
sensor.init();
sensor.configureDefault();
sensor.setScaling(SCALING);
sensor.setTimeout(500);
2023-04-17 19:32:34 +00:00
for (uint16_t i=0;i<WATERLEVELMEAN_SIZE;i++) {
waterlevelMean_array[i]=-1; //-1 is also timeout value
2023-04-17 19:32:34 +00:00
}
}
void waterlevel_loop(unsigned long loopmillis) {
2023-04-17 19:32:34 +00:00
2023-06-20 18:06:41 +00:00
static unsigned long last_read_waterlevel;
if (loopmillis>=last_read_waterlevel+READINTERVAL_WATERLEVEL) {
last_read_waterlevel=loopmillis;
uint16_t distance=sensor.readRangeSingleMillimeters();
2023-04-17 19:32:34 +00:00
//Serial.print("Distance reading:"); Serial.println(distance);
if (distance!=WATERLEVEL_UNAVAILABLE) { //successful
waterlevelMean_array[waterlevelMean_array_pos]=distance;
waterlevelMean_array_pos++;
waterlevelMean_array_pos%=WATERLEVELMEAN_SIZE;
}
if (isValueArrayOKf(waterlevelMean_array,WATERLEVELMEAN_SIZE,WATERLEVEL_UNAVAILABLE)){
2023-05-09 21:20:47 +00:00
//float _distance=getFilteredf(waterlevelMean_array,WATERLEVELMEAN_SIZE,WATERLEVELMEAN_FILTER_CUTOFF);
float _distance=getMaxf(waterlevelMean_array,WATERLEVELMEAN_SIZE);
2023-05-09 21:20:47 +00:00
//Invert distance and offset
waterlevel=distance-(waterlevel_calib_offset_sensor+waterlevel_calib_offset_measured);
watervolume=waterlevel_heightToVolume(_distance);
//float _meanWaterlevel=getMeanf(waterlevelMean,WATERLEVELMEAN_SIZE);
//Serial.print("\t Dist="); Serial.print(_filteredWaterlevel); Serial.print("mm"); Serial.print("(+- "); Serial.print((getMaxf(waterlevelMean,WATERLEVELMEAN_SIZE)-getMinf(waterlevelMean,WATERLEVELMEAN_SIZE))/2.0); Serial.print(")"); Serial.print(" [mean="); Serial.print(_meanWaterlevel); Serial.print("]");
}
2023-04-17 19:32:34 +00:00
}
}
2023-05-09 21:20:47 +00:00
float waterlevel_heightToVolume(float distance){
return waterlevel_calib_reservoirArea/100 * distance/100; //area[cm^2] in dm^2 * height in dm = dm^3= L
}
2023-04-17 19:32:34 +00:00
#endif