app_can.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434
  1. #include "common.h"
  2. #include "drv_can.h"
  3. #include "app_rs485_1.h"
  4. #include "app_rs485_2.h"
  5. #include "app_can.h"
  6. #include "app.h"
  7. #include "measure_temprature.h"
  8. #include "measure_vol.h"
  9. #include "app_adas.h"
  10. #include "app_end_ctr.h"
  11. #include "app_bms_1.h"
  12. #include "app_bms_2.h"
  13. //can
  14. static uint8_t app_can_buf[CAN_TX_BUF_MAX];
  15. CAN_FRAME app_can_frame;
  16. static uint8_t app_can_bms_1_buf[CAN_BMS_TX_BUF_MAX];
  17. CAN_FRAME app_can_bms_1_frame;
  18. static uint8_t app_can_bms_2_buf[CAN_BMS_TX_BUF_MAX];
  19. CAN_FRAME app_can_bms_2_frame;
  20. static uint8_t app_can_ctr_buf[CAN_CTR_TX_BUF_MAX];
  21. CAN_FRAME app_can_ctr_frame;
  22. static uint8_t app_can_adas_buf[CAN_ADAS_TX_BUF_MAX];
  23. CAN_FRAME app_can_adas_frame;
  24. uint8_t mode = 0;
  25. uint8_t adjust_step = 0;
  26. int8_t Resend_can_bms_1_frame(void)
  27. {
  28. return Send_Data_Can(&app_can_bms_1_frame,BMS_1_RESEND);
  29. }
  30. int8_t Resend_can_bms_2_frame(void)
  31. {
  32. return Send_Data_Can(&app_can_bms_2_frame,BMS_2_RESEND);
  33. }
  34. int8_t Resend_can_ctr_frame(void)
  35. {
  36. return Send_Data_Can(&app_can_ctr_frame,CTR_RESEND);
  37. }
  38. int8_t Resend_can_adas_frame(void)
  39. {
  40. return Send_Data_Can(&app_can_adas_frame,ADAS_RESEND);
  41. }
  42. int8_t Timeout_Resend_can_bms_1_frame(void)
  43. {
  44. return Send_Data_Can(&app_can_bms_1_frame,TIMEOUT_BMS_1_RESEND);
  45. }
  46. int8_t Timeout_Resend_can_bms_2_frame(void)
  47. {
  48. return Send_Data_Can(&app_can_bms_2_frame,TIMEOUT_BMS_2_RESEND);
  49. }
  50. int8_t Timeout_Resend_can_ctr_frame(void)
  51. {
  52. return Send_Data_Can(&app_can_ctr_frame,TIMEOUT_CTR_RESEND);
  53. }
  54. int8_t Timeout_Resend_can_adas_frame(void)
  55. {
  56. return Send_Data_Can(&app_can_adas_frame,TIMEOUT_ADAS_RESEND);
  57. }
  58. void ADAS_Self_Send_Up(void)
  59. {
  60. Can_ADAS_Self_Send(&app_can_adas_frame);
  61. }
  62. void Check_Can_Self_Send_Status(void)
  63. {
  64. Can_Bms_1_Self_Send_Check(&app_can_bms_1_frame);
  65. Can_Bms_2_Self_Send_Check(&app_can_bms_2_frame);
  66. Can_End_Ctr_Self_Send_Check(&app_can_ctr_frame);
  67. }
  68. static int8_t Handle_Can_CMD(CAN_FRAME*can_frame)
  69. {
  70. uint8_t key = can_frame->data[1];
  71. switch(key)
  72. {
  73. case 0x31:
  74. memcpy(&app_can_bms_1_frame.head,&can_frame->head,sizeof(can_frame->head));
  75. app_can_bms_1_frame.len = can_frame->len;
  76. memcpy(app_can_bms_1_frame.data,can_frame->data,app_can_bms_1_frame.len);
  77. if(!Handle_Can_Bms_1_CMD(&app_can_bms_1_frame))
  78. return 0;
  79. if(!Rsp_Can_Bms_1_CMD(&app_can_bms_1_frame))
  80. return 0;
  81. break;
  82. case 0x32:
  83. memcpy(&app_can_bms_2_frame.head,&can_frame->head,sizeof(can_frame->head));
  84. app_can_bms_2_frame.len = can_frame->len;
  85. memcpy(app_can_bms_2_frame.data,can_frame->data,app_can_bms_2_frame.len);
  86. if(!Handle_Can_Bms_2_CMD(&app_can_bms_2_frame))
  87. return 0;
  88. if(!Rsp_Can_Bms_2_CMD(&app_can_bms_2_frame))
  89. return 0;
  90. break;
  91. case 0x48:
  92. case 0x42:
  93. case 0x43:
  94. memcpy(&app_can_ctr_frame.head,&can_frame->head,sizeof(can_frame->head));
  95. app_can_ctr_frame.len = can_frame->len;
  96. memcpy(app_can_ctr_frame.data,can_frame->data,app_can_ctr_frame.len);
  97. if(!Handle_Can_Ctr_CMD(&app_can_ctr_frame))
  98. return 0;
  99. if(!Rsp_Can_Ctr_CMD(&app_can_ctr_frame))
  100. return 0;
  101. break;
  102. case 0x52:
  103. memcpy(&app_can_adas_frame.head,&can_frame->head,sizeof(can_frame->head));
  104. app_can_adas_frame.len = can_frame->len;
  105. memcpy(app_can_adas_frame.data,can_frame->data,app_can_adas_frame.len);
  106. #if 0
  107. if(!Handle_Can_Adas_CMD(&app_can_adas_frame))
  108. return 0;
  109. if(!Rsp_Can_Adas_CMD(&app_can_adas_frame))
  110. return 0;
  111. #endif
  112. break;
  113. default:
  114. break;
  115. }
  116. return 1;
  117. }
  118. int8_t Handle_Can_Data(void)
  119. {
  120. uint8_t len = Get_Data_Can(&app_can_frame);
  121. if(len == 0)
  122. return 0;
  123. if((mode == 1)&&(app_can_buf[0] == 0xFF) &&(app_can_buf[1] == 0xFF))
  124. {
  125. len = 2;
  126. adjust_step = app_can_buf[len++];
  127. switch(adjust_step)
  128. {
  129. /*case 0:
  130. break;
  131. case OPERATE_UN_INPUT:
  132. memcpy(&Un,&app_can_buf[len],sizeof(Un));
  133. break;
  134. case OPERATE_UNIBA_INPUT:
  135. memcpy(&Iba,&app_can_buf[len],sizeof(Iba));
  136. break;
  137. case OPERATE_UNIBB_INPUT:
  138. memcpy(&Ibb,&app_can_buf[len],sizeof(Ibb));
  139. break;
  140. case OPERATE_POWERA_INPUT:
  141. memcpy(&tPowerA,&app_can_buf[len],sizeof(tPowerA));
  142. break;
  143. case OPERATE_POWERB_INPUT:
  144. memcpy(&tPowerB,&app_can_buf[len],sizeof(tPowerB));
  145. break;*/
  146. case OPERATE_READ_DATA:
  147. printf("return:%d\r\n",Battery_CB_Switch(app_can_buf[len]));
  148. break;
  149. case OPERATE_POWER_DATA:
  150. printf("yjkxslc_1:%d\r\n",sub_bms_info_1.packet_common.yjkxslc);
  151. printf("m_percent_1:%d\r\n",sub_bms_info_1.packet_common.m_percent);
  152. printf("yjcdwcsj_1:%d\r\n",sub_bms_info_1.packet_common.yjcdwcsj);
  153. printf("charge_flag_1:%d\r\n",sub_bms_info_1.packet_common.charge_flag);
  154. printf("m_current_1:%dma\r\n",sub_bms_info_1.packet_common.m_current);
  155. printf("m_total_vol_1:%umv\r\n",sub_bms_info_1.packet_common.m_total_vol);
  156. printf("bms_temp_1:%d\r\n",sub_bms_info_1.packet_common.bms_temp);
  157. printf("work_status_1:%x\r\n",sub_bms_info_1.packet_common.work_status);
  158. printf("banlance_cell_1:%x\r\n",sub_bms_info_1.packet_common.banlance_cell);
  159. printf("bms_status_1:%x\r\n",sub_bms_info_1.packet_common.bms_status);
  160. memcpy(app_can_buf,sub_bms_info_1.bat_dev_info.sn,SERIAL_NUM_SIZE);
  161. app_can_buf[SERIAL_NUM_SIZE] = 0;
  162. printf("sn_1:%s\r\n",app_can_buf);
  163. memcpy(app_can_buf,sub_bms_info_1.bat_dev_info.soft_ver,SOFTWARE_SIZE);
  164. app_can_buf[SOFTWARE_SIZE] = 0;
  165. printf("soft_ver_1:%s\r\n",app_can_buf);
  166. printf("dcsmxs_1:%d\r\n",sub_bms_info_1.bat_times.dcsmxs);
  167. printf("Charge_Num_1:%lu\r\n",sub_bms_info_1.bat_times.charge_times);
  168. printf("OvCh_vol_Num_1:%lu\r\n",sub_bms_info_1.bat_times.charge_over_vol_times);
  169. printf("OvDis_vol_Num_1:%lu\r\n",sub_bms_info_1.bat_times.discharge_under_vol_times);
  170. printf("OvCharge_cur_Num_1:%lu\r\n",sub_bms_info_1.bat_times.charge_over_cur_times);
  171. printf("OvDischarge_cur_Num_1:%lu\r\n",sub_bms_info_1.bat_times.discharge_under_cur_times);
  172. printf("Short_Num_1:%lu\r\n",sub_bms_info_1.bat_times.short_times);
  173. printf("UdTempeCh_Num_1:%lu\r\n",sub_bms_info_1.bat_times.charge_under_temp_times);
  174. printf("UdTempeDis_Num_1:%lu\r\n",sub_bms_info_1.bat_times.discharge_under_temp_times);
  175. printf("OvTempeCh_Num_1:%lu\r\n",sub_bms_info_1.bat_times.charge_over_temp_times);
  176. printf("OvTempeDis_Num_1:%lu\r\n",sub_bms_info_1.bat_times.discharge_over_temp_times);
  177. break;
  178. case OPERATE_ENERGY_DATA: //0x0C
  179. printf("yjkxslc_2:%d\r\n",sub_bms_info_2.packet_common.yjkxslc);
  180. printf("m_percent_2:%d\r\n",sub_bms_info_2.packet_common.m_percent);
  181. printf("yjcdwcsj_2:%d\r\n",sub_bms_info_2.packet_common.yjcdwcsj);
  182. printf("charge_flag_2:%d\r\n",sub_bms_info_2.packet_common.charge_flag);
  183. printf("m_current_2:%dma\r\n",sub_bms_info_2.packet_common.m_current);
  184. printf("m_total_vol_2:%umv\r\n",sub_bms_info_2.packet_common.m_total_vol);
  185. printf("bms_temp_2:%d\r\n",sub_bms_info_2.packet_common.bms_temp);
  186. printf("work_status_2:%x\r\n",sub_bms_info_2.packet_common.work_status);
  187. printf("banlance_cell_2:%x\r\n",sub_bms_info_2.packet_common.banlance_cell);
  188. printf("bms_status_2:%x\r\n",sub_bms_info_2.packet_common.bms_status);
  189. memcpy(app_can_buf,sub_bms_info_2.bat_dev_info.sn,SERIAL_NUM_SIZE);
  190. app_can_buf[SERIAL_NUM_SIZE] = 0;
  191. printf("sn_2:%s\r\n",app_can_buf);
  192. memcpy(app_can_buf,sub_bms_info_2.bat_dev_info.soft_ver,SOFTWARE_SIZE);
  193. app_can_buf[SOFTWARE_SIZE] = 0;
  194. printf("soft_ver_2:%s\r\n",app_can_buf);
  195. printf("dcsmxs_2:%d\r\n",sub_bms_info_2.bat_times.dcsmxs);
  196. printf("Charge_Num_2:%lu\r\n",sub_bms_info_2.bat_times.charge_times);
  197. printf("OvCh_vol_Num_2:%lu\r\n",sub_bms_info_2.bat_times.charge_over_vol_times);
  198. printf("OvDis_vol_Num_2:%lu\r\n",sub_bms_info_2.bat_times.discharge_under_vol_times);
  199. printf("OvCharge_cur_Num_2:%lu\r\n",sub_bms_info_2.bat_times.charge_over_cur_times);
  200. printf("OvDischarge_cur_Num_2:%lu\r\n",sub_bms_info_2.bat_times.discharge_under_cur_times);
  201. printf("Short_Num_2:%lu\r\n",sub_bms_info_2.bat_times.short_times);
  202. printf("UdTempeCh_Num_2:%lu\r\n",sub_bms_info_2.bat_times.charge_under_temp_times);
  203. printf("UdTempeDis_Num_2:%lu\r\n",sub_bms_info_2.bat_times.discharge_under_temp_times);
  204. printf("OvTempeCh_Num_2:%lu\r\n",sub_bms_info_2.bat_times.charge_over_temp_times);
  205. printf("OvTempeDis_Num_2:%lu\r\n",sub_bms_info_2.bat_times.discharge_over_temp_times);
  206. break;
  207. case OPERATE_DEEP_DATA://0x0D
  208. printf("ctr_temperature[0]:%d\r\n",ctr_temperature[0]);
  209. printf("ctr_temperature[1]:%d\r\n",ctr_temperature[1]);
  210. printf("Batter_Vol:%lu\r\n",Measure_Vol());
  211. // printf("cb_val_last:%d\r\n",*(uint8_t*)(&cb_val_last));
  212. printf("cb_operate_state:%d\r\n",cb_operate_state);
  213. break;
  214. case OPERATE_ERASE_RECORD_TIMES://0x0E
  215. if(app_can_buf[len])
  216. {
  217. sub_bms_info_1.sub_bms_cmd.operate = OP_OPEN_FET;
  218. sub_bms_info_1.sub_bms_cmd.param = 0x03;
  219. }
  220. else
  221. {
  222. sub_bms_info_1.sub_bms_cmd.operate = OP_OPEN_FET;
  223. sub_bms_info_1.sub_bms_cmd.param = 0x00;
  224. }
  225. printf("BMS_1:%d\r\n",sub_bms_info_1.sub_bms_cmd.param);
  226. break;
  227. case OPERATE_RECORD_DATA://0x0F
  228. if(app_can_buf[len])
  229. {
  230. sub_bms_info_2.sub_bms_cmd.operate = OP_OPEN_FET;
  231. sub_bms_info_2.sub_bms_cmd.param = 0x03;
  232. }
  233. else
  234. {
  235. sub_bms_info_2.sub_bms_cmd.operate = OP_OPEN_FET;
  236. sub_bms_info_2.sub_bms_cmd.param = 0x00;
  237. }
  238. printf("BMS_2:%d\r\n",sub_bms_info_2.sub_bms_cmd.param);
  239. break;
  240. case OPERATE_LOW_SHAKE_DATA:
  241. break;
  242. case OPERATE_MEASURE_LOW_VOL:
  243. break;
  244. case OPERATE_TIMES_DATA:
  245. break;
  246. case 0x13:
  247. break;
  248. case 0x14:
  249. printf("mode:%d\r\n",mode);
  250. break;
  251. case 0x30: // FF 0X30 LEN ADDR0 ADDR1 DATA
  252. break;
  253. case 0x31: // FF 0X31 LEN ADDR0 ADDR1 DATA
  254. break;
  255. default: break;
  256. }
  257. return 1;
  258. }
  259. else if(memcmp(app_can_buf,"mode",4) == 0)
  260. {
  261. if(memcmp(&app_can_buf[4],"test",4) == 0)
  262. {
  263. mode = 1;
  264. printf("test success!");
  265. }
  266. else if(memcmp(&app_can_buf[4],"jiaozhun",8) == 0)
  267. {
  268. mode = 4;
  269. printf("jiaozhun success!");
  270. }
  271. else if(memcmp(&app_can_buf[4],"peizhi",6) == 0)
  272. {
  273. mode = 2;
  274. printf("peizhi success!");
  275. }
  276. else if(memcmp(&app_can_buf[4],"ceshi",5) == 0)
  277. {
  278. mode = 3;
  279. printf("ceshi success!");
  280. }
  281. else if(memcmp(&app_can_buf[4],"tuichu",6) == 0)
  282. {
  283. mode = 0;
  284. printf("tuichu success!");
  285. }
  286. else if(memcmp(&app_can_buf[4],"cachu",5) == 0)
  287. {
  288. printf("cachu success!");
  289. }
  290. else
  291. return 0;
  292. return 1;
  293. }
  294. else if(mode == 2&&app_can_buf[0] == 0xFC && app_can_buf[1] == 0xFC)
  295. {
  296. }
  297. else if(mode == 3&&app_can_buf[0] == 0xFE && app_can_buf[1] == 0xFE)
  298. {
  299. }
  300. else if(mode == 4&&app_can_buf[0] == 0xFD && app_can_buf[1] == 0xFD)
  301. {
  302. }
  303. else
  304. {
  305. mode = 0;
  306. Handle_Can_CMD(&app_can_frame);
  307. return 1;
  308. }
  309. /**/
  310. if(!Send_Data_Can(&app_can_frame,OTHER_SEND))
  311. return 0;
  312. return 1;
  313. }
  314. void Can_Com_Initial(void)
  315. {
  316. CAN_Config();
  317. memset(app_can_buf,0x00,sizeof(app_can_buf));
  318. memset(&app_can_frame,0x00,sizeof(app_can_frame));
  319. app_can_frame.data = app_can_buf;
  320. memset(app_can_bms_1_buf,0x00,sizeof(app_can_bms_1_buf));
  321. memset(&app_can_bms_1_frame,0x00,sizeof(app_can_bms_1_frame));
  322. app_can_bms_1_frame.data = app_can_bms_1_buf;
  323. memset(app_can_bms_2_buf,0x00,sizeof(app_can_bms_2_buf));
  324. memset(&app_can_bms_2_frame,0x00,sizeof(app_can_bms_2_frame));
  325. app_can_bms_2_frame.data = app_can_bms_2_buf;
  326. memset(app_can_ctr_buf,0x00,sizeof(app_can_ctr_buf));
  327. memset(&app_can_ctr_frame,0x00,sizeof(app_can_ctr_frame));
  328. app_can_ctr_frame.data = app_can_ctr_buf;
  329. memset(app_can_adas_buf,0x00,sizeof(app_can_adas_buf));
  330. memset(&app_can_adas_frame,0x00,sizeof(app_can_adas_frame));
  331. app_can_adas_frame.data = app_can_adas_buf;
  332. memset(&bms_1_self_ss,0x00,sizeof(bms_1_self_ss));
  333. bms_1_self_ss.key = KEY_BMS_1_SELF_UP;
  334. memset(&bms_1_cur_vol_ss,0x00,sizeof(bms_1_cur_vol_ss));
  335. bms_1_cur_vol_ss.key = KEY_BMS_1_CUR_VOL_SELF_UP;
  336. memset(&bms_2_self_ss,0x00,sizeof(bms_2_self_ss));
  337. bms_2_self_ss.key = KEY_BMS_2_SELF_UP;
  338. memset(&bms_2_cur_vol_ss,0x00,sizeof(bms_2_cur_vol_ss));
  339. bms_2_cur_vol_ss.key = KEY_BMS_2_CUR_VOL_SELF_UP;
  340. memset(&end_ctr_self_ss,0x00,sizeof(end_ctr_self_ss));
  341. end_ctr_self_ss.key = KEY_END_CTR_SELF_UP;
  342. memset(&end_ctr_self_ss_new,0x00,sizeof(end_ctr_self_ss_new));
  343. end_ctr_self_ss_new.key = KEY_END_CTR_SELF_UP;
  344. memset(&end_ctr_rsp,0x00,sizeof(end_ctr_rsp));
  345. end_ctr_rsp.key = KEY_END_CTR_COMMON;
  346. }
  347. void Can_Test(void)
  348. {
  349. app_can_frame.head.rsp = FRAME_PT_NEED_RSP;
  350. app_can_frame.head.dest = CTR_ID;
  351. app_can_frame.head.sour = SELF_ID;
  352. app_can_frame.head.index = 1;
  353. app_can_frame.head.total = 2;
  354. app_can_frame.head.pro =FRAME_PRO_D;
  355. //
  356. app_can_frame.len = 15;
  357. memset(app_can_frame.data,0xCC,15);
  358. Send_Data_Can(&app_can_frame,CAN_TEST);
  359. }