app_end_ctr.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854
  1. #include "common.h"
  2. #include "drv_io.h"
  3. #include "drv_can.h"
  4. #include "app_rs485_1.h"
  5. #include "app_rs485_2.h"
  6. #include "app_can.h"
  7. #include "app.h"
  8. #include "app_end_ctr.h"
  9. #include "measure_temprature.h"
  10. #include "hardware_test.h"
  11. #include "drv_io.h"
  12. #include "measure_vol.h"
  13. END_CTR_SELF_SEND_STATUS end_ctr_self_ss;
  14. END_CTR_SELF_SEND_STATUS end_ctr_self_ss_new;
  15. END_CTR_SELF_SEND_STATUS end_ctr_rsp;
  16. DELAY_COMMON end_ctr_self_stimeout;
  17. uint8_t Get_QD_State(void)
  18. {
  19. return end_ctr_self_ss_new.qd_sta;
  20. }
  21. uint8_t Is_Soak(void)
  22. {
  23. return end_ctr_self_ss_new.soak_sta;
  24. }
  25. void Shield_XL_Timeout(void)
  26. {
  27. if(shield_xl.set)
  28. {
  29. if(++shield_xl.count >= SHIELD_XL_TIME)
  30. {
  31. memset(&shield_xl,0x00,sizeof(shield_xl));
  32. }
  33. }
  34. }
  35. void Can_End_Ctr_Self_Send_Check(CAN_FRAME*can_ctr_frame)
  36. {
  37. uint16_t len;
  38. uint8_t *buf = can_ctr_frame->data;
  39. if(!memcmp(&end_ctr_self_ss,&end_ctr_self_ss_new,sizeof(END_CTR_SELF_SEND_STATUS)))
  40. return;
  41. memcpy(&end_ctr_self_ss,&end_ctr_self_ss_new,sizeof(END_CTR_SELF_SEND_STATUS));
  42. len = sizeof(end_ctr_self_ss);
  43. //
  44. can_ctr_frame->head.rsp = FRAME_PT_NEED_RSP;
  45. can_ctr_frame->head.dest = CTR_ID;
  46. can_ctr_frame->head.sour = SELF_ID;
  47. can_ctr_frame->head.index = 1;
  48. can_ctr_frame->head.total = (len - 1)/8 + 1;
  49. can_ctr_frame->head.pro =FRAME_PRO_D;
  50. //
  51. can_ctr_frame->len = len;
  52. memcpy(buf,&end_ctr_self_ss,len);
  53. end_ctr_self_stimeout.set = 1;
  54. end_ctr_self_stimeout.count = 0;
  55. //
  56. if(!Send_Data_Can(can_ctr_frame,CTR_SELF))
  57. {
  58. //g_event |= END_CTR_RESEND_CMD_EVENT;
  59. //return;
  60. }
  61. }
  62. #ifdef CONFIG_CAN_IAP
  63. void qws_iap_fmc_flag_clear(void)
  64. {
  65. fmc_flag_clear(FMC_FLAG_BANK0_PGERR | FMC_FLAG_BANK0_WPERR | FMC_FLAG_BANK0_END);
  66. }
  67. void qws_iap_write_magic(uint32_t magic)
  68. {
  69. uint32_t capacity = (REG32(0x1FFFF7E0) & 0xFFFF) << 10;
  70. uint32_t address = 0x08000000 + (capacity - 1024);
  71. uint32_t length, checksum, value;
  72. value = REG32(address + 8);
  73. if (magic == value) {
  74. return;
  75. }
  76. length = REG32(address);
  77. checksum = REG32(address + 4);
  78. fmc_unlock();
  79. if (value != 0xFFFFFFFF) {
  80. qws_iap_fmc_flag_clear();
  81. fmc_page_erase(address);
  82. qws_iap_fmc_flag_clear();
  83. fmc_word_program(address, length);
  84. qws_iap_fmc_flag_clear();
  85. fmc_word_program(address + 4, checksum);
  86. }
  87. if (magic != 0xFFFFFFFF) {
  88. qws_iap_fmc_flag_clear();
  89. fmc_word_program(address + 8, magic);
  90. }
  91. fmc_lock();
  92. }
  93. void qws_iap_reboot(void)
  94. {
  95. qws_iap_write_magic(0xFFFFFFFF);
  96. __set_FAULTMASK(1);
  97. NVIC_SystemReset();
  98. }
  99. uint8_t qws_iap_read_string(uint8_t *buff)
  100. {
  101. uint32_t address = ((uint32_t) buff[4]) << 16 | ((uint32_t) buff[3]) << 8 | buff[2];
  102. const char *text = (const char *) (0x08000000 + address);
  103. int length = strlen(text);
  104. if (length > 250) {
  105. length = 250;
  106. }
  107. buff[5] = buff[4];
  108. buff[4] = buff[3];
  109. buff[3] = buff[2];
  110. buff[2] = 0x00;
  111. memcpy(buff + 6, text, length);
  112. return length + 6;
  113. }
  114. #endif
  115. int8_t Handle_Can_Ctr_CMD(CAN_FRAME*can_ctr_frame)
  116. {
  117. uint16_t key;
  118. uint8_t *buf = can_ctr_frame->data;
  119. memcpy(&key,can_ctr_frame->data,sizeof(key));
  120. switch(key)
  121. {
  122. case KEY_END_CTR_COMMON:
  123. soak_dec_delay.enable = (buf[2]&0x01);
  124. break;
  125. case KEY_END_CTR_SWI_BAT:
  126. break;
  127. case KEY_END_CTR_BAT_INT_EN:
  128. is_intelligent = buf[2];
  129. break;
  130. case KEY_END_CTR_BAT_INT_PRE:
  131. if(buf[2] == 1)
  132. CB_OPERATE_PRECEDENCE_Config = PRE_SERIES;
  133. else if(buf[2] == 2)
  134. CB_OPERATE_PRECEDENCE_Config = PRE_PARRALLEL;
  135. else
  136. return 0;
  137. break;
  138. case KEY_END_CTR_SOFT_WARE:
  139. break;
  140. case KEY_END_CTR_SN:
  141. break;
  142. case KEY_END_CTR_WRITER_SN:
  143. Writer_SN(&buf[2]);
  144. break;
  145. case KEY_END_CTR_BAT_UPDATE_REQ:
  146. break;
  147. case KEY_END_CTR_BAT_UPDATE:
  148. break;
  149. case KEY_END_CTR_BAT_UPDATE_EXIT:
  150. break;
  151. case KEY_END_CTR_DAN_CI_LI_CHENG:
  152. memcpy(&sheng_yu_li_cheng.sy_dan_ci_li_cheng_temp,&buf[2],sizeof(sheng_yu_li_cheng.sy_dan_ci_li_cheng_temp));
  153. break;
  154. case KEY_END_CTR_ZHEN_JI_CE_SHI:
  155. break;
  156. case KEY_END_CTR_TEST_INFO:
  157. break;
  158. case KEY_END_CTR_QD:
  159. if(work_normal == 1)
  160. {
  161. switch(buf[2])
  162. {
  163. case 0:
  164. //QD_Enable(0);
  165. //ACC2_Enable(0);
  166. QD_Enable_From(0,2);
  167. serise_low_enable = 0;
  168. break;
  169. case 1:
  170. //QD_Enable(1);
  171. QD_Enable_From(1,3);
  172. // if(ACC2_Is_On() == 0)
  173. ACC2_Enable(1);
  174. break;
  175. default:
  176. return 0;
  177. }
  178. delay_1ms(10);
  179. }
  180. break;
  181. case KEY_END_CTR_LOCK:
  182. switch(buf[2])
  183. {
  184. case 0:
  185. Lock_Enable(0);
  186. break;
  187. case 1:
  188. Lock_Enable(1);
  189. break;
  190. default:
  191. return 0;
  192. }
  193. break;
  194. case KEY_END_CTR_L_R_LIGHT:
  195. if(buf[2] == 0)
  196. {
  197. Left_Light_Enable(0);
  198. left_light_delay.set = 0;
  199. left_light_delay.count = 0;
  200. }
  201. if(buf[2] == 1)
  202. {
  203. Left_Light_Enable(1);
  204. }
  205. if(buf[2] == 2)
  206. {
  207. Left_Light_Enable(1);
  208. left_light_delay.set = 1;
  209. left_light_delay.count = 0;
  210. }
  211. if(buf[2] == 3)
  212. {
  213. Left_Light_Enable(0);
  214. left_light_delay.set = 1;
  215. left_light_delay.count = 600;
  216. }
  217. if(buf[3] == 0)
  218. {
  219. Right_Light_Enable(0);
  220. right_light_delay.set = 0;
  221. right_light_delay.count = 0;
  222. }
  223. if(buf[3] == 1)
  224. {
  225. Right_Light_Enable(1);
  226. }
  227. if(buf[3] == 2)
  228. {
  229. Right_Light_Enable(1);
  230. right_light_delay.set = 1;
  231. right_light_delay.count = 0;
  232. }
  233. if(buf[3] == 3)
  234. {
  235. Right_Light_Enable(0);
  236. right_light_delay.set = 1;
  237. right_light_delay.count = 600;
  238. }
  239. break;
  240. case KEY_END_CTR_CARPET_LIGHT:
  241. switch(buf[2])
  242. {
  243. case 0:
  244. Carpet_Light_Enable(0);
  245. break;
  246. case 1:
  247. Carpet_Light_Enable(1);
  248. break;
  249. default:
  250. return 0;
  251. }
  252. break;
  253. case KEY_END_CTR_TAIL_LIGHT:
  254. switch(buf[2])
  255. {
  256. case 0:
  257. Tail_Light_Enable(0);
  258. break;
  259. case 1:
  260. Tail_Light_Enable(1);
  261. break;
  262. default:
  263. return 0;
  264. }
  265. break;
  266. case KEY_END_CTR_ACC12:
  267. if(work_normal == 1)
  268. {
  269. switch(buf[2])
  270. {
  271. case 0:
  272. if(QD_Dect() == 0)
  273. {
  274. ACC2_Enable(0);
  275. }
  276. break;
  277. case 1:
  278. // if(ACC2_Is_On() == 0)
  279. ACC2_Enable(1);
  280. break;
  281. default:
  282. return 0;
  283. }
  284. delay_1ms(10);
  285. }
  286. break;
  287. case KEY_END_CTR_ACC12_TEST:
  288. if(work_normal == 1)
  289. {
  290. sub_bms_info_1.test_error = buf[2];
  291. sub_bms_info_2.test_error = buf[3];
  292. }
  293. break;
  294. case KEY_END_CTR_ACC12_TEST_1:
  295. switch(buf[2])
  296. {
  297. case 0:
  298. //if(QD_Dect() == 0)
  299. {
  300. ACC2_Enable(0);
  301. }
  302. break;
  303. case 1:
  304. // if(ACC2_Is_On() == 0)
  305. ACC2_Enable(1);
  306. break;
  307. default:
  308. return 0;
  309. }
  310. delay_1ms(10);
  311. break;
  312. case KEY_END_CTR_HEART_TICK:
  313. break;
  314. case KEY_END_CTR_SELF_UP:
  315. end_ctr_self_stimeout.set = 0;
  316. return 0;
  317. #ifdef CONFIG_CAN_IAP
  318. case 0x42F0:
  319. qws_iap_reboot();
  320. return 0;
  321. case 0x42F5:
  322. case 0x42F6:
  323. case 0x42F8:
  324. break;
  325. #endif
  326. default:
  327. return 0;
  328. }
  329. return 1;
  330. }
  331. extern uint32_t acc12_overloader_times;
  332. extern uint8_t shark_battery_shake1;
  333. extern uint8_t shark_battery_shake2;
  334. int8_t Rsp_Can_Ctr_CMD(CAN_FRAME*can_ctr_frame)
  335. {
  336. uint16_t key,len;
  337. uint8_t *buf = can_ctr_frame->data;
  338. uint8_t temp = 0,rtn = 0;
  339. memcpy(&key,can_ctr_frame->data,sizeof(key));
  340. switch(key)
  341. {
  342. case KEY_END_CTR_COMMON:
  343. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  344. return 1;
  345. end_ctr_rsp.key = KEY_END_CTR_COMMON;
  346. end_ctr_rsp.op_result = 0;
  347. len = sizeof(end_ctr_rsp);
  348. memcpy(buf,&end_ctr_rsp,len);
  349. buf[len++] = QD_switch_from;
  350. buf[len++] = power_switch_from;
  351. buf[len++] = (uint8_t)utc_seconds;
  352. buf[len++] = (uint8_t)(utc_seconds >> 8);
  353. break;
  354. case KEY_END_CTR_SWI_BAT:
  355. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  356. return 1;
  357. len = 2;
  358. if(is_intelligent)
  359. {
  360. buf[len++] = 0;
  361. buf[len++] = CB_BAT_NO;
  362. }
  363. else
  364. {
  365. if(buf[len] > CB_BAT_NO && buf[len] < CB_MAX)
  366. {
  367. if(cb_operate_state != buf[len])
  368. {
  369. Battery_Change_Mode(buf[len]);
  370. }
  371. buf[len++] = 0;
  372. }
  373. else
  374. {
  375. buf[len++] = 1;
  376. }
  377. buf[len++] = cb_operate_state;
  378. }
  379. break;
  380. case KEY_END_CTR_BAT_INT_EN:
  381. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  382. return 1;
  383. len = 2;
  384. buf[len++] = 0;
  385. break;
  386. case KEY_END_CTR_BAT_INT_PRE:
  387. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  388. return 1;
  389. len = 2;
  390. buf[len++] = 0;
  391. break;
  392. case KEY_END_CTR_SOFT_WARE:
  393. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  394. return 1;
  395. len = 2;
  396. buf[len++] = 0;
  397. memcpy(&buf[len],soft_version,PS100_SOFTWARE_SIZE);
  398. len += PS100_SOFTWARE_SIZE;
  399. break;
  400. case KEY_END_CTR_SN:
  401. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  402. return 1;
  403. len = 2;
  404. buf[len++] = 0;
  405. memcpy(&buf[len],sn,sizeof(sn));
  406. len += sizeof(sn);
  407. break;
  408. case KEY_END_CTR_WRITER_SN:
  409. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  410. return 1;
  411. len = 2;
  412. buf[len++] = 0;
  413. break;
  414. case KEY_END_CTR_BAT_UPDATE_REQ:
  415. //if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  416. // return 1;
  417. rtn = 0;
  418. len = buf[2];
  419. if(len == UPDATE_BAT_1 || len == UPDATE_BAT_2)
  420. {
  421. if(len == UPDATE_BAT_1)
  422. {
  423. temp = Update_Sub_BMS_1_Software(UPDATE_STEP_REQ);
  424. }
  425. else
  426. {
  427. temp = Update_Sub_BMS_2_Software(UPDATE_STEP_REQ);
  428. }
  429. if(temp)
  430. {
  431. update_bat.ub_step = UPDATE_STEP_REQ;
  432. update_bat.ub_bat = buf[2];
  433. update_bat.ub_total = buf[4];
  434. update_bat.ub_total = (update_bat.ub_total<<8)|buf[3];
  435. }
  436. else
  437. rtn = 3;
  438. }
  439. else
  440. rtn = 1;
  441. len = 2;
  442. buf[len++] = rtn;
  443. break;
  444. case KEY_END_CTR_BAT_UPDATE:
  445. //if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  446. /// return 1;
  447. rtn = 0;
  448. len = buf[3];
  449. len = (len<<8)|buf[2];
  450. if(len <= update_bat.ub_total)
  451. {
  452. if(len == update_bat.ub_sq || len == update_bat.ub_sq + 1)
  453. {
  454. len = buf[5];
  455. len = (len<<8)|buf[4];
  456. if(len <= sizeof(update_bat.ub_data))
  457. {
  458. update_bat.ub_step = UPDATE_STEP_DATA;
  459. update_bat.ub_sq = buf[3];
  460. update_bat.ub_sq = (update_bat.ub_sq<<8)|buf[2];
  461. update_bat.ub_len = buf[5];
  462. update_bat.ub_len = (update_bat.ub_len<<8)|buf[4];
  463. memcpy(update_bat.ub_data,&buf[6],update_bat.ub_len);
  464. //
  465. if(update_bat.ub_bat == UPDATE_BAT_1)
  466. {
  467. temp = Update_Sub_BMS_1_Software(UPDATE_STEP_DATA);
  468. }
  469. else
  470. {
  471. temp = Update_Sub_BMS_2_Software(UPDATE_STEP_DATA);
  472. }
  473. if(temp)
  474. {
  475. if(update_bat.ub_sq == update_bat.ub_total)
  476. {
  477. memset(&update_bat,0x00,sizeof(update_bat));
  478. }
  479. }
  480. else
  481. rtn = 4;
  482. }
  483. else
  484. rtn = 3;
  485. }
  486. else
  487. rtn = 2;
  488. }
  489. else
  490. rtn = 1;
  491. len = 2;
  492. buf[len++] = rtn;
  493. break;
  494. case KEY_END_CTR_BAT_UPDATE_EXIT:
  495. //if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  496. // return 1;
  497. memset(&update_bat,0x00,sizeof(update_bat));
  498. len = 2;
  499. buf[len++] = 0;
  500. break;
  501. case KEY_END_CTR_DAN_CI_LI_CHENG:
  502. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  503. return 1;
  504. len = 2;
  505. buf[len++] = sheng_yu_li_cheng.sy_yu_ji_ke_xing_shi_li_cheng;
  506. break;
  507. case KEY_END_CTR_ZHEN_JI_CE_SHI:
  508. Writer_HT_Flash(1);
  509. len = 2;
  510. buf[len++] = 0;
  511. break;
  512. case KEY_END_CTR_TEST_INFO:
  513. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  514. return 1;
  515. len = 2;
  516. switch(buf[len++])
  517. {
  518. case 1:
  519. memcpy(&buf[len],&test_info.ti_bms_1,sizeof(test_info.ti_bms_1));
  520. len += sizeof(test_info.ti_bms_1);
  521. memcpy(&buf[len],&test_info.ti_bms_2,sizeof(test_info.ti_bms_2));
  522. len += sizeof(test_info.ti_bms_2);
  523. break;
  524. case 2:
  525. Ca_Chu_Test_Info();
  526. buf[len++] = 0;
  527. break;
  528. case 3:
  529. shark_printf_enabled = buf[len];
  530. if (shark_printf_enabled) {
  531. println("log enabled");
  532. }
  533. buf[len++] = 0;
  534. break;
  535. case 5:
  536. buf[len++] = sub_bms_info_1.packet_common.bms_status;
  537. buf[len++] = sub_bms_info_2.packet_common.bms_status;
  538. break;
  539. case 6:
  540. buf[len++] = cb_operate_state;
  541. buf[len++] = sub_bms_info_1.exit_code;
  542. buf[len++] = sub_bms_info_2.exit_code;
  543. break;
  544. case 7:
  545. buf[len++] = end_ctr_self_ss_new.acc12_sta << 1 | ACC2_Dect();
  546. buf[len++] = end_ctr_self_ss_new.qd_sta << 1 | QD_Dect();
  547. break;
  548. default:
  549. buf[len++] = 0;
  550. break;
  551. }
  552. break;
  553. case KEY_END_CTR_QD:
  554. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  555. return 1;
  556. len = 2;
  557. buf[len++] = 0;
  558. if(work_normal == 1)
  559. {
  560. buf[len++] = QD_Dect();
  561. qd_dec_delay.count = QD_DEC_TIMEOUT;
  562. shield_xl.set = 1;
  563. shield_xl.count = 0;
  564. xl_dec_delay.count = 0;
  565. xl_count = 0;
  566. }
  567. else
  568. buf[len++] = 0;
  569. break;
  570. case KEY_END_CTR_LOCK:
  571. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  572. return 1;
  573. len = 2;
  574. buf[len++] = 0;
  575. buf[len++] = Lock_Dect();
  576. break;
  577. case KEY_END_CTR_L_R_LIGHT:
  578. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  579. return 1;
  580. len = 2;
  581. buf[len++] = 0;
  582. break;
  583. case KEY_END_CTR_CARPET_LIGHT:
  584. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  585. return 1;
  586. len = 2;
  587. buf[len++] = 0;
  588. break;
  589. case KEY_END_CTR_TAIL_LIGHT:
  590. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  591. return 1;
  592. len = 2;
  593. buf[len++] = 0;
  594. break;
  595. case KEY_END_CTR_ACC12:
  596. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  597. return 1;
  598. len = 2;
  599. buf[len++] = 0;
  600. if(work_normal == 1)
  601. {
  602. buf[len++] = ACC2_Dect();
  603. acc2_dec_delay.count = ACC2_DEC_TIMEOUT;
  604. }
  605. else
  606. buf[len++] = 0;
  607. break;
  608. case KEY_END_CTR_ACC12_TEST:
  609. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  610. return 1;
  611. len = 2;
  612. buf[len++] = 0;
  613. break;
  614. case KEY_END_CTR_ACC12_TEST_1:
  615. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  616. return 1;
  617. len = 2;
  618. buf[len++] = 0;
  619. if(work_normal == 1)
  620. {
  621. buf[len++] = ACC2_Dect();
  622. acc2_dec_delay.count = ACC2_DEC_TIMEOUT;
  623. }
  624. else
  625. buf[len++] = 0;
  626. break;
  627. case KEY_END_CTR_HEART_TICK:
  628. if((can_ctr_frame->head.rsp != FRAME_PT_NEED_RSP) || end_ctr_self_stimeout.set)
  629. return 1;
  630. len = 2;
  631. buf[len++] = 0;
  632. break;
  633. case KEY_END_CTR_SELF_UP:
  634. return 0;
  635. #ifdef CONFIG_CAN_IAP
  636. case 0x42F5:
  637. case 0x42F6:
  638. len = 3;
  639. buf[2] = 0;
  640. break;
  641. case 0x42F8:
  642. len = qws_iap_read_string(buf);
  643. break;
  644. #endif
  645. default:
  646. return 0;
  647. }
  648. //
  649. can_ctr_frame->head.rsp = FRAME_PT_RSP;
  650. can_ctr_frame->head.dest = can_ctr_frame->head.sour;
  651. can_ctr_frame->head.sour = SELF_ID;
  652. can_ctr_frame->head.index = 1;
  653. can_ctr_frame->head.total = (len - 1)/8 + 1;
  654. can_ctr_frame->head.pro =FRAME_PRO_D;
  655. //
  656. can_ctr_frame->len = len;
  657. //
  658. if(!Send_Data_Can(can_ctr_frame,CTR_RSP))
  659. {
  660. g_event |= END_CTR_RESEND_CMD_EVENT;
  661. return 0;
  662. }
  663. return 1;
  664. }
  665. void Check_End_Ctr_Status(void)
  666. {
  667. if(side_stay_dec_delay.set&&side_stay_dec_delay.count >= SIDE_STAY_DEC_TIMEOUT)
  668. {
  669. memset(&side_stay_dec_delay,0x00,sizeof(side_stay_dec_delay));
  670. end_ctr_self_ss_new.side_sta = !Side_Stay_Dect();
  671. }
  672. if(soak_dec_delay.set&&soak_dec_delay.count >= SOAK_DEC_TIMEOUT)
  673. {
  674. soak_dec_delay.set = 0;
  675. soak_dec_delay.count = 0;
  676. end_ctr_self_ss_new.soak_sta = Soak_Dect();
  677. }
  678. if(sti_dec_delay.set&&sti_dec_delay.count >= STI_DEC_TIMEOUT)
  679. {
  680. memset(&sti_dec_delay,0x00,sizeof(sti_dec_delay));
  681. end_ctr_self_ss_new.sit_sta = !Sitting_Dect();
  682. }
  683. if(repair_dec_delay.set&&repair_dec_delay.count >= REPAIR_DEC_TIMEOUT)
  684. {
  685. memset(&repair_dec_delay,0x00,sizeof(repair_dec_delay));
  686. //end_ctr_self_ss_new.side_sta = !Repair_Key_Dect();
  687. }
  688. if(qd_dec_delay.set&&qd_dec_delay.count >= QD_DEC_TIMEOUT/*&&serise_low_qd_status == 0*/)
  689. {
  690. memset(&qd_dec_delay,0x00,sizeof(qd_dec_delay));
  691. end_ctr_self_ss_new.qd_sta = QD_Dect();
  692. }
  693. //xl_dec_delay
  694. if(xl_dec_delay.set&&xl_dec_delay.count >= XL_DEC_TIMEOUT)
  695. {
  696. xl_dec_delay.count = 0;
  697. if(shield_xl.set == 0)
  698. {
  699. end_ctr_self_ss_new.xl_sta = (xl_count > 0 || XL_Dect() == RESET);
  700. }
  701. xl_count = 0;
  702. }
  703. if(acc2_dec_delay.set&&acc2_dec_delay.count >= ACC2_DEC_TIMEOUT)
  704. {
  705. memset(&acc2_dec_delay,0x00,sizeof(acc2_dec_delay));
  706. end_ctr_self_ss_new.acc12_sta = ACC2_Dect();
  707. }
  708. //
  709. end_ctr_self_ss_new.charger_in = IS_CHARGE_IN();
  710. end_ctr_self_ss_new.moto_temp = ctr_temperature[1];
  711. end_ctr_self_ss_new.ps100_temp = ctr_temperature[0];
  712. end_ctr_self_ss_new.bms_1_status = sub_bms_info_1.conn_state;
  713. end_ctr_self_ss_new.bms_2_status = sub_bms_info_2.conn_state;
  714. end_ctr_self_ss_new.using_bms_mode = cb_operate_state;
  715. end_ctr_self_ss_new.nhb = (uint16_t)(sheng_yu_li_cheng.sy_ss_parm.neng_hao_bi);
  716. //
  717. end_ctr_rsp = end_ctr_self_ss_new;
  718. end_ctr_rsp.lock_sta = Lock_Dect();
  719. end_ctr_rsp.carpet_sta = Carpet_Dect();
  720. end_ctr_rsp.tail_sta = Tail_Dect();
  721. }
  722. void End_Ctr_Initial(void)
  723. {
  724. E_CTR_Initial();
  725. memset(&update_bat,0x00,sizeof(update_bat));
  726. }
  727. void End_Ctr_Self_Send_Timeout(void)
  728. {
  729. if(end_ctr_self_stimeout.set)
  730. {
  731. ++end_ctr_self_stimeout.count;
  732. if(end_ctr_self_stimeout.count >= 300)
  733. {
  734. memset(&end_ctr_self_stimeout,0x00,sizeof(end_ctr_self_stimeout));
  735. g_event |= END_CTR_SELF_TIMEOUT_EVENT;
  736. }
  737. else if(end_ctr_self_stimeout.count == 200)
  738. g_event |= END_CTR_SELF_TIMEOUT_EVENT;
  739. else if(end_ctr_self_stimeout.count == 100)
  740. g_event |= END_CTR_SELF_TIMEOUT_EVENT;
  741. }
  742. else
  743. end_ctr_self_stimeout.count = 0;
  744. }