can.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951
  1. /************************************************************************
  2. Project: Welling Motor Control Paltform
  3. Filename: asr.c
  4. Partner Filename: asr.h
  5. Description: Automatic speed regulator
  6. Complier: IAR Embedded Workbench for ARM 7.80, IAR Systems.
  7. CPU TYPE : STM32F30x
  8. *************************************************************************
  9. Copyright (c) 2018 Welling Motor Technology(Shanghai) Co. Ltd.
  10. All rights reserved.
  11. *************************************************************************
  12. *************************************************************************
  13. Revising History (ECL of this file):
  14. ************************************************************************/
  15. /************************************************************************
  16. Beginning of File, do not put anything above here except notes
  17. Compiler Directives:
  18. *************************************************************************/
  19. #ifndef _CAN_C_
  20. #define _CAN_C_
  21. #endif
  22. /************************************************************************
  23. Included File:
  24. *************************************************************************/
  25. #include "stdlib.h"
  26. #include "string.h"
  27. #include "gd32f30x.h"
  28. #include "FuncLayerAPI.h"
  29. #include "can.h"
  30. #include "canAppl.h"
  31. #include "CodePara.h"
  32. #include "flash_master.h"
  33. #include "i2c_master.h"
  34. #include "power.h"
  35. static const ULONG Crc32Table[256] = {
  36. 0x00000000U, 0x04C11DB7U, 0x09823B6EU, 0x0D4326D9U, 0x130476DCU, 0x17C56B6BU, 0x1A864DB2U, 0x1E475005U, 0x2608EDB8U, 0x22C9F00FU, 0x2F8AD6D6U, 0x2B4BCB61U,
  37. 0x350C9B64U, 0x31CD86D3U, 0x3C8EA00AU, 0x384FBDBDU, 0x4C11DB70U, 0x48D0C6C7U, 0x4593E01EU, 0x4152FDA9U, 0x5F15ADACU, 0x5BD4B01BU, 0x569796C2U, 0x52568B75U,
  38. 0x6A1936C8U, 0x6ED82B7FU, 0x639B0DA6U, 0x675A1011U, 0x791D4014U, 0x7DDC5DA3U, 0x709F7B7AU, 0x745E66CDU, 0x9823B6E0U, 0x9CE2AB57U, 0x91A18D8EU, 0x95609039U,
  39. 0x8B27C03CU, 0x8FE6DD8BU, 0x82A5FB52U, 0x8664E6E5U, 0xBE2B5B58U, 0xBAEA46EFU, 0xB7A96036U, 0xB3687D81U, 0xAD2F2D84U, 0xA9EE3033U, 0xA4AD16EAU, 0xA06C0B5DU,
  40. 0xD4326D90U, 0xD0F37027U, 0xDDB056FEU, 0xD9714B49U, 0xC7361B4CU, 0xC3F706FBU, 0xCEB42022U, 0xCA753D95U, 0xF23A8028U, 0xF6FB9D9FU, 0xFBB8BB46U, 0xFF79A6F1U,
  41. 0xE13EF6F4U, 0xE5FFEB43U, 0xE8BCCD9AU, 0xEC7DD02DU, 0x34867077U, 0x30476DC0U, 0x3D044B19U, 0x39C556AEU, 0x278206ABU, 0x23431B1CU, 0x2E003DC5U, 0x2AC12072U,
  42. 0x128E9DCFU, 0x164F8078U, 0x1B0CA6A1U, 0x1FCDBB16U, 0x018AEB13U, 0x054BF6A4U, 0x0808D07DU, 0x0CC9CDCAU, 0x7897AB07U, 0x7C56B6B0U, 0x71159069U, 0x75D48DDEU,
  43. 0x6B93DDDBU, 0x6F52C06CU, 0x6211E6B5U, 0x66D0FB02U, 0x5E9F46BFU, 0x5A5E5B08U, 0x571D7DD1U, 0x53DC6066U, 0x4D9B3063U, 0x495A2DD4U, 0x44190B0DU, 0x40D816BAU,
  44. 0xACA5C697U, 0xA864DB20U, 0xA527FDF9U, 0xA1E6E04EU, 0xBFA1B04BU, 0xBB60ADFCU, 0xB6238B25U, 0xB2E29692U, 0x8AAD2B2FU, 0x8E6C3698U, 0x832F1041U, 0x87EE0DF6U,
  45. 0x99A95DF3U, 0x9D684044U, 0x902B669DU, 0x94EA7B2AU, 0xE0B41DE7U, 0xE4750050U, 0xE9362689U, 0xEDF73B3EU, 0xF3B06B3BU, 0xF771768CU, 0xFA325055U, 0xFEF34DE2U,
  46. 0xC6BCF05FU, 0xC27DEDE8U, 0xCF3ECB31U, 0xCBFFD686U, 0xD5B88683U, 0xD1799B34U, 0xDC3ABDEDU, 0xD8FBA05AU, 0x690CE0EEU, 0x6DCDFD59U, 0x608EDB80U, 0x644FC637U,
  47. 0x7A089632U, 0x7EC98B85U, 0x738AAD5CU, 0x774BB0EBU, 0x4F040D56U, 0x4BC510E1U, 0x46863638U, 0x42472B8FU, 0x5C007B8AU, 0x58C1663DU, 0x558240E4U, 0x51435D53U,
  48. 0x251D3B9EU, 0x21DC2629U, 0x2C9F00F0U, 0x285E1D47U, 0x36194D42U, 0x32D850F5U, 0x3F9B762CU, 0x3B5A6B9BU, 0x0315D626U, 0x07D4CB91U, 0x0A97ED48U, 0x0E56F0FFU,
  49. 0x1011A0FAU, 0x14D0BD4DU, 0x19939B94U, 0x1D528623U, 0xF12F560EU, 0xF5EE4BB9U, 0xF8AD6D60U, 0xFC6C70D7U, 0xE22B20D2U, 0xE6EA3D65U, 0xEBA91BBCU, 0xEF68060BU,
  50. 0xD727BBB6U, 0xD3E6A601U, 0xDEA580D8U, 0xDA649D6FU, 0xC423CD6AU, 0xC0E2D0DDU, 0xCDA1F604U, 0xC960EBB3U, 0xBD3E8D7EU, 0xB9FF90C9U, 0xB4BCB610U, 0xB07DABA7U,
  51. 0xAE3AFBA2U, 0xAAFBE615U, 0xA7B8C0CCU, 0xA379DD7BU, 0x9B3660C6U, 0x9FF77D71U, 0x92B45BA8U, 0x9675461FU, 0x8832161AU, 0x8CF30BADU, 0x81B02D74U, 0x857130C3U,
  52. 0x5D8A9099U, 0x594B8D2EU, 0x5408ABF7U, 0x50C9B640U, 0x4E8EE645U, 0x4A4FFBF2U, 0x470CDD2BU, 0x43CDC09CU, 0x7B827D21U, 0x7F436096U, 0x7200464FU, 0x76C15BF8U,
  53. 0x68860BFDU, 0x6C47164AU, 0x61043093U, 0x65C52D24U, 0x119B4BE9U, 0x155A565EU, 0x18197087U, 0x1CD86D30U, 0x029F3D35U, 0x065E2082U, 0x0B1D065BU, 0x0FDC1BECU,
  54. 0x3793A651U, 0x3352BBE6U, 0x3E119D3FU, 0x3AD08088U, 0x2497D08DU, 0x2056CD3AU, 0x2D15EBE3U, 0x29D4F654U, 0xC5A92679U, 0xC1683BCEU, 0xCC2B1D17U, 0xC8EA00A0U,
  55. 0xD6AD50A5U, 0xD26C4D12U, 0xDF2F6BCBU, 0xDBEE767CU, 0xE3A1CBC1U, 0xE760D676U, 0xEA23F0AFU, 0xEEE2ED18U, 0xF0A5BD1DU, 0xF464A0AAU, 0xF9278673U, 0xFDE69BC4U,
  56. 0x89B8FD09U, 0x8D79E0BEU, 0x803AC667U, 0x84FBDBD0U, 0x9ABC8BD5U, 0x9E7D9662U, 0x933EB0BBU, 0x97FFAD0CU, 0xAFB010B1U, 0xAB710D06U, 0xA6322BDFU, 0xA2F33668U,
  57. 0xBCB4666DU, 0xB8757BDAU, 0xB5365D03U, 0xB1F740B4U};
  58. //中断服务函数
  59. void CAN_Rx_ISR(CAN_Buf_TypeDef *ptCANRx, UBYTE ucLength)
  60. {
  61. for (UBYTE i = 0; i < ucLength; i++)
  62. {
  63. *((*ptCANRx).pcBufAddr + (*ptCANRx).ucBufWrInde) = pRxMsg->rx_data[i]; /* parasoft-suppress MISRA2004-17_4 "本项目无法更改,后续避免非数组索引指针运算" */
  64. ++((*ptCANRx).ucBufWrInde);
  65. if ((*ptCANRx).ucBufWrInde >= (*ptCANRx).ucBufSize)
  66. {
  67. (*ptCANRx).ucBufWrInde = 0;
  68. }
  69. ++((*ptCANRx).ucBufCnt);
  70. if ((*ptCANRx).ucBufCnt > (*ptCANRx).ucBufSize)
  71. {
  72. (*ptCANRx).ucBufCnt = (*ptCANRx).ucBufSize;
  73. (*ptCANRx).ucBufOvf = 1;
  74. }
  75. }
  76. }
  77. static UWORD LastPacketLen, PacketNum;
  78. static ULONG OVtim;
  79. static UWORD CAN_DELYA;
  80. static UWORD MailState;
  81. void CAN_SendData(UWORD ID, const UBYTE Data[], UWORD Length)
  82. {
  83. UBYTE i, j;
  84. if (Length > 0)
  85. {
  86. //计算分包个数
  87. LastPacketLen = Length % 8; //最后一个数据包长度
  88. if (LastPacketLen == 0)
  89. {
  90. LastPacketLen = 8;
  91. PacketNum = Length / 8;
  92. }
  93. else
  94. {
  95. PacketNum = Length / 8 + 1;
  96. }
  97. //开始发送数据
  98. pTxMsg->tx_sfid = ID;
  99. pTxMsg->tx_ft = CAN_FT_DATA;
  100. pTxMsg->tx_ff = CAN_FF_STANDARD;
  101. //发送前(PacketNum - 1)个数据包
  102. for (i = 0; i < (PacketNum - 1); i++)
  103. {
  104. pTxMsg->tx_dlen = 8;
  105. for (j = 0; j < 8; j++)
  106. {
  107. pTxMsg->tx_data[j] = Data[8 * i + j];
  108. }
  109. can_ubMbox = can_message_transmit(CAN0, pTxMsg);
  110. OVtim = 0;
  111. while((can_transmit_states(CAN0,can_ubMbox) != CAN_TRANSMIT_OK) && (OVtim < 0XFFF))
  112. {
  113. OVtim++;
  114. } //等待发送结束
  115. MailState = (UWORD)can_transmit_states(CAN0,can_ubMbox);
  116. if (OVtim >= 0XFFF)
  117. {
  118. return;
  119. }
  120. //发送最后一个数据包
  121. pTxMsg->tx_dlen = (UBYTE)LastPacketLen;
  122. for (j = 0; j < LastPacketLen; j++)
  123. {
  124. pTxMsg->tx_data[j] = Data[8 * i + j];
  125. }
  126. can_ubMbox = can_message_transmit(CAN0, pTxMsg);
  127. OVtim = 0;
  128. while((can_transmit_states(CAN0,can_ubMbox) != CAN_TRANSMIT_OK) && (OVtim < 0XFFF))
  129. {
  130. OVtim++;
  131. }
  132. if (OVtim >= 0XFFF)
  133. {
  134. return;
  135. }
  136. }
  137. }
  138. }
  139. static UBYTE CanSendData[255], CanSendData_CRC_Buf[255];
  140. void SendData(UWORD ID, UBYTE Mode, UWORD Command, const UBYTE *Data)
  141. {
  142. ULONG CRC_Result = 0x00000000U;
  143. UBYTE DataLength;
  144. DataLength = (UBYTE)(Command & 0xFF);
  145. CanSendData[0] = FRAME_BEGIN1;
  146. CanSendData[1] = FRAME_BEGIN2;
  147. CanSendData[2] = Mode;
  148. CanSendData[3] = DataLength + 2;
  149. CanSendData[4] = (UBYTE)((Command >> 8) & 0xFF);
  150. CanSendData[5] = DataLength;
  151. if((DataLength)> (255 - 6))
  152. {
  153. DataLength = 255 - 6;
  154. }
  155. memcpy(CanSendData + 6, Data, DataLength);
  156. CanSendData_CRC_Buf[0] = FRAME_BEGIN1;
  157. CanSendData_CRC_Buf[1] = FRAME_BEGIN2;
  158. CanSendData_CRC_Buf[2] = (UBYTE)(ID >> 8);
  159. CanSendData_CRC_Buf[3] = (UBYTE)(ID & 0xFF);
  160. if((DataLength + 4 )> (255 - 4))
  161. {
  162. DataLength = 251 - 4 - 4;
  163. }
  164. memcpy(CanSendData_CRC_Buf + 4, CanSendData + 2, DataLength + 4);
  165. CRC_Result = CRC32_Calculate(CanSendData_CRC_Buf, DataLength + 8); //֡ͷ2bytes + ID 2bytes + ģʽ 1byte + ����γ��� 1byte + ������ 2bytes
  166. CanSendData[6 + DataLength] = (UBYTE)((CRC_Result >> 24) & 0xFF);
  167. CanSendData[7 + DataLength] = (UBYTE)((CRC_Result >> 16) & 0xFF);
  168. CanSendData[8 + DataLength] = (UBYTE)((CRC_Result >> 8) & 0xFF);
  169. CanSendData[9 + DataLength] = (UBYTE)(CRC_Result & 0xFF);
  170. CanSendData[10 + DataLength] = FRAME_END;
  171. CAN_SendData(ID, CanSendData, DataLength + 11);
  172. }
  173. UBYTE cd_ReadChar(const CAN_Buf_TypeDef *ptCANRx, UBYTE ucNum)
  174. {
  175. UBYTE ucData;
  176. UWORD i;
  177. i = ucNum;
  178. if ((*ptCANRx).ucBufCnt >= ucNum)
  179. {
  180. i += (*ptCANRx).ucBufRdInde;
  181. if (i >= (*ptCANRx).ucBufSize)
  182. {
  183. i -= (*ptCANRx).ucBufSize;
  184. }
  185. }
  186. else
  187. {
  188. i = 0;
  189. }
  190. ucData = *((*ptCANRx).pcBufAddr + i); /* parasoft-suppress MISRA2004-17_4 "本项目无法更改,后续避免非数组索引指针运算" */
  191. return ucData;
  192. }
  193. //从队列删除一个字节
  194. void cd_DelChar(CAN_Buf_TypeDef *ptCANRx, UBYTE ucNum)
  195. {
  196. UWORD i;
  197. if ((*ptCANRx).ucBufCnt >= ucNum)
  198. {
  199. // __HAL_CAN_DISABLE_IT(&hcan, CAN_IT_FMP0);//关接收中断
  200. can_interrupt_disable(CAN0, CAN_INT_RFNE0);
  201. // CAN_ITConfig(CAN1, CAN_IT_FMP0, DISABLE);
  202. (*ptCANRx).ucBufCnt -= ucNum;
  203. // __HAL_CAN_ENABLE_IT(&hcan, CAN_IT_FMP0);//开接收中断
  204. can_interrupt_enable(CAN0, CAN_INT_RFNE0);
  205. // CAN_ITConfig(CAN1, CAN_IT_FMP0, ENABLE);
  206. i = ucNum;
  207. i += (*ptCANRx).ucBufRdInde;
  208. if (i >= (*ptCANRx).ucBufSize)
  209. {
  210. i -= (*ptCANRx).ucBufSize;
  211. }
  212. (*ptCANRx).ucBufRdInde = (UBYTE)i;
  213. }
  214. else
  215. {
  216. // __HAL_CAN_DISABLE_IT(&hcan, CAN_IT_FMP0);//关接收中断
  217. can_interrupt_disable(CAN0, CAN_INT_RFNE0);
  218. // CAN_ITConfig(CAN1, CAN_IT_FMP0, DISABLE);
  219. i = (*ptCANRx).ucBufCnt;
  220. (*ptCANRx).ucBufCnt = 0;
  221. // __HAL_CAN_ENABLE_IT(&hcan, CAN_IT_FMP0);//开接收中断
  222. can_interrupt_enable(CAN0, CAN_INT_RFNE0);
  223. // CAN_ITConfig(CAN1, CAN_IT_FMP0, ENABLE);
  224. i += (*ptCANRx).ucBufRdInde;
  225. if (i >= (*ptCANRx).ucBufSize)
  226. {
  227. i -= (*ptCANRx).ucBufSize;
  228. }
  229. (*ptCANRx).ucBufRdInde = (UBYTE)i;
  230. }
  231. }
  232. //解析队列数据,严格按照通信协议格式
  233. static UBYTE CAN_RevData[255], CAN_RevData_CRC_Buf[255];
  234. void CAN_RxData_Process(CAN_Buf_TypeDef *ptCANRx, UWORD TimeOutCnt)
  235. {
  236. UBYTE Mode, CmdLength, DataLength;
  237. UWORD Cmd, i;
  238. ULONG CrcResult, CrcData;
  239. UBYTE FrameBegin1, FrameBegin2;
  240. if (ptCANRx->ucBufCnt >= 11)
  241. {
  242. //读取帧头
  243. FrameBegin1 = cd_ReadChar(ptCANRx, 0);
  244. CAN_RevData_CRC_Buf[0] = FrameBegin1;
  245. FrameBegin2 = cd_ReadChar(ptCANRx, 1);
  246. CAN_RevData_CRC_Buf[1] = FrameBegin2;
  247. if ((FrameBegin1 == FRAME_BEGIN1) && (FrameBegin2 == FRAME_BEGIN2))
  248. {
  249. CAN_RevData_CRC_Buf[2] = (UBYTE)((ptCANRx->ucBufID >> 8) & 0xFF);
  250. CAN_RevData_CRC_Buf[3] = (UBYTE)(ptCANRx->ucBufID & 0xFF);
  251. //读取帧模式
  252. Mode = cd_ReadChar(ptCANRx, 2);
  253. CAN_RevData_CRC_Buf[4] = Mode;
  254. if ((Mode == MODE_READ) || (Mode == MODE_WRITE) || (Mode == MODE_REPORT))
  255. {
  256. //读取命令段长度和命令字
  257. CmdLength = cd_ReadChar(ptCANRx, 3);
  258. CAN_RevData_CRC_Buf[5] = CmdLength;
  259. Cmd =(UWORD)((UWORD)cd_ReadChar(ptCANRx, 4) << 8) + cd_ReadChar(ptCANRx, 5);
  260. CAN_RevData_CRC_Buf[6] = (UBYTE)((Cmd >> 8) & 0xFF);
  261. CAN_RevData_CRC_Buf[7] = (UBYTE)(Cmd & 0xFF);
  262. DataLength = cd_ReadChar(ptCANRx, 5);
  263. if ((CmdLength - DataLength) == 2)
  264. {
  265. if (ptCANRx->ucBufCnt < (CmdLength + 9)) //帧头2bytes + 模式1byte + 命令段长度1byte + 校验位4bytes + 帧尾1byte
  266. {
  267. if (ptCANRx->IsWaitRX_Flag == FALSE)
  268. {
  269. ptCANRx->DelayTimeCnt = cp_ulSystickCnt; // SysTick_GetCounter()
  270. ptCANRx->IsWaitRX_Flag = TRUE;
  271. }
  272. if ((cp_ulSystickCnt - ptCANRx->DelayTimeCnt) > TimeOutCnt) //超时,单位ms
  273. {
  274. cd_DelChar(ptCANRx, ptCANRx->ucBufCnt);
  275. ptCANRx->IsWaitRX_Flag = FALSE;
  276. }
  277. return;
  278. }
  279. else
  280. {
  281. ptCANRx->IsWaitRX_Flag = FALSE;
  282. //接收到完整正确数据包
  283. for (i = 0; i < DataLength; i++) //读取数据段
  284. {
  285. CAN_RevData[i] = cd_ReadChar(ptCANRx, (UBYTE)(6 + i));
  286. CAN_RevData_CRC_Buf[8 + i] = CAN_RevData[i];
  287. }
  288. CrcData = ((ULONG)cd_ReadChar(ptCANRx, 6 + DataLength) << 24) + ((ULONG)cd_ReadChar(ptCANRx, 7 + DataLength) << 16) +
  289. ((ULONG)cd_ReadChar(ptCANRx, 8 + DataLength) << 8) + cd_ReadChar(ptCANRx, 9 + DataLength);
  290. CrcResult = CRC32_Calculate(CAN_RevData_CRC_Buf, 8 + DataLength);
  291. if ((CrcData - CrcResult) == 0) // 比较校验
  292. {
  293. //数据处理
  294. DataProcess(ptCANRx->ucBufID, Mode, Cmd, CAN_RevData); // Mode为帧模式,Cmd为命令字,Data为数据段
  295. cd_DelChar(ptCANRx, CmdLength + 9);
  296. return;
  297. }
  298. cd_DelChar(ptCANRx, 1);
  299. }
  300. }
  301. else
  302. {
  303. cd_DelChar(ptCANRx, 1);
  304. }
  305. }
  306. else
  307. {
  308. cd_DelChar(ptCANRx, 1);
  309. }
  310. }
  311. else
  312. {
  313. cd_DelChar(ptCANRx, 1);
  314. }
  315. }
  316. }
  317. // CAN数据解任务,定时执行
  318. void CanRx_Process(void)
  319. {
  320. CAN_RxData_Process(&CAN_RxBuf_Struct_PBU, 500);
  321. CAN_RxData_Process(&CAN_RxBuf_Struct_BMS, 500);
  322. CAN_RxData_Process(&CAN_RxBuf_Struct_HMI, 500);
  323. CAN_RxData_Process(&CAN_RxBuf_Struct_CDL, 500);
  324. }
  325. void DataProcess(UWORD ID, UBYTE Mode, UWORD Cmd, UBYTE Data[]) /* parasoft-suppress METRICS-28 "本项目圈复杂度无法更改,后续避免" */
  326. { /* parasoft-suppress GJB5369-4_2_2_2 "本项目函数行数无法更改,后续应避免" */
  327. UBYTE DataLength;
  328. DataLength = (UBYTE)(Cmd & 0x00FF);
  329. switch (ID)
  330. {
  331. //处理BMS发送的指令
  332. case ID_BMS_BC:
  333. case ID_BMS_TO_MC:
  334. {
  335. switch (Cmd)
  336. {
  337. case 0x1010: // BMS运行信息
  338. {
  339. //更新电池运行信息
  340. memcpy(&BMS_RunInfo.Voltage, Data, DataLength);
  341. MC_RunInfo.SOC = BMS_RunInfo.SOC;
  342. break;
  343. }
  344. case 0x1308: //关机指令
  345. {
  346. //电池关闭电源前控制器存储数据
  347. power_stPowStateOut.powerstate = POWER_OFF;
  348. power_stPowStateOut.blPowerStartupFlg = FALSE;
  349. //发送关机就绪信号
  350. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (UBYTE *)"READY");
  351. break;
  352. }
  353. default:
  354. break;
  355. }
  356. break;
  357. }
  358. //处理OBC发送的指令
  359. case ID_PBU_BC:
  360. case ID_PBU_TO_MC:
  361. {
  362. switch (Cmd)
  363. {
  364. case 0x1008: // OBC关机指令
  365. {
  366. //仪表关闭电源前控制器存储数据
  367. power_stPowStateOut.powerstate = POWER_OFF;
  368. power_stPowStateOut.blPowerStartupFlg = FALSE;
  369. //发送关机就绪信号
  370. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (UBYTE *)"READY");
  371. break;
  372. }
  373. // OBC发送给MC的指令
  374. case 0x3002: //控制电机指令
  375. {
  376. memcpy(&MC_ControlCode.GearSt, Data, DataLength);
  377. MC_RunInfo.GearSt = (UBYTE)MC_ControlCode.GearSt; //当前助力档位更新
  378. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch; //大灯状态更新
  379. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (UBYTE *)&MC_RunInfo.BikeSpeed);
  380. ulOBC_ComTimeOutCount = cp_ulSystickCnt;
  381. break;
  382. }
  383. case 0x3105:
  384. {
  385. if (power_stPowStateOut.powerstate == POWER_ON_END)
  386. {
  387. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x1305, (UBYTE *)"READY");
  388. }
  389. break;
  390. }
  391. case 0x3300: // OBC设置用户参数
  392. {
  393. OBC_SetCustomPara.uwWheelPerimeter = (UBYTE)ass_stParaCong.uwWheelPerimeter;
  394. OBC_SetCustomPara.StartUpMod = (UBYTE)ass_stParaCong.uwStartMode;
  395. OBC_SetCustomPara.BikeSpeedLimit = (UBYTE)ass_stParaCong.uwAssistMaxSpdKmH;
  396. OBC_SetCustomPara.DeltDiameter =(SBYTE) ass_stParaCong.swDeltPerimeter;
  397. OBC_SetCustomPara.AssistMod = (UBYTE)ass_stParaSet.uwAsssistSelectNum;
  398. OBC_SetCustomPara.AutoPowerOffTime = (UBYTE)ass_stParaCong.uwAutoPowerOffTime;
  399. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5408, (UBYTE *)&OBC_SetCustomPara.uwWheelPerimeter);
  400. break;
  401. }
  402. case 0x3408: // OBC设置用户参数
  403. {
  404. OBC_SetCustomPara.DeltDiameter = (SBYTE)Data[0];
  405. OBC_SetCustomPara.StartUpMod = Data[1];
  406. OBC_SetCustomPara.AssistMod = Data[2];
  407. OBC_SetCustomPara.AutoPowerOffTime = Data[3];
  408. ass_stParaCong.swDeltPerimeter = OBC_SetCustomPara.DeltDiameter;
  409. ass_stParaCong.uwStartMode = OBC_SetCustomPara.StartUpMod;
  410. ass_stParaSet.uwAsssistSelectNum = OBC_SetCustomPara.AssistMod;
  411. ass_stParaCong.uwAutoPowerOffTime = OBC_SetCustomPara.AutoPowerOffTime;
  412. MC_UpcInfo.stBikeInfo.uwSaveFlg = 1;
  413. MC_UpcInfo.stBikeInfo.swWheelSizeAdjust = OBC_SetCustomPara.DeltDiameter;
  414. MC_UpcInfo.stBikeInfo.uwStartMode = OBC_SetCustomPara.StartUpMod;
  415. MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime = OBC_SetCustomPara.AutoPowerOffTime;
  416. cp_stFlg.ParaUpdateFlg = TRUE;
  417. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  418. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  419. cp_stFlg.ParaSaveEEFlg = TRUE;
  420. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  421. break;
  422. }
  423. case 0x3500: //查询骑行历史
  424. {
  425. SendData(ID_MC_BC, MODE_REPORT, 0x1510, (UBYTE *)&MC_RideLog.ODO_Km);
  426. break;
  427. }
  428. case 0x3605: // OBC清除TRIP信息
  429. {
  430. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  431. {
  432. MC_RideLog.TRIP_Km = 0;
  433. MC_RideLog.TRIP_Time = 0;
  434. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  435. MC_RunInfo.Ride_Km = 0;
  436. MC_RunInfo.Ride_Time = 0;
  437. cp_stHistoryPara.ulTripSum=0;
  438. cp_stHistoryPara.ulTripSumTime=0;
  439. }
  440. break;
  441. }
  442. case 0x3900: //返回电机版本信息
  443. {
  444. SendData(ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  445. SendData(ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE*)Firmware_Special);
  446. break;
  447. }
  448. case 0x3A02: //OBC按键状态
  449. {
  450. OBC_ButtonStatus.Reserver = Data[0];
  451. OBC_ButtonStatus.ButtonStatu.KeyStatus = Data[1];
  452. OBC_ButtonStatus.ulButtonSetTimeCnt = cp_ulSystickCnt;
  453. break;
  454. }
  455. default:
  456. break;
  457. }
  458. break;
  459. }
  460. //处理上位机发送的指令
  461. case ID_CDL_BC:
  462. case ID_CDL_TO_MC:
  463. {
  464. switch (Cmd)
  465. {
  466. case 0xF000: // 上位机握手指令 返回应答指令
  467. {
  468. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xF000, (UBYTE *)0);
  469. break;
  470. }
  471. case 0x1200: //查询电机版本信息
  472. {
  473. SendData(ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  474. SendData(ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE*)Firmware_Special);
  475. break;
  476. }
  477. case 0x1300: //查询自定义字符串1
  478. {
  479. SendData(ID_MC_BC, MODE_REPORT, 0xA610, (UBYTE *)MC_RsASSCII.CustomASCII1);
  480. break;
  481. }
  482. case 0x1410: //写入自定义字符串1
  483. {
  484. memcpy(MC_RsASSCII.CustomASCII1, Data, DataLength);
  485. //执行存储操作
  486. memcpy(flash_stPara.ubRsASSCII.CustomASCII1, MC_RsASSCII.CustomASCII1, sizeof(MC_RsASSCII.CustomASCII1));
  487. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  488. break;
  489. }
  490. case 0x1500: //查询自定义字符串2
  491. {
  492. SendData(ID_MC_BC, MODE_REPORT, 0xA710, (UBYTE *)MC_RsASSCII.CustomASCII2);
  493. break;
  494. }
  495. case 0x1610: //写入自定义字符串2
  496. {
  497. memcpy(MC_RsASSCII.CustomASCII2, Data, DataLength);
  498. //执行存储操作
  499. memcpy(flash_stPara.ubRsASSCII.CustomASCII2, MC_RsASSCII.CustomASCII2, sizeof(MC_RsASSCII.CustomASCII2));
  500. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  501. break;
  502. }
  503. case 0x1700: //查询自定义字符串3
  504. {
  505. SendData(ID_MC_BC, MODE_REPORT, 0xA810, (UBYTE *)MC_RsASSCII.CustomASCII3);
  506. break;
  507. }
  508. case 0x1810: //写入自定义字符串3
  509. {
  510. memcpy(MC_RsASSCII.CustomASCII3, Data, DataLength);
  511. //执行存储操作
  512. memcpy(flash_stPara.ubRsASSCII.CustomASCII3, MC_RsASSCII.CustomASCII3, sizeof(MC_RsASSCII.CustomASCII3));
  513. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  514. break;
  515. }
  516. case 0x1901: //写入电机工作模式
  517. {
  518. MC_WorkMode = *Data; // 0-关闭定时发送,1-开启定时发送
  519. break;
  520. }
  521. case 0x1E00: //查询历史信息
  522. {
  523. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB74C, (UBYTE *)&MC_UpcInfo.stHistoryInfo.uwOpenTimes);
  524. break;
  525. }
  526. case 0x1F00: //查询电机生产信息
  527. {
  528. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA520, (UBYTE *)MC_MacInfo.Manufacturer);
  529. break;
  530. }
  531. case 0x2210: //写入电机型号
  532. {
  533. memcpy(MC_VerInfo.Mode, Data, DataLength);
  534. //执行存储操作
  535. memcpy(flash_stPara.ubMotorVersion, MC_VerInfo.Mode, sizeof(flash_stPara.ubMotorVersion));
  536. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  537. break;
  538. }
  539. case 0x2310: //写入电机SN
  540. {
  541. memcpy(MC_VerInfo.SN_Num, Data, DataLength);
  542. //执行存储操作
  543. memcpy(flash_stPara.ubSN, MC_VerInfo.SN_Num, sizeof(flash_stPara.ubSN));
  544. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  545. break;
  546. }
  547. case 0x2420: //写入电机生产信息
  548. {
  549. memcpy(&MC_MacInfo, Data, DataLength);
  550. //执行存储操作
  551. memcpy(flash_stPara.ubProdInfo.Manufacturer, MC_MacInfo.Manufacturer, sizeof(flash_stPara.ubProdInfo));
  552. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  553. break;
  554. }
  555. case 0x2505: //复位指令
  556. {
  557. if (strncmp("RESET", (char *)Data, DataLength) == 0)
  558. {
  559. //执行关机,需硬件重启
  560. power_stPowStateOut.powerstate = POWER_OFF;
  561. power_stPowStateOut.blPowerStartupFlg = FALSE;
  562. PowerOffDTimeOut = cp_ulSystickCnt;
  563. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  564. }
  565. break;
  566. }
  567. case 0x2605: //系统清除
  568. {
  569. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  570. {
  571. flash_voParaInit();
  572. DISABLE_IRQ;
  573. /* Parameter default value write*/
  574. i2c_voDefaultWriteBuffer();
  575. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  576. CodeHistoryParaDelete();
  577. mn_voEEHistoryParaUpdate();
  578. i2c_voHistoryWriteBuffer();
  579. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  580. ENABLE_IRQ;
  581. if (I2C_EE_ComuFltFlg != TRUE)
  582. {
  583. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  584. }
  585. IO_POWERLOCK_OFF;
  586. // GPIOC->ODR &= ~(1 << POWER_LOCK_PORT);
  587. }
  588. break;
  589. }
  590. case 0x2708: //参数还原
  591. {
  592. if (strncmp("RECOVERY", (char *)Data, DataLength) == 0)
  593. {
  594. flash_voParaInit();
  595. DISABLE_IRQ;
  596. /* Parameter default value write*/
  597. i2c_voDefaultWriteBuffer();
  598. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  599. cp_stFlg.ParaSaveEEFlg = FALSE;
  600. ENABLE_IRQ;
  601. if (I2C_EE_ComuFltFlg != TRUE)
  602. {
  603. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  604. }
  605. IO_POWERLOCK_OFF;
  606. // GPIOC->ODR &= ~(1 << POWER_LOCK_PORT);
  607. }
  608. break;
  609. }
  610. case 0x2802: //控制指令
  611. {
  612. memcpy(&MC_ControlCode.GearSt, Data, DataLength);
  613. MC_RunInfo.GearSt = (UBYTE)MC_ControlCode.GearSt; //当前助力档位更新
  614. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch;
  615. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (UBYTE *)&MC_RunInfo.BikeSpeed);
  616. break;
  617. }
  618. case 0x2C01: //控制指令
  619. {
  620. MC_MotorSPD_rpm_Percent = *Data;
  621. break;
  622. }
  623. case 0x2D08: //读取存储器指定地址数据
  624. {
  625. do
  626. {
  627. ULONG DataLength, AddressBegin, AddressEnd;
  628. AddressBegin = ((ULONG)Data[0] << 24) + ((ULONG)Data[1] << 16) + ((ULONG)Data[2] << 8) + ((ULONG)Data[3]);
  629. AddressEnd = ((ULONG)Data[4] << 24) + ((ULONG)Data[5] << 16) + ((ULONG)Data[6] << 8) + ((ULONG)Data[7]);
  630. if(AddressBegin <= AddressEnd)
  631. {
  632. DataLength = AddressEnd - AddressBegin+ 1;
  633. memcpy((UBYTE*)(Data + 8), (UBYTE*)(AddressBegin), (uint32_t)DataLength); /* parasoft-suppress MISRA2004-17_1 "本项目无法更改,后续避免未指向数组的指针运算" */
  634. SendData((UWORD)ID_MC_TO_CDL, (UBYTE)MODE_REPORT, (UWORD)(0xAB08 + DataLength), (UBYTE*)Data);
  635. }
  636. }while(0);
  637. break;
  638. }
  639. case 0x2E00: //查询骑行历史信息
  640. {
  641. SendData(ID_MC_BC, MODE_REPORT, 0x1510, (UBYTE *)&MC_RideLog.ODO_Km);
  642. break;
  643. }
  644. case 0x3909:
  645. {
  646. if (strncmp("LOG CLEAR", (char *)Data, DataLength) == 0)
  647. {
  648. CodeHistoryParaDelete();
  649. MC_RideLog.TRIP_Km = 0;
  650. MC_RideLog.TRIP_Time = 0;
  651. MC_RideLog.ODO_Km = 0;
  652. MC_RideLog.ODO_Time = 0;
  653. cp_stHistoryPara.ulTripSum=0;
  654. cp_stHistoryPara.ulTripSumTime=0;
  655. cp_stHistoryPara.ulODOTrip = 0;
  656. cp_stHistoryPara.ulODOTime = 0;
  657. DISABLE_IRQ;
  658. mn_voEEHistoryParaUpdate();
  659. i2c_voHistoryWriteBuffer();
  660. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  661. ENABLE_IRQ;
  662. if (I2C_EE_ComuFltFlg != TRUE)
  663. {
  664. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  665. }
  666. IO_POWERLOCK_OFF;
  667. // GPIOC->ODR &= ~(1 << POWER_LOCK_PORT);
  668. }
  669. break;
  670. }
  671. ////////////////////////////////////////
  672. case 0x3A00:
  673. {
  674. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB226, (UBYTE *)&MC_UpcInfo.stMotorInfo.uwPolePairs);
  675. break;
  676. }
  677. case 0x3B28:
  678. {
  679. memcpy(&MC_UpcInfo.stMotorInfo, Data, DataLength);
  680. if (MC_UpcInfo.stMotorInfo.uwSaveFlg == 1)
  681. {
  682. cp_stFlg.ParaSaveEEFlg = TRUE;
  683. }
  684. cp_stFlg.ParaUpdateFlg = TRUE;
  685. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  686. cp_stFlg.ParaMInfoUpdateFlg = TRUE;
  687. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  688. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  689. break;
  690. }
  691. case 0x3C00:
  692. {
  693. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB31A, (UBYTE *)&MC_UpcInfo.stBikeInfo.uwWheelPerimeter);
  694. break;
  695. }
  696. case 0x3D1C: //写入整车参数
  697. {
  698. memcpy(&MC_UpcInfo.stBikeInfo, Data, DataLength);
  699. if (MC_UpcInfo.stBikeInfo.uwSaveFlg == 1)
  700. {
  701. cp_stFlg.ParaSaveEEFlg = TRUE;
  702. }
  703. cp_stFlg.ParaUpdateFlg = TRUE;
  704. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  705. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  706. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  707. break;
  708. }
  709. case 0x3E00:
  710. {
  711. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin = spi_stResolverOut.swSpiThetaOffsetOrignPu;
  712. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetNow = spi_stResolverOut.swSpiThetaOffsetPu;
  713. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB420, (UBYTE *)&MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin);
  714. break;
  715. }
  716. case 0x3F22:
  717. {
  718. memcpy(&MC_UpcInfo.stMContorlInfo, Data, DataLength);
  719. if (MC_UpcInfo.stMContorlInfo.uwSaveFlg == 1)
  720. {
  721. cp_stFlg.ParaSaveEEFlg = TRUE;
  722. }
  723. cp_stFlg.ParaUpdateFlg = TRUE;
  724. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  725. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  726. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  727. break;
  728. }
  729. case 0x4000:
  730. {
  731. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin = torsensor_stTorSensorCof.uwTorqueOffsetOrign;
  732. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow1 = torsensor_stTorSensorCof.uwTorqueOffsetNow1;
  733. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow2 = torsensor_stTorSensorCof.uwTorqueOffsetNow2;
  734. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow3 = torsensor_stTorSensorCof.uwTorqueOffsetNow3;
  735. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow4 = torsensor_stTorSensorCof.uwTorqueOffsetNow4;
  736. MC_UpcInfo.stSensorInfo.uwBikeTorMaxNm = torsensor_stTorSensorCof.uwMaxSensorTorquePu;
  737. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep1RealNm;
  738. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = torsensor_stTorSensorCof.uwBikeTorStep1ADC;
  739. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep2RealNm;
  740. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = torsensor_stTorSensorCof.uwBikeTorStep2ADC;
  741. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep3RealNm;
  742. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = torsensor_stTorSensorCof.uwBikeTorStep3ADC;
  743. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep4RealNm;
  744. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = torsensor_stTorSensorCof.uwBikeTorStep4ADC;
  745. MC_UpcInfo.stSensorInfo.uwCadSensorPulseNm = cadence_stFreGetCof.uwNumbersPulses;
  746. MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm = bikespeed_stFreGetCof.uwNumbersPulses;
  747. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB528, (UBYTE *)&MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin);
  748. break;
  749. }
  750. case 0x4104:
  751. {
  752. UWORD SAVETemp[2];
  753. memcpy(&SAVETemp, Data, DataLength);
  754. if (SAVETemp[0] == 1)
  755. {
  756. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = SAVETemp[1];
  757. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = hw_uwADC0[7]; //hw_uwADC1[0];//torsensor_stTorSensorOut.uwTorqueReg;
  758. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  759. }
  760. else if (SAVETemp[0] == 2)
  761. {
  762. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = SAVETemp[1];
  763. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = hw_uwADC0[7];//hw_uwADC1[0];//torsensor_stTorSensorOut.uwTorqueReg;
  764. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  765. }
  766. else if (SAVETemp[0] == 3)
  767. {
  768. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = SAVETemp[1];
  769. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = hw_uwADC0[7]; //hw_uwADC1[0];//torsensor_stTorSensorOut.uwTorqueReg;
  770. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  771. }
  772. else if (SAVETemp[0] == 4)
  773. {
  774. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = SAVETemp[1];
  775. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = hw_uwADC0[7]; //hw_uwADC1[0];//torsensor_stTorSensorOut.uwTorqueReg;
  776. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  777. }
  778. else
  779. {
  780. //do noting
  781. }
  782. cp_stFlg.ParaSaveEEFlg = TRUE;
  783. cp_stFlg.ParaUpdateFlg = TRUE;
  784. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  785. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  786. break;
  787. }
  788. case 0x420E:
  789. {
  790. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 2);
  791. memcpy(&MC_UpcInfo.stSensorInfo.uwCadSensorPulseNm, Data + 2, DataLength - 2); /* parasoft-suppress MISRA2004-17_1 "本项目无法更改,后续避免未指向数组的指针运算" */
  792. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  793. {
  794. cp_stFlg.ParaSaveEEFlg = TRUE;
  795. }
  796. cp_stFlg.ParaUpdateFlg = TRUE;
  797. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  798. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  799. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  800. break;
  801. }
  802. case 0x4304:
  803. {
  804. memcpy(&MC_UpcInfo.stCurveOrderInfo, Data, DataLength);
  805. Can_AssistCoef_Read(&MC_UpcInfo.stCurveOrderInfo);
  806. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB64C, (UBYTE *)&MC_UpcInfo.stAssistInfo.swStartupGain);
  807. break;
  808. }
  809. case 0x4450:
  810. {
  811. memcpy(&MC_UpcInfo.stAssistInfo, Data, DataLength);
  812. Can_AssistCoef_Write(&MC_UpcInfo.stAssistInfo.stCurveOrderInfo);
  813. if (MC_UpcInfo.stAssistInfo.uwSaveFlg == 1)
  814. {
  815. cp_stFlg.ParaSaveEEFlg = TRUE;
  816. }
  817. cp_stFlg.ParaUpdateFlg = TRUE;
  818. cp_stFlg.ParaAInfoUpdateFlg = TRUE;
  819. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  820. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  821. break;
  822. }
  823. case 0x4500:
  824. {
  825. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB83A, (UBYTE *)&MC_UpcInfo.stTestParaInfo.RunModelSelect);
  826. break;
  827. }
  828. case 0x463C:
  829. {
  830. memcpy(&MC_UpcInfo.stTestParaInfo.uwTestParaSaveFlg, Data, DataLength);
  831. cp_stFlg.ParaUpdateFlg = TRUE;
  832. cp_stFlg.TestParaInfoUpdateFlg = TRUE;
  833. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  834. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  835. break;
  836. }
  837. case 0x472E:
  838. {
  839. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 30);
  840. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  841. {
  842. cp_stFlg.ParaSaveEEFlg = TRUE;
  843. }
  844. cp_stFlg.ParaUpdateFlg = TRUE;
  845. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  846. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  847. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  848. break;
  849. }
  850. case 0x4800:
  851. {
  852. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB904, (UBYTE *)&MC_UpcInfo.stTestParaInfo.uwEEFirstDefaultSetFlg);
  853. break;
  854. }
  855. case 0x4906:
  856. {
  857. memcpy(&MC_UpcInfo.stTestParaInfo.uwSaveFlg, Data, DataLength);
  858. if(MC_UpcInfo.stTestParaInfo.uwSaveFlg == 1)
  859. {
  860. cp_stFlg.ParaSaveEEFlg = TRUE;
  861. }
  862. cp_stFlg.ParaUpdateFlg = TRUE;
  863. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  864. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  865. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  866. break;
  867. }
  868. default:
  869. break;
  870. }
  871. break;
  872. }
  873. default:
  874. break;
  875. }
  876. }
  877. ULONG CRC32_Calculate(const UBYTE pData[], UWORD Length)
  878. {
  879. ULONG nReg;
  880. ULONG nTemp = 0;
  881. UWORD i, n;
  882. nReg = 0xFFFFFFFFU;
  883. for (n = 0; n < Length; n++)
  884. {
  885. nReg ^= (ULONG)pData[n];
  886. for (i = 0; i < 4; i++)
  887. {
  888. nTemp = Crc32Table[(UBYTE)((nReg >> 24) & 0xFF)];
  889. nReg <<= 8;
  890. nReg ^= nTemp;
  891. }
  892. }
  893. return nReg;
  894. }
  895. /************************************************************************
  896. Copyright (c) 2018 Welling Motor Technology(Shanghai) Co. Ltd.
  897. All rights reserved.
  898. *************************************************************************/
  899. #ifdef _CAN_C_
  900. #undef _CAN_C_ /* parasoft-suppress MISRA2004-19_6 "本项目中无法更改,后续避免使用" */
  901. #endif
  902. /*************************************************************************
  903. End of this File (EOF):
  904. !!!!!!Do not put anything after this part!!!!!!!!!!!
  905. *************************************************************************/