chenjintao/banban
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

fix: battery check fix

Browse Source
This commit is contained in:
chenjintao
2026-09-21 14:07:30 +08:00
parent 91e9b2e66b
commit 823e846262
2 changed files with 153 additions and 152 deletions
Download Patch File Download Diff File Expand all files Collapse all files
ql-application/threadx/interface/custom_app/battery.c
+150 -150
View File
@@ -19,9 +19,10 @@
#include "ql_atcmd.h"
#include "app_inc.h"
#include "ql_uart.h"
#include "ql_application.h"
#include "ql_log.h"
#include "hal_api.h"
#include "ql_application.h"
#include "ql_log.h"
#include "ql_power.h"
#include "hal_api.h"
// 电量阈值定义
#define BAT_VOLTAGE_100 4200
@@ -36,25 +37,24 @@
#define BAT_VOLTAGE_10 3550
#define BAT_VOLTAGE_MIN 3500
// ========== 新增：10分钟电压历史记录用于判断充放电状态 ==========
#define VOLTAGE_HISTORY_SIZE 60 // 10分钟 = 60个10秒采样点
#define VOLTAGE_RISE_THRESHOLD 15 // 10分钟内上升超过15mV判定为充电
#define VOLTAGE_DROP_THRESHOLD 15 // 10分钟内下降超过15mV判定为放电
#define VOLTAGE_STABLE_RANGE 10 // 变化在±10mV内判定为稳定
#define BAT_LOW_WARN_MV 3550
#define BAT_LOW_PROBE_EXIT_MV 3600
#define BAT_SHUTDOWN_MV 3500
#define BAT_VALID_MIN_MV 2500
#define BAT_VALID_MAX_MV 5000
#define BAT_SHUTDOWN_CONFIRM_COUNT 3
unsigned short g_vbat_vol = 0;
unsigned short vbat_sample[6] = {0}; // 修改：样本数改为6
unsigned char battery_first_update_flag = 0;
static unsigned short g_vbat_vol_last = 0;
static bat_level_t g_bat_level_last = BAT_LEVEL_100;
// ========== 新增：电压历史记录环形缓冲区 ==========
static unsigned short g_voltage_history[VOLTAGE_HISTORY_SIZE] = {0};
static unsigned char g_history_index = 0;
static unsigned char g_history_count = 0; // 已记录的有效点数
static int g_charging_state = 0; // 当前判定的充电状态：1-充电, 0-未充电
static unsigned char g_charging_stable_cnt = 0; // 状态稳定计数
static unsigned short g_vbat_vol_last = 0;
static bat_level_t g_bat_level_last = BAT_LEVEL_100;
static unsigned char g_bat_level_valid = 0;
static unsigned char g_low_voltage_count = 0;
static unsigned char g_low_probe_active = 0;
static unsigned char g_low_power_warned = 0;
static int g_vbus_last_state = -1;
bat_level_t calc_battery_level(uint16_t voltage_mv)
{
@@ -71,101 +71,93 @@ bat_level_t calc_battery_level(uint16_t voltage_mv)
else return BAT_LEVEL_0;
}
/**
* @brief 基于10分钟电压历史判断充放电状态
* @return 1-充电中, 0-未充电/放电
*/
static int detect_charging_by_trend(void)
{
if (g_history_count < VOLTAGE_HISTORY_SIZE) {
printf("[BAT] history not full (%d/%d), keep state:%d\r\n",
g_history_count, VOLTAGE_HISTORY_SIZE, g_charging_state);
return g_charging_state;
}
unsigned char old_index = (g_history_index + 1) % VOLTAGE_HISTORY_SIZE;
unsigned short vbat_now = g_voltage_history[(g_history_index + VOLTAGE_HISTORY_SIZE - 1) % VOLTAGE_HISTORY_SIZE];
unsigned short vbat_10min_ago = g_voltage_history[old_index];
short delta = (short)vbat_now - (short)vbat_10min_ago;
printf("[BAT] trend: now=%d, 10min_ago=%d, delta=%d\r\n",
vbat_now, vbat_10min_ago, delta);
int new_state = g_charging_state;
if (delta > VOLTAGE_RISE_THRESHOLD) {
new_state = 1;
printf("[BAT] trend: CHARGING detected (rise %dmV)\r\n", delta);
}
else if (delta < -VOLTAGE_DROP_THRESHOLD) {
new_state = 0;
printf("[BAT] trend: DISCHARGING detected (drop %dmV)\r\n", -delta);
}
else {
printf("[BAT] trend: STABLE (delta %dmV), keep state:%d\r\n", delta, g_charging_state);
}
if (new_state == g_charging_state) {
g_charging_stable_cnt = 0;
} else {
g_charging_stable_cnt++;
if (g_charging_stable_cnt < 3) {
printf("[BAT] state change pending: %d -> %d (%d/3)\r\n",
g_charging_state, new_state, g_charging_stable_cnt);
return g_charging_state;
}
g_charging_stable_cnt = 0;
printf("[BAT] state changed: %d -> %d (confirmed)\r\n", g_charging_state, new_state);
}
return new_state;
}
static void update_voltage_history(unsigned short voltage)
{
g_voltage_history[g_history_index] = voltage;
g_history_index = (g_history_index + 1) % VOLTAGE_HISTORY_SIZE;
if (g_history_count < VOLTAGE_HISTORY_SIZE) {
g_history_count++;
}
}
static int is_charging(void)
{
// 如有硬件检测引脚，可优先使用
return detect_charging_by_trend();
}
static bat_level_t limit_level_jump(bat_level_t raw_level, bat_level_t last_level, int charging)
{
bat_level_t result = last_level;
if (charging) {
if (raw_level > last_level) {
if (raw_level - last_level == 1) {
result = raw_level;
printf("[BAT] level up (charging): %d -> %d\r\n", last_level, raw_level);
} else if (raw_level - last_level > 1) {
result = (bat_level_t)(last_level + 1);
printf("[BAT] level up limited (charging): %d -> %d (raw:%d)\r\n",
last_level, result, raw_level);
}
}
} else {
if (raw_level < last_level) {
if (last_level - raw_level == 1) {
result = raw_level;
printf("[BAT] level down (discharging): %d -> %d\r\n", last_level, raw_level);
} else if (last_level - raw_level > 1) {
result = (bat_level_t)(last_level - 1);
printf("[BAT] level down limited (discharging): %d -> %d (raw:%d)\r\n",
last_level, result, raw_level);
}
}
}
return result;
}
bat_level_t battery_get_level(void)
{
return g_bat_level_valid ? g_bat_level_last : calc_battery_level(g_vbat_vol);
}
static int update_vbus_state(void)
{
int vbus_state = ql_get_vbus_state() ? 1 : 0;
if (vbus_state != g_vbus_last_state) {
printf("[BAT][VBUS] state changed: %d -> %d\r\n",
g_vbus_last_state, vbus_state);
g_vbus_last_state = vbus_state;
if (vbus_state) {
g_low_voltage_count = 0;
g_low_probe_active = 0;
g_low_power_warned = 0;
}
}
return vbus_state;
}
static bat_level_t limit_level_jump(bat_level_t raw_level, int external_power)
{
bat_level_t result = g_bat_level_last;
if (!g_bat_level_valid) {
g_bat_level_valid = 1;
g_bat_level_last = raw_level;
printf("[BAT] first level initialized: %d\r\n", raw_level);
return raw_level;
}
if (external_power) {
if (raw_level > g_bat_level_last) {
result = (raw_level >= g_bat_level_last + BAT_LEVEL_10)
? (bat_level_t)(g_bat_level_last + BAT_LEVEL_10)
: raw_level;
}
} else {
if (raw_level < g_bat_level_last) {
result = (raw_level <= g_bat_level_last - BAT_LEVEL_10)
? (bat_level_t)(g_bat_level_last - BAT_LEVEL_10)
: raw_level;
}
}
printf("[BAT] level update: last=%d raw=%d result=%d vbus=%d\r\n",
g_bat_level_last, raw_level, result, external_power);
g_bat_level_last = result;
return result;
}
static void battery_check_critical_voltage(unsigned short voltage_mv, int external_power)
{
if (external_power) {
g_low_voltage_count = 0;
g_low_probe_active = 0;
return;
}
if (voltage_mv < BAT_LOW_WARN_MV) {
g_low_probe_active = 1;
} else if (voltage_mv >= BAT_LOW_PROBE_EXIT_MV) {
g_low_probe_active = 0;
}
if (voltage_mv < BAT_SHUTDOWN_MV) {
if (g_low_voltage_count < BAT_SHUTDOWN_CONFIRM_COUNT) {
g_low_voltage_count++;
}
printf("[BAT] critical voltage:%d, confirm:%d/%d\r\n",
voltage_mv, g_low_voltage_count, BAT_SHUTDOWN_CONFIRM_COUNT);
if (g_low_voltage_count >= BAT_SHUTDOWN_CONFIRM_COUNT) {
printf("[BAT] critical voltage confirmed, poweroff now\r\n");
app_play_tips_file(15);
ql_rtos_task_sleep_s(5);
ql_power_down(1);
}
} else {
g_low_voltage_count = 0;
}
}
/* 修改后的 battery_check：分阶段采样，采样窗口为6次 */
void battery_check(void)
@@ -174,13 +166,17 @@ void battery_check(void)
static unsigned char sample_idx = 0; // 当前已采集样本数 (0~5)
static unsigned short sample_buf[6] = {0}; // 本地缓冲（也可用全局 vbat_sample，此处直接用局部）
call_count++;
int external_power = update_vbus_state();
call_count++;
/* 判断本次是否执行ADC采样 */
unsigned char do_sample = 0;
if (call_count <= 24) { // 开机2分钟内 (24次*5s=120s)
do_sample = 1;
} else {
if (call_count <= 24) { // 开机2分钟内 (24次*5s=120s)
do_sample = 1;
} else if (g_low_probe_active) {
do_sample = 1; // 低电风险时每5秒快速确认
} else {
// 2分钟后，每36次调用采样一次 (36*5s=180s=3分钟)
if ((call_count - 25) % 36 == 0) {
do_sample = 1;
@@ -195,9 +191,21 @@ void battery_check(void)
u16 vbat_vol = 0;
ql_adc_onff(1);
ql_rtos_task_sleep_ms(5);
ql_adc_onff(0);
vbat_vol = ql_get_battery_vol();
sample_buf[sample_idx] = vbat_vol;
ql_adc_onff(0);
vbat_vol = ql_get_battery_vol();
printf("[BAT][SAMPLE] voltage=%d, vbus=%d, low_probe=%d\r\n",
vbat_vol, external_power, g_low_probe_active);
if (vbat_vol < BAT_VALID_MIN_MV || vbat_vol > BAT_VALID_MAX_MV) {
printf("[BAT] invalid voltage sample ignored:%d\r\n", vbat_vol);
g_low_voltage_count = 0;
return;
}
battery_check_critical_voltage(vbat_vol, external_power);
sample_buf[sample_idx] = vbat_vol;
sample_idx++;
/* 当收集满6个样本时进行平均处理 */
@@ -215,47 +223,39 @@ void battery_check(void)
vol_all = vol_all - min - max;
vbat_vol = vol_all / 4; // 6个样本去掉最大最小，剩余4个平均
/* 更新电压历史（用于充电趋势判断） */
update_voltage_history(vbat_vol);
/* 判断充电状态 */
int charging = is_charging();
g_charging_state = charging;
/* 非充电状态下，电压不允许上升 */
if (!charging) {
if (g_vbat_vol_last > 0 && vbat_vol > g_vbat_vol_last) {
printf("[BAT] voltage rise blocked: %d -> %d (not charging)\r\n",
g_vbat_vol_last, vbat_vol);
vbat_vol = g_vbat_vol_last;
}
/* 非接电状态下，电压不允许上升 */
if (!external_power) {
if (g_vbat_vol_last > 0 && vbat_vol > g_vbat_vol_last) {
printf("[BAT] voltage rise blocked: %d -> %d (vbus=0)\r\n",
g_vbat_vol_last, vbat_vol);
vbat_vol = g_vbat_vol_last;
}
}
g_vbat_vol = vbat_vol;
g_vbat_vol_last = vbat_vol;
printf("vbat_vol:%d, charging:%d\r\n", g_vbat_vol, charging);
printf("vbat_vol:%d, vbus:%d\r\n", g_vbat_vol, external_power);
/* 计算电量等级并限制跳变 */
bat_level_t raw_level = calc_battery_level(g_vbat_vol);
bat_level_t level = limit_level_jump(raw_level, g_bat_level_last, charging);
g_bat_level_last = level;
printf("[BAT] raw_level:%d, limited_level:%d, charging:%d\r\n",
raw_level, level, charging);
/* 计算电量等级并限制跳变 */
bat_level_t raw_level = calc_battery_level(g_vbat_vol);
bat_level_t level = limit_level_jump(raw_level, external_power);
printf("[BAT] raw_level:%d, limited_level:%d, vbus:%d\r\n",
raw_level, level, external_power);
if (battery_first_update_flag == 0) {
battery_first_update_flag = 1;
}
/* 低电量处理 */
if (level == BAT_LEVEL_0) {
printf("poweroff now\r\n");
app_play_tips_file(15);
ql_rtos_task_sleep_s(5);
ql_power_down(1);
} else if (level <= BAT_LEVEL_10) {
app_play_tips_file(14);
}
/* 极低电关机由原始电压独立处理，普通低电提示只播放一次 */
if (!external_power && level <= BAT_LEVEL_10) {
if (!g_low_power_warned) {
g_low_power_warned = 1;
app_play_tips_file(14);
}
} else if (external_power || level >= BAT_LEVEL_20) {
g_low_power_warned = 0;
}
sample_idx = 0; // 重置样本索引，准备下一轮采集
}