Improved state change mechanism

This commit is contained in:
Dejvino 2026-02-15 19:05:19 +01:00
parent 2cdb05b4d8
commit eba13c6181

View File

@ -56,10 +56,9 @@ BH1750 lightMeter;
// Thresholds
const float LIGHT_ACTIVATION_THRESHOLD = 50.0;
const float LIGHT_DEACTIVATION_THRESHOLD = 20.0;
const unsigned long VIBRATION_STATE_CHANGE_INTERVAL = 10000; // 1000 = 1 second
const unsigned long WINDOW_DURATION = 10000; // 10 seconds
const int REQUIRED_CONSECUTIVE_WINDOWS = 6;
const unsigned long VIBRATION_ACTIVE_THRESHOLD = 100000;
const int VIBRATION_WINDOW_SIZE = 6; // X * VIBRATION_STATE_CHANGE_INTERVAL seconds window
const unsigned long WARMUP_DURATION = 30000; // 20 seconds warmup
// Device state
@ -67,9 +66,7 @@ bool isVibrationActive = false;
bool isLightActive = false;
// Time tracking for sensor states
unsigned long lastVibrationCheckTime = 0;
unsigned long lightHighStartTime = 0;
unsigned long lightLowStartTime = 0;
unsigned long lastWindowStartTime = 0;
// OLED display data
#ifdef ENABLE_DISPLAY
@ -91,10 +88,12 @@ QueueHandle_t notificationQueue;
volatile bool isNetworkActive = false;
#ifdef ENABLE_SENSORS
unsigned long vibrationHistory[VIBRATION_WINDOW_SIZE];
int vibrationHistoryIdx = 0;
unsigned long vibrationWindowTotal = 0;
unsigned long vibrationTotalLow = 0;
int vibConsecutiveOn = 0;
int vibConsecutiveOff = 0;
int lightConsecutiveOn = 0;
int lightConsecutiveOff = 0;
float maxLightInWindow = 0.0;
volatile unsigned long lastChangeTime = 0;
volatile unsigned long lowTimeAccumulator = 0;
volatile unsigned long highTimeAccumulator = 0;
@ -186,9 +185,6 @@ void setup() {
lastChangeTime = micros();
attachInterrupt(digitalPinToInterrupt(VIBRATION_PIN), onChange, CHANGE);
// Initialize history buffer
for(int i=0; i<VIBRATION_WINDOW_SIZE; i++) vibrationHistory[i] = 0;
// Initialize light sensor
if (!lightMeter.begin(BH1750::CONTINUOUS_HIGH_RES_MODE)) {
Serial.println(F("Could not find a valid BH1750 sensor, check wiring!"));
@ -250,6 +246,9 @@ void loop() {
// Sensor readings
#ifdef ENABLE_SENSORS
float currentLightLevel = lightMeter.readLightLevel();
if (currentLightLevel > maxLightInWindow) {
maxLightInWindow = currentLightLevel;
}
#else
float currentLightLevel = 0.0;
#endif
@ -257,11 +256,12 @@ void loop() {
bool previousVibrationState = isVibrationActive;
bool previousLightState = isLightActive;
// Vibration state change logic
#ifdef ENABLE_SENSORS
if (currentTime - lastVibrationCheckTime >= VIBRATION_STATE_CHANGE_INTERVAL) {
lastVibrationCheckTime = currentTime;
// Window Logic
if (currentTime - lastWindowStartTime >= WINDOW_DURATION) {
lastWindowStartTime = currentTime;
// 1. Process Vibration
#ifdef ENABLE_SENSORS
noInterrupts();
unsigned long now = micros();
unsigned long duration = now - lastChangeTime;
@ -278,40 +278,42 @@ void loop() {
highTimeAccumulator = 0;
interrupts();
vibrationWindowTotal -= vibrationHistory[vibrationHistoryIdx];
vibrationHistory[vibrationHistoryIdx] = vibrationTotalLow;
vibrationWindowTotal += vibrationTotalLow;
vibrationHistoryIdx = (vibrationHistoryIdx + 1) % VIBRATION_WINDOW_SIZE;
bool vibWindowOn = (vibrationTotalLow > VIBRATION_ACTIVE_THRESHOLD);
if (vibrationWindowTotal > VIBRATION_ACTIVE_THRESHOLD && currentTime > WARMUP_DURATION) {
isVibrationActive = true;
if (vibWindowOn) {
vibConsecutiveOn++;
vibConsecutiveOff = 0;
} else {
vibConsecutiveOff++;
vibConsecutiveOn = 0;
}
if (vibConsecutiveOn >= REQUIRED_CONSECUTIVE_WINDOWS && currentTime > WARMUP_DURATION) {
isVibrationActive = true;
} else if (vibConsecutiveOff >= REQUIRED_CONSECUTIVE_WINDOWS) {
isVibrationActive = false;
}
}
#endif
#endif
// Light state change logic
if (currentLightLevel >= LIGHT_ACTIVATION_THRESHOLD && !isLightActive) {
if (lightHighStartTime == 0) {
lightHighStartTime = currentTime;
// 2. Process Light
bool lightWindowOn = (maxLightInWindow > LIGHT_ACTIVATION_THRESHOLD);
if (lightWindowOn) {
lightConsecutiveOn++;
lightConsecutiveOff = 0;
} else {
lightConsecutiveOff++;
lightConsecutiveOn = 0;
}
if (currentTime - lightHighStartTime >= VIBRATION_STATE_CHANGE_INTERVAL && currentTime > WARMUP_DURATION) {
if (lightConsecutiveOn >= REQUIRED_CONSECUTIVE_WINDOWS && currentTime > WARMUP_DURATION) {
isLightActive = true;
}
lightLowStartTime = 0;
} else if (currentLightLevel < LIGHT_DEACTIVATION_THRESHOLD && isLightActive) {
if (lightLowStartTime == 0) {
lightLowStartTime = currentTime;
}
if (currentTime - lightLowStartTime >= VIBRATION_STATE_CHANGE_INTERVAL) {
} else if (lightConsecutiveOff >= REQUIRED_CONSECUTIVE_WINDOWS) {
isLightActive = false;
}
lightHighStartTime = 0;
} else if(currentLightLevel >= LIGHT_ACTIVATION_THRESHOLD) {
lightLowStartTime = 0;
} else {
lightHighStartTime = 0;
// Reset Light Accumulator
maxLightInWindow = 0.0;
}
// Device 1 (Vibration) Notifications
@ -382,10 +384,10 @@ void loop() {
#ifdef ENABLE_DISPLAY
// Update display data
displayData[0] = String(DEVICE1_NAME) + ": " + String(vibrationWindowTotal);
displayData[1] = "Vibra: " + String(isVibrationActive ? "ON" : "OFF");
displayData[0] = String(DEVICE1_NAME) + ": " + (vibrationTotalLow > VIBRATION_ACTIVE_THRESHOLD ? "YES" : "NO");
displayData[1] = "Vibra: " + String(isVibrationActive ? "OFF? " + String(vibConsecutiveOff) : "ON? " + String(vibConsecutiveOn)) + "/" + String(REQUIRED_CONSECUTIVE_WINDOWS);
displayData[2] = String(DEVICE2_NAME) + ": " + String(currentLightLevel, 0);
displayData[3] = "Light: " + String(isLightActive ? "ON" : "OFF");
displayData[3] = "Light: " + String(isLightActive ? "OFF? " + String(lightConsecutiveOff) : "ON? " + String(lightConsecutiveOn)) + "/" + String(REQUIRED_CONSECUTIVE_WINDOWS);
displayDataLines = 4;
// Update display