usart.c 64 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625
  1. /**
  2. ******************************************************************************
  3. * @file uart.c
  4. * @author
  5. * @version V1.0.0
  6. * @date 23-12-2015
  7. * @brief usart function.
  8. ******************************************************************************
  9. *
  10. * COPYRIGHT(c) 2015 STMicroelectronics
  11. *
  12. * Redistribution and use in source and binary forms, with or without modification,
  13. * are permitted provided that the following conditions are met:
  14. * 1. Redistributions of source code must retain the above copyright notice,
  15. * this list of conditions and the following disclaimer.
  16. * 2. Redistributions in binary form must reproduce the above copyright notice,
  17. * this list of conditions and the following disclaimer in the documentation
  18. * and/or other materials provided with the distribution.
  19. * 3. Neither the name of STMicroelectronics nor the names of its contributors
  20. * may be used to endorse or promote products derived from this software
  21. * without specific prior written permission.
  22. *
  23. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  24. * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  25. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  26. * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
  27. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  28. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  29. * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  30. * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  31. * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  32. * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  33. *
  34. ******************************************************************************
  35. */
  36. /* Includes ------------------------------------------------------------------*/
  37. #include "usart.h"
  38. #include "can.h"
  39. #include "string.h"
  40. #include "canAppl.h"
  41. #include "CodePara.h"
  42. #include "flash_master.h"
  43. #include "i2c_master.h"
  44. #include "power.h"
  45. #include "torquesensor.h"
  46. #include "FuncLayerAPI.h"
  47. #include "MosResCalib.h"
  48. #include "syspar.h"
  49. #include "uart_Lidian2.h"
  50. #include "uart_gainianzhihui.h"
  51. #include "ti_msp_dl_config.h"
  52. #include "uart_bafang.h"
  53. #include "uart_lanfeng.h"
  54. #include "uart_lanfeng9.h"
  55. #include "uart_J.h"
  56. #include "hwsetup.h"
  57. #include "UserGpio_Config.h"
  58. //#include "api.h"
  59. //#include "board_config.h"
  60. /* Private variables ---------------接收缓存区------------------------------------------*/
  61. UBYTE UART_RxBuff_OBC[UART_BUFF_SIZE];
  62. USART_Buf_TypeDef UART_RxBuff_Struct_OBC = {UART_BUFF_SIZE,0,0,0,0,UART_RxBuff_OBC,0,0};
  63. UBYTE UART_TxBuff_OBC[UART_BUFF_SIZE];
  64. USART_Buf_TypeDef UART_TxBuff_Struct_OBC = {UART_BUFF_SIZE,0,0,0,0,UART_TxBuff_OBC,0,0};
  65. UBYTE UART_RxBuff_BMS[UART_BUFF_SIZE];
  66. USART_Buf_TypeDef UART_RxBuff_Struct_BMS = {UART_BUFF_SIZE,0,0,0,0,UART_RxBuff_BMS,0,0};
  67. UBYTE UART_TxBuff_BMS[UART_BUFF_SIZE];
  68. USART_Buf_TypeDef UART_TxBuff_Struct_BMS = {UART_BUFF_SIZE,0,0,0,0,UART_TxBuff_BMS,0,0};
  69. USART_FrameBuf_TypeDef stUSART_FrameBuf_OBC;
  70. USART_FrameBuf_TypeDef stUSART_FrameBuf_BMS;
  71. OBC_RunInfo_Struct_t stOBC_RunInfo;
  72. OBC_SetInfo_Struct_t stOBC_SetInfo;
  73. MC2OBC_RunInfo_Struct_t stMC2OBC_RRunInfo;
  74. UBYTE ucUartAnalyseID = 0;
  75. UBYTE ucCommType = 0;//0-Both,1-CAN,2-UART
  76. /* Private variables ---------------------------------------------------------*/
  77. const UBYTE ucOBC_password[64]=
  78. {137,159,134,249,88,11,250,61,33,150,3,193,118,141,209,94,
  79. 226,68,146,158,145,127,216,62,116,230,101,211,251,54,229,247,
  80. 20,222,59,63,35,252,142,238,23,197,84,77,147,173,210,57,
  81. 142,223,157,97,36,160,229,237,75,80,37,113,154,88,23,120};
  82. /* Private function prototypes -----------------------------------------------*/
  83. // CAN数据解任务,定时执行
  84. void UsartRx_Process(USART_Buf_TypeDef *USARTx_RxBuf_Struct, USART_Buf_TypeDef *USARTx_TxBuf_Struct, USART_FrameBuf_TypeDef *USART_RxFrameBuf_Struct)
  85. {
  86. if((USARTx_RxBuf_Struct->ul_UartComTimeOutCount > FRAMETIMEOUT_Count) && (USART_RxFrameBuf_Struct->uwDataCount[USART_RxFrameBuf_Struct->ucBufWrIndex] > 0))
  87. {
  88. // usart_interrupt_enable(USARTx_RxBuf_Struct->usart_periph, USART_RDBF_INT, FALSE);
  89. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  90. //(*USART_FrameBuf_Struct).uartframebuf[(*USART_FrameBuf_Struct).ucBufWrIndex].uwDataCount = 0;
  91. USART_RxFrameBuf_Struct->ucBufWrIndex++;
  92. if(USART_RxFrameBuf_Struct->ucBufWrIndex >= FRAME_SIZE)
  93. {
  94. USART_RxFrameBuf_Struct->ucBufWrIndex = 0;
  95. }
  96. // usart_interrupt_enable(USARTx_RxBuf_Struct->usart_periph, USART_RDBF_INT, TRUE);
  97. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  98. USART_RxFrameBuf_Struct->uwFramecount++;
  99. USARTx_RxBuf_Struct->ul_UartComTimeOutCount = 0;
  100. }
  101. if(USART_RxFrameBuf_Struct->uwFramecount > 0)
  102. {
  103. UBYTE data[255];
  104. UBYTE datacount;
  105. datacount = USART_RxFrameBuf_Struct->uwDataCount[USART_RxFrameBuf_Struct->ucBufRdIndex];
  106. for(int i=0;i<datacount;i++)
  107. {
  108. data[i] = UART_ReadChar(USARTx_RxBuf_Struct,i);
  109. }
  110. UART_DelChar(USARTx_RxBuf_Struct,datacount);
  111. //UART_PutChar(&UART_TxBuff_Struct_OBC,datacount);
  112. /*解析1*/
  113. KM5S_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  114. /*解析2*/
  115. #if (UART_ID == 1)
  116. Lidian2_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  117. #elif (UART_ID == 2)
  118. GNZH_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  119. #elif (UART_ID == 3)
  120. Bafang_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  121. #elif (UART_ID == 4)
  122. Lanfeng_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  123. #elif (UART_ID == 5)
  124. J_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  125. #elif (UART_ID == 6)
  126. Lanfeng9_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  127. #endif
  128. /*clear*/
  129. USART_RxFrameBuf_Struct->uwDataCount[USART_RxFrameBuf_Struct->ucBufRdIndex] = 0;
  130. USART_RxFrameBuf_Struct->uwFramecount--;
  131. USART_RxFrameBuf_Struct->ucBufRdIndex++;
  132. if(USART_RxFrameBuf_Struct->ucBufRdIndex>=FRAME_SIZE)
  133. {
  134. USART_RxFrameBuf_Struct->ucBufRdIndex = 0;
  135. }
  136. }
  137. }
  138. void KM5S_USART_RxData_Process(USART_Buf_TypeDef* ptUartTx, UBYTE* buf, UWORD dataCount)
  139. {
  140. UBYTE Mode, DataLength, Addr;
  141. static UBYTE Data[255];
  142. //UWORD Cmd, ID;
  143. UWORD i;
  144. UWORD CheckSumResult=0, CheckSumData=0;
  145. UBYTE FrameBegin, FrameEnd1, FrameEnd2;
  146. if(dataCount >= 8)
  147. {
  148. //帧头
  149. FrameBegin = buf[0];
  150. if(FrameBegin == UARTFRAME_BEGIN)
  151. {
  152. //地址
  153. Addr = buf[1];
  154. //if(Addr == UARTID_MC_TO_CDL)
  155. {
  156. //模式
  157. Mode = buf[2];
  158. //if((Mode == UARTMODE_READ) || (Mode == UARTMODE_WRITE) || (Mode == UARTMODE_REPORT))
  159. {
  160. //长度
  161. DataLength = buf[3];
  162. if(dataCount == (DataLength + 8))
  163. {
  164. for(i=0; i<(DataLength+4); i++)//数据
  165. {
  166. Data[i] = buf[i];
  167. }
  168. CheckSumData = (UWORD)(buf[4 + DataLength] + (buf[5 + DataLength] << 8));
  169. for(i = 1; i<(DataLength+4); i++)
  170. {
  171. CheckSumResult = (UWORD)(Data[i] + CheckSumResult);
  172. }
  173. FrameEnd1 = buf[6 + DataLength];
  174. FrameEnd2 = buf[7 + DataLength];
  175. if((CheckSumData == CheckSumResult) && (FrameEnd1 == UARTFRAME_END1) && (FrameEnd2 == UARTFRAME_END2))// 校验和帧尾正常
  176. {
  177. KM5S_USART_DataProcess(ptUartTx, Addr, Mode, DataLength, &Data[0]);
  178. }
  179. }
  180. }
  181. }
  182. }
  183. }
  184. }
  185. void KM5S_USART_DataProcess(USART_Buf_TypeDef* ptUartTx, UWORD Addr, UBYTE Mode, UBYTE Length, UBYTE* Data)
  186. {
  187. UWORD uwCmd,uwID;
  188. if(Addr == UARTADDR_CDL)
  189. {
  190. if((Mode == UARTMODE_READ) || (Mode == UARTMODE_WRITE) || (Mode == UARTMODE_REPORT))
  191. {
  192. if(Length >= 4)
  193. {
  194. uwID = (UWORD)((Data[4]<<8) + Data[5]);
  195. uwCmd = (UWORD)((Data[6]<<8) + Data[7]);
  196. ucCommType = 2;
  197. DataProcess(ptUartTx, uwID, Mode, uwCmd, &Data[8]);
  198. }
  199. }
  200. }
  201. else if(Addr == UARTADDR_OBC)
  202. {
  203. if((Mode == 0x52) && (Length == 0x02)) //运行信息
  204. {
  205. /*数据获取*/
  206. stOBC_RunInfo.ucPWM = Data[4];
  207. stOBC_RunInfo.ucLightSwitch = ((Data[5] & 0x80)>>7);//大灯
  208. stOBC_RunInfo.ucLowPower = ((Data[5] & 0x20)>>5);//电池容量低
  209. stOBC_RunInfo.ucWalk = ((Data[5] & 0x10)>>4);//6km/h 推行功能
  210. stOBC_RunInfo.ucCruise = ((Data[5] & 0x04)>>2);//巡航
  211. stOBC_RunInfo.ucOverSpeed = (Data[5] & 0x01);//超速
  212. /*数据更新*/
  213. if(stOBC_RunInfo.ucWalk == 1)
  214. {
  215. MC_ControlCode.GearSt = MC_GearSt_WALK;
  216. }
  217. else if(stOBC_RunInfo.ucPWM == 0) //1-255
  218. {
  219. MC_ControlCode.GearSt = MC_GearSt_OFF;
  220. }
  221. else if(stOBC_RunInfo.ucPWM <= 76) //1-255
  222. {
  223. MC_ControlCode.GearSt = MC_GearSt_Torque_ECO;
  224. }
  225. else if(stOBC_RunInfo.ucPWM <= 127) //1-255
  226. {
  227. MC_ControlCode.GearSt = MC_GearSt_Torque_NORM;
  228. }
  229. else if(stOBC_RunInfo.ucPWM <= 178) //1-255
  230. {
  231. MC_ControlCode.GearSt = MC_GearSt_Torque_SPORT;
  232. }
  233. else if(stOBC_RunInfo.ucPWM <= 204) //1-255
  234. {
  235. MC_ControlCode.GearSt = MC_GearSt_Torque_TURBO;
  236. }
  237. else
  238. {
  239. MC_ControlCode.GearSt = MC_GearSt_SMART;
  240. }
  241. if(stOBC_RunInfo.ucLightSwitch == 1) //大灯
  242. {
  243. MC_ControlCode.LightSwitch = MC_LightSwitch_ON;
  244. }
  245. else
  246. {
  247. MC_ControlCode.LightSwitch = MC_LightSwitch_OFF;
  248. }
  249. MC_RunInfo.GearSt = MC_ControlCode.GearSt; //当前助力档位更新
  250. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch; //大灯状态更新
  251. KM5S_SendData_OBC(ptUartTx, Mode, 0x05, 0x00);
  252. ulOBC_ComTimeOutCount = cp_ulSystickCnt;
  253. }
  254. else if((Mode == 0x53) && (Length == 0x07)) //参数设置
  255. {
  256. // KM5S_OBCSetPara(Data);
  257. KM5S_SendData_OBC(ptUartTx, Mode, 0x05, stOBC_SetInfo.ucShakingCode);
  258. }
  259. }
  260. else if(Addr == UARTADDR_BMS)
  261. {
  262. /*if((Mode == 0x10) && (Length == 0x02)) //总容量
  263. {
  264. BMS_RunInfo.FCC = (UWORD)(Data[4] + (Data[5]<<8));
  265. }
  266. else if((Mode == 0x0f) && (Length == 0x02)) //剩余容量
  267. {
  268. BMS_RunInfo.RC = (UWORD)(Data[4] + (Data[5]<<8));
  269. ulBMS_ComTimeOutCount = cp_ulSystickCnt;
  270. }
  271. else if((Mode == 0x09) && (Length == 0x02)) //当前电压
  272. {
  273. BMS_RunInfo.Voltage = (UWORD)(Data[4] + (Data[5]<<8));
  274. }
  275. else if((Mode == 0x0A) && (Length == 0x02)) //当前电流
  276. {
  277. BMS_RunInfo.Current = (UWORD)(Data[4] + (Data[5]<<8));
  278. }
  279. else if((Mode == 0x17) && (Length == 0x02)) //充放电的 cycle次数
  280. {
  281. BMS_RunInfo.RecyclNm = (UWORD)(Data[4] + (Data[5]<<8));
  282. }
  283. else if((Mode == 0x08) && (Length == 0x02)) //温度
  284. {
  285. BMS_RunInfo.Cell_NTC = (UBYTE)((Data[4] + (Data[5]<<8) - 2731)/10 + 40);
  286. }
  287. else if((Mode == 0x0d) && (Length == 0x01)) //相对容量百分比
  288. {
  289. BMS_RunInfo.SOC = Data[4];
  290. ulBMS_ComTimeOutCount = cp_ulSystickCnt;
  291. }*/
  292. #if (UART_ID == 3)
  293. if((Mode == 0x0d) && (Length == 0x01)) //相对容量百分比
  294. {
  295. BMS_RunInfo.SOC = Data[4];
  296. ulBMS_ComTimeOutCount = cp_ulSystickCnt;
  297. UART_PutChar(&UART_TxBuff_Struct_OBC, BMS_RunInfo.SOC);
  298. UART_PutChar(&UART_TxBuff_Struct_OBC, BMS_RunInfo.SOC);
  299. }
  300. #endif
  301. }
  302. }
  303. void DataProcess(USART_Buf_TypeDef* ptUartTx, UWORD ID, UBYTE Mode, UWORD Cmd, UBYTE *Data)
  304. {
  305. uint8_t DataLength;
  306. DataLength = (uint8_t)(Cmd & 0x00FF);
  307. switch (ID)
  308. {
  309. //处理BMS发送的指令
  310. case ID_BMS_BC:
  311. case ID_BMS_TO_MC: {
  312. switch (Cmd)
  313. {
  314. case 0x1010: // BMS运行信息
  315. {
  316. //更新电池运行信息
  317. memcpy(&BMS_RunInfo.Voltage, Data, DataLength);
  318. // MC_RunInfo.SOC = BMS_RunInfo.SOC;
  319. ulBMS_ComTimeOutCount = cp_ulSystickCnt;
  320. break;
  321. }
  322. case 0x1308: //关机指令
  323. {
  324. //电池关闭电源前控制器存储数据
  325. //...
  326. //发送关机就绪信号
  327. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1305, (uint8_t *)"READY");
  328. break;
  329. }
  330. default:
  331. break;
  332. }
  333. break;
  334. }
  335. //处理OBC发送的指令
  336. case ID_PBU_BC:
  337. case ID_PBU_TO_MC: {
  338. switch (Cmd)
  339. {
  340. case 0x1008: // OBC关机指令
  341. {
  342. //仪表关闭电源前控制器存储数据
  343. power_stPowStateOut.powerstate = POWER_OFF;
  344. power_stPowStateOut.blPowerStartupFlg = FALSE;
  345. //发送关机就绪信号
  346. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1305, (uint8_t *)"READY");
  347. break;
  348. }
  349. // OBC发送给MC的指令
  350. case 0x3002://控制电机指令
  351. {
  352. memcpy(&MC_ControlCode.GearSt, Data, DataLength);
  353. MC_RunInfo.GearSt = MC_ControlCode.GearSt; //当前助力档位更新
  354. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch; //大灯状态更新
  355. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1020, (uint8_t *)&MC_RunInfo.BikeSpeed);
  356. ulOBC_ComTimeOutCount = cp_ulSystickCnt;
  357. break;
  358. }
  359. case 0x3300: // OBC设置用户参数
  360. {
  361. OBC_SetCustomPara.uwWheelPerimeter = ass_ParaCong.uwWheelPerimeter;
  362. OBC_SetCustomPara.StartUpMod = ass_ParaCong.uwStartMode;
  363. OBC_SetCustomPara.BikeSpeedLimit = ass_ParaSet.uwAssistLimitBikeSpdStart;
  364. OBC_SetCustomPara.DeltPerimeter = ass_ParaCong.swDeltPerimeter;
  365. OBC_SetCustomPara.AssistMod = ass_ParaSet.uwAsssistSelectNum;
  366. OBC_SetCustomPara.AutoPowerOffTime = ass_ParaCong.uwAutoPowerOffTime;
  367. SendData(ptUartTx, ID_MC_TO_PBU, MODE_REPORT, 0x5408, (uint8_t *)&OBC_SetCustomPara.uwWheelPerimeter);
  368. break;
  369. }
  370. case 0x3408: // OBC设置用户参数
  371. {
  372. OBC_SetCustomPara.DeltPerimeter = Data[0];
  373. OBC_SetCustomPara.StartUpMod = Data[1];
  374. OBC_SetCustomPara.AssistMod = Data[2];
  375. OBC_SetCustomPara.AutoPowerOffTime = Data[3];
  376. if(OBC_SetCustomPara.DeltPerimeter > 10)
  377. {
  378. OBC_SetCustomPara.DeltPerimeter = 10;
  379. }
  380. else if(OBC_SetCustomPara.DeltPerimeter < -10)
  381. {
  382. OBC_SetCustomPara.DeltPerimeter = -10;
  383. }
  384. else
  385. {
  386. //do nothing
  387. }
  388. ass_ParaCong.swDeltPerimeter = OBC_SetCustomPara.DeltPerimeter;
  389. ass_ParaCong.uwStartMode = OBC_SetCustomPara.StartUpMod;
  390. ass_ParaSet.uwAsssistSelectNum = OBC_SetCustomPara.AssistMod;
  391. ass_ParaCong.uwAutoPowerOffTime &= ~0x00FF;
  392. ass_ParaCong.uwAutoPowerOffTime |= OBC_SetCustomPara.AutoPowerOffTime;
  393. MC_UpcInfo.stBikeInfo.uwSaveFlg = TRUE;
  394. MC_UpcInfo.stBikeInfo.swWheelSizeAdjust = OBC_SetCustomPara.DeltPerimeter;
  395. MC_UpcInfo.stBikeInfo.uwStartMode = OBC_SetCustomPara.StartUpMod;
  396. MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime = ass_ParaCong.uwAutoPowerOffTime;
  397. cp_stFlg.ParaUpdateFlg = TRUE;
  398. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  399. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  400. cp_stFlg.ParaSaveEEFlg = TRUE;
  401. SendData(ptUartTx, ID_MC_TO_PBU, MODE_REPORT, 0x5303, (uint8_t *)"ACK");
  402. break;
  403. }
  404. case 0x3500: //查询骑行历史
  405. {
  406. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1510, (uint8_t *)&MC_RideLog.ODO_Km);
  407. break;
  408. }
  409. case 0x3605: // OBC清除TRIP信息
  410. {
  411. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  412. {
  413. MC_RideLog.TRIP_Km = 0;
  414. MC_RideLog.TRIP_Time = 0;
  415. SendData(ptUartTx, ID_MC_TO_PBU, MODE_REPORT, 0x5303, (uint8_t *)"ACK");
  416. MC_RunInfo.Ride_Km = 0;
  417. MC_RunInfo.Ride_Time = 0;
  418. cp_stHistoryPara.ulTripSum=0;
  419. cp_stHistoryPara.ulTripSumTime=0;
  420. }
  421. break;
  422. }
  423. case 0x3900: //返回电机版本信息
  424. {
  425. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  426. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE *)Firmware_Special);
  427. break;
  428. }
  429. case 0x3A02: //OBC按键状态
  430. {
  431. OBC_ButtonStatus.Reserver = Data[0];
  432. OBC_ButtonStatus.ButtonStatu.KeyStatus = Data[1];
  433. OBC_ButtonStatus.ulButtonSetTimeCnt = cp_ulSystickCnt;
  434. OBC_ButtonStatus.blOBCbuttonPress = TRUE;
  435. break;
  436. }
  437. default:
  438. break;
  439. }
  440. break;
  441. }
  442. //处理上位机发送的指令
  443. case ID_CDL_BC:
  444. case ID_CDL_TO_MC: {
  445. switch (Cmd)
  446. {
  447. case 0xF000: // 上位机握手指令 返回应答指令
  448. {
  449. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xF000, (uint8_t *)0);
  450. break;
  451. }
  452. case 0x1200: //查询电机版本信息
  453. {
  454. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  455. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE *)Firmware_Special);
  456. break;
  457. }
  458. case 0x1300: //查询自定义字符串1
  459. {
  460. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA610, (uint8_t *)MC_RsASSCII.CustomASCII1);
  461. break;
  462. }
  463. case 0x1410: //写入自定义字符串1
  464. {
  465. memcpy(MC_RsASSCII.CustomASCII1, Data, DataLength);
  466. //执行存储操作
  467. memcpy( Syspara2.flash_stPara.ubRsASSCII.CustomASCII1, MC_RsASSCII.CustomASCII1, sizeof(MC_RsASSCII.CustomASCII1));
  468. //...
  469. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  470. break;
  471. }
  472. case 0x1500: //查询自定义字符串2
  473. {
  474. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA710, (uint8_t *)MC_RsASSCII.CustomASCII2);
  475. break;
  476. }
  477. case 0x1610: //写入自定义字符串2
  478. {
  479. memcpy(MC_RsASSCII.CustomASCII2, Data, DataLength);
  480. //执行存储操作
  481. memcpy(Syspara2.flash_stPara.ubRsASSCII.CustomASCII2, MC_RsASSCII.CustomASCII2, sizeof(MC_RsASSCII.CustomASCII2));
  482. //...
  483. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  484. break;
  485. }
  486. case 0x1700: //查询自定义字符串3
  487. {
  488. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA810, (uint8_t *)MC_RsASSCII.CustomASCII3);
  489. break;
  490. }
  491. case 0x1810: //写入自定义字符串3
  492. {
  493. memcpy(MC_RsASSCII.CustomASCII3, Data, DataLength);
  494. //执行存储操作
  495. memcpy(Syspara2.flash_stPara.ubRsASSCII.CustomASCII3, MC_RsASSCII.CustomASCII3, sizeof(MC_RsASSCII.CustomASCII3));
  496. //...
  497. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  498. break;
  499. }
  500. case 0x1901: //写入电机工作模式
  501. {
  502. MC_WorkMode = *Data; // 0-关闭定时发送,1-开启定时发送
  503. if(*Data == 2)
  504. {
  505. MC_BC_COM = 1;
  506. }
  507. break;
  508. }
  509. case 0x1E00: //查询历史信息
  510. {
  511. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB74C, (uint8_t *)&MC_UpcInfo.stHistoryInfo.uwOpenTimes);
  512. break;
  513. }
  514. case 0x1F00: //查询电机生产信息
  515. {
  516. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA520, (uint8_t *)MC_MacInfo.Manufacturer);
  517. break;
  518. }
  519. case 0x2210: //写入电机型号
  520. {
  521. memcpy(MC_VerInfo.Mode, Data, DataLength);
  522. //执行存储操作
  523. // memcpy(Syspara2.flash_stPara.ubMotorVersion, MC_VerInfo.Mode, sizeof(Syspara2.flash_stPara.ubMotorVersion));
  524. memcpy(Productionpara.ubMotorVersion, MC_VerInfo.Mode, sizeof(Productionpara.ubMotorVersion));
  525. //...
  526. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  527. break;
  528. }
  529. case 0x2310: //写入电机SN
  530. {
  531. memcpy(MC_VerInfo.SN_Num, Data, DataLength);
  532. //执行存储操作
  533. //...
  534. //memcpy(Syspara2.flash_stPara.ubSN, MC_VerInfo.SN_Num, sizeof(Syspara2.flash_stPara.ubSN));
  535. memcpy(Productionpara.ubSN, MC_VerInfo.SN_Num, sizeof(Productionpara.ubSN));
  536. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  537. break;
  538. }
  539. case 0x2420: //写入电机生产信息
  540. {
  541. memcpy(MC_MacInfo.Manufacturer, Data, DataLength);
  542. //执行存储操作
  543. //...
  544. // memcpy(Syspara2.flash_stPara.ubProdInfo.Manufacturer, MC_MacInfo.Manufacturer, sizeof(Syspara2.flash_stPara.ubProdInfo));
  545. memcpy(Productionpara.ubProdInfo.Manufacturer, MC_MacInfo.Manufacturer, sizeof(Productionpara.ubProdInfo));
  546. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  547. break;
  548. }
  549. case 0x2505: //复位指令
  550. {
  551. if (strncmp("OFF..", (char *)Data, DataLength) == 0)
  552. {
  553. power_stPowStateOut.powerstate = POWER_OFF;
  554. power_stPowStateOut.blPowerStartupFlg = FALSE;
  555. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  556. }
  557. else if (strncmp("RESET", (char *)Data, DataLength) == 0)
  558. {
  559. //执行复位,跳转进入Bootloader
  560. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  561. // __set_FAULTMASK(1);//关闭所有中断
  562. NVIC_SystemReset();
  563. }
  564. break;
  565. }
  566. case 0x2605: //系统清除
  567. {
  568. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  569. {
  570. DISABLE_IRQ;
  571. //flash_voParaInit();
  572. flash_voErrorClear();//历史信息
  573. que_voInit(&que_stFlashErrorLog);
  574. flash_voSysParaInit();
  575. CodeHistoryParaDelete();
  576. mn_voEEHistoryParaUpdate();
  577. flash_voSysParaInit();
  578. flash_voSysParaWrite();//
  579. flash_HistoryWrite(); //
  580. ENABLE_IRQ;
  581. /* DISABLE_IRQ;
  582. i2c_voDefaultWriteBuffer();
  583. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  584. CodeHistoryParaDelete();
  585. mn_voEEHistoryParaUpdate();
  586. i2c_voHistoryWriteBuffer();
  587. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  588. ENABLE_IRQ;*/
  589. // if (I2C_EEFltFlg != TRUE)
  590. {
  591. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  592. }
  593. //GPIO_ResetBits(POWER_LOCK_PORT,POWER_LOCK_PIN);
  594. }
  595. break;
  596. }
  597. case 0x2708: //参数还原
  598. {
  599. if (strncmp("RECOVERY", (char *)Data, DataLength) == 0)
  600. {
  601. DISABLE_IRQ;
  602. //flash_voParaInit();
  603. // flash_voWrite();
  604. flash_voSysParaInit();
  605. flash_voSysParaInit();
  606. flash_voSysParaWrite();//tbd
  607. ENABLE_IRQ;
  608. /*DISABLE_IRQ;
  609. i2c_voDefaultWriteBuffer();
  610. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  611. cp_stFlg.ParaSaveEEFlg = FALSE;
  612. ENABLE_IRQ;*/
  613. cp_stFlg.ParaSaveEEFlg = FALSE;
  614. // if (I2C_EEFltFlg != TRUE)
  615. {
  616. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  617. }
  618. //GPIO_ResetBits(POWER_LOCK_PORT,POWER_LOCK_PIN);
  619. }
  620. break;
  621. }
  622. case 0x2802: //控制指令
  623. {
  624. memcpy(&MC_ControlCode.GearSt, Data, DataLength);
  625. MC_RunInfo.GearSt = MC_ControlCode.GearSt; //当前助力档位更新
  626. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch;
  627. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1020, (uint8_t *)&MC_RunInfo.BikeSpeed);
  628. break;
  629. }
  630. case 0x2C01: //控制指令
  631. {
  632. MC_MotorSPD_rpm_Percent = *Data;
  633. break;
  634. }
  635. case 0x2D08: //读取存储器指定地址数据 故障日志
  636. {
  637. do
  638. {
  639. uint32_t DataLength, AddressBegin, AddressEnd;
  640. AddressBegin = (uint32_t)((Data[0] << 24) + (Data[1] << 16) + (Data[2] << 8) + (Data[3]));
  641. AddressEnd = (uint32_t)((Data[4] << 24) + (Data[5] << 16) + (Data[6] << 8) + (Data[7]));
  642. if(((AddressBegin <= AddressEnd) &&(AddressBegin>0) &&(AddressEnd<=(uint32_t)(0x0001FFFF)))
  643. ||((AddressBegin <= AddressEnd) &&(AddressBegin>=(uint32_t)(0x20200000)) &&(AddressEnd<(uint32_t)(0x20208000))) )
  644. {
  645. DataLength = AddressEnd - AddressBegin+ 1;
  646. memcpy((uint8_t*)(Data + 8), (uint8_t*)(AddressBegin), DataLength);
  647. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, (0xAB08 + DataLength), (uint8_t*)Data);
  648. }
  649. } while (0);
  650. break;
  651. }
  652. case 0x2E00: //查询骑行历史信息
  653. {
  654. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1510, (uint8_t *)&MC_RideLog.ODO_Km);
  655. break;
  656. }
  657. case 0x3909: // 历史信息清除
  658. {
  659. if (strncmp("LOG CLEAR", (char *)Data, DataLength) == 0)
  660. {
  661. DISABLE_IRQ;
  662. flash_voErrorClear();//清故障日志
  663. que_voInit(&que_stFlashErrorLog);
  664. CodeHistoryParaDelete();
  665. mn_voEEHistoryParaUpdate();
  666. flash_HistoryWrite(); //
  667. ENABLE_IRQ;
  668. /*i2c_voHistoryWriteBuffer();
  669. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  670. ENABLE_IRQ;*/
  671. // if (I2C_EEFltFlg != TRUE)
  672. {
  673. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  674. }
  675. //GPIO_ResetBits(POWER_LOCK_PORT,POWER_LOCK_PIN);
  676. }
  677. break;
  678. }
  679. ////////////////////////////////////////
  680. case 0x3A00: //读取马达信息
  681. {
  682. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB226, (uint8_t *)&MC_UpcInfo.stMotorInfo.uwPolePairs);
  683. break;
  684. }
  685. case 0x3B28: //写入马达信息
  686. {
  687. memcpy(&MC_UpcInfo.stMotorInfo, Data, DataLength);
  688. if (MC_UpcInfo.stMotorInfo.uwSaveFlg == 1)
  689. {
  690. cp_stFlg.ParaSaveEEFlg = TRUE;
  691. }
  692. cp_stFlg.ParaUpdateFlg = TRUE;
  693. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  694. cp_stFlg.ParaMInfoUpdateFlg = TRUE;
  695. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  696. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  697. break;
  698. }
  699. case 0x3C00: //读取整车信息
  700. {
  701. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB31A, (uint8_t *)&MC_UpcInfo.stBikeInfo.uwWheelPerimeter);
  702. break;
  703. }
  704. case 0x3D1C: //写入整车信息
  705. {
  706. memcpy(&MC_UpcInfo.stBikeInfo, Data, DataLength);
  707. if (MC_UpcInfo.stBikeInfo.uwSaveFlg == 1)
  708. {
  709. cp_stFlg.ParaSaveEEFlg = TRUE;
  710. }
  711. cp_stFlg.ParaUpdateFlg = TRUE;
  712. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  713. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  714. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  715. break;
  716. }
  717. case 0x3E00: //查询控制器参数
  718. {
  719. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin = 0;//spi_stResolverOut.swSpiThetaOffsetOrignPu;
  720. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetNow = 0;//spi_stResolverOut.swSpiThetaOffsetPu;
  721. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB420, (uint8_t *)&MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin);
  722. break;
  723. }
  724. case 0x3F22: //写入控制器参数
  725. {
  726. memcpy(&MC_UpcInfo.stMContorlInfo, Data, DataLength);
  727. if (MC_UpcInfo.stMContorlInfo.uwSaveFlg == 1)
  728. {
  729. cp_stFlg.ParaSaveEEFlg = TRUE;
  730. }
  731. cp_stFlg.ParaUpdateFlg = TRUE;
  732. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  733. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  734. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  735. break;
  736. }
  737. case 0x4000: //查询传感器参数
  738. {
  739. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin = torsensor_stTorSensorCof.uwTorqueOffsetOrign;
  740. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow1 = torsensor_stTorSensorCof.uwTorqueOffsetNow1;
  741. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow2 = torsensor_stTorSensorCof.uwTorqueOffsetNow2;
  742. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow3 = torsensor_stTorSensorCof.uwTorqueOffsetNow3;
  743. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow4 = torsensor_stTorSensorCof.uwTorqueOffsetNow4;
  744. MC_UpcInfo.stSensorInfo.uwBikeTorMaxNm = torsensor_stTorSensorCof.uwMaxSensorTorquePu;
  745. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep1RealNm;
  746. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = torsensor_stTorSensorCof.uwBikeTorStep1ADC;
  747. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep2RealNm;
  748. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = torsensor_stTorSensorCof.uwBikeTorStep2ADC;
  749. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep3RealNm;
  750. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = torsensor_stTorSensorCof.uwBikeTorStep3ADC;
  751. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep4RealNm;
  752. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = torsensor_stTorSensorCof.uwBikeTorStep4ADC;
  753. MC_UpcInfo.stSensorInfo.uwTorque_SensorPulseNm = cadence_stFreGetCof.uwTorque_NumbersPulses;
  754. MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm = bikespeed_stFreGetCof.uwNumbersPulses;
  755. MC_UpcInfo.stSensorInfo.uwCad_SensorPulseNm=cadence_stFreGetCof.uwCad_NumbersPulses;
  756. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB528, (uint8_t *)&MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin);
  757. break;
  758. }
  759. case 0x4104: //写入力矩传感器参数
  760. {
  761. UWORD SAVETemp[2];
  762. memcpy(&SAVETemp, Data, DataLength);
  763. if (SAVETemp[0] == 1)
  764. {
  765. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = SAVETemp[1];
  766. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC =TORQUEVOLREG();// DL_ADC12_getMemResult(ADC12_1_INST, DL_ADC12_MEM_IDX_1);
  767. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  768. }
  769. else if (SAVETemp[0] == 2)
  770. {
  771. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = SAVETemp[1];
  772. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC =TORQUEVOLREG();// DL_ADC12_getMemResult(ADC12_1_INST, DL_ADC12_MEM_IDX_1);
  773. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  774. }
  775. else if (SAVETemp[0] == 3)
  776. {
  777. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = SAVETemp[1];
  778. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = TORQUEVOLREG();//DL_ADC12_getMemResult(ADC12_1_INST, DL_ADC12_MEM_IDX_1);
  779. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  780. }
  781. else if (SAVETemp[0] == 4)
  782. {
  783. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = SAVETemp[1];
  784. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = TORQUEVOLREG();//DL_ADC12_getMemResult(ADC12_1_INST, DL_ADC12_MEM_IDX_1);
  785. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  786. }
  787. else
  788. {}
  789. cp_stFlg.ParaSaveEEFlg = TRUE;
  790. cp_stFlg.ParaUpdateFlg = TRUE;
  791. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  792. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  793. break;
  794. }
  795. case 0x420E: //写入其它传感器参数
  796. {
  797. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 2);
  798. memcpy(&MC_UpcInfo.stSensorInfo.uwTorque_SensorPulseNm, Data + 2, DataLength - 2);
  799. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  800. {
  801. cp_stFlg.ParaSaveEEFlg = TRUE;
  802. }
  803. cp_stFlg.ParaUpdateFlg = TRUE;
  804. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  805. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  806. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  807. break;
  808. }
  809. case 0x4304: //查询助力参数
  810. {
  811. memcpy(&MC_UpcInfo.stCurveOrderInfo, Data, DataLength);
  812. if(MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum > 15)
  813. {
  814. MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum = 15;
  815. }
  816. else if(MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum < 1)
  817. {
  818. MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum = 1;
  819. }
  820. if(MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum > 5)
  821. {
  822. MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum = 5;
  823. }
  824. else if(MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum < 1)
  825. {
  826. MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum = 1;
  827. }
  828. Can_AssistCoef_Read(&MC_UpcInfo.stCurveOrderInfo);
  829. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB64C, (uint8_t *)&MC_UpcInfo.stAssistInfo.swStartupGain);
  830. break;
  831. }
  832. case 0x4450: //写入助力参数
  833. {
  834. memcpy(&MC_UpcInfo.stAssistInfo, Data, DataLength);
  835. if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum > 15)
  836. {
  837. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum = 15;
  838. }
  839. else if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum < 1)
  840. {
  841. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum = 1;
  842. }
  843. if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum > 5)
  844. {
  845. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum = 5;
  846. }
  847. else if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum < 1)
  848. {
  849. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum = 1;
  850. }
  851. Can_AssistCoef_Write(&MC_UpcInfo.stAssistInfo.stCurveOrderInfo);
  852. if (MC_UpcInfo.stAssistInfo.uwSaveFlg == 1)
  853. {
  854. cp_stFlg.ParaSaveEEFlg = TRUE;
  855. }
  856. cp_stFlg.ParaUpdateFlg = TRUE;
  857. cp_stFlg.ParaAInfoUpdateFlg = TRUE;
  858. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  859. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  860. break;
  861. }
  862. case 0x4500: //查询调试参数
  863. {
  864. MC_UpcInfo.stTestParaInfo.RunModelSelect = cp_stFlg.RunModelSelect;
  865. MC_UpcInfo.stTestParaInfo.ThetaGetModelSelect = cp_stFlg.ThetaGetModelSelect;
  866. MC_UpcInfo.stTestParaInfo.CurrentSampleModelSelect = cp_stFlg.CurrentSampleModelSelect;
  867. MC_UpcInfo.stTestParaInfo.RotateDirectionSelect = cp_stFlg.RotateDirectionSelect;
  868. MC_UpcInfo.stTestParaInfo.uwInitPosCurAmp = cp_stControlPara.swAlignCurAp ;
  869. MC_UpcInfo.stTestParaInfo.uwVFControlVolAmp = cp_stControlPara.swDragVolAp ;
  870. MC_UpcInfo.stTestParaInfo.uwIFControlCurAmp = cp_stControlPara.swDragCurAp ;
  871. MC_UpcInfo.stTestParaInfo.uwVFIFTargetFreHz = cp_stControlPara.swDragSpdHz;
  872. MC_UpcInfo.stTestParaInfo.uwSpeedLoopAccRate = cp_stControlPara.swSpeedAccRate ;
  873. MC_UpcInfo.stTestParaInfo.uwSpeedLoopDecRate = cp_stControlPara.swSpeedDccRate;
  874. MC_UpcInfo.stTestParaInfo.uwSpeedLoopBandWidthHz = cp_stControlPara.swAsrPIBandwidth;
  875. MC_UpcInfo.stTestParaInfo.uwSpeedLoopCoefM = cp_stControlPara.swAsrPIM;
  876. MC_UpcInfo.stTestParaInfo.uwCuerrentLoopBandWidthHz = cp_stControlPara.swAcrPIBandwidth;
  877. MC_UpcInfo.stTestParaInfo.uwCurrentLoopCoefM = cp_stControlPara.swAcrRaCoef;
  878. MC_UpcInfo.stTestParaInfo.uwFluxObsCoefM = cp_stControlPara.swObsFluxPIDampratio;
  879. MC_UpcInfo.stTestParaInfo.uwFluxObsBandWidthHz = cp_stControlPara.swObsFluxPICrossfreHz;
  880. MC_UpcInfo.stTestParaInfo.uwThetaObsPLLCoefM = cp_stControlPara.swObsSpdPLLM;
  881. MC_UpcInfo.stTestParaInfo.uwThetaObsPLLBandWidthHz = cp_stControlPara.swObsSpdPLLBandWidthHz;
  882. MC_UpcInfo.stTestParaInfo.uwPWMMaxDuty = cp_stControlPara.swPWMMaxDuty;
  883. MC_UpcInfo.stTestParaInfo.uwPWM7to5Duty = cp_stControlPara.swPWM7to5Duty;
  884. MC_UpcInfo.stTestParaInfo.uwPwrLimit = cp_stControlPara.swPwrLimitValWt;
  885. MC_UpcInfo.stTestParaInfo.uwPwrLimitError = cp_stControlPara.swPwrLimitErrWt;
  886. MC_UpcInfo.stTestParaInfo.uwPwrLimitKp = cp_stControlPara.swPwrLimitKpPu;
  887. MC_UpcInfo.stTestParaInfo.uwPwrLimitKi = cp_stControlPara.swPwrLimitKiPu;
  888. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB83A, (uint8_t *)&MC_UpcInfo.stTestParaInfo.RunModelSelect);
  889. break;
  890. }
  891. case 0x463C: //写入调试参数
  892. {
  893. memcpy(&MC_UpcInfo.stTestParaInfo.uwTestParaSaveFlg, Data, DataLength);
  894. // if (MC_UpcInfo.stTestParaInfo.uwSaveFlg == 1)
  895. // {
  896. cp_stFlg.ParaSaveEEFlg = TRUE;
  897. if(MC_UpcInfo.stTestParaInfo.RunModelSelect <= 3)
  898. {
  899. MC_UpcInfo.stTestParaInfo.uwSaveFlg = FALSE;
  900. }
  901. else
  902. {
  903. MC_UpcInfo.stTestParaInfo.uwSaveFlg = TRUE;
  904. }
  905. // }
  906. cp_stFlg.ParaUpdateFlg = TRUE;
  907. cp_stFlg.TestParaInfoUpdateFlg = TRUE;
  908. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  909. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  910. break;
  911. }
  912. case 0x472E://写入力矩传感器参数
  913. {
  914. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 30);
  915. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  916. {
  917. cp_stFlg.ParaSaveEEFlg = TRUE;
  918. }
  919. cp_stFlg.ParaUpdateFlg = TRUE;
  920. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  921. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  922. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  923. break;
  924. }
  925. case 0x4800: //读取储存标志
  926. {
  927. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB904, (uint8_t *)&MC_UpcInfo.stTestParaInfo.uwEEFirstDefaultSetFlg);
  928. break;
  929. }
  930. case 0x4906: //写入储存标志
  931. {
  932. memcpy(&MC_UpcInfo.stTestParaInfo.uwSaveFlg, Data, DataLength);
  933. if(MC_UpcInfo.stTestParaInfo.uwSaveFlg == 1)
  934. {
  935. cp_stFlg.ParaSaveEEFlg = TRUE;
  936. }
  937. cp_stFlg.ParaUpdateFlg = TRUE;
  938. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  939. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  940. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  941. break;
  942. }
  943. case 0x4A12: //内阻校准指令
  944. {
  945. memcpy(&MC_UpcInfo.stResistanceCalibInfo.uwSaveFlg, Data, DataLength);
  946. memcpy(&Syspara2.EepromMosPara.EEP_K50,&MC_UpcInfo.stResistanceCalibInfo.Coeff1,10 );
  947. MosResInside.blCalibFlag=TRUE;
  948. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  949. break;
  950. }
  951. case 0x4B00: //读取内阻校准参数
  952. {
  953. MC_UpcInfo.stWriteResistanceCalibInfo.MOSResA = Syspara2.EepromMosPara.EEP_MOSA.uwTEMP_RES1;
  954. MC_UpcInfo.stWriteResistanceCalibInfo.MOSResB = Syspara2.EepromMosPara.EEP_MOSB.uwTEMP_RES1;
  955. MC_UpcInfo.stWriteResistanceCalibInfo.MOSResC = Syspara2.EepromMosPara.EEP_MOSC.uwTEMP_RES1;
  956. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff1 = Syspara2.EepromMosPara.EEP_K50;
  957. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff2 = Syspara2.EepromMosPara.EEP_K75;
  958. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff3 = Syspara2.EepromMosPara.EEP_K100;
  959. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff4 = Syspara2.EepromMosPara.EEP_K125;
  960. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff5 = Syspara2.EepromMosPara.EEP_K150;
  961. MC_UpcInfo.stWriteResistanceCalibInfo.reserve1 = 0;
  962. MC_UpcInfo.stWriteResistanceCalibInfo.reserve2 = 0;
  963. MC_UpcInfo.stWriteResistanceCalibInfo.reserve3 = 0;
  964. MC_UpcInfo.stWriteResistanceCalibInfo.reserve4 = 0;
  965. MC_UpcInfo.stWriteResistanceCalibInfo.reserve5 = 0;
  966. MC_UpcInfo.stWriteResistanceCalibInfo.reserve6 = 0;
  967. MC_UpcInfo.stWriteResistanceCalibInfo.reserve7 = 0;
  968. MC_UpcInfo.stWriteResistanceCalibInfo.reserve8 = 0;
  969. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xBC20, (uint8_t *)&MC_UpcInfo.stWriteResistanceCalibInfo.MOSResA);
  970. break;
  971. }
  972. case 0x4C22: //写入内阻校准参数
  973. {
  974. // memcpy(&MC_UpcInfo.stWriteResistanceCalibInfo.uwSaveFlg, Data, DataLength);
  975. // if(MC_UpcInfo.stWriteResistanceCalibInfo.uwSaveFlg == 1)
  976. // {
  977. // cp_stFlg.ParaSaveEEFlg = TRUE;
  978. // }
  979. // cp_stFlg.ParaUpdateFlg = TRUE;
  980. // cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  981. // cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  982. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (uint8_t *)"ACK");
  983. break;
  984. }
  985. case 0x5200: //读取故障日志地址范围
  986. {
  987. ManageError_Address.ulErrAStart_Address= StartServerManageError_Address;
  988. ManageError_Address.ulErrEnd_Address=EndServerManageError_Address;
  989. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xC008, (uint8_t *)&ManageError_Address.ulErrAStart_Address);
  990. break;
  991. }
  992. default:
  993. break;
  994. }
  995. break;
  996. }
  997. //切换解析函数
  998. case 0x07FF: {
  999. switch (Cmd)
  1000. {
  1001. case 0x7702:
  1002. {
  1003. ucUartAnalyseID = Data[0];
  1004. // #if (UART_ID == 3)
  1005. // usart_reset(UART_RxBuff_Struct_OBC.usart_periph);
  1006. // hw_voInitUART1(9600);
  1007. // #endif
  1008. }
  1009. default:
  1010. break;
  1011. }
  1012. break;
  1013. }
  1014. default:
  1015. break;
  1016. }
  1017. }
  1018. UBYTE UART_ReadChar(USART_Buf_TypeDef * ptRx, UBYTE ucNum)
  1019. {
  1020. UBYTE ucData;
  1021. UWORD i;
  1022. i = ucNum;
  1023. if ((*ptRx).ucBufCnt >= ucNum)
  1024. {
  1025. i += (*ptRx).ucBufRdInde;
  1026. if (i >= (*ptRx).ucBufSize)
  1027. {
  1028. i -=((*ptRx).ucBufSize);
  1029. }
  1030. }
  1031. else
  1032. {
  1033. i=0;
  1034. }
  1035. ucData = *((*ptRx).pcBufAddr + i);
  1036. return ucData;
  1037. }
  1038. void UART_DelChar(USART_Buf_TypeDef * ptRx, UBYTE ucNum)
  1039. {
  1040. UWORD i;
  1041. if ((*ptRx).ucBufCnt >= ucNum)
  1042. {
  1043. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, FALSE);
  1044. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1045. (*ptRx).ucBufCnt -= ucNum;
  1046. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, TRUE);
  1047. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1048. i = ucNum;
  1049. i += (*ptRx).ucBufRdInde;
  1050. if (i >= (*ptRx).ucBufSize)
  1051. {
  1052. i -= (*ptRx).ucBufSize;
  1053. }
  1054. (*ptRx).ucBufRdInde = i;
  1055. }
  1056. else
  1057. {
  1058. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, FALSE);
  1059. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1060. i = (*ptRx).ucBufCnt;
  1061. (*ptRx).ucBufCnt = 0;
  1062. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, TRUE);
  1063. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1064. i += (*ptRx).ucBufRdInde;
  1065. if (i >= (*ptRx).ucBufSize)
  1066. {
  1067. i -= (*ptRx).ucBufSize;
  1068. }
  1069. (*ptRx).ucBufRdInde = i;
  1070. }
  1071. }
  1072. void UART_PutChar(USART_Buf_TypeDef * ptTx, UBYTE ucData)
  1073. {
  1074. while ((*ptTx).ucBufCnt == (*ptTx).ucBufSize);
  1075. // usart_interrupt_enable(ptTx->usart_periph, USART_TDBE_INT, FALSE);
  1076. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1077. if((*ptTx).ucBufCnt == 0)
  1078. {
  1079. // if(usart_flag_get(ptTx->usart_periph, USART_TDBE_FLAG) == SET) //check if transmit data register full or not
  1080. if(DL_UART_isTXFIFOEmpty(UART_HMI_INST) == TRUE)
  1081. {
  1082. // usart_data_transmit(ptTx->usart_periph, ucData);
  1083. // usart_interrupt_enable(ptTx->usart_periph, USART_TDBE_INT, TRUE);
  1084. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1085. DL_UART_Main_transmitData(UART_HMI_INST, ucData);
  1086. return;
  1087. }
  1088. }
  1089. *((*ptTx).pcBufAddr + (*ptTx).ucBufWrInde) = ucData;
  1090. if(++(*ptTx).ucBufWrInde == (*ptTx).ucBufSize)
  1091. {
  1092. (*ptTx).ucBufWrInde = 0;
  1093. }
  1094. ++(*ptTx).ucBufCnt;
  1095. // usart_interrupt_enable(ptTx->usart_periph, USART_TDBE_INT, TRUE);
  1096. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1097. }
  1098. void SendData(USART_Buf_TypeDef* ptUartTx, UWORD ID, UBYTE Mode, UWORD Command, UBYTE *Data)
  1099. {
  1100. if(ucCommType != 2)
  1101. {
  1102. ULONG CRC_Result = 0x00000000U;
  1103. UBYTE DataLength;
  1104. UBYTE CanSendData[255], CanSendData_CRC_Buf[255];
  1105. DataLength = (UBYTE)(Command & 0xFF);
  1106. CanSendData[0] = FRAME_BEGIN1;
  1107. CanSendData[1] = FRAME_BEGIN2;
  1108. CanSendData[2] = Mode;
  1109. CanSendData[3] = DataLength + 2;
  1110. CanSendData[4] = (UBYTE)((Command >> 8) & 0xFF);
  1111. CanSendData[5] = DataLength;
  1112. if((DataLength)> (255 - 6))
  1113. {
  1114. DataLength = 255 - 6;
  1115. }
  1116. memcpy(CanSendData + 6, Data, DataLength);
  1117. CanSendData_CRC_Buf[0] = FRAME_BEGIN1;
  1118. CanSendData_CRC_Buf[1] = FRAME_BEGIN2;
  1119. CanSendData_CRC_Buf[2] = (UBYTE)(ID >> 8);
  1120. CanSendData_CRC_Buf[3] = (UBYTE)(ID & 0xFF);
  1121. if((DataLength + 4 )> (255 - 4))
  1122. {
  1123. DataLength = 251 - 4 - 4;
  1124. }
  1125. memcpy(CanSendData_CRC_Buf + 4, CanSendData + 2, DataLength + 4);
  1126. CRC_Result = CRC32_Calculate(CanSendData_CRC_Buf, DataLength + 8); //帧头2bytes + ID 2bytes + 模式 1byte + 命令段长度 1byte + 命令字 2bytes
  1127. CanSendData[6 + DataLength] = (UBYTE)((CRC_Result >> 24) & 0xFF);
  1128. CanSendData[7 + DataLength] = (UBYTE)((CRC_Result >> 16) & 0xFF);
  1129. CanSendData[8 + DataLength] = (UBYTE)((CRC_Result >> 8) & 0xFF);
  1130. CanSendData[9 + DataLength] = (UBYTE)(CRC_Result & 0xFF);
  1131. CanSendData[10 + DataLength] = FRAME_END;
  1132. CAN_SendData(ID, ID_MODE_STANDARD, CanSendData, DataLength + 11);
  1133. }
  1134. if(ucCommType != 1)
  1135. {
  1136. UBYTE i = 0;
  1137. UBYTE len = 0;
  1138. UWORD checksum = 0;
  1139. UBYTE databuf[256] = {0};
  1140. len = (UBYTE)((Command & 0xff) + 4);
  1141. if(len > 247)
  1142. {
  1143. len = 247;
  1144. }
  1145. databuf[0] = UARTFRAME_BEGIN;
  1146. databuf[1] = UARTADDR_CDL;
  1147. databuf[2] = Mode;
  1148. databuf[3] = len;
  1149. databuf[4] = (UBYTE)((ID >> 8) & 0xFF);
  1150. databuf[5] = (UBYTE)(ID & 0xFF);
  1151. databuf[6] = (UBYTE)((Command >> 8) & 0xFF);
  1152. databuf[7] = (UBYTE)(Command & 0xFF);
  1153. for(i=0; i<(len-4); i++)
  1154. {
  1155. databuf[8+i] = Data[i];
  1156. }
  1157. for(i=1; i<(len+4); i++)
  1158. {
  1159. checksum = (UWORD)(databuf[i] + checksum);
  1160. }
  1161. databuf[4+len] = (UBYTE)checksum;
  1162. databuf[5+len] = (UBYTE)(checksum>>8);
  1163. databuf[6+len] = UARTFRAME_END1;
  1164. databuf[7+len] = UARTFRAME_END2;
  1165. for(i=0; i<(len+8); i++)
  1166. {
  1167. UART_PutChar(ptUartTx, databuf[i]);
  1168. }
  1169. }
  1170. }
  1171. void KM5S_OBCSetPara(UBYTE* Data)
  1172. {
  1173. UWORD tmpdata;
  1174. /*数据获取*/
  1175. if((Data[4] & 0x40) == 0x40) //助力方向
  1176. {
  1177. stOBC_SetInfo.AssistDir = Assist_Backward;
  1178. }
  1179. else
  1180. {
  1181. stOBC_SetInfo.AssistDir = Assist_Forward;
  1182. }
  1183. stOBC_SetInfo.ucAssistedMagnetSteel = (Data[4] & 0x3F);//助力过几个磁钢
  1184. stOBC_SetInfo.ucAssistRatio = Data[5];
  1185. stOBC_SetInfo.ucThrottleGt = ((Data[6] & 0x80)>>7);
  1186. stOBC_SetInfo.ucThrottleLimited = ((Data[6] & 0x40)>>6);
  1187. stOBC_SetInfo.ucSlowStartMode = ((Data[6] & 0x30)>>4);
  1188. stOBC_SetInfo.ucSpeedSensorPulses = (Data[6] & 0x0F);
  1189. if((Data[7] & 0x80) == 0x80)
  1190. {
  1191. stOBC_SetInfo.swUnderVoltageBias = (SWORD)(-1 * (Data[7] & 0x7F));//0.1V
  1192. }
  1193. else
  1194. {
  1195. stOBC_SetInfo.swUnderVoltageBias = (SWORD)(1 * (Data[7] & 0x7F));
  1196. }
  1197. if((Data[8] & 0xC0) == 0xC0)
  1198. {
  1199. stOBC_SetInfo.uwUnderVoltageBase = 420;//0.1V
  1200. }
  1201. else if((Data[8] & 0xC0) == 0x40)
  1202. {
  1203. stOBC_SetInfo.uwUnderVoltageBase = 210;
  1204. }
  1205. else
  1206. {
  1207. stOBC_SetInfo.uwUnderVoltageBase = 315;
  1208. }
  1209. stOBC_SetInfo.ucCurrentLimiation = (Data[8] & 0x3F);//0.5A
  1210. stOBC_SetInfo.ucShakingCode = Data[9];
  1211. stOBC_SetInfo.ucSpeedLimiation = ((Data[10] & 0xF8)>>3) + 10;//km/h
  1212. stOBC_SetInfo.ucWheelDiameterCode = (Data[10] & 0x07);
  1213. /*低压保护阈值更新*/
  1214. if(MC_UpcInfo.stMContorlInfo.uwAlamUVolV != (UWORD)(stOBC_SetInfo.uwUnderVoltageBase + stOBC_SetInfo.swUnderVoltageBias))
  1215. {
  1216. MC_UpcInfo.stMContorlInfo.uwAlamUVolV = (UWORD)(stOBC_SetInfo.uwUnderVoltageBase + stOBC_SetInfo.swUnderVoltageBias);
  1217. MC_UpcInfo.stMContorlInfo.uwSaveFlg = 1;
  1218. cp_stFlg.ParaSaveEEFlg = TRUE;
  1219. cp_stFlg.ParaUpdateFlg = TRUE;
  1220. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  1221. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1222. }
  1223. /*功率限幅阈值更新*/
  1224. #if (IPM_VOLTAGE_SEL == IPM_VOLTAGE_48V)
  1225. UWORD uwVolt = 480;
  1226. #elif (IPM_VOLTAGE_SEL == IPM_VOLTAGE_36V)
  1227. UWORD uwVolt = 360;
  1228. #else
  1229. UWORD uwVolt = 360;
  1230. #endif
  1231. if(MC_UpcInfo.stTestParaInfo.uwPwrLimit != ((stOBC_SetInfo.ucCurrentLimiation*uwVolt>>1) + 500))
  1232. {
  1233. MC_UpcInfo.stTestParaInfo.uwPwrLimit = (UWORD)((stOBC_SetInfo.ucCurrentLimiation*uwVolt>>1) + 500);
  1234. MC_UpcInfo.stTestParaInfo.uwSaveFlg = 1;
  1235. cp_stFlg.ParaSaveEEFlg = TRUE;
  1236. cp_stFlg.ParaUpdateFlg = TRUE;
  1237. cp_stFlg.TestParaInfoUpdateFlg = TRUE;
  1238. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1239. }
  1240. /*限速阈值更新*/
  1241. if(MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart != stOBC_SetInfo.ucSpeedLimiation)
  1242. {
  1243. MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart = stOBC_SetInfo.ucSpeedLimiation;
  1244. MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStop = stOBC_SetInfo.ucSpeedLimiation + 2;
  1245. MC_UpcInfo.stBikeInfo.uwThrottleMaxSpdKmH = stOBC_SetInfo.ucSpeedLimiation;
  1246. MC_UpcInfo.stBikeInfo.uwSaveFlg = 1;
  1247. MC_UpcInfo.stAssistInfo.uwSaveFlg = 1;
  1248. cp_stFlg.ParaSaveEEFlg = TRUE;
  1249. cp_stFlg.ParaUpdateFlg = TRUE;
  1250. cp_stFlg.ParaAInfoUpdateFlg = TRUE;
  1251. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  1252. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1253. }
  1254. /*轮径更新*/
  1255. if(stOBC_SetInfo.ucWheelDiameterCode <= 5)
  1256. {
  1257. tmpdata = (stOBC_SetInfo.ucWheelDiameterCode*2 + 16) * 8; //3.14*2.54=7.9756=8
  1258. }
  1259. else if(stOBC_SetInfo.ucWheelDiameterCode == 6)
  1260. {
  1261. tmpdata = 219; //3.14*700mm=2198mm
  1262. }
  1263. else
  1264. {
  1265. tmpdata = 223; //3.14*2.54*28
  1266. }
  1267. if(MC_UpcInfo.stBikeInfo.uwWheelPerimeter != tmpdata)
  1268. {
  1269. MC_UpcInfo.stBikeInfo.uwWheelPerimeter = tmpdata;
  1270. MC_UpcInfo.stBikeInfo.uwSaveFlg = 1;
  1271. cp_stFlg.ParaSaveEEFlg = TRUE;
  1272. cp_stFlg.ParaUpdateFlg = TRUE;
  1273. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  1274. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1275. }
  1276. }
  1277. void KM5S_SendData_OBC(USART_Buf_TypeDef* ptUartTx, UBYTE Mode, UBYTE Length, UBYTE checknum)
  1278. {
  1279. UBYTE i = 0;
  1280. UWORD checksum = 0;
  1281. UBYTE databuf[13] = {0};
  1282. UBYTE tmp = 0;
  1283. if(MC_RunInfo.BusVoltage > 63000)
  1284. {
  1285. tmp = 0x3F; //max=63V
  1286. }
  1287. else
  1288. {
  1289. tmp = (UBYTE)((MC_RunInfo.BusVoltage/1000)&0x3F);
  1290. }
  1291. stMC2OBC_RRunInfo.Stage = (UBYTE)(stOBC_RunInfo.ucLowPower << 7) //欠压,MC_ErrorCode.ERROR_Bit.Protect_UnderVoltage
  1292. | (bikeCruise.CruiseMode << 6) //巡航,由控制器判定
  1293. | tmp;
  1294. stMC2OBC_RRunInfo.Current = (UBYTE)(abs(MC_RunInfo.BusCurrent/1000)*3);//电流
  1295. if(bikespeed_stFreGetOut.uwLPFFrequencyPu == 0)
  1296. {
  1297. stMC2OBC_RRunInfo.Speed = 0;
  1298. }
  1299. else
  1300. {
  1301. stMC2OBC_RRunInfo.Speed = (UWORD)((SQWORD)(1000 << 20) / bikespeed_stFreGetOut.uwLPFFrequencyPu / FBASE); //车轮转动一圈时间,ms
  1302. }
  1303. //故障码
  1304. if(1 == MC_ErrorCode.ERROR_Bit.Protect_OverCurrent)
  1305. {
  1306. stMC2OBC_RRunInfo.ErrorCode = 0x21;//电流异常
  1307. }
  1308. else if(1 == MC_ErrorCode.ERROR_Bit.Fault_Throttle)
  1309. {
  1310. stMC2OBC_RRunInfo.ErrorCode = 0x22;//转把异常
  1311. }
  1312. else if(1 == MC_ErrorCode.ERROR_Bit.Fault_PhaseLine)
  1313. {
  1314. stMC2OBC_RRunInfo.ErrorCode = 0x23;//电机缺相
  1315. }
  1316. else if(1 == MC_ErrorCode.ERROR_Bit.Fault_HallSensor)
  1317. {
  1318. stMC2OBC_RRunInfo.ErrorCode = 0x24;//电机霍尔异常
  1319. }
  1320. /*else if(0)
  1321. {
  1322. stMC2OBC_RRunInfo.ErrorCode = 0x25;//刹车异常
  1323. }*/
  1324. else
  1325. {
  1326. stMC2OBC_RRunInfo.ErrorCode = 0x00;
  1327. }
  1328. databuf[0] = UARTFRAME_BEGIN;
  1329. databuf[1] = UARTADDR_OBC;
  1330. databuf[2] = Mode;
  1331. databuf[3] = Length;
  1332. databuf[4] = stMC2OBC_RRunInfo.Stage;
  1333. databuf[5] = stMC2OBC_RRunInfo.Current;
  1334. databuf[6] = (UBYTE)((stMC2OBC_RRunInfo.Speed &0xFF00)>>8);
  1335. databuf[7] = (UBYTE)(stMC2OBC_RRunInfo.Speed &0xFF);
  1336. if(Mode == 0x53)
  1337. {
  1338. if(checknum > 63)
  1339. {
  1340. checknum = 63;
  1341. }
  1342. databuf[7] = ucOBC_password[checknum];//握手查表
  1343. }
  1344. databuf[8] = stMC2OBC_RRunInfo.ErrorCode;
  1345. for(i=1; i<(Length+4); i++)
  1346. {
  1347. checksum = (UWORD)(databuf[i] + checksum);
  1348. }
  1349. databuf[4+Length] = (UBYTE)checksum;
  1350. databuf[5+Length] = (UBYTE)(checksum>>8);
  1351. databuf[6+Length] = UARTFRAME_END1;
  1352. databuf[7+Length] = UARTFRAME_END2;
  1353. for(i=0; i<(Length+8); i++)
  1354. {
  1355. UART_PutChar(ptUartTx, databuf[i]);
  1356. }
  1357. }
  1358. /*******************************************************************************
  1359. * Function:void USARTx_Rx_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct)
  1360. * Discrible:
  1361. * Input:
  1362. * Output:
  1363. * Return:
  1364. * Others:
  1365. * date version author record
  1366. * -----------------------------------------------
  1367. * 20151107 V1.0 VINCENT Create
  1368. *********************************************************************************/
  1369. //void USARTx_Rx_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct)
  1370. //{
  1371. // UBYTE ucData;
  1372. //
  1373. //// if(USARTx_RxBuf_Struct->usart_periph->ctrl1_bit.rdbfien != RESET) //接收中斷
  1374. // if((DL_UART_Main_getPendingInterrupt(UART_HMI_INST))==DL_UART_MAIN_IIDX_RX)
  1375. // {
  1376. //// if(RESET != usart_flag_get(USARTx_RxBuf_Struct->usart_periph, USART_RDBF_FLAG))
  1377. // {
  1378. //// ucData = (UBYTE)usart_data_receive(USARTx_RxBuf_Struct->usart_periph);
  1379. // ucData = DL_UART_Main_receiveDataBlocking(UART_HMI_INST);
  1380. //
  1381. // {
  1382. // *((* USARTx_RxBuf_Struct).pcBufAddr + (* USARTx_RxBuf_Struct).ucBufWrInde) = ucData;
  1383. // if(++(* USARTx_RxBuf_Struct).ucBufWrInde >= (* USARTx_RxBuf_Struct).ucBufSize)
  1384. // {
  1385. // (* USARTx_RxBuf_Struct).ucBufWrInde = 0;
  1386. // }
  1387. // if(++(* USARTx_RxBuf_Struct).ucBufCnt > (* USARTx_RxBuf_Struct).ucBufSize)
  1388. // {
  1389. // (* USARTx_RxBuf_Struct).ucBufCnt = (* USARTx_RxBuf_Struct).ucBufSize;
  1390. // (* USARTx_RxBuf_Struct).ucBufOvf = 1;
  1391. // }
  1392. // }
  1393. // }
  1394. // }
  1395. //}
  1396. //
  1397. //void USARTx_Tx_IRQ(USART_Buf_TypeDef *USARTx_TxBuf_Struct)
  1398. //{
  1399. //// if(USARTx_TxBuf_Struct->usart_periph->ctrl1_bit.tdbeien != RESET)
  1400. // if( (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))==DL_UART_MAIN_IIDX_EOT_DONE)
  1401. // // if( (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))== DL_UART_MAIN_IIDX_EOT_DONE)
  1402. // {
  1403. //// if(RESET != usart_flag_get(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_FLAG))
  1404. // // if(DL_UART_isTXFIFOEmpty(UART_HMI_INST) == TRUE)
  1405. // {
  1406. //
  1407. // if((* USARTx_TxBuf_Struct).ucBufCnt)
  1408. // {
  1409. // --(* USARTx_TxBuf_Struct).ucBufCnt;
  1410. // /* write one byte to the transmit data register */
  1411. //// usart_data_transmit(USARTx_TxBuf_Struct->usart_periph, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1412. // DL_UART_Main_transmitData(UART_HMI_INST, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1413. // if(++(* USARTx_TxBuf_Struct).ucBufRdInde >= (* USARTx_TxBuf_Struct).ucBufSize)
  1414. // {
  1415. // (* USARTx_TxBuf_Struct).ucBufRdInde = 0;
  1416. // }
  1417. // }
  1418. // else
  1419. // {
  1420. // /* Disable the UART Transmit Data Register Empty Interrupt */
  1421. //// usart_interrupt_enable(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_INT, FALSE);
  1422. // DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1423. // }
  1424. // }
  1425. // }
  1426. //}
  1427. unsigned uartcnt=0;
  1428. void USARTx_RxTX_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct,USART_Buf_TypeDef *USARTx_TxBuf_Struct,USART_FrameBuf_TypeDef *USART_RxFrameBuf_Struct)
  1429. {
  1430. UBYTE ucData;
  1431. switch (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))
  1432. {
  1433. case DL_UART_MAIN_IIDX_RX:
  1434. ucData = (UBYTE) DL_UART_Main_receiveDataBlocking(UART_HMI_INST);
  1435. USARTx_RxBuf_Struct->ul_UartComTimeOutCount = 0;
  1436. USART_RxFrameBuf_Struct->uwDataCount[USART_RxFrameBuf_Struct->ucBufWrIndex]++;
  1437. //if(((USARTx_RxBuf_Struct->ptUartHandel->Instance->SR) & 0x0000) == 0)
  1438. {
  1439. *((* USARTx_RxBuf_Struct).pcBufAddr + (* USARTx_RxBuf_Struct).ucBufWrInde) = ucData;
  1440. if(++(* USARTx_RxBuf_Struct).ucBufWrInde >= (* USARTx_RxBuf_Struct).ucBufSize)
  1441. {
  1442. (* USARTx_RxBuf_Struct).ucBufWrInde = 0;
  1443. }
  1444. if(++(* USARTx_RxBuf_Struct).ucBufCnt > (* USARTx_RxBuf_Struct).ucBufSize)
  1445. {
  1446. (* USARTx_RxBuf_Struct).ucBufCnt = (* USARTx_RxBuf_Struct).ucBufSize;
  1447. (* USARTx_RxBuf_Struct).ucBufOvf = 1;
  1448. }
  1449. }
  1450. break;
  1451. case DL_UART_MAIN_IIDX_EOT_DONE:
  1452. uartcnt++;
  1453. if((* USARTx_TxBuf_Struct).ucBufCnt)
  1454. {
  1455. --(* USARTx_TxBuf_Struct).ucBufCnt;
  1456. /* write one byte to the transmit data register */
  1457. // usart_data_transmit(USARTx_TxBuf_Struct->usart_periph, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1458. DL_UART_Main_transmitData(UART_HMI_INST, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1459. if(++(* USARTx_TxBuf_Struct).ucBufRdInde >= (* USARTx_TxBuf_Struct).ucBufSize)
  1460. {
  1461. (* USARTx_TxBuf_Struct).ucBufRdInde = 0;
  1462. }
  1463. }
  1464. else
  1465. {
  1466. /* Disable the UART Transmit Data Register Empty Interrupt */
  1467. // usart_interrupt_enable(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_INT, FALSE);
  1468. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1469. }
  1470. //-----------
  1471. break;
  1472. default:
  1473. break;
  1474. }
  1475. }
  1476. //void USARTx_RxTX_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct,USART_Buf_TypeDef *USARTx_TxBuf_Struct)
  1477. //{
  1478. // static unsigned uartcnt=0;
  1479. // UBYTE ucData;
  1480. // switch (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))
  1481. // {
  1482. // case DL_UART_MAIN_IIDX_RX:
  1483. // ucData = DL_UART_Main_receiveDataBlocking(UART_HMI_INST);
  1484. //
  1485. // *((* USARTx_RxBuf_Struct).pcBufAddr + (* USARTx_RxBuf_Struct).ucBufWrInde) = ucData;
  1486. // if(++(* USARTx_RxBuf_Struct).ucBufWrInde >= (* USARTx_RxBuf_Struct).ucBufSize)
  1487. // {
  1488. // (* USARTx_RxBuf_Struct).ucBufWrInde = 0;
  1489. // }
  1490. // if(++(* USARTx_RxBuf_Struct).ucBufCnt > (* USARTx_RxBuf_Struct).ucBufSize)
  1491. // {
  1492. // (* USARTx_RxBuf_Struct).ucBufCnt = (* USARTx_RxBuf_Struct).ucBufSize;
  1493. // (* USARTx_RxBuf_Struct).ucBufOvf = 1;
  1494. // }
  1495. //
  1496. // break;
  1497. // case DL_UART_MAIN_IIDX_EOT_DONE:
  1498. //
  1499. // uartcnt++;
  1500. // if((* USARTx_TxBuf_Struct).ucBufCnt)
  1501. // {
  1502. // --(* USARTx_TxBuf_Struct).ucBufCnt;
  1503. // /* write one byte to the transmit data register */
  1504. // // usart_data_transmit(USARTx_TxBuf_Struct->usart_periph, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1505. // DL_UART_Main_transmitData(UART_HMI_INST, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1506. // if(++(* USARTx_TxBuf_Struct).ucBufRdInde >= (* USARTx_TxBuf_Struct).ucBufSize)
  1507. // {
  1508. // (* USARTx_TxBuf_Struct).ucBufRdInde = 0;
  1509. // }
  1510. // }
  1511. // else
  1512. // {
  1513. // /* Disable the UART Transmit Data Register Empty Interrupt */
  1514. // // usart_interrupt_enable(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_INT, FALSE);
  1515. // DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1516. // }
  1517. // break;
  1518. // default:
  1519. // break;
  1520. // }
  1521. //}
  1522. /************************ (C) END OF FILE *********************************/