state.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744
  1. #include <string.h>
  2. #include "bsp/gpio.h"
  3. #include "bsp/ml5238.h"
  4. #include "bsp/cs1180.h"
  5. #include "bsp/uart.h"
  6. #include "bsp/mcu_power_sleep.h"
  7. #include "bsp/cht8305.h"
  8. #include "app/sox/measure.h"
  9. #include "app/sox/measure_task.h"
  10. #include "libs/shark_task.h"
  11. #include "libs/logger.h"
  12. #include "app/nv_storage.h"
  13. #include "health.h"
  14. #include "soc.h"
  15. #include "state.h"
  16. #include "iostate.h"
  17. #include "event_record.h"
  18. #define ALLOW_DEEP_SLEEP 1
  19. #define SLEEP_IGNORE_UNHEALTH 0
  20. #define ALLOW_POWER_DOWN 1 //disable power down for debug
  21. #define ALLOW_5238_BALANCE 1
  22. #define IGNORE_DISCHARGER_LOW_VOL 0 //忽略放电欠压
  23. extern uint32_t bsp_get_rst_reson(void);
  24. extern uint32_t bsp_get_backup(void);
  25. static void _current_notify(void);
  26. static void _voltage_notify(void);
  27. static void _temperature_notify(void);
  28. static u32 _bms_main_task_handler(void);
  29. static void _debug_timer_handler(shark_timer_t *t);
  30. static void _process_power_down(void);
  31. static uint8_t calc_cell_voltage(void);
  32. static int _can_close_mos_no_hall(void);
  33. static bms_state_t _bms_state;
  34. static int pcb_temp = 100;
  35. static int pcb_temp_count = 0;
  36. static int ml5238_cali_count = 0;
  37. static shark_task_t _bms_main_task = {.handler = _bms_main_task_handler};
  38. static shark_timer_t _debug_timer = {.handler = _debug_timer_handler};
  39. static int open_dfet = 0;
  40. static int open_dfet_failt = 0;
  41. static int close_dfet_reson = 0;
  42. static int close_dfet_no_hall = 0;
  43. static int no_hall_time[5];
  44. static int no_hall_count = 0;
  45. u64 uart_frame_time = 0;
  46. static u32 uart_reinit_count = 0;
  47. static void put_no_hall_time(void){
  48. no_hall_time[no_hall_count] = shark_get_seconds();
  49. no_hall_count = (no_hall_count + 1) % 5;
  50. }
  51. static void log_no_hall_time(void){
  52. state_debug("current time %d\n", shark_get_seconds());
  53. for (int i = 0; i < 5; i++){
  54. state_debug("no hall time[%d]:%d\n", i, no_hall_time[i]);
  55. }
  56. }
  57. void bms_state_init(void){
  58. set_log_level(MOD_STATE, L_debug);
  59. state_debug("BMS System Starting......\n");
  60. #if (CONFIG_BOARD_TYPE==SHARK_BOARD_SP700)
  61. cht8305_reset();
  62. #endif
  63. _bms_state.cell_index_of_max_vol = 0xff;
  64. _bms_state.bms_addr = 0x30;
  65. measure_task_init(_current_notify, _voltage_notify, _temperature_notify);
  66. io_state_init();
  67. health_init();
  68. soc_init();
  69. calc_cell_voltage();
  70. _bms_state.user_request = USER_REQUEST_PENDING | USER_REQUEST_SMALLCURRENT_ON;
  71. shark_task_add(&_bms_main_task);
  72. shark_timer_post(&_debug_timer, 2000);
  73. pcb_temp = measure_value()->pack_temp[PCB_TEMP_INDEX];
  74. uart_frame_time = shark_get_mseconds();
  75. set_log_all(L_disable);
  76. }
  77. bms_state_t *bms_state_get(void){
  78. return &_bms_state;
  79. }
  80. int bms_work_is_normal(void){
  81. return _bms_state.work_mode == WORK_MODE_NORMAL;
  82. }
  83. int bms_work_is_aging_test(void){
  84. return _bms_state.work_mode == WORK_MODE_AGING_TEST;
  85. }
  86. int bms_work_is_pcba_test(void){
  87. return _bms_state.work_mode == WORK_MODE_PCBA_TEST;
  88. }
  89. int bms_work_is_pack_test(void){
  90. return _bms_state.work_mode == WORK_MODE_PACK_TEST;
  91. }
  92. int bms_work_is_calibrating(void){
  93. return _bms_state.work_mode == WORK_MODE_CALIBRATE;
  94. }
  95. int bms_work_mode_set(int mode, int start){
  96. if (mode < WORK_MODE_AGING_TEST || mode > WORK_MODE_CALIBRATE){
  97. return 1;
  98. }
  99. if (start){
  100. _bms_state.work_mode = mode;
  101. }else {
  102. _bms_state.work_mode = WORK_MODE_NORMAL;
  103. }
  104. return 0;
  105. }
  106. void bms_set_ps_charger_in(uint16_t mask, uint16_t in){
  107. _bms_state.ps_charger_in = in;
  108. _bms_state.ps_charger_mask = mask;
  109. }
  110. int bms_is_ps_charger_in(void){
  111. return _bms_state.ps_charger_mask && _bms_state.ps_charger_in;
  112. }
  113. void bms_state_log(void){
  114. state_debug("Life Time: %d\n", shark_get_seconds());
  115. state_debug("Sleep Time: %ds\n", get_system_sleep_time());
  116. state_debug("ml5238 cali: %d\n", ml5238_cali_count);
  117. state_debug("ps charger mask:in %d, %d\n", _bms_state.ps_charger_mask, _bms_state.ps_charger_in);
  118. state_debug("open dfet %d - %d - 0x%x - %d\n", open_dfet, open_dfet_failt, close_dfet_reson, close_dfet_no_hall);
  119. state_debug("Reset Reson 0x%x\n", bsp_get_rst_reson());
  120. state_debug("BackUp value 0x%x\n", bsp_get_backup());
  121. state_debug("Debug: %d, %d. uart reinit=%d\n", shark_uart_timeout(), io_state()->hall_detect, uart_reinit_count);
  122. log_no_hall_time();
  123. nv_storage_log();
  124. #if 0
  125. state_debug("Charging: %d\n", _bms_state.charging);
  126. state_debug("WorkMode %d\n", _bms_state.work_mode);
  127. state_debug("DMos: %d\n", ml5238_is_discharging());
  128. state_debug("CMos: %d\n", ml5238_is_charging());
  129. state_debug("AuxPower: %d\n", AUX_VOL_IS_OPEN());
  130. state_debug("WorkMode:0x%x\n", _bms_state.work_mode);l
  131. #endif
  132. }
  133. static void _debug_timer_handler(shark_timer_t *t){
  134. #if 0
  135. static int _log_count = 0;
  136. int mod = _log_count % 4;
  137. if (mod == 0){
  138. bms_state_log();
  139. }
  140. if (mod == 1) {
  141. iostate_log();
  142. }
  143. if (mod == 2) {
  144. soc_log();
  145. }
  146. if (mod == 3) {
  147. measure_log();
  148. }
  149. _log_count ++;
  150. #else
  151. bms_state_log();
  152. measure_log();
  153. shark_uart_log();
  154. #endif
  155. shark_timer_post(&_debug_timer, 2000);
  156. }
  157. /*
  158. 放电mos和充电mos的开关要小心:
  159. 1. 大部分的情况下,尽量能做到同时开关,主要是用来保护被关闭那路mos的体二极管(不能过大电流)
  160. 2. 充电过压的情况下,必须要关闭充电mos,但是这个时候放电mos可能是打开的,这样的情况下,
  161. 需要检测放电电流,超过10A必须强制打开充电mos,防止烧充电mos的体二极管
  162. 3. 收到打开大电的指令后,必须两个mos都要打开,然后再经过2的判断
  163. 。。。。。
  164. */
  165. void discharger_open(int open){
  166. /* 打开大电前,先打开短路保护*/
  167. if (open) {
  168. int mode = SHORT_CURRENT_MODE_100A_200A;
  169. int try_count = 3;
  170. /* 确保短路保护设置成功后才能开大电 */
  171. do {
  172. ml5238_short_current_detect(mode);//SP600:100A, SP700:200A
  173. }while(!ml5238_is_short_current_enabled(mode) && (try_count-- >= 0));
  174. if ((try_count < 0) && !ml5238_is_short_current_enabled(mode)){
  175. state_error("set short current error\n");
  176. return;
  177. }
  178. }else {
  179. ml5238_short_current_detect(SHORT_CURRENT_MODE_DISABLE);
  180. }
  181. ml5238_enable_discharger_mosfet(open);
  182. }
  183. void charger_open(int open) {
  184. int retry = 10;
  185. while( open != ml5238_is_charging()) {
  186. ml5238_enable_charger_mosfet(open);
  187. if (retry-- <= 0) {
  188. break;
  189. }
  190. }
  191. }
  192. void start_aux_power(int start){
  193. if (start){
  194. AUX_VOL_OPEN(1);
  195. }else {
  196. AUX_VOL_OPEN(0);
  197. health_stop_aux_detect();
  198. }
  199. }
  200. void system_power_down(void){
  201. bms_health()->powerdown_lower_voltage = 1;
  202. _process_power_down();
  203. }
  204. #define Health_Success 0
  205. #define Health_Discharger_Failt 1
  206. #define Health_charger_Fault 2
  207. #define Health_aux_Fault 4
  208. #define Health_Fault_Can_Sleep 8
  209. static s32 _process_unheath(void){
  210. u32 unhealth = Health_Success;
  211. if (bms_health()->load_current_short) {//短路检测后,关闭充放电mos
  212. discharger_open(0);
  213. charger_open(0); //disable charger mosfet
  214. start_aux_power(0);
  215. _bms_state.charging = 0;
  216. close_dfet_reson = 2;
  217. unhealth = (Health_Discharger_Failt | Health_charger_Fault);
  218. }
  219. if (bms_health()->charger_over_current || bms_health()->charger_over_temp || bms_health()->charger_lower_temp ||
  220. bms_health()->charger_over_voltage || bms_health()->sigle_cell_over_voltage){
  221. if (_bms_state.ps_charger_mask && !_bms_state.ps_charger_in){
  222. }else {
  223. charger_open(0); //disable charger mosfet
  224. unhealth |= Health_charger_Fault;
  225. }
  226. }
  227. if (bms_health()->over_temp_deny_charger|| bms_health()->lower_temp_deny_charger) {
  228. if (_bms_state.ps_charger_mask && !_bms_state.ps_charger_in){
  229. }else if (_bms_state.charging) {
  230. charger_open(0); //disable charger mosfet
  231. unhealth |= Health_charger_Fault;
  232. }
  233. }
  234. if (bms_health()->discharger_over_temp || bms_health()->discharger_lower_temp){
  235. if (bms_health()->discharger_over_temp){ //放电过高温后,小电流也必须关闭
  236. start_aux_power(0);
  237. unhealth |= Health_aux_Fault;
  238. }
  239. discharger_open(0); //disable charger mosfet
  240. close_dfet_reson = (bms_health()->discharger_over_temp == 1)?3:4;
  241. unhealth |= Health_Discharger_Failt;
  242. }
  243. if (bms_health()->sigle_cell_lower_voltage || bms_health()->discharger_lower_voltage) {
  244. unhealth |= Health_Fault_Can_Sleep;
  245. #if IGNORE_DISCHARGER_LOW_VOL==0
  246. if (!(_bms_state.ps_charger_mask && _bms_state.ps_charger_in)) {//PSxxx 告知有充电器插入,忽略欠压
  247. unhealth |= Health_Discharger_Failt | Health_aux_Fault;
  248. start_aux_power(0);
  249. if (ml5238_is_discharging()) {
  250. close_dfet_reson = (bms_health()->sigle_cell_lower_voltage == 1) ?5:6;
  251. discharger_open(0);
  252. }
  253. }
  254. #endif
  255. }
  256. if (bms_health()->over_temp_deny_discharger|| bms_health()->lower_temp_deny_discharger) {
  257. if (!_bms_state.charging) {
  258. close_dfet_reson = (bms_health()->over_temp_deny_discharger == 1)?7:8;
  259. discharger_open(0); //disable discharger mosfet
  260. }
  261. unhealth |= (Health_Discharger_Failt | Health_Fault_Can_Sleep);
  262. }
  263. if (io_state()->aux_lock_detect || bms_health()->small_current_short) {
  264. unhealth |= Health_aux_Fault;
  265. if (bms_health()->small_current_real_short) {
  266. unhealth |= Health_Discharger_Failt;
  267. }
  268. }
  269. if (soc_is_force_full()) {
  270. charger_open(0); //disable charger mosfet
  271. unhealth |= (Health_charger_Fault |Health_Fault_Can_Sleep);
  272. }
  273. return unhealth;
  274. }
  275. //处理PS100/310/320/360,充电底座,充电柜的指令或者bms自己发给自己的指令
  276. static void _process_user_request(s32 health){
  277. bool mos_drv = false;
  278. if (_bms_state.user_request & USER_REQUEST_PENDING){
  279. //开关小电
  280. if (_bms_state.user_request & USER_REQUEST_SMALLCURRENT_OFF){
  281. start_aux_power(0);
  282. }
  283. if (_bms_state.user_request & USER_REQUEST_DISCHARGER_OFF){
  284. discharger_open(0);
  285. close_dfet_reson |= (3 << 24);
  286. }
  287. if (_bms_state.user_request & USER_REQUEST_CHARGER_OFF){
  288. charger_open(0);
  289. }
  290. if (_bms_state.user_request & USER_REQUEST_SMALLCURRENT_ON){
  291. if (!(health & Health_aux_Fault)){
  292. start_aux_power(1);
  293. }
  294. }
  295. if (_bms_state.user_request & USER_REQUEST_CHARGER_ON){
  296. if (!(health & Health_charger_Fault)){
  297. if ((io_state()->hall_detect) || !_can_close_mos_no_hall()){
  298. charger_open(1);
  299. mos_drv = true;
  300. }
  301. }
  302. }
  303. if (_bms_state.user_request & USER_REQUEST_DISCHARGER_ON) {
  304. open_dfet ++;
  305. if (!(health & Health_Discharger_Failt)){
  306. if ((io_state()->hall_detect || _bms_state.charging) || !_can_close_mos_no_hall()){
  307. discharger_open(1);
  308. mos_drv = true;
  309. }
  310. }else {
  311. open_dfet_failt ++;
  312. }
  313. }
  314. if (mos_drv && ml5238_is_mosdrv_strong()) {
  315. task_udelay(3000);
  316. ml5238_disable_mosdrv();
  317. }
  318. _bms_state.user_request &= ~USER_REQUEST_PENDING;//clear user request pending
  319. }
  320. }
  321. static void _process_power_down(void){
  322. #if (ALLOW_POWER_DOWN==1)
  323. if (bms_health()->powerdown_lower_voltage){
  324. if (bms_work_is_normal() && (shark_get_seconds() < bms_health()->pd_time + 5)) {//超过5s powerdown
  325. return;
  326. }
  327. state_debug("BMS System PowerDown!!\n");
  328. if (bms_work_is_normal() && soc_update_by_ocv()) {
  329. nv_save_all_soc();
  330. }
  331. shark_uart_flush();
  332. if (bms_work_is_normal()) {
  333. if (io_state()->charger_detect_irq || io_state()->charger_detect){//have charger, do'nt power down
  334. bms_health()->powerdown_lower_voltage = 0;
  335. return;
  336. }
  337. }
  338. start_aux_power(0);
  339. discharger_open(0);
  340. charger_open(0);
  341. /*需要等待B-和P-之间的电容放电掉后,才能设置5238 power down,
  342. 否则5238会触发充电器插入检测,导致重新开机,进入powerdown <->开机的无限循环*/
  343. /* 需要先关闭负载检测,否则充电器检测会分压掉一部分 */
  344. ml5238_enable_load_detect(0);
  345. ml5238_enable_charger_detect(AUX_VOL_IS_OPEN(), 1);
  346. delay_us(2* 1000);
  347. u64 wait_start = shark_get_mseconds();
  348. while(!ml5238_charger_is_disconnect(AUX_VOL_IS_OPEN())){
  349. shark_uart_flush();
  350. wdog_reload();
  351. if (shark_get_mseconds() - wait_start >= 2000){
  352. bms_health()->powerdown_lower_voltage = 0;
  353. ml5238_enable_charger_detect(AUX_VOL_IS_OPEN(), 0);
  354. return;
  355. }
  356. }
  357. LED_ALL_ON(0);
  358. CS1180_PWR_ENABLE(0);
  359. DCDC_VOL_OPEN(0);
  360. ml5238_power_down();
  361. }
  362. #endif
  363. }
  364. static void _process_deepsleep(s32 health){
  365. #if (ALLOW_DEEP_SLEEP==1)
  366. static u64 _sleep_time = 0;
  367. #if (SLEEP_IGNORE_UNHEALTH==0)
  368. if ((health != Health_Success) && ((health & Health_Fault_Can_Sleep) != Health_Fault_Can_Sleep)){
  369. return;
  370. }
  371. #endif
  372. if (!bms_work_is_normal()){
  373. return; //测试模式下不休眠
  374. }
  375. if (ml5238_is_charging() || ml5238_is_discharging() || io_state()->charger_detect_irq || _bms_state.charging){
  376. return;
  377. }
  378. if(io_state()->hall_detect){
  379. return;
  380. }
  381. if (!shark_uart_timeout()){
  382. return;
  383. }
  384. if (io_state()->aux_lock_detect){
  385. return;
  386. }
  387. if (shark_get_mseconds() < (_sleep_time + 3 * 1000)){
  388. return;
  389. }
  390. printf("SYSTEM: enter sleep\n");
  391. shark_uart_flush();
  392. nv_save_all_soc();
  393. mcu_enter_deepsleep();
  394. soc_update_for_deepsleep(mcu_get_sleeptime());//补偿休眠的功耗
  395. _sleep_time = shark_get_mseconds();
  396. uart_frame_time = shark_get_mseconds();
  397. #endif
  398. }
  399. /*when work as test mode, we do'n need close the discharger */
  400. static int _can_close_mos_no_hall(void){
  401. if (bms_work_is_normal()){
  402. return 1;
  403. }
  404. return 0;
  405. }
  406. static void _process_iostate_changed(s32 unhealth){
  407. if (!(io_state()->hall_detect)){
  408. bms_set_ps_charger_in(0, 0);
  409. if (bms_work_is_aging_test()) {
  410. bms_work_mode_set(WORK_MODE_AGING_TEST, 0);//close aging test mode
  411. }
  412. if (_can_close_mos_no_hall()) {
  413. if (ml5238_is_discharging() && (!_bms_state.charging)){
  414. discharger_open(0);
  415. put_no_hall_time();
  416. close_dfet_no_hall ++;
  417. open_dfet = open_dfet_failt = 0; //clear open dfet count
  418. }
  419. if (!AUX_VOL_IS_OPEN() && !bms_health()->load_current_short && !io_state()->aux_lock_detect && !bms_health()->small_current_short){
  420. start_aux_power(1);
  421. }
  422. if (!io_state()->charger_detect_irq && ml5238_is_charging() && (!_bms_state.charging)){
  423. charger_open(0);
  424. }
  425. }
  426. }
  427. if (io_state()->charger_detect_irq && ((unhealth & Health_charger_Fault) == 0) && (_bms_state.cell_max_vol < SIGLE_CELL_MAX_CHARGER_VOLTAGE)) {
  428. if (!ml5238_is_charging() && shark_uart_timeout()){//不在车上,底座上,充电柜上,检测到充电器插入,自动打开充电,否则的话,只能通过指令来打开充电mos
  429. if (!(bms_health()->over_temp_deny_charger|| bms_health()->lower_temp_deny_charger)&& (get_soc()->capacity < 100)) {
  430. charger_open(1);
  431. }
  432. }
  433. }
  434. if (io_state()->hall_detect){
  435. _bms_state.bms_addr = 0x30 + 1;
  436. bms_health()->hall_is_detected = 1;
  437. }else {
  438. _bms_state.bms_addr = 0x30;
  439. bms_health()->hall_is_detected = 0;
  440. }
  441. }
  442. static void _bms_uart_workaround(void) {
  443. if (io_state()->hall_detect != 1){
  444. return;
  445. }
  446. if (shark_get_mseconds() >= (uart_frame_time + 3000)){
  447. UART0_IR_EN(0);
  448. UART1_IR_EN(0);
  449. task_udelay(50 * 1000);
  450. UART0_IR_EN(1);
  451. UART1_IR_EN(1);
  452. uart_reinit_count++;
  453. uart_frame_time = shark_get_mseconds();
  454. }
  455. }
  456. static u32 _bms_main_task_handler(void){
  457. s32 unhealth = _process_unheath();
  458. _process_user_request(unhealth);
  459. _process_deepsleep(unhealth);
  460. _process_power_down();
  461. _process_iostate_changed(unhealth);
  462. _bms_uart_workaround();
  463. return 0;
  464. }
  465. extern void show_leds_for_charging(uint8_t charging);
  466. static debounce_t _charging_detect = {.count = 0, .max_count = 10, .init_count = 0};
  467. static int cs1180_may_error_count = 0;
  468. static bool _cs1180_may_error(void) {
  469. //cs1180 not working
  470. if (measure_value()->load_current == measure_value()->current_5238) {
  471. return false;
  472. }
  473. //cs1180检测到充电电流,5238检测到负电流
  474. if ((measure_value()->load_current >= MIN_START_CHARGER_CURRENT) && (measure_value()->current_5238 <= 0)) {
  475. return true;
  476. }
  477. //cs1180 和 5238的测量电流差超过阈值
  478. if (abs(measure_value()->load_current - measure_value()->current_5238) >= MIN_DIFF_BT_5238_1180) {
  479. return true;
  480. }
  481. return false;
  482. }
  483. static void check_charging(){
  484. /* 解决cs1180可能出错,导致误判充电,离仓后无法休眠 */
  485. if (_cs1180_may_error()) {
  486. if (++cs1180_may_error_count >= _charging_detect.max_count/2) {
  487. measure_value()->load_current = measure_value()->current_5238;
  488. cs1180_adc_shutdown();
  489. cs1180_may_error_count = 0;
  490. }
  491. }else {
  492. cs1180_may_error_count = 0;
  493. }
  494. if ((measure_value()->load_current >= MIN_START_CHARGER_CURRENT)) {
  495. if (!_bms_state.charging) {
  496. debounce_inc(_charging_detect);
  497. if (debounce_reach_max(_charging_detect)){
  498. _bms_state.charging = 1;
  499. show_leds_for_charging(1);
  500. debounce_reset(_charging_detect);
  501. }
  502. }else {
  503. debounce_reset(_charging_detect);
  504. }
  505. }else/* if ((measure_value()->load_current < MIN_START_LOADING_CURRENT))*/{
  506. if (_bms_state.charging) {
  507. debounce_inc(_charging_detect);
  508. if (debounce_reach_max(_charging_detect)){
  509. _bms_state.charging = 0;
  510. show_leds_for_charging(0);
  511. debounce_reset(_charging_detect);
  512. }
  513. }else {
  514. debounce_reset(_charging_detect);
  515. }
  516. }
  517. }
  518. /* if discharger mos and charger mos, one is open but other is closed.
  519. we must judage the current: if current is large than 10A(-10A),
  520. we must open the closed mos to avoid the closed mos to be destroyed
  521. */
  522. #define MIN_CURRENT_FOR_BOTH_MOS_OPEN (1000)
  523. static int _min_current_for_both_mos_count = 0;
  524. static u32 _check_mos_time = 0;
  525. static __INLINE u32 _open_all_mos_time(void){
  526. if (abs(measure_value()->load_current) >= MIN_CURRENT_FOR_BOTH_MOS_OPEN * 11){
  527. return 0;
  528. }
  529. if (abs(measure_value()->load_current) >= MIN_CURRENT_FOR_BOTH_MOS_OPEN * 6) {
  530. return 5;
  531. }
  532. if (abs(measure_value()->load_current) >= MIN_CURRENT_FOR_BOTH_MOS_OPEN) {
  533. return 10;
  534. }
  535. return 30;
  536. }
  537. static void _check_mos_stat(void){
  538. if (abs(measure_value()->load_current) >= MIN_CURRENT_FOR_BOTH_MOS_OPEN){
  539. _min_current_for_both_mos_count ++;
  540. if (_min_current_for_both_mos_count >= 2){
  541. int dmos = ml5238_is_discharging();
  542. int cmos = ml5238_is_charging();
  543. if (dmos + cmos == 0){
  544. //state_error("current = %d, but all mos is closed\n", measure_value()->load_current);
  545. _check_mos_time = shark_get_seconds();
  546. return;
  547. }
  548. if (dmos == 1 && cmos == 1){
  549. _check_mos_time = shark_get_seconds();
  550. return;
  551. }
  552. if (shark_get_seconds() >= (_check_mos_time + _open_all_mos_time())) {
  553. uint32_t request = USER_REQUEST_PENDING;
  554. if (!dmos) {
  555. request |= USER_REQUEST_DISCHARGER_ON;
  556. }else {
  557. request |= USER_REQUEST_CHARGER_ON;
  558. }
  559. _bms_state.user_request = request;
  560. _check_mos_time = shark_get_seconds();
  561. }
  562. }
  563. }else {
  564. _min_current_for_both_mos_count = 0;
  565. _check_mos_time = shark_get_seconds();
  566. }
  567. }
  568. static void _current_notify(void){
  569. check_charging();
  570. check_current_state(); //check health of current
  571. _check_mos_stat();
  572. soc_update(); //计算soc
  573. }
  574. #if (ALLOW_5238_BALANCE==1)
  575. /* 需要检查电芯的电压,如果发现有电芯电压过高,需要开启被动均衡
  576. * 充电过程中考虑balance,主要是希望cell 电压扩散后,保证1. 单电芯不能过压, 2. 单电芯不能比平均电压过低,导致
  577. * 木桶效应,目标是电压最高的那个cell,尽量压制,不让电压再升高,或者升高的尽量慢一些
  578. */
  579. static void _balance_timer_handler(shark_timer_t *t);
  580. static shark_timer_t _balance_timer = {.handler = _balance_timer_handler};
  581. static debounce_t _cell_balance = {.count = 0, .max_count = 120, .init_count = 0};
  582. static void _balance_timer_handler(shark_timer_t *t){
  583. ml5238_cell_start_balance(0);
  584. _bms_state.pack_balancing = 0;
  585. debounce_reset(_cell_balance);
  586. }
  587. static uint32_t get_balance_mask(uint8_t current_max_index){
  588. return BIT(current_max_index);
  589. }
  590. static void check_cell_balance(uint8_t current_max_index){
  591. if (!_bms_state.charging || (_bms_state.cell_max_vol >= SIGLE_CELL_MAX_CHARGER_VOLTAGE) || !bms_work_is_normal()){ //not charging, need not do balance
  592. if (_bms_state.pack_balancing){
  593. debounce_reset(_cell_balance);
  594. _bms_state.pack_balancing = ml5238_cell_start_balance(0);
  595. shark_timer_cancel(&_balance_timer);
  596. }
  597. return;
  598. }
  599. if ((!_bms_state.pack_balancing && _bms_state.cell_max_vol < MAX_CELL_VOLTAGE_FOR_BALACNE) || _bms_state.pack_balancing){
  600. return;
  601. }
  602. if (_bms_state.cell_max_vol >= MAX_CELL_VOLTAGE_FOR_BALACNE){
  603. debounce_inc(_cell_balance);
  604. }else {
  605. debounce_reset(_cell_balance);
  606. }
  607. if (!_bms_state.pack_balancing && debounce_reach_max(_cell_balance)){
  608. _bms_state.pack_balancing = 1;
  609. ml5238_cell_start_balance(get_balance_mask(current_max_index));
  610. shark_timer_post(&_balance_timer, 5 * 1000); //stop balance after 30s
  611. debounce_reset(_cell_balance);
  612. }
  613. _bms_state.cell_index_of_max_vol = current_max_index;
  614. }
  615. #endif
  616. static uint8_t calc_cell_voltage(void){
  617. uint16_t voltage = 0;
  618. uint16_t max_cell = 0;
  619. uint16_t min_cell = 0xf000;
  620. uint8_t max_index = 0;
  621. for (int i = 0; i < CELLS_NUM; i++){
  622. voltage += measure_value()->cell_vol[i];
  623. if (max_cell < measure_value()->cell_vol[i]){
  624. max_cell = measure_value()->cell_vol[i];
  625. max_index = i;
  626. }
  627. if (min_cell > measure_value()->cell_vol[i]){
  628. min_cell = measure_value()->cell_vol[i];
  629. }
  630. }
  631. _bms_state.pack_voltage = voltage;
  632. _bms_state.cell_max_vol = max_cell;
  633. _bms_state.cell_min_vol = min_cell;
  634. return max_index;
  635. }
  636. static void _voltage_notify(void){
  637. uint8_t max_index = calc_cell_voltage();
  638. check_voltage_state(); //check health of cell voltage
  639. #if (ALLOW_5238_BALANCE==1)
  640. check_cell_balance(max_index);
  641. #endif
  642. }
  643. static void _temperature_notify(void){
  644. static uint8_t _bms_aging_test = 0;
  645. int pcb_current_temp = measure_value()->pack_temp[PCB_TEMP_INDEX];
  646. if (abs(pcb_temp - pcb_current_temp) >= 5){//pcb温度变化超过5度,需要重新校准ML5238
  647. if (pcb_temp_count ++ >= 5) {
  648. current_calibrate();
  649. state_warning("ML5238 calibrate, %d -> %d!!\n", pcb_temp, pcb_current_temp);
  650. pcb_temp = pcb_current_temp;
  651. pcb_temp_count = 0;
  652. ml5238_cali_count ++;
  653. }
  654. }else {
  655. pcb_temp_count = 0;
  656. }
  657. check_temp_state(); //check health of cell/pcb temperature
  658. if (bms_work_is_aging_test()) {
  659. if (abs(measure_value()->load_current) >= 2000) {
  660. if (_bms_aging_test == 0) {
  661. memcpy(_bms_state.aging_start_temp, measure_value()->pack_temp, PACK_TEMPS_NUM * sizeof(int));
  662. memcpy(_bms_state.aging_max_temp, measure_value()->pack_temp, PACK_TEMPS_NUM * sizeof(int));
  663. _bms_state.aging_real_start = 0;
  664. _bms_state.agint_cost_time = 0;
  665. _bms_aging_test = 1;
  666. }
  667. if (_bms_state.aging_real_start == 0) {
  668. _bms_state.aging_real_start = shark_get_seconds();
  669. }
  670. for (int i = 0; i < PACK_TEMPS_NUM; i++) {
  671. if (_bms_state.aging_max_temp[i] < measure_value()->pack_temp[i]) {
  672. _bms_state.aging_max_temp[i] = measure_value()->pack_temp[i];
  673. }
  674. }
  675. }else {
  676. if(_bms_state.aging_real_start > 0){
  677. _bms_state.agint_cost_time += (shark_get_seconds() - _bms_state.aging_real_start);
  678. _bms_state.aging_real_start = 0;
  679. }
  680. }
  681. }else {
  682. _bms_aging_test = 0;
  683. }
  684. }