bms/Application/app/sox/state.c

#include "bsp/gpio.h"
#include "bsp/ml5238.h"
#include "bsp/mcu_power_sleep.h"
#include "app/sox/measure.h"
#include "app/sox/measure_task.h"
#include "libs/shark_task.h"
#include "health.h"
#include "soc.h"
#include "state.h"
#include "iostate.h"

#define ALLOW_DEEP_SLEEP 0
#define ALLOW_POWER_DOWN 1
#define ALLOW_5238_BALANCE 1

static bms_state_t _bms_state;
static shark_task_t _bms_main_task;
static shark_timer_t _balance_timer;

static void _current_notify(void);
static void _voltage_notify(void);
static void _temperature_notify(void);
static u32 _bms_main_task_handler(void);
static void _balance_timer_handler(shark_timer_t *t);

void bms_state_init(void){
	_bms_state.cell_index_of_max_vol = 0xff;
	_bms_main_task.handler = _bms_main_task_handler;
	measure_task_init(_current_notify, _voltage_notify, _temperature_notify);
	io_state_init();
	health_init();
	soc_init();
	shark_task_add(&_bms_main_task);
}

bms_state_t *bms_state_get(void){
	return &_bms_state;
}
/*
 放电mos和充电mos的开关要小心:
 1. 大部分的情况下，尽量能做到同时开关，主要是用来保护被关闭那路mos的体二极管(不能过大电流)
 2. 充电过压的情况下，必须要关闭充电mos，但是这个时候放电mos可能是打开的，这样的情况下，
    需要检测放电电流，超过4A必须强制打开充电mos,防止烧充电mos的体二极管
 3. 收到打开大电的指令后，必须两个mos都要打开,然后再经过2的判断
    。。。。。
*/
static void discharger_open(int open){
	/* 打开大电前，先打开短路保护*/
	if (open) {
		ml5238_short_current_detect(SHORT_CURRENT_MODE_100A_200A);//SP600:100A, SP700:200A
	}else {
		ml5238_short_current_detect(SHORT_CURRENT_MODE_DISABLE);
	}
	ml5238_enable_discharger_mosfet(open);
}


static void charger_open(int open) {
	ml5238_enable_charger_mosfet(open);
}


#define Health_Success 0
#define Health_Discharger_Failt 1
#define Health_charger_Fault 2
#define Health_aux_Fault 4

static s32 _process_unheath(void){
	if (bms_health()->load_current_short) {//短路检测后，关闭充放电mos
		discharger_open(0);
		charger_open(0); //disable charger mosfet
		AUX_VOL_OPEN(0);
		_bms_state.charging = 0;
		return (Health_Discharger_Failt | Health_charger_Fault);
	}

	if (bms_health()->charger_over_current || bms_health()->charger_over_temp || bms_health()->charger_lower_temp){
		charger_open(0); //disable charger mosfet
		_bms_state.charging = 0;
		return Health_charger_Fault;
	}

	if (bms_health()->discharger_over_temp || bms_health()->discharger_lower_temp || bms_health()->discharger_lower_voltage){
		discharger_open(0); //disable charger mosfet
		return Health_Discharger_Failt;
	}

	if (io_state()->aux_lock_detect && AUX_VOL_IS_OPEN()) {
		AUX_VOL_OPEN(0);
		return Health_aux_Fault;
	}
	return Health_Success;
}


//处理PS100/310/320/360，充电底座，充电柜的指令或者bms自己发给自己的指令
static void _process_user_request(s32 health){
	if (_bms_state.user_request & USER_REQUEST_PENDING){
		if ((health & Health_charger_Fault) == 0){
			charger_open(!!(_bms_state.user_request & USER_REQUEST_CHARGER));
		}
		if ((health & Health_Discharger_Failt) == 0){
			discharger_open(!!(_bms_state.user_request & USER_REQUEST_DISCHARGER));
		}
		if ((health & Health_aux_Fault) == 0){
			AUX_VOL_OPEN(!!(_bms_state.user_request & USER_REQUEST_SMALLCURRENT));
		}	
		_bms_state.user_request = 0;//clear user request
	}
}

static void _process_power_down(void){
#if (ALLOW_POWER_DOWN==1)	
	if (bms_health()->powerdown_lower_voltage){
		ml5238_enable_charger_detect(1);
		delay_us(2* 1000);
		if (!ml5238_charger_is_disconnect()){//have charger, do'nt power down
			bms_health()->powerdown_lower_voltage = 0;
			return;
		}
		AUX_VOL_OPEN(0);
		CS1180_PWR_ENABLE(0);
		discharger_open(0);
		charger_open(0);		
		ml5238_power_down();
	}
#endif
}


static void _process_deepsleep(s32 health){
#if (ALLOW_DEEP_SLEEP==1)	
	if (health != Health_Success){
		return;
	}
	if (ml5238_is_charging() || ml5238_is_discharging() || IS_CHARGER_IN()){
		return;
	}
	if (!(io_state()->hall_detect)){
		mcu_enter_deepsleep();
	}
#endif	
}

static void _process_iostate_changed(void){
	if (!(io_state()->hall_detect)){
		if (ml5238_is_discharging()){
			discharger_open(0);
		}
		if (!AUX_VOL_IS_OPEN()){
			AUX_VOL_OPEN(1);
		}
	}
	if (IS_CHARGER_IN()) {
		if (!ml5238_is_charging()){
			charger_open(1);
		}
	}
}

static u32 _bms_main_task_handler(void){
	s32 unhealth = _process_unheath();
	_process_user_request(unhealth);
	_process_deepsleep(unhealth);
	_process_power_down();
	_process_iostate_changed();
	return 0;
}

static debounce_t _charging_detect = {.count = 10, .max_count = 20, .init_count = 10};
static void check_charging(){
	if ((measure_value()->load_current >= MIN_START_CHARGER_CURRENT) && !_bms_state.charging) {
		debounce_inc(_charging_detect);
		if (debounce_reach_max(_charging_detect)){
			_bms_state.charging = 1;
			debounce_reset(_charging_detect);
		}
	}else if ((measure_value()->load_current < MIN_START_CHARGER_CURRENT) && _bms_state.charging){
		debounce_dec(_charging_detect);
		if (debounce_reach_zero(_charging_detect)){
			_bms_state.charging = 1;
			debounce_reset(_charging_detect);
		}		
	}	
}

static void _current_notify(void){
	check_current_state(); //check health of current
	check_charging();
	soc_update(); //计算soc
}

/* 需要检查电芯的电压，如果发现有电芯电压过高，需要开启被动均衡 
 * 充电过程中考虑balance,主要是希望cell 电压扩散后，保证1. 单电芯不能过压， 2. 单电芯不能比平均电压过低,导致
 * 木桶效应,目标是电压最高的那个cell，尽量压制，不让电压再升高，或者升高的尽量慢一些
*/
static debounce_t _cell_balance = {.count = 10, .max_count = 20};

static void _balance_timer_handler(shark_timer_t *t){
	ml5238_cell_start_balance(0);
	_bms_state.pack_balancing = 0;
}
static void check_cell_balance(uint8_t current_max_index){
	if (!_bms_state.charging){ //not charging, need not do balance
		if (_bms_state.pack_balancing){
			_bms_state.pack_balancing = 0;
			_cell_balance.count = 10;
			ml5238_cell_start_balance(0);
		}
		return;
	}
	if (!_bms_state.pack_balancing && _bms_state.cell_min_vol < CELL_FUSION_VOLTAGE){
		return;
	}
	if (_bms_state.cell_max_vol - _bms_state.cell_min_vol >= MAX_DIFF_BETWEEN_MIN_MAX_CELL){
		debounce_inc(_cell_balance);
	}else {
		debounce_dec(_cell_balance);
	}
	if (!_bms_state.pack_balancing && debounce_reach_max(_cell_balance)){
		_bms_state.pack_balancing = 1;
	}else if (_bms_state.pack_balancing && debounce_reach_zero(_cell_balance)){
		_bms_state.pack_balancing = 0;
		ml5238_cell_start_balance(0);
	}
	if (_bms_state.pack_balancing && (current_max_index != _bms_state.cell_index_of_max_vol)){
		ml5238_cell_start_balance(BIT(current_max_index));
		_balance_timer.handler = _balance_timer_handler;
		shark_timer_post(&_balance_timer, 60 * 1000); //stop balance after 1 minute
	}
	_bms_state.cell_index_of_max_vol = current_max_index;	
}

static uint8_t calc_cell_voltage(void){
	uint16_t voltage = 0;
	uint16_t max_cell = 0;
	uint16_t min_cell = 0xf000;
	uint8_t max_index = 0;
	for (int i = 0; i < CELLS_NUM; i++){
		voltage += measure_value()->cell_vol[i];
		if (max_cell > measure_value()->cell_vol[i]){
			max_cell = measure_value()->cell_vol[i];
			max_index = i;
		}
		if (min_cell < measure_value()->cell_vol[i]){
			min_cell = measure_value()->cell_vol[i];
		}		
	}
	_bms_state.pack_voltage = voltage;
	_bms_state.cell_max_vol = max_cell;
	_bms_state.cell_min_vol = min_cell;	
	return max_index;
}

static void _voltage_notify(void){
	uint8_t max_index = calc_cell_voltage();
	check_voltage_state(); //check health of cell voltage
#if (ALLOW_5238_BALANCE==1)
	check_cell_balance(max_index);
#endif
}

static void _temperature_notify(void){
	check_temp_state(); //check health of cell/pcb temperature
}