can.c 56 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328
  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. #ifdef RUN_ARCH_SIM
  26. #include "can.h"
  27. void CAN_Rx_ISR(CAN_Buf_TypeDef *ptCANRx, UBYTE ucLength)
  28. {}
  29. void CAN_SendData(UWORD ID, const UBYTE Data[], UWORD Length)
  30. {}
  31. void CAN_SendRemote(UWORD ID)
  32. {}
  33. void SendData(UWORD ID, UBYTE Mode, UWORD Command, const UBYTE *Data)
  34. {}
  35. UBYTE cd_ReadChar(const CAN_Buf_TypeDef *ptCANRx, UBYTE ucNum)
  36. {}
  37. void cd_DelChar(CAN_Buf_TypeDef *ptCANRx, UBYTE ucNum)
  38. {}
  39. void CAN_RxData_Process(CAN_Buf_TypeDef *ptCANRx, UWORD TimeOutCnt)
  40. {}
  41. void CanRx_Process(void)
  42. {}
  43. void DataProcess(UWORD ID, UBYTE Mode, UWORD Cmd, UBYTE Data[])
  44. {}
  45. ULONG CRC32_Calculate(const UBYTE pData[], UWORD Length)
  46. {}
  47. #else
  48. #include "can.h"
  49. #include "stdlib.h"
  50. #include "string.h"
  51. #include "canAppl.h"
  52. #include "CodePara.h"
  53. #include "flash_master.h"
  54. #include "i2c_master.h"
  55. #include "power.h"
  56. #include "torquesensor.h"
  57. #include "api.h"
  58. #include "gd32f30x.h"
  59. #include "hwsetup.h"
  60. #include "enviolo_can.h"
  61. #include "giant_can.h"
  62. static const ULONG Crc32Table[256] = {
  63. 0x00000000U, 0x04C11DB7U, 0x09823B6EU, 0x0D4326D9U, 0x130476DCU, 0x17C56B6BU, 0x1A864DB2U, 0x1E475005U, 0x2608EDB8U, 0x22C9F00FU, 0x2F8AD6D6U, 0x2B4BCB61U,
  64. 0x350C9B64U, 0x31CD86D3U, 0x3C8EA00AU, 0x384FBDBDU, 0x4C11DB70U, 0x48D0C6C7U, 0x4593E01EU, 0x4152FDA9U, 0x5F15ADACU, 0x5BD4B01BU, 0x569796C2U, 0x52568B75U,
  65. 0x6A1936C8U, 0x6ED82B7FU, 0x639B0DA6U, 0x675A1011U, 0x791D4014U, 0x7DDC5DA3U, 0x709F7B7AU, 0x745E66CDU, 0x9823B6E0U, 0x9CE2AB57U, 0x91A18D8EU, 0x95609039U,
  66. 0x8B27C03CU, 0x8FE6DD8BU, 0x82A5FB52U, 0x8664E6E5U, 0xBE2B5B58U, 0xBAEA46EFU, 0xB7A96036U, 0xB3687D81U, 0xAD2F2D84U, 0xA9EE3033U, 0xA4AD16EAU, 0xA06C0B5DU,
  67. 0xD4326D90U, 0xD0F37027U, 0xDDB056FEU, 0xD9714B49U, 0xC7361B4CU, 0xC3F706FBU, 0xCEB42022U, 0xCA753D95U, 0xF23A8028U, 0xF6FB9D9FU, 0xFBB8BB46U, 0xFF79A6F1U,
  68. 0xE13EF6F4U, 0xE5FFEB43U, 0xE8BCCD9AU, 0xEC7DD02DU, 0x34867077U, 0x30476DC0U, 0x3D044B19U, 0x39C556AEU, 0x278206ABU, 0x23431B1CU, 0x2E003DC5U, 0x2AC12072U,
  69. 0x128E9DCFU, 0x164F8078U, 0x1B0CA6A1U, 0x1FCDBB16U, 0x018AEB13U, 0x054BF6A4U, 0x0808D07DU, 0x0CC9CDCAU, 0x7897AB07U, 0x7C56B6B0U, 0x71159069U, 0x75D48DDEU,
  70. 0x6B93DDDBU, 0x6F52C06CU, 0x6211E6B5U, 0x66D0FB02U, 0x5E9F46BFU, 0x5A5E5B08U, 0x571D7DD1U, 0x53DC6066U, 0x4D9B3063U, 0x495A2DD4U, 0x44190B0DU, 0x40D816BAU,
  71. 0xACA5C697U, 0xA864DB20U, 0xA527FDF9U, 0xA1E6E04EU, 0xBFA1B04BU, 0xBB60ADFCU, 0xB6238B25U, 0xB2E29692U, 0x8AAD2B2FU, 0x8E6C3698U, 0x832F1041U, 0x87EE0DF6U,
  72. 0x99A95DF3U, 0x9D684044U, 0x902B669DU, 0x94EA7B2AU, 0xE0B41DE7U, 0xE4750050U, 0xE9362689U, 0xEDF73B3EU, 0xF3B06B3BU, 0xF771768CU, 0xFA325055U, 0xFEF34DE2U,
  73. 0xC6BCF05FU, 0xC27DEDE8U, 0xCF3ECB31U, 0xCBFFD686U, 0xD5B88683U, 0xD1799B34U, 0xDC3ABDEDU, 0xD8FBA05AU, 0x690CE0EEU, 0x6DCDFD59U, 0x608EDB80U, 0x644FC637U,
  74. 0x7A089632U, 0x7EC98B85U, 0x738AAD5CU, 0x774BB0EBU, 0x4F040D56U, 0x4BC510E1U, 0x46863638U, 0x42472B8FU, 0x5C007B8AU, 0x58C1663DU, 0x558240E4U, 0x51435D53U,
  75. 0x251D3B9EU, 0x21DC2629U, 0x2C9F00F0U, 0x285E1D47U, 0x36194D42U, 0x32D850F5U, 0x3F9B762CU, 0x3B5A6B9BU, 0x0315D626U, 0x07D4CB91U, 0x0A97ED48U, 0x0E56F0FFU,
  76. 0x1011A0FAU, 0x14D0BD4DU, 0x19939B94U, 0x1D528623U, 0xF12F560EU, 0xF5EE4BB9U, 0xF8AD6D60U, 0xFC6C70D7U, 0xE22B20D2U, 0xE6EA3D65U, 0xEBA91BBCU, 0xEF68060BU,
  77. 0xD727BBB6U, 0xD3E6A601U, 0xDEA580D8U, 0xDA649D6FU, 0xC423CD6AU, 0xC0E2D0DDU, 0xCDA1F604U, 0xC960EBB3U, 0xBD3E8D7EU, 0xB9FF90C9U, 0xB4BCB610U, 0xB07DABA7U,
  78. 0xAE3AFBA2U, 0xAAFBE615U, 0xA7B8C0CCU, 0xA379DD7BU, 0x9B3660C6U, 0x9FF77D71U, 0x92B45BA8U, 0x9675461FU, 0x8832161AU, 0x8CF30BADU, 0x81B02D74U, 0x857130C3U,
  79. 0x5D8A9099U, 0x594B8D2EU, 0x5408ABF7U, 0x50C9B640U, 0x4E8EE645U, 0x4A4FFBF2U, 0x470CDD2BU, 0x43CDC09CU, 0x7B827D21U, 0x7F436096U, 0x7200464FU, 0x76C15BF8U,
  80. 0x68860BFDU, 0x6C47164AU, 0x61043093U, 0x65C52D24U, 0x119B4BE9U, 0x155A565EU, 0x18197087U, 0x1CD86D30U, 0x029F3D35U, 0x065E2082U, 0x0B1D065BU, 0x0FDC1BECU,
  81. 0x3793A651U, 0x3352BBE6U, 0x3E119D3FU, 0x3AD08088U, 0x2497D08DU, 0x2056CD3AU, 0x2D15EBE3U, 0x29D4F654U, 0xC5A92679U, 0xC1683BCEU, 0xCC2B1D17U, 0xC8EA00A0U,
  82. 0xD6AD50A5U, 0xD26C4D12U, 0xDF2F6BCBU, 0xDBEE767CU, 0xE3A1CBC1U, 0xE760D676U, 0xEA23F0AFU, 0xEEE2ED18U, 0xF0A5BD1DU, 0xF464A0AAU, 0xF9278673U, 0xFDE69BC4U,
  83. 0x89B8FD09U, 0x8D79E0BEU, 0x803AC667U, 0x84FBDBD0U, 0x9ABC8BD5U, 0x9E7D9662U, 0x933EB0BBU, 0x97FFAD0CU, 0xAFB010B1U, 0xAB710D06U, 0xA6322BDFU, 0xA2F33668U,
  84. 0xBCB4666DU, 0xB8757BDAU, 0xB5365D03U, 0xB1F740B4U};
  85. //中断服务函数
  86. void CAN_Rx_ISR(CAN_Buf_TypeDef *ptCANRx, UBYTE ucLength)
  87. {
  88. for (UBYTE i = 0; i < ucLength; i++)
  89. {
  90. *((*ptCANRx).pcBufAddr + (*ptCANRx).ucBufWrInde) = pRxMsg->rx_data[i]; /* parasoft-suppress MISRA2004-17_4 "本项目无法更改,后续避免非数组索引指针运算" */
  91. ++((*ptCANRx).ucBufWrInde);
  92. if ((*ptCANRx).ucBufWrInde >= (*ptCANRx).ucBufSize)
  93. {
  94. (*ptCANRx).ucBufWrInde = 0;
  95. }
  96. ++((*ptCANRx).ucBufCnt);
  97. if ((*ptCANRx).ucBufCnt > (*ptCANRx).ucBufSize)
  98. {
  99. (*ptCANRx).ucBufCnt = (*ptCANRx).ucBufSize;
  100. (*ptCANRx).ucBufOvf = 1;
  101. }
  102. }
  103. }
  104. static UWORD LastPacketLen, PacketNum;
  105. static ULONG OVtim;
  106. void CAN_SendData(UWORD ID, const UBYTE Data[], UWORD Length)
  107. {
  108. UBYTE i, j;
  109. if (Length > 0)
  110. {
  111. //计算分包个数
  112. LastPacketLen = Length % 8; //最后一个数据包长度
  113. if (LastPacketLen == 0)
  114. {
  115. LastPacketLen = 8;
  116. PacketNum = Length / 8;
  117. }
  118. else
  119. {
  120. PacketNum = Length / 8 + 1;
  121. }
  122. //开始发送数据
  123. pTxMsg->tx_sfid = ID;
  124. pTxMsg->tx_ft = CAN_FT_DATA;
  125. pTxMsg->tx_ff = CAN_FF_STANDARD;
  126. //发送前(PacketNum - 1)个数据包
  127. for (i = 0; i < (PacketNum - 1); i++)
  128. {
  129. pTxMsg->tx_dlen = 8;
  130. for (j = 0; j < 8; j++)
  131. {
  132. pTxMsg->tx_data[j] = Data[8 * i + j];
  133. }
  134. can_ubMbox = can_message_transmit(CAN0, pTxMsg);
  135. OVtim = 0;
  136. while((can_transmit_states(CAN0,can_ubMbox) != CAN_TRANSMIT_OK) && (OVtim < 0XFFF))
  137. {
  138. OVtim++;
  139. } //等待发送结束
  140. if (OVtim >= 0XFFF)
  141. {
  142. return;
  143. }
  144. }
  145. //发送最后一个数据包
  146. pTxMsg->tx_dlen = (UBYTE)LastPacketLen;
  147. for (j = 0; j < LastPacketLen; j++)
  148. {
  149. pTxMsg->tx_data[j] = Data[8 * i + j];
  150. }
  151. can_ubMbox = can_message_transmit(CAN0, pTxMsg);
  152. OVtim = 0;
  153. while((can_transmit_states(CAN0,can_ubMbox) != CAN_TRANSMIT_OK) && (OVtim < 0XFFF))
  154. {
  155. OVtim++;
  156. }
  157. if (OVtim >= 0XFFF)
  158. {
  159. return;
  160. }
  161. }
  162. }
  163. void CAN_SendRemote(UWORD ID)
  164. {
  165. //开始发送数据
  166. pTxMsg->tx_sfid = ID;
  167. pTxMsg->tx_ft = CAN_FT_REMOTE;
  168. pTxMsg->tx_ff = CAN_FF_STANDARD;
  169. pTxMsg->tx_dlen = 0;
  170. can_ubMbox = can_message_transmit(CAN0, pTxMsg);
  171. OVtim = 0;
  172. while((can_transmit_states(CAN0,can_ubMbox) != CAN_TRANSMIT_OK) && (OVtim < 0XFFF))
  173. {
  174. OVtim++;
  175. }
  176. if (OVtim >= 0XFFF)
  177. {
  178. return;
  179. }
  180. }
  181. static UBYTE CanSendData[255], CanSendData_CRC_Buf[255];
  182. void SendData(UWORD ID, UBYTE Mode, UWORD Command, const UBYTE *Data)
  183. {
  184. ULONG CRC_Result = 0x00000000U;
  185. UBYTE DataLength;
  186. DataLength = (UBYTE)(Command & 0xFF);
  187. CanSendData[0] = FRAME_BEGIN1;
  188. CanSendData[1] = FRAME_BEGIN2;
  189. CanSendData[2] = Mode;
  190. CanSendData[3] = DataLength + 2;
  191. CanSendData[4] = (UBYTE)((Command >> 8) & 0xFF);
  192. CanSendData[5] = DataLength;
  193. if((DataLength)> (255 - 6))
  194. {
  195. DataLength = 255 - 6;
  196. }
  197. memcpy(CanSendData + 6, Data, DataLength);
  198. CanSendData_CRC_Buf[0] = FRAME_BEGIN1;
  199. CanSendData_CRC_Buf[1] = FRAME_BEGIN2;
  200. CanSendData_CRC_Buf[2] = (UBYTE)(ID >> 8);
  201. CanSendData_CRC_Buf[3] = (UBYTE)(ID & 0xFF);
  202. if((DataLength + 4 )> (255 - 4))
  203. {
  204. DataLength = 251 - 4 - 4;
  205. }
  206. memcpy(CanSendData_CRC_Buf + 4, CanSendData + 2, DataLength + 4);
  207. CRC_Result = CRC32_Calculate(CanSendData_CRC_Buf, DataLength + 8); //帧头2bytes + ID 2bytes + 模式 1byte + 命令段长度 1byte + 命令字 2bytes
  208. CanSendData[6 + DataLength] = (UBYTE)((CRC_Result >> 24) & 0xFF);
  209. CanSendData[7 + DataLength] = (UBYTE)((CRC_Result >> 16) & 0xFF);
  210. CanSendData[8 + DataLength] = (UBYTE)((CRC_Result >> 8) & 0xFF);
  211. CanSendData[9 + DataLength] = (UBYTE)(CRC_Result & 0xFF);
  212. CanSendData[10 + DataLength] = FRAME_END;
  213. CAN_SendData(ID, CanSendData, DataLength + 11);
  214. }
  215. UBYTE cd_ReadChar(const CAN_Buf_TypeDef *ptCANRx, UBYTE ucNum)
  216. {
  217. UBYTE ucData;
  218. UWORD i;
  219. i = ucNum;
  220. if ((*ptCANRx).ucBufCnt >= ucNum)
  221. {
  222. i += (*ptCANRx).ucBufRdInde;
  223. if (i >= (*ptCANRx).ucBufSize)
  224. {
  225. i -= (*ptCANRx).ucBufSize;
  226. }
  227. }
  228. else
  229. {
  230. i = 0;
  231. }
  232. ucData = *((*ptCANRx).pcBufAddr + i); /* parasoft-suppress MISRA2004-17_4 "本项目无法更改,后续避免非数组索引指针运算" */
  233. return ucData;
  234. }
  235. //从队列删除一个字节
  236. void cd_DelChar(CAN_Buf_TypeDef *ptCANRx, UBYTE ucNum)
  237. {
  238. UWORD i;
  239. if ((*ptCANRx).ucBufCnt >= ucNum)
  240. {
  241. // __HAL_CAN_DISABLE_IT(&hcan, CAN_IT_FMP0);//关接收中断
  242. can_interrupt_disable(CAN0, CAN_INT_RFNE0);
  243. // CAN_ITConfig(CAN1, CAN_IT_FMP0, DISABLE);
  244. (*ptCANRx).ucBufCnt -= ucNum;
  245. // __HAL_CAN_ENABLE_IT(&hcan, CAN_IT_FMP0);//开接收中断
  246. can_interrupt_enable(CAN0, CAN_INT_RFNE0);
  247. // CAN_ITConfig(CAN1, CAN_IT_FMP0, ENABLE);
  248. i = ucNum;
  249. i += (*ptCANRx).ucBufRdInde;
  250. if (i >= (*ptCANRx).ucBufSize)
  251. {
  252. i -= (*ptCANRx).ucBufSize;
  253. }
  254. (*ptCANRx).ucBufRdInde = (UBYTE)i;
  255. }
  256. else
  257. {
  258. // __HAL_CAN_DISABLE_IT(&hcan, CAN_IT_FMP0);//关接收中断
  259. can_interrupt_disable(CAN0, CAN_INT_RFNE0);
  260. // CAN_ITConfig(CAN1, CAN_IT_FMP0, DISABLE);
  261. i = (*ptCANRx).ucBufCnt;
  262. (*ptCANRx).ucBufCnt = 0;
  263. // __HAL_CAN_ENABLE_IT(&hcan, CAN_IT_FMP0);//开接收中断
  264. can_interrupt_enable(CAN0, CAN_INT_RFNE0);
  265. // CAN_ITConfig(CAN1, CAN_IT_FMP0, ENABLE);
  266. i += (*ptCANRx).ucBufRdInde;
  267. if (i >= (*ptCANRx).ucBufSize)
  268. {
  269. i -= (*ptCANRx).ucBufSize;
  270. }
  271. (*ptCANRx).ucBufRdInde = (UBYTE)i;
  272. }
  273. }
  274. //解析队列数据,严格按照通信协议格式
  275. static UBYTE CAN_RevData[255], CAN_RevData_CRC_Buf[255];
  276. void CAN_RxData_Process(CAN_Buf_TypeDef *ptCANRx, UWORD TimeOutCnt)
  277. {
  278. UBYTE Mode, CmdLength, DataLength;
  279. UWORD Cmd, i;
  280. ULONG CrcResult, CrcData;
  281. UBYTE FrameBegin1, FrameBegin2;
  282. if (ptCANRx->ucBufCnt >= 11)
  283. {
  284. //读取帧头
  285. FrameBegin1 = cd_ReadChar(ptCANRx, 0);
  286. CAN_RevData_CRC_Buf[0] = FrameBegin1;
  287. FrameBegin2 = cd_ReadChar(ptCANRx, 1);
  288. CAN_RevData_CRC_Buf[1] = FrameBegin2;
  289. if ((FrameBegin1 == FRAME_BEGIN1) && (FrameBegin2 == FRAME_BEGIN2))
  290. {
  291. CAN_RevData_CRC_Buf[2] = (UBYTE)((ptCANRx->ucBufID >> 8) & 0xFF);
  292. CAN_RevData_CRC_Buf[3] = (UBYTE)(ptCANRx->ucBufID & 0xFF);
  293. //读取帧模式
  294. Mode = cd_ReadChar(ptCANRx, 2);
  295. CAN_RevData_CRC_Buf[4] = Mode;
  296. if ((Mode == MODE_READ) || (Mode == MODE_WRITE) || (Mode == MODE_REPORT))
  297. {
  298. //读取命令段长度和命令字
  299. CmdLength = cd_ReadChar(ptCANRx, 3);
  300. CAN_RevData_CRC_Buf[5] = CmdLength;
  301. Cmd =(UWORD)((UWORD)cd_ReadChar(ptCANRx, 4) << 8) + cd_ReadChar(ptCANRx, 5);
  302. CAN_RevData_CRC_Buf[6] = (UBYTE)((Cmd >> 8) & 0xFF);
  303. CAN_RevData_CRC_Buf[7] = (UBYTE)(Cmd & 0xFF);
  304. DataLength = cd_ReadChar(ptCANRx, 5);
  305. if ((CmdLength - DataLength) == 2)
  306. {
  307. if (ptCANRx->ucBufCnt < (CmdLength + 9)) //帧头2bytes + 模式1byte + 命令段长度1byte + 校验位4bytes + 帧尾1byte
  308. {
  309. if (ptCANRx->IsWaitRX_Flag == FALSE)
  310. {
  311. ptCANRx->DelayTimeCnt = cp_ulSystickCnt; // SysTick_GetCounter()
  312. ptCANRx->IsWaitRX_Flag = TRUE;
  313. }
  314. if ((cp_ulSystickCnt - ptCANRx->DelayTimeCnt) > TimeOutCnt) //超时,单位ms
  315. {
  316. cd_DelChar(ptCANRx, ptCANRx->ucBufCnt);
  317. ptCANRx->IsWaitRX_Flag = FALSE;
  318. }
  319. return;
  320. }
  321. else
  322. {
  323. ptCANRx->IsWaitRX_Flag = FALSE;
  324. //接收到完整正确数据包
  325. for (i = 0; i < DataLength; i++) //读取数据段
  326. {
  327. CAN_RevData[i] = cd_ReadChar(ptCANRx, (UBYTE)(6 + i));
  328. CAN_RevData_CRC_Buf[8 + i] = CAN_RevData[i];
  329. }
  330. CrcData = ((ULONG)cd_ReadChar(ptCANRx, 6 + DataLength) << 24) + ((ULONG)cd_ReadChar(ptCANRx, 7 + DataLength) << 16) +
  331. ((ULONG)cd_ReadChar(ptCANRx, 8 + DataLength) << 8) + cd_ReadChar(ptCANRx, 9 + DataLength);
  332. CrcResult = CRC32_Calculate(CAN_RevData_CRC_Buf, 8 + DataLength);
  333. if ((CrcData - CrcResult) == 0) // 比较校验
  334. {
  335. //数据处理
  336. DataProcess(ptCANRx->ucBufID, Mode, Cmd, CAN_RevData); // Mode为帧模式,Cmd为命令字,Data为数据段
  337. cd_DelChar(ptCANRx, CmdLength + 9);
  338. return;
  339. }
  340. cd_DelChar(ptCANRx, 1);
  341. }
  342. }
  343. else
  344. {
  345. cd_DelChar(ptCANRx, 1);
  346. }
  347. }
  348. else
  349. {
  350. cd_DelChar(ptCANRx, 1);
  351. }
  352. }
  353. else
  354. {
  355. cd_DelChar(ptCANRx, 1);
  356. }
  357. }
  358. }
  359. // CAN数据解任务,定时执行
  360. void CanRx_Process(void)
  361. {
  362. CAN_RxData_Process(&CAN_RxBuf_Struct_PBU, 500);
  363. CAN_RxData_Process(&CAN_RxBuf_Struct_BMS, 500);
  364. CAN_RxData_Process(&CAN_RxBuf_Struct_HMI, 500);
  365. CAN_RxData_Process(&CAN_RxBuf_Struct_CDL, 500);
  366. giant_CANRxData_Process();
  367. }
  368. void DataProcess(UWORD ID, UBYTE Mode, UWORD Cmd, UBYTE Data[]) /* parasoft-suppress METRICS-28 "本项目圈复杂度无法更改,后续避免" */
  369. { /* parasoft-suppress GJB5369-4_2_2_2 "本项目函数行数无法更改,后续应避免" */
  370. UBYTE DataLength;
  371. DataLength = (UBYTE)(Cmd & 0x00FF);
  372. switch (ID)
  373. {
  374. //处理BMS发送的指令
  375. case ID_BMS_BC:
  376. case ID_BMS_TO_MC:
  377. {
  378. switch (Cmd)
  379. {
  380. case 0x1010: // BMS运行信息
  381. {
  382. //更新电池运行信息
  383. memcpy(&BMS_RunInfo.Voltage, Data, DataLength);
  384. //MC_RunInfo.SOC = BMS_RunInfo.SOC;
  385. ulBMS_ComTimeOutCount = cp_ulSystickCnt;
  386. break;
  387. }
  388. case 0x1308: //关机指令
  389. {
  390. //电池关闭电源前控制器存储数据
  391. power_stPowStateOut.powerstate = POWER_OFF;
  392. power_stPowStateOut.blPowerStartupFlg = FALSE;
  393. //发送关机就绪信号
  394. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (UBYTE *)"READY");
  395. break;
  396. }
  397. default:
  398. break;
  399. }
  400. break;
  401. }
  402. //处理OBC发送的指令
  403. case ID_PBU_BC:
  404. case ID_PBU_TO_MC:
  405. {
  406. switch (Cmd)
  407. {
  408. case 0x1008: // OBC关机指令
  409. {
  410. //仪表关闭电源前控制器存储数据
  411. power_stPowStateOut.powerstate = POWER_OFF;
  412. power_stPowStateOut.blPowerStartupFlg = FALSE;
  413. //发送关机就绪信号
  414. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (UBYTE *)"READY");
  415. break;
  416. }
  417. // OBC发送给MC的指令
  418. case 0x3002: //控制电机指令
  419. {
  420. memcpy(&MC_ControlCode.GearSt, Data, DataLength);
  421. MC_RunInfo.GearSt = (UBYTE)MC_ControlCode.GearSt; //当前助力档位更新
  422. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch; //大灯状态更新
  423. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (UBYTE *)&MC_RunInfo.BikeSpeed);
  424. ulOBC_ComTimeOutCount = cp_ulSystickCnt;
  425. break;
  426. }
  427. case 0x3105:
  428. {
  429. if (power_stPowStateOut.powerstate == POWER_ON_END)
  430. {
  431. //SendData(ID_MC_TO_PBU, MODE_REPORT, 0x1305, (UBYTE *)"READY");
  432. }
  433. break;
  434. }
  435. case 0x3300: // OBC设置用户参数
  436. {
  437. OBC_SetCustomPara.uwWheelPerimeter = (UBYTE)ass_stParaCong.uwWheelPerimeter;
  438. OBC_SetCustomPara.StartUpMod = (UBYTE)ass_stParaCong.uwStartMode;
  439. OBC_SetCustomPara.BikeSpeedLimit = (UBYTE)ass_stParaSet.uwAssistLimitBikeSpdStart;
  440. OBC_SetCustomPara.DeltDiameter =(SBYTE) ass_stParaCong.swDeltPerimeter;
  441. OBC_SetCustomPara.AssistMod = (UBYTE)ass_stParaSet.uwAsssistSelectNum;
  442. OBC_SetCustomPara.AutoPowerOffTime = (UBYTE)ass_stParaCong.uwAutoPowerOffTime;
  443. OBC_SetCustomPara.scDeltaBikeSpeedLimit = (SBYTE)ass_stParaCong.swDeltaBikeSpeedLimit;
  444. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5408, (UBYTE *)&OBC_SetCustomPara.uwWheelPerimeter);
  445. break;
  446. }
  447. case 0x3408: // OBC设置用户参数
  448. {
  449. #if(WEITUER_ENABLE == 1)
  450. OBC_SetCustomPara.DeltDiameter = (SBYTE)Data[0];
  451. OBC_SetCustomPara.StartUpMod = Data[1];
  452. ass_stParaCong.swDeltPerimeter = OBC_SetCustomPara.DeltDiameter;
  453. ass_stParaCong.uwStartMode = OBC_SetCustomPara.StartUpMod;
  454. MC_UpcInfo.stBikeInfo.uwSaveFlg = 1;
  455. MC_UpcInfo.stBikeInfo.swWheelSizeAdjust = OBC_SetCustomPara.DeltDiameter;
  456. MC_UpcInfo.stBikeInfo.uwStartMode = OBC_SetCustomPara.StartUpMod;
  457. MC_UpcInfo.stAssistInfo.uwSaveFlg = 1;
  458. MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart = Data[2];
  459. MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStop = Data[2]+2;
  460. cp_stFlg.ParaUpdateFlg = TRUE;
  461. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  462. cp_stFlg.ParaAInfoUpdateFlg = TRUE;
  463. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  464. cp_stFlg.ParaSaveEEFlg = TRUE;
  465. GearBox_Init();
  466. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  467. break;
  468. #endif
  469. OBC_SetCustomPara.DeltDiameter = (SBYTE)Data[0];
  470. OBC_SetCustomPara.StartUpMod = Data[1];
  471. OBC_SetCustomPara.AssistMod = Data[2];
  472. OBC_SetCustomPara.AutoPowerOffTime = Data[3];
  473. if(OBC_SetCustomPara.DeltDiameter > 10)
  474. {
  475. OBC_SetCustomPara.DeltDiameter = 10;
  476. }
  477. else if(OBC_SetCustomPara.DeltDiameter < -10)
  478. {
  479. OBC_SetCustomPara.DeltDiameter = -10;
  480. }
  481. else
  482. {
  483. //do nothing
  484. }
  485. OBC_SetCustomPara.scDeltaBikeSpeedLimit = (SBYTE)Data[4];
  486. if(OBC_SetCustomPara.scDeltaBikeSpeedLimit > 0)
  487. {
  488. OBC_SetCustomPara.scDeltaBikeSpeedLimit = 0;
  489. }
  490. else if(OBC_SetCustomPara.scDeltaBikeSpeedLimit < (-ass_stParaSet.uwAssistLimitBikeSpdStart))
  491. {
  492. OBC_SetCustomPara.scDeltaBikeSpeedLimit = (-ass_stParaSet.uwAssistLimitBikeSpdStart);
  493. }
  494. else
  495. {
  496. //do nothing
  497. }
  498. ass_stParaCong.swDeltPerimeter = OBC_SetCustomPara.DeltDiameter;
  499. ass_stParaCong.uwStartMode = OBC_SetCustomPara.StartUpMod;
  500. ass_stParaSet.uwAsssistSelectNum = OBC_SetCustomPara.AssistMod;
  501. ass_stParaCong.uwAutoPowerOffTime = ass_stParaCong.uwAutoPowerOffTime & 0xFF00;
  502. ass_stParaCong.uwAutoPowerOffTime |= OBC_SetCustomPara.AutoPowerOffTime;
  503. ass_stParaCong.swDeltaBikeSpeedLimit = (SWORD)OBC_SetCustomPara.scDeltaBikeSpeedLimit;
  504. MC_UpcInfo.stBikeInfo.uwSaveFlg = 1;
  505. MC_UpcInfo.stBikeInfo.swWheelSizeAdjust = OBC_SetCustomPara.DeltDiameter;
  506. MC_UpcInfo.stBikeInfo.uwStartMode = OBC_SetCustomPara.StartUpMod;
  507. MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime = ass_stParaCong.uwAutoPowerOffTime & 0xFF00;
  508. MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime |= OBC_SetCustomPara.AutoPowerOffTime;
  509. MC_UpcInfo.stBikeInfo2.uwSaveFlg = 1;
  510. MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit = (SWORD)OBC_SetCustomPara.scDeltaBikeSpeedLimit;
  511. cp_stFlg.ParaUpdateFlg = TRUE;
  512. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  513. cp_stFlg.ParaBikeInfo2UpdateFlg = TRUE;
  514. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  515. cp_stFlg.ParaSaveEEFlg = TRUE;
  516. GearBox_Init();
  517. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  518. break;
  519. }
  520. case 0x3500: //查询骑行历史
  521. {
  522. SendData(ID_MC_BC, MODE_REPORT, 0x1510, (UBYTE *)&MC_RideLog.ODO_Km);
  523. break;
  524. }
  525. case 0x3605: // OBC清除TRIP信息
  526. {
  527. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  528. {
  529. MC_RideLog.TRIP_Km = 0;
  530. MC_RideLog.TRIP_Time = 0;
  531. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  532. MC_RunInfo.Ride_Km = 0;
  533. MC_RunInfo.Ride_Time = 0;
  534. cp_stHistoryPara.ulTripSum = 0;
  535. cp_stHistoryPara.ulTripSumTime = 0;
  536. cp_stHistoryPara.ulODOTime = cp_stHistoryPara.ulODOTime + (cp_stBikeRunInfoPara.ulRiTime >> 10) / 60;
  537. cp_stBikeRunInfoPara.ulRiTime = 0;
  538. }
  539. break;
  540. }
  541. case 0x3A05: // OBC清除ODO信息
  542. {
  543. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  544. {
  545. #if(WEITUER_ENABLE == 1)
  546. if(strncmp("CLEAR_ODO", (char *)MC_RsASSCII.CustomASCII1, 9) != 0)
  547. {
  548. strncpy(MC_RsASSCII.CustomASCII1, (char *)"CLEAR_ODO_0", 11);
  549. memcpy(flash_stPara.ubRsASSCII.CustomASCII1, MC_RsASSCII.CustomASCII1, sizeof(MC_RsASSCII.CustomASCII1));
  550. }
  551. if(strncmp("CLEAR_ODO", (char *)MC_RsASSCII.CustomASCII1, 9) == 0)
  552. {
  553. if((MC_RsASSCII.CustomASCII1[10] < '5') && (MC_RideLog.ODO_Km < 500))
  554. {
  555. MC_RsASSCII.CustomASCII1[10]++;
  556. memcpy(flash_stPara.ubRsASSCII.CustomASCII1, MC_RsASSCII.CustomASCII1, sizeof(MC_RsASSCII.CustomASCII1));
  557. MC_RideLog.TRIP_Km = 0;
  558. MC_RideLog.TRIP_Time = 0;
  559. MC_RideLog.ODO_Km = 0;
  560. MC_RideLog.ODO_Time = 0;
  561. cp_stHistoryPara.ulODOTrip = MC_RideLog.ODO_Km;
  562. cp_stHistoryPara.ulODOTime = MC_RideLog.ODO_Time;
  563. cp_stHistoryPara.ulTripSum = MC_RideLog.TRIP_Km;
  564. cp_stHistoryPara.ulTripSumTime = MC_RideLog.TRIP_Time;
  565. cp_stBikeRunInfoPara.ulRiTime = 0;
  566. }
  567. }
  568. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  569. #endif
  570. }
  571. break;
  572. }
  573. case 0x3900: //返回电机版本信息
  574. {
  575. SendData(ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  576. SendData(ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE *)Firmware_Special);
  577. break;
  578. }
  579. case 0x3A02: //OBC按键状态
  580. {
  581. OBC_ButtonStatus.Reserver = Data[0];
  582. OBC_ButtonStatus.ButtonStatu.KeyStatus = Data[1];
  583. OBC_ButtonStatus.ulButtonSetTimeCnt = cp_ulSystickCnt;
  584. break;
  585. }
  586. case 0x4008: //变速器控制参数
  587. {
  588. memcpy((uint8_t*)&GearBox_OBC_SetMode.Mode, Data, DataLength);
  589. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (uint8_t*)"ACK");
  590. break;
  591. }
  592. case 0x4100: //读取变速器参数
  593. {
  594. GearBox_Send_OBC_Params(GearBox_CalFlag, &GearBox_OBC_SetParams, &EnvioloGearInfo2.Soft_Version);
  595. break;
  596. }
  597. case 0x4208: //设置变速器参数
  598. {
  599. memcpy((uint8_t*)&GearBox_OBC_SetParams.GearNum, Data, DataLength);
  600. Syspara2.stGearBoxPara.uwGearBoxNum.uwReal = GearBox_OBC_SetParams.GearNum;
  601. Syspara2.stGearBoxPara.uwGearBoxCadenceMin.uwReal = GearBox_OBC_SetParams.CadenceMin;
  602. Syspara2.stGearBoxPara.uwGearBoxCadenceMax.uwReal = GearBox_OBC_SetParams.CadenceMax;
  603. cp_stFlg.ParaSaveEEFlg = TRUE;
  604. GearBox_Init();
  605. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (uint8_t*)"ACK");
  606. break;
  607. }
  608. case 0x4300:
  609. {
  610. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5620, (UBYTE *)&MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1);
  611. break;
  612. }
  613. case 0x4420:
  614. {
  615. memcpy((uint8_t*)&MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1, Data, DataLength);
  616. LimtRidePara();
  617. MC_UpcInfo.stRideParaInfo.uwSaveFlg = 1;
  618. cp_stFlg.ParaUpdateFlg = TRUE;
  619. cp_stFlg.ParaRideInfoUpdateFlg = TRUE;
  620. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  621. cp_stFlg.ParaSaveEEFlg = TRUE;
  622. SendData(ID_MC_TO_PBU, MODE_REPORT, 0x5303, (uint8_t*)"ACK");
  623. break;
  624. }
  625. default:
  626. break;
  627. }
  628. break;
  629. }
  630. //处理上位机发送的指令
  631. case ID_CDL_BC:
  632. case ID_CDL_TO_MC:
  633. {
  634. switch (Cmd)
  635. {
  636. case 0xF000: // 上位机握手指令 返回应答指令
  637. {
  638. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xF000, (UBYTE *)0);
  639. break;
  640. }
  641. case 0x1200: //查询电机版本信息
  642. {
  643. SendData(ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  644. SendData(ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE*)Firmware_Special);
  645. break;
  646. }
  647. case 0x1300: //查询自定义字符串1
  648. {
  649. SendData(ID_MC_BC, MODE_REPORT, 0xA610, (UBYTE *)MC_RsASSCII.CustomASCII1);
  650. break;
  651. }
  652. case 0x1410: //写入自定义字符串1
  653. {
  654. memcpy(MC_RsASSCII.CustomASCII1, Data, DataLength);
  655. //执行存储操作
  656. memcpy(flash_stPara.ubRsASSCII.CustomASCII1, MC_RsASSCII.CustomASCII1, sizeof(MC_RsASSCII.CustomASCII1));
  657. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  658. break;
  659. }
  660. case 0x1500: //查询自定义字符串2
  661. {
  662. SendData(ID_MC_BC, MODE_REPORT, 0xA710, (UBYTE *)MC_RsASSCII.CustomASCII2);
  663. break;
  664. }
  665. case 0x1610: //写入自定义字符串2
  666. {
  667. memcpy(MC_RsASSCII.CustomASCII2, Data, DataLength);
  668. //执行存储操作
  669. memcpy(flash_stPara.ubRsASSCII.CustomASCII2, MC_RsASSCII.CustomASCII2, sizeof(MC_RsASSCII.CustomASCII2));
  670. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  671. break;
  672. }
  673. case 0x1700: //查询自定义字符串3
  674. {
  675. SendData(ID_MC_BC, MODE_REPORT, 0xA810, (UBYTE *)MC_RsASSCII.CustomASCII3);
  676. break;
  677. }
  678. case 0x1810: //写入自定义字符串3
  679. {
  680. memcpy(MC_RsASSCII.CustomASCII3, Data, DataLength);
  681. //执行存储操作
  682. memcpy(flash_stPara.ubRsASSCII.CustomASCII3, MC_RsASSCII.CustomASCII3, sizeof(MC_RsASSCII.CustomASCII3));
  683. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  684. break;
  685. }
  686. case 0x1901: //写入电机工作模式
  687. {
  688. MC_WorkMode = *Data; // 0-关闭定时发送,1-开启定时发送
  689. if(*Data == 2)
  690. {
  691. MC_BC_COM = 1;
  692. }
  693. break;
  694. }
  695. case 0x1E00: //查询历史信息
  696. {
  697. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB74C, (UBYTE *)&MC_UpcInfo.stHistoryInfo.uwOpenTimes);
  698. break;
  699. }
  700. case 0x1F00: //查询电机生产信息
  701. {
  702. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA520, (UBYTE *)MC_MacInfo.Manufacturer);
  703. break;
  704. }
  705. case 0x2210: //写入电机型号
  706. {
  707. memcpy(MC_VerInfo.Mode, Data, DataLength);
  708. //执行存储操作
  709. memcpy(flash_stPara.ubMotorVersion, MC_VerInfo.Mode, sizeof(flash_stPara.ubMotorVersion));
  710. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  711. break;
  712. }
  713. case 0x2310: //写入电机SN
  714. {
  715. memcpy(MC_VerInfo.SN_Num, Data, DataLength);
  716. //执行存储操作
  717. memcpy(flash_stPara.ubSN, MC_VerInfo.SN_Num, sizeof(flash_stPara.ubSN));
  718. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  719. break;
  720. }
  721. case 0x2420: //写入电机生产信息
  722. {
  723. memcpy(&MC_MacInfo, Data, DataLength);
  724. //执行存储操作
  725. memcpy(flash_stPara.ubProdInfo.Manufacturer, MC_MacInfo.Manufacturer, sizeof(flash_stPara.ubProdInfo));
  726. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  727. break;
  728. }
  729. case 0x2505: //复位指令
  730. {
  731. if (strncmp("OFF..", (char *)Data, DataLength) == 0)
  732. {
  733. //执行关机,需硬件重启
  734. power_stPowStateOut.powerstate = POWER_OFF;
  735. power_stPowStateOut.blPowerStartupFlg = FALSE;
  736. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  737. }
  738. else if (strncmp("RESET", (char *)Data, DataLength) == 0)
  739. {
  740. //执行复位,跳转进入Bootloader
  741. power_stPowStateOut.powerstate = POWER_RESET;
  742. power_stPowStateOut.blPowerStartupFlg = FALSE;
  743. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  744. }
  745. break;
  746. }
  747. case 0x2605: //系统清除
  748. {
  749. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  750. {
  751. DISABLE_IRQ;
  752. flash_voParaInit();
  753. flash_voErrorClear();
  754. /* Parameter default value write*/
  755. i2c_voDefaultWriteBuffer();
  756. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  757. /* History Default Value Write */
  758. i2c_voHistoryDefaultWriteBuffer();
  759. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  760. ENABLE_IRQ;
  761. if (I2C_EE_ComuFltFlg != TRUE)
  762. {
  763. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  764. }
  765. iGpio_Write(HW_GPIO_POWERLOCK_PIN,ApiGpio_LowLevel);
  766. }
  767. break;
  768. }
  769. case 0x2708: //参数还原
  770. {
  771. if (strncmp("RECOVERY", (char *)Data, DataLength) == 0)
  772. {
  773. DISABLE_IRQ;
  774. flash_voParaInit();
  775. /* Parameter default value write*/
  776. i2c_voDefaultWriteBuffer();
  777. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  778. cp_stFlg.ParaSaveEEFlg = FALSE;
  779. ENABLE_IRQ;
  780. if (I2C_EE_ComuFltFlg != TRUE)
  781. {
  782. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  783. }
  784. iGpio_Write(HW_GPIO_POWERLOCK_PIN,ApiGpio_LowLevel);
  785. }
  786. break;
  787. }
  788. case 0x2802: //控制指令
  789. {
  790. memcpy(&MC_ControlCode.GearSt, Data, DataLength);
  791. MC_RunInfo.GearSt = (UBYTE)MC_ControlCode.GearSt; //当前助力档位更新
  792. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch;
  793. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (UBYTE *)&MC_RunInfo.BikeSpeed);
  794. break;
  795. }
  796. case 0x2C01: //控制指令
  797. {
  798. MC_MotorSPD_rpm_Percent = *Data;
  799. break;
  800. }
  801. case 0x2D08: //读取存储器指定地址数据
  802. {
  803. do
  804. {
  805. ULONG DataLength, AddressBegin, AddressEnd;
  806. AddressBegin = ((ULONG)Data[0] << 24) + ((ULONG)Data[1] << 16) + ((ULONG)Data[2] << 8) + ((ULONG)Data[3]);
  807. AddressEnd = ((ULONG)Data[4] << 24) + ((ULONG)Data[5] << 16) + ((ULONG)Data[6] << 8) + ((ULONG)Data[7]);
  808. if(AddressBegin <= AddressEnd)
  809. {
  810. DataLength = AddressEnd - AddressBegin+ 1;
  811. memcpy((UBYTE*)(Data + 8), (UBYTE*)(AddressBegin), (uint32_t)DataLength); /* parasoft-suppress MISRA2004-17_1 "本项目无法更改,后续避免未指向数组的指针运算" */
  812. SendData((UWORD)ID_MC_TO_CDL, (UBYTE)MODE_REPORT, (UWORD)(0xAB08 + DataLength), (UBYTE*)Data);
  813. }
  814. }while(0);
  815. break;
  816. }
  817. case 0x2E00: //查询骑行历史信息
  818. {
  819. SendData(ID_MC_BC, MODE_REPORT, 0x1510, (UBYTE *)&MC_RideLog.ODO_Km);
  820. break;
  821. }
  822. case 0x3909: //历史信息清除
  823. {
  824. if (strncmp("LOG CLEAR", (char *)Data, DataLength) == 0)
  825. {
  826. DISABLE_IRQ;
  827. flash_voErrorClear();
  828. /* History Default Value Write */
  829. i2c_voHistoryDefaultWriteBuffer();
  830. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  831. ENABLE_IRQ;
  832. if (I2C_EE_ComuFltFlg != TRUE)
  833. {
  834. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  835. }
  836. iGpio_Write(HW_GPIO_POWERLOCK_PIN,ApiGpio_LowLevel);
  837. }
  838. break;
  839. }
  840. ////////////////////////////////////////
  841. case 0x3A00:
  842. {
  843. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB226, (UBYTE *)&MC_UpcInfo.stMotorInfo.uwPolePairs);
  844. break;
  845. }
  846. case 0x3B10:
  847. {
  848. memcpy(&MC_RideLog.ODO_Km, Data, DataLength);
  849. cp_stHistoryPara.ulODOTrip = MC_RideLog.ODO_Km;
  850. cp_stHistoryPara.ulODOTime = MC_RideLog.ODO_Time;
  851. cp_stHistoryPara.ulTripSum = MC_RideLog.TRIP_Km;
  852. cp_stHistoryPara.ulTripSumTime = MC_RideLog.TRIP_Time;
  853. MC_UpcInfo.stHistoryInfo.uwODOTripH = (UWORD)(cp_stHistoryPara.ulODOTrip >> 16);
  854. MC_UpcInfo.stHistoryInfo.uwODOTripL = (UWORD)cp_stHistoryPara.ulODOTrip;
  855. MC_UpcInfo.stHistoryInfo.uwODOTimeH = (UWORD)(cp_stHistoryPara.ulODOTime >> 16);
  856. MC_UpcInfo.stHistoryInfo.uwODOTimeL = (UWORD)cp_stHistoryPara.ulODOTime;
  857. MC_UpcInfo.stHistoryInfo.uwTripSumH = (UWORD)(cp_stHistoryPara.ulTripSum >> 16);
  858. MC_UpcInfo.stHistoryInfo.uwTripSumL = (UWORD)cp_stHistoryPara.ulTripSum;
  859. MC_UpcInfo.stHistoryInfo.uwTripSumTimeH = (UWORD)(cp_stHistoryPara.ulTripSumTime >> 16);
  860. MC_UpcInfo.stHistoryInfo.uwTripSumTimeL = (UWORD)cp_stHistoryPara.ulTripSumTime;
  861. cp_stBikeRunInfoPara.ulRiTime = 0;
  862. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  863. break;
  864. }
  865. case 0x3B28:
  866. {
  867. memcpy(&MC_UpcInfo.stMotorInfo, Data, DataLength);
  868. if (MC_UpcInfo.stMotorInfo.uwSaveFlg == 1)
  869. {
  870. cp_stFlg.ParaSaveEEFlg = TRUE;
  871. }
  872. cp_stFlg.ParaUpdateFlg = TRUE;
  873. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  874. cp_stFlg.ParaMInfoUpdateFlg = TRUE;
  875. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  876. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  877. break;
  878. }
  879. case 0x3C00:
  880. {
  881. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB31A, (UBYTE *)&MC_UpcInfo.stBikeInfo.uwWheelPerimeter);
  882. break;
  883. }
  884. case 0x3D1C: //写入整车参数
  885. {
  886. memcpy(&MC_UpcInfo.stBikeInfo, Data, DataLength);
  887. if (MC_UpcInfo.stBikeInfo.uwSaveFlg == 1)
  888. {
  889. cp_stFlg.ParaSaveEEFlg = TRUE;
  890. }
  891. cp_stFlg.ParaUpdateFlg = TRUE;
  892. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  893. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  894. GearBox_Init();
  895. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  896. break;
  897. }
  898. case 0x3D20: //写入电机标签信息
  899. {
  900. memcpy(MC_VerInfo.ProductLabel, Data, DataLength);
  901. //执行存储操作
  902. memcpy(flash_stPara.ucProductLabel, MC_VerInfo.ProductLabel, sizeof(flash_stPara.ucProductLabel));
  903. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  904. break;
  905. }
  906. case 0x3E00:
  907. {
  908. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin = spi_stResolverOut.swSpiThetaOffsetOrignPu;
  909. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetNow = spi_stResolverOut.swSpiThetaOffsetPu;
  910. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB420, (UBYTE *)&MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin);
  911. break;
  912. }
  913. case 0x3F22:
  914. {
  915. // memcpy(&MC_UpcInfo.stMContorlInfo, Data, DataLength);
  916. memcpy(&MC_UpcInfo.stMContorlInfo.uwSaveFlg, Data, 2);
  917. memcpy(&MC_UpcInfo.stMContorlInfo.uwIPeakMaxA, Data + 6, DataLength - 6);//不更新位置传感器零点
  918. if (MC_UpcInfo.stMContorlInfo.uwSaveFlg == 1)
  919. {
  920. cp_stFlg.ParaSaveEEFlg = TRUE;
  921. }
  922. cp_stFlg.ParaUpdateFlg = TRUE;
  923. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  924. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  925. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  926. break;
  927. }
  928. case 0x4000:
  929. {
  930. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin = torsensor_stTorSensorCof.uwTorqueOffsetOrign;
  931. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow1 = torsensor_stTorSensorCof.uwTorqueOffsetNow1;
  932. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow2 = torsensor_stTorSensorCof.uwTorqueOffsetNow2;
  933. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow3 = torsensor_stTorSensorCof.uwTorqueOffsetNow3;
  934. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow4 = torsensor_stTorSensorCof.uwTorqueOffsetNow4;
  935. MC_UpcInfo.stSensorInfo.uwBikeTorMaxNm = torsensor_stTorSensorCof.uwMaxSensorTorquePu;
  936. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep1RealNm;
  937. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = torsensor_stTorSensorCof.uwBikeTorStep1ADC;
  938. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep2RealNm;
  939. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = torsensor_stTorSensorCof.uwBikeTorStep2ADC;
  940. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep3RealNm;
  941. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = torsensor_stTorSensorCof.uwBikeTorStep3ADC;
  942. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep4RealNm;
  943. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = torsensor_stTorSensorCof.uwBikeTorStep4ADC;
  944. MC_UpcInfo.stSensorInfo.uwCadSensorPulseNm = cadence_stFreGetCof.uwNumbersPulses;
  945. MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm = bikespeed_stFreGetCof.uwNumbersPulses;
  946. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB528, (UBYTE *)&MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin);
  947. break;
  948. }
  949. case 0x4104:
  950. {
  951. UWORD SAVETemp[2];
  952. memcpy(&SAVETemp, Data, DataLength);
  953. if (SAVETemp[0] == 1)
  954. {
  955. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = SAVETemp[1];
  956. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
  957. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  958. }
  959. else if (SAVETemp[0] == 2)
  960. {
  961. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = SAVETemp[1];
  962. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
  963. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  964. }
  965. else if (SAVETemp[0] == 3)
  966. {
  967. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = SAVETemp[1];
  968. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
  969. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  970. }
  971. else if (SAVETemp[0] == 4)
  972. {
  973. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = SAVETemp[1];
  974. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
  975. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  976. }
  977. else
  978. {
  979. //do nothing
  980. }
  981. cp_stFlg.ParaSaveEEFlg = TRUE;
  982. cp_stFlg.ParaUpdateFlg = TRUE;
  983. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  984. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  985. break;
  986. }
  987. case 0x420E:
  988. {
  989. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 2);
  990. memcpy(&MC_UpcInfo.stSensorInfo.uwCadSensorPulseNm, Data + 2, DataLength - 2); /* parasoft-suppress MISRA2004-17_1 "本项目无法更改,后续避免未指向数组的指针运算" */
  991. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  992. {
  993. cp_stFlg.ParaSaveEEFlg = TRUE;
  994. }
  995. cp_stFlg.ParaUpdateFlg = TRUE;
  996. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  997. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  998. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  999. break;
  1000. }
  1001. case 0x4304:
  1002. {
  1003. memcpy(&MC_UpcInfo.stCurveOrderInfo, Data, DataLength);
  1004. if(MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum > 15)
  1005. {
  1006. MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum = 15;
  1007. }
  1008. else if(MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum < 1)
  1009. {
  1010. MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum = 1;
  1011. }
  1012. if(MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum > 5)
  1013. {
  1014. MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum = 5;
  1015. }
  1016. else if(MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum < 1)
  1017. {
  1018. MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum = 1;
  1019. }
  1020. Can_AssistCoef_Read(&MC_UpcInfo.stCurveOrderInfo);
  1021. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB64C, (UBYTE *)&MC_UpcInfo.stAssistInfo.swStartupGain);
  1022. break;
  1023. }
  1024. case 0x4450:
  1025. {
  1026. memcpy(&MC_UpcInfo.stAssistInfo, Data, DataLength);
  1027. if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum > 15)
  1028. {
  1029. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum = 15;
  1030. }
  1031. else if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum < 1)
  1032. {
  1033. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum = 1;
  1034. }
  1035. if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum > 5)
  1036. {
  1037. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum = 5;
  1038. }
  1039. else if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum < 1)
  1040. {
  1041. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum = 1;
  1042. }
  1043. Can_AssistCoef_Write(&MC_UpcInfo.stAssistInfo.stCurveOrderInfo);
  1044. if (MC_UpcInfo.stAssistInfo.uwSaveFlg == 1)
  1045. {
  1046. cp_stFlg.ParaSaveEEFlg = TRUE;
  1047. }
  1048. cp_stFlg.ParaUpdateFlg = TRUE;
  1049. cp_stFlg.ParaAInfoUpdateFlg = TRUE;
  1050. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1051. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1052. break;
  1053. }
  1054. case 0x4500:
  1055. {
  1056. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB83A, (UBYTE *)&MC_UpcInfo.stTestParaInfo.RunModelSelect);
  1057. break;
  1058. }
  1059. case 0x463C:
  1060. {
  1061. memcpy(&MC_UpcInfo.stTestParaInfo.uwTestParaSaveFlg, Data, DataLength);
  1062. cp_stFlg.ParaUpdateFlg = TRUE;
  1063. cp_stFlg.TestParaInfoUpdateFlg = TRUE;
  1064. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1065. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1066. break;
  1067. }
  1068. case 0x472E:
  1069. {
  1070. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 30);
  1071. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  1072. {
  1073. cp_stFlg.ParaSaveEEFlg = TRUE;
  1074. }
  1075. cp_stFlg.ParaUpdateFlg = TRUE;
  1076. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  1077. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1078. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1079. break;
  1080. }
  1081. case 0x4800:
  1082. {
  1083. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xB904, (UBYTE *)&MC_UpcInfo.stTestParaInfo.uwEEFirstDefaultSetFlg);
  1084. break;
  1085. }
  1086. case 0x4906:
  1087. {
  1088. memcpy(&MC_UpcInfo.stTestParaInfo.uwSaveFlg, Data, DataLength);
  1089. if(MC_UpcInfo.stTestParaInfo.uwSaveFlg == 1)
  1090. {
  1091. cp_stFlg.ParaSaveEEFlg = TRUE;
  1092. }
  1093. cp_stFlg.ParaUpdateFlg = TRUE;
  1094. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  1095. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1096. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1097. break;
  1098. }
  1099. case 0x4A00:
  1100. {
  1101. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xBE20, (UBYTE *)&MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1);
  1102. break;
  1103. }
  1104. case 0x4B22:
  1105. {
  1106. memcpy(&MC_UpcInfo.stRideParaInfo.uwSaveFlg, Data, DataLength);
  1107. LimtRidePara();
  1108. if (MC_UpcInfo.stRideParaInfo.uwSaveFlg == 1)
  1109. {
  1110. cp_stFlg.ParaSaveEEFlg = TRUE;
  1111. }
  1112. cp_stFlg.ParaUpdateFlg = TRUE;
  1113. cp_stFlg.ParaRideInfoUpdateFlg = TRUE;
  1114. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1115. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1116. break;
  1117. }
  1118. case 0x4C00:
  1119. {
  1120. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xBD20, (UBYTE *)&MC_UpcInfo.stBikeInfo2.uwNoneOBCEnable);
  1121. break;
  1122. }
  1123. case 0x4D22:
  1124. {
  1125. memcpy(&MC_UpcInfo.stBikeInfo2.uwSaveFlg, Data, DataLength);
  1126. if(MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit > 0)
  1127. {
  1128. MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit = 0;
  1129. }
  1130. else if(MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit < (-ass_stParaSet.uwAssistLimitBikeSpdStart))
  1131. {
  1132. MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit = (-ass_stParaSet.uwAssistLimitBikeSpdStart);
  1133. }
  1134. else
  1135. {
  1136. //do nothing
  1137. }
  1138. if (MC_UpcInfo.stBikeInfo2.uwSaveFlg == 1)
  1139. {
  1140. cp_stFlg.ParaSaveEEFlg = TRUE;
  1141. }
  1142. cp_stFlg.ParaUpdateFlg = TRUE;
  1143. cp_stFlg.ParaBikeInfo2UpdateFlg = TRUE;
  1144. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1145. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1146. break;
  1147. }
  1148. case 0x4E00:
  1149. {
  1150. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xBB20, (UBYTE *)MC_VerInfo.ProductLabel);
  1151. break;
  1152. }
  1153. case 0x5002: //启动校准
  1154. {
  1155. AngleTest = TRUE;
  1156. MC_MotorSPD_rpm_Percent = 10;
  1157. cp_stFlg.RunModelSelect = IFContorl;
  1158. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1159. break;
  1160. }
  1161. case 0x5104: //位置传感器零点校准
  1162. {
  1163. memcpy(&MC_UpcInfo.stMContorlInfo, Data, DataLength);
  1164. if (MC_UpcInfo.stMContorlInfo.uwSaveFlg == 1)
  1165. {
  1166. cp_stFlg.ParaSaveEEFlg = TRUE;
  1167. }
  1168. cp_stFlg.ParaUpdateFlg = TRUE;
  1169. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  1170. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1171. SendData(ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1172. break;
  1173. }
  1174. default:
  1175. break;
  1176. }
  1177. break;
  1178. }
  1179. default:
  1180. break;
  1181. }
  1182. }
  1183. void LimtRidePara(void)
  1184. {
  1185. MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1 = (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1);
  1186. MC_UpcInfo.stRideParaInfo.ucAssistRatioGain2 = (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain2 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain2 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistRatioGain2);
  1187. MC_UpcInfo.stRideParaInfo.ucAssistRatioGain3 = (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain3 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain3 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistRatioGain3);
  1188. MC_UpcInfo.stRideParaInfo.ucAssistRatioGain4 = (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain4 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain4 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistRatioGain4);
  1189. MC_UpcInfo.stRideParaInfo.ucAssistRatioGain5 = (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain5 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistRatioGain5 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistRatioGain5);
  1190. MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain1 = (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain1 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain1 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain1);
  1191. MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain2 = (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain2 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain2 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain2);
  1192. MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain3 = (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain3 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain3 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain3);
  1193. MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain4 = (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain4 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain4 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain4);
  1194. MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain5 = (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain5 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain5 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain5);
  1195. MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain1 = (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain1 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain1 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain1);
  1196. MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain2 = (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain2 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain2 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain2);
  1197. MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain3 = (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain3 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain3 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain3);
  1198. MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain4 = (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain4 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain4 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain4);
  1199. MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain5 = (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain5 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain5 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain5);
  1200. MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain1 = (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain1 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain1 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain1);
  1201. MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain2 = (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain2 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain2 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain2);
  1202. MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain3 = (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain3 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain3 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain3);
  1203. MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain4 = (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain4 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain4 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain4);
  1204. MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain5 = (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain5 < 80)? (80): (MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain5 > 120 ? 120 : MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain5);
  1205. }
  1206. ULONG CRC32_Calculate(const UBYTE pData[], UWORD Length)
  1207. {
  1208. ULONG nReg;
  1209. ULONG nTemp = 0;
  1210. UWORD i, n;
  1211. nReg = 0xFFFFFFFFU;
  1212. for (n = 0; n < Length; n++)
  1213. {
  1214. nReg ^= (ULONG)pData[n];
  1215. for (i = 0; i < 4; i++)
  1216. {
  1217. nTemp = Crc32Table[(UBYTE)((nReg >> 24) & 0xFF)];
  1218. nReg <<= 8;
  1219. nReg ^= nTemp;
  1220. }
  1221. }
  1222. return nReg;
  1223. }
  1224. #endif
  1225. /************************************************************************
  1226. Copyright (c) 2018 Welling Motor Technology(Shanghai) Co. Ltd.
  1227. All rights reserved.
  1228. *************************************************************************/
  1229. #ifdef _CAN_C_
  1230. #undef _CAN_C_ /* parasoft-suppress MISRA2004-19_6 "本项目中无法更改,后续避免使用" */
  1231. #endif
  1232. /*************************************************************************
  1233. End of this File (EOF):
  1234. !!!!!!Do not put anything after this part!!!!!!!!!!!
  1235. *************************************************************************/