fix: battery level update without charging status
This commit is contained in:
@@ -45,31 +45,17 @@
|
||||
#define BAT_VALID_MAX_MV 5000
|
||||
#define BAT_SHUTDOWN_CONFIRM_COUNT 3
|
||||
|
||||
/*
|
||||
* 原理图中电池负极经 R28(0.33R) 接地,电池侧通过 R35 接 ADC0。
|
||||
* 充电电流流过 R28 时 ADC0 出现正向压降;放电时 ADC0 接近 0mV。
|
||||
* 8mV 约对应 24mA,3mV 作为退出阈值,滞回可避免零点噪声抖动。
|
||||
*/
|
||||
#define BAT_CHARGE_ADC_ENTER_MV 8
|
||||
#define BAT_CHARGE_ADC_EXIT_MV 3
|
||||
#define BAT_CHARGE_CONFIRM_COUNT 3
|
||||
#define BAT_CHARGE_ADC_FAIL_COUNT 3
|
||||
#define BAT_NORMAL_SAMPLE_CALLS 6
|
||||
|
||||
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 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;
|
||||
static int g_charge_adc_state = 0;
|
||||
static unsigned char g_charge_adc_enter_count = 0;
|
||||
static unsigned char g_charge_adc_exit_count = 0;
|
||||
static unsigned char g_charge_adc_fail_count = 0;
|
||||
|
||||
bat_level_t calc_battery_level(uint16_t voltage_mv)
|
||||
{
|
||||
@@ -91,83 +77,7 @@ 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_external_power_state(void)
|
||||
{
|
||||
int vbus_state = ql_get_vbus_state() ? 1 : 0;
|
||||
int adc_valid = 0;
|
||||
unsigned short adc0_mv = 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 (ql_adc_read(ADC_CHANNEL_ADC0, &adc0_mv) == ADC_READ_SUCCESS) {
|
||||
adc_valid = 1;
|
||||
g_charge_adc_fail_count = 0;
|
||||
|
||||
if (!g_charge_adc_state) {
|
||||
g_charge_adc_exit_count = 0;
|
||||
if (adc0_mv >= BAT_CHARGE_ADC_ENTER_MV) {
|
||||
if (g_charge_adc_enter_count < BAT_CHARGE_CONFIRM_COUNT) {
|
||||
g_charge_adc_enter_count++;
|
||||
}
|
||||
if (g_charge_adc_enter_count >= BAT_CHARGE_CONFIRM_COUNT) {
|
||||
g_charge_adc_state = 1;
|
||||
g_charge_adc_enter_count = 0;
|
||||
printf("[BAT][CHARGE] ADC0 charging detected: %dmV\r\n",
|
||||
adc0_mv);
|
||||
}
|
||||
} else {
|
||||
g_charge_adc_enter_count = 0;
|
||||
}
|
||||
} else {
|
||||
g_charge_adc_enter_count = 0;
|
||||
if (adc0_mv <= BAT_CHARGE_ADC_EXIT_MV) {
|
||||
if (g_charge_adc_exit_count < BAT_CHARGE_CONFIRM_COUNT) {
|
||||
g_charge_adc_exit_count++;
|
||||
}
|
||||
if (g_charge_adc_exit_count >= BAT_CHARGE_CONFIRM_COUNT) {
|
||||
g_charge_adc_state = 0;
|
||||
g_charge_adc_exit_count = 0;
|
||||
printf("[BAT][CHARGE] ADC0 charging removed: %dmV\r\n",
|
||||
adc0_mv);
|
||||
}
|
||||
} else {
|
||||
g_charge_adc_exit_count = 0;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
g_charge_adc_enter_count = 0;
|
||||
g_charge_adc_exit_count = 0;
|
||||
if (g_charge_adc_fail_count < BAT_CHARGE_ADC_FAIL_COUNT) {
|
||||
g_charge_adc_fail_count++;
|
||||
}
|
||||
if (g_charge_adc_fail_count >= BAT_CHARGE_ADC_FAIL_COUNT) {
|
||||
g_charge_adc_state = 0;
|
||||
}
|
||||
}
|
||||
|
||||
{
|
||||
int external_power = vbus_state || g_charge_adc_state;
|
||||
|
||||
printf("[BAT][POWER] vbus=%d, adc0=%d, adc_valid=%d, "
|
||||
"adc_charge=%d, external=%d\r\n",
|
||||
vbus_state, adc0_mv, adc_valid,
|
||||
g_charge_adc_state, external_power);
|
||||
|
||||
if (external_power) {
|
||||
g_low_voltage_count = 0;
|
||||
g_low_probe_active = 0;
|
||||
g_low_power_warned = 0;
|
||||
}
|
||||
|
||||
return external_power;
|
||||
}
|
||||
}
|
||||
|
||||
static bat_level_t limit_level_jump(bat_level_t raw_level, int external_power)
|
||||
static bat_level_t limit_level_jump(bat_level_t raw_level)
|
||||
{
|
||||
bat_level_t result = g_bat_level_last;
|
||||
|
||||
@@ -178,34 +88,24 @@ static bat_level_t limit_level_jump(bat_level_t raw_level, int external_power)
|
||||
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;
|
||||
}
|
||||
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 external=%d\r\n",
|
||||
g_bat_level_last, raw_level, result, external_power);
|
||||
printf("[BAT] level update: last=%d raw=%d result=%d\r\n",
|
||||
g_bat_level_last, raw_level, result);
|
||||
g_bat_level_last = result;
|
||||
return result;
|
||||
}
|
||||
|
||||
static void battery_check_critical_voltage(unsigned short voltage_mv, int external_power)
|
||||
static void battery_check_critical_voltage(unsigned short voltage_mv)
|
||||
{
|
||||
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) {
|
||||
@@ -238,8 +138,6 @@ void battery_check(void)
|
||||
static unsigned char sample_idx = 0; // 当前已采集样本数 (0~5)
|
||||
static unsigned short sample_buf[6] = {0}; // 本地缓冲(也可用全局 vbat_sample,此处直接用局部)
|
||||
|
||||
int external_power = update_external_power_state();
|
||||
|
||||
call_count++;
|
||||
|
||||
/* 判断本次是否执行ADC采样 */
|
||||
@@ -249,8 +147,8 @@ void battery_check(void)
|
||||
} else if (g_low_probe_active) {
|
||||
do_sample = 1; // 低电风险时每5秒快速确认
|
||||
} else {
|
||||
// 2分钟后,每36次调用采样一次 (36*5s=180s=3分钟)
|
||||
if ((call_count - 25) % 36 == 0) {
|
||||
// 2分钟后,每6次调用采样一次 (6*5s=30秒)
|
||||
if (call_count % BAT_NORMAL_SAMPLE_CALLS == 0) {
|
||||
do_sample = 1;
|
||||
}
|
||||
}
|
||||
@@ -266,8 +164,8 @@ void battery_check(void)
|
||||
ql_adc_onff(0);
|
||||
vbat_vol = ql_get_battery_vol();
|
||||
|
||||
printf("[BAT][SAMPLE] voltage=%d, external=%d, low_probe=%d\r\n",
|
||||
vbat_vol, external_power, g_low_probe_active);
|
||||
printf("[BAT][SAMPLE] voltage=%d, low_probe=%d\r\n",
|
||||
vbat_vol, 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);
|
||||
@@ -275,7 +173,7 @@ void battery_check(void)
|
||||
return;
|
||||
}
|
||||
|
||||
battery_check_critical_voltage(vbat_vol, external_power);
|
||||
battery_check_critical_voltage(vbat_vol);
|
||||
|
||||
sample_buf[sample_idx] = vbat_vol;
|
||||
sample_idx++;
|
||||
@@ -295,37 +193,27 @@ void battery_check(void)
|
||||
vol_all = vol_all - min - max;
|
||||
vbat_vol = vol_all / 4; // 6个样本去掉最大最小,剩余4个平均
|
||||
|
||||
/* 非接电状态下,电压不允许上升 */
|
||||
if (!external_power) {
|
||||
if (g_vbat_vol_last > 0 && vbat_vol > g_vbat_vol_last) {
|
||||
printf("[BAT] voltage rise blocked: %d -> %d (external=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, external:%d\r\n", g_vbat_vol, external_power);
|
||||
g_vbat_vol = vbat_vol;
|
||||
printf("vbat_vol:%d\r\n", g_vbat_vol);
|
||||
|
||||
/* 计算电量等级并限制跳变 */
|
||||
bat_level_t raw_level = calc_battery_level(g_vbat_vol);
|
||||
bat_level_t level = limit_level_jump(raw_level, external_power);
|
||||
bat_level_t level = limit_level_jump(raw_level);
|
||||
|
||||
printf("[BAT] raw_level:%d, limited_level:%d, external:%d\r\n",
|
||||
raw_level, level, external_power);
|
||||
printf("[BAT] raw_level:%d, limited_level:%d\r\n",
|
||||
raw_level, level);
|
||||
|
||||
if (battery_first_update_flag == 0) {
|
||||
battery_first_update_flag = 1;
|
||||
}
|
||||
|
||||
/* 极低电关机由原始电压独立处理,普通低电提示只播放一次 */
|
||||
if (!external_power && level <= BAT_LEVEL_10) {
|
||||
if (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) {
|
||||
} else if (level >= BAT_LEVEL_20) {
|
||||
g_low_power_warned = 0;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user