BatteryMonitor.cpp

/*
 * MotionHub project
 * Copyright (c) 2026 Fedir Vilhota <fredy31415@gmail.com>
 * This software is released under the MIT License.
 * See the LICENSE file in the project root for full license information.
 */
#include "BatteryMonitor.h"

BatteryMonitor::BatteryMonitor(uint8_t pin, float dividerMultiplier, float referenceVoltage, int adcResolution, float criticalVoltage)
    : _pin(pin), _dividerMultiplier(dividerMultiplier), _referenceVoltage(referenceVoltage), _adcResolution(adcResolution), _criticalVoltage(criticalVoltage), _lastReadTime(0), _lastVoltage(0.0), _isFirstRead(true) {
}

void BatteryMonitor::begin() {
    pinMode(_pin, INPUT);
    // Робимо перший симулятивний апдейт відразу, щоб перевірити напругу
    update(true); 
}

void BatteryMonitor::update(bool force) {
    unsigned long currentMillis = millis();
    // Перевіряємо, чи пройшла 1 секунда (1000 мс) або це виклик force
    if (force || currentMillis - _lastReadTime >= 1000) {
        _lastReadTime = currentMillis;
        
        // Робимо 5 швидких замірів
        uint16_t readings[5];
        for (int i = 0; i < 5; i++) {
            readings[i] = analogRead(_pin);
        }
        
        // Сортуємо масив для знаходження медіани
        bubbleSort(readings, 5);
        uint16_t medianReading = readings[2]; // 3-й елемент у відсортованому масиві з 5 елементів
        
        // Розраховуємо напругу 
        _lastVoltage = ((float)medianReading / _adcResolution) * _referenceVoltage * _dividerMultiplier;
        
        // Виводимо в Serial
        Serial.print("[BatteryMonitor] Level: ");
        Serial.print(_lastVoltage);
        Serial.println(" V");

        // Перевіряємо напругу на критичний рівень (лише виводимо в лог, якщо треба)
        if (_lastVoltage > 1.0 && _lastVoltage < _criticalVoltage) { 
            Serial.println("[BatteryMonitor] Critical voltage level detected!");
        }
    }
}

float BatteryMonitor::getVoltage() {
    return _lastVoltage;
}

bool BatteryMonitor::isCritical() {
    return (_lastVoltage > 1.0 && _lastVoltage < _criticalVoltage);
}

void BatteryMonitor::bubbleSort(uint16_t arr[], int n) {
    for (int i = 0; i < n - 1; i++) {
        for (int j = 0; j < n - i - 1; j++) {
            if (arr[j] > arr[j + 1]) {
                uint16_t temp = arr[j];
                arr[j] = arr[j + 1];
                arr[j + 1] = temp;
            }
        }
    }
}