609 lines
20 KiB
C
609 lines
20 KiB
C
// Copyright (C) 2024, Mark Qvist
|
|
|
|
// This program is free software: you can redistribute it and/or modify
|
|
// it under the terms of the GNU General Public License as published by
|
|
// the Free Software Foundation, either version 3 of the License, or
|
|
// (at your option) any later version.
|
|
|
|
// This program is distributed in the hope that it will be useful,
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
// GNU General Public License for more details.
|
|
|
|
// You should have received a copy of the GNU General Public License
|
|
// along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|
|
|
#if BOARD_MODEL == BOARD_TBEAM || BOARD_MODEL == BOARD_TBEAM_S_V1
|
|
#include <XPowersLib.h>
|
|
XPowersLibInterface* PMU = NULL;
|
|
|
|
#ifndef PMU_WIRE_PORT
|
|
#if BOARD_MODEL == BOARD_TBEAM_S_V1
|
|
#define PMU_WIRE_PORT Wire1
|
|
#else
|
|
#define PMU_WIRE_PORT Wire
|
|
#endif
|
|
#endif
|
|
|
|
#define BAT_V_MIN 3.15
|
|
#define BAT_V_MAX 4.14
|
|
|
|
void disablePeripherals() {
|
|
if (PMU) {
|
|
// GNSS RTC PowerVDD
|
|
PMU->enablePowerOutput(XPOWERS_VBACKUP);
|
|
|
|
// LoRa VDD
|
|
PMU->disablePowerOutput(XPOWERS_ALDO2);
|
|
|
|
// GNSS VDD
|
|
PMU->disablePowerOutput(XPOWERS_ALDO3);
|
|
}
|
|
}
|
|
|
|
bool pmuInterrupt;
|
|
void setPmuFlag()
|
|
{
|
|
pmuInterrupt = true;
|
|
}
|
|
#elif BOARD_MODEL == BOARD_RNODE_NG_21 || BOARD_MODEL == BOARD_LORA32_V2_1
|
|
#define BAT_V_MIN 3.15
|
|
#define BAT_V_MAX 4.3
|
|
#define BAT_V_CHG 4.48
|
|
#define BAT_V_FLOAT 4.33
|
|
#define BAT_SAMPLES 5
|
|
const uint8_t pin_vbat = 35;
|
|
float bat_p_samples[BAT_SAMPLES];
|
|
float bat_v_samples[BAT_SAMPLES];
|
|
uint8_t bat_samples_count = 0;
|
|
int bat_discharging_samples = 0;
|
|
int bat_charging_samples = 0;
|
|
int bat_charged_samples = 0;
|
|
bool bat_voltage_dropping = false;
|
|
float bat_delay_v = 0;
|
|
float bat_state_change_v = 0;
|
|
#elif BOARD_MODEL == BOARD_OPENCOM_XL
|
|
#include "nrfx_power.h"
|
|
#define BAT_C_SAMPLES 7
|
|
#define BAT_D_SAMPLES 2
|
|
#define BAT_V_MIN 2.75
|
|
#define BAT_V_MAX 4.2
|
|
#define BAT_V_FLOAT 4.22
|
|
#define BAT_SAMPLES 5
|
|
#define VBAT_MV_PER_LSB (0.73242188F) // 3.0V ADC range and 12 - bit ADC resolution = 3000mV / 4096
|
|
#define VBAT_DIVIDER_COMP (1.73) // Compensation factor for the VBAT divider
|
|
#define VBAT_MV_PER_LSB_FIN (VBAT_DIVIDER_COMP * VBAT_MV_PER_LSB)
|
|
#define PIN_VBAT WB_A0
|
|
float bat_p_samples[BAT_SAMPLES];
|
|
float bat_v_samples[BAT_SAMPLES];
|
|
uint8_t bat_samples_count = 0;
|
|
int bat_discharging_samples = 0;
|
|
int bat_charging_samples = 0;
|
|
int bat_charged_samples = 0;
|
|
bool bat_voltage_dropping = false;
|
|
float bat_delay_v = 0;
|
|
#elif BOARD_MODEL == BOARD_TDECK
|
|
#define BAT_V_MIN 3.15
|
|
#define BAT_V_MAX 4.3
|
|
#define BAT_V_CHG 4.48
|
|
#define BAT_V_FLOAT 4.33
|
|
#define BAT_SAMPLES 5
|
|
const uint8_t pin_vbat = 4;
|
|
float bat_p_samples[BAT_SAMPLES];
|
|
float bat_v_samples[BAT_SAMPLES];
|
|
uint8_t bat_samples_count = 0;
|
|
int bat_discharging_samples = 0;
|
|
int bat_charging_samples = 0;
|
|
int bat_charged_samples = 0;
|
|
bool bat_voltage_dropping = false;
|
|
float bat_delay_v = 0;
|
|
float bat_state_change_v = 0;
|
|
#elif BOARD_MODEL == BOARD_HELTEC32_V3
|
|
#define BAT_V_MIN 3.15
|
|
#define BAT_V_MAX 4.3
|
|
#define BAT_V_CHG 4.48
|
|
#define BAT_V_FLOAT 4.33
|
|
#define BAT_SAMPLES 7
|
|
const uint8_t pin_vbat = 1;
|
|
const uint8_t pin_ctrl = 37;
|
|
float bat_p_samples[BAT_SAMPLES];
|
|
float bat_v_samples[BAT_SAMPLES];
|
|
uint8_t bat_samples_count = 0;
|
|
int bat_discharging_samples = 0;
|
|
int bat_charging_samples = 0;
|
|
int bat_charged_samples = 0;
|
|
bool bat_voltage_dropping = false;
|
|
float bat_delay_v = 0;
|
|
float bat_state_change_v = 0;
|
|
>>>>>>> upstream/dev
|
|
#endif
|
|
|
|
uint32_t last_pmu_update = 0;
|
|
uint8_t pmu_target_pps = 1;
|
|
int pmu_update_interval = 1000/pmu_target_pps;
|
|
uint8_t pmu_rc = 0;
|
|
#define PMU_R_INTERVAL 5
|
|
void kiss_indicate_battery();
|
|
|
|
void measure_battery() {
|
|
#if BOARD_MODEL == BOARD_RNODE_NG_21 || BOARD_MODEL == BOARD_LORA32_V2_1 || BOARD_MODEL == BOARD_HELTEC32_V3 || BOARD_MODEL == BOARD_TDECK
|
|
battery_installed = true;
|
|
battery_indeterminate = true;
|
|
|
|
#if BOARD_MODEL == BOARD_HELTEC32_V3
|
|
float battery_measurement = (float)(analogRead(pin_vbat)) * 0.0041;
|
|
#else
|
|
float battery_measurement = (float)(analogRead(pin_vbat)) / 4095.0*2.0*3.3*1.1;
|
|
#endif
|
|
|
|
bat_v_samples[bat_samples_count%BAT_SAMPLES] = battery_measurement;
|
|
bat_p_samples[bat_samples_count%BAT_SAMPLES] = ((battery_voltage-BAT_V_MIN) / (BAT_V_MAX-BAT_V_MIN))*100.0;
|
|
|
|
bat_samples_count++;
|
|
if (!battery_ready && bat_samples_count >= BAT_SAMPLES) {
|
|
battery_ready = true;
|
|
}
|
|
|
|
if (battery_ready) {
|
|
|
|
battery_percent = 0;
|
|
for (uint8_t bi = 0; bi < BAT_SAMPLES; bi++) {
|
|
battery_percent += bat_p_samples[bi];
|
|
}
|
|
battery_percent = battery_percent/BAT_SAMPLES;
|
|
|
|
battery_voltage = 0;
|
|
for (uint8_t bi = 0; bi < BAT_SAMPLES; bi++) {
|
|
battery_voltage += bat_v_samples[bi];
|
|
}
|
|
battery_voltage = battery_voltage/BAT_SAMPLES;
|
|
|
|
if (bat_delay_v == 0) bat_delay_v = battery_voltage;
|
|
if (bat_state_change_v == 0) bat_state_change_v = battery_voltage;
|
|
if (battery_percent > 100.0) battery_percent = 100.0;
|
|
if (battery_percent < 0.0) battery_percent = 0.0;
|
|
|
|
if (bat_samples_count%BAT_SAMPLES == 0) {
|
|
float bat_delay_diff = bat_state_change_v-battery_voltage;
|
|
if (bat_delay_diff < 0) { bat_delay_diff *= -1; }
|
|
|
|
if (battery_voltage < bat_delay_v && battery_voltage < BAT_V_FLOAT) {
|
|
if (bat_voltage_dropping == false) {
|
|
if (bat_delay_diff > 0.008) {
|
|
bat_voltage_dropping = true;
|
|
bat_state_change_v = battery_voltage;
|
|
// SerialBT.printf("STATE CHANGE to DISCHARGE at delta=%.3fv. State change v is now %.3fv.\n", bat_delay_diff, bat_state_change_v);
|
|
}
|
|
}
|
|
} else {
|
|
if (bat_voltage_dropping == true) {
|
|
if (bat_delay_diff > 0.01) {
|
|
bat_voltage_dropping = false;
|
|
bat_state_change_v = battery_voltage;
|
|
// SerialBT.printf("STATE CHANGE to CHARGE at delta=%.3fv. State change v is now %.3fv.\n", bat_delay_diff, bat_state_change_v);
|
|
}
|
|
}
|
|
}
|
|
bat_samples_count = 0;
|
|
bat_delay_v = battery_voltage;
|
|
}
|
|
|
|
if (bat_voltage_dropping && battery_voltage < BAT_V_FLOAT) {
|
|
battery_state = BATTERY_STATE_DISCHARGING;
|
|
} else {
|
|
if (battery_percent < 100.0) {
|
|
battery_state = BATTERY_STATE_CHARGING;
|
|
} else {
|
|
battery_state = BATTERY_STATE_CHARGED;
|
|
}
|
|
}
|
|
|
|
// if (bt_state == BT_STATE_CONNECTED) {
|
|
// SerialBT.printf("Bus voltage %.3fv. Unfiltered %.3fv.", battery_voltage, bat_v_samples[BAT_SAMPLES-1]);
|
|
// if (bat_volta |