usart.c 77 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878
  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 "uart_TORG4BBSensor.h"
  57. #include "hwsetup.h"
  58. #include "UserGpio_Config.h"
  59. #include "FuncLayerAPI.h"
  60. //#include "api.h"
  61. //#include "board_config.h"
  62. /* Private variables ---------------接收缓存区------------------------------------------*/
  63. UBYTE UART_RxBuff_OBC[UART_BUFF_SIZE];
  64. USART_Buf_TypeDef UART_RxBuff_Struct_OBC = {UART_BUFF_SIZE,0,0,0,0,UART_RxBuff_OBC,0,0};
  65. UBYTE UART_TxBuff_OBC[UART_BUFF_SIZE];
  66. USART_Buf_TypeDef UART_TxBuff_Struct_OBC = {UART_BUFF_SIZE,0,0,0,0,UART_TxBuff_OBC,0,0};
  67. UBYTE UART_RxBuff_BMS[UART_BUFF_SIZE];
  68. USART_Buf_TypeDef UART_RxBuff_Struct_BMS = {UART_BUFF_SIZE,0,0,0,0,UART_RxBuff_BMS,0,0};
  69. UBYTE UART_TxBuff_BMS[UART_BUFF_SIZE];
  70. USART_Buf_TypeDef UART_TxBuff_Struct_BMS = {UART_BUFF_SIZE,0,0,0,0,UART_TxBuff_BMS,0,0};
  71. USART_FrameBuf_TypeDef stUSART_FrameBuf_OBC;
  72. USART_FrameBuf_TypeDef stUSART_FrameBuf_BMS;
  73. OBC_RunInfo_Struct_t stOBC_RunInfo;
  74. OBC_SetInfo_Struct_t stOBC_SetInfo;
  75. MC2OBC_RunInfo_Struct_t stMC2OBC_RRunInfo;
  76. UBYTE ucUartAnalyseID = 0;
  77. UBYTE ucCommType = 0;//0-Both,1-CAN,2-UART
  78. /* Private variables ---------------------------------------------------------*/
  79. const UBYTE ucOBC_password[64]=
  80. {137,159,134,249,88,11,250,61,33,150,3,193,118,141,209,94,
  81. 226,68,146,158,145,127,216,62,116,230,101,211,251,54,229,247,
  82. 20,222,59,63,35,252,142,238,23,197,84,77,147,173,210,57,
  83. 142,223,157,97,36,160,229,237,75,80,37,113,154,88,23,120};
  84. /* Private function prototypes -----------------------------------------------*/
  85. // CAN数据解任务,定时执行
  86. void UsartRx_Process(USART_Buf_TypeDef *USARTx_RxBuf_Struct, USART_Buf_TypeDef *USARTx_TxBuf_Struct, USART_FrameBuf_TypeDef *USART_RxFrameBuf_Struct)
  87. {
  88. if((USARTx_RxBuf_Struct->ul_UartComTimeOutCount > FRAMETIMEOUT_Count) && (USART_RxFrameBuf_Struct->uwDataCount[USART_RxFrameBuf_Struct->ucBufWrIndex] > 0))
  89. {
  90. // usart_interrupt_enable(USARTx_RxBuf_Struct->usart_periph, USART_RDBF_INT, FALSE);
  91. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  92. //(*USART_FrameBuf_Struct).uartframebuf[(*USART_FrameBuf_Struct).ucBufWrIndex].uwDataCount = 0;
  93. USART_RxFrameBuf_Struct->ucBufWrIndex++;
  94. if(USART_RxFrameBuf_Struct->ucBufWrIndex >= FRAME_SIZE)
  95. {
  96. USART_RxFrameBuf_Struct->ucBufWrIndex = 0;
  97. }
  98. // usart_interrupt_enable(USARTx_RxBuf_Struct->usart_periph, USART_RDBF_INT, TRUE);
  99. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  100. USART_RxFrameBuf_Struct->uwFramecount++;
  101. USARTx_RxBuf_Struct->ul_UartComTimeOutCount = 0;
  102. }
  103. if(USART_RxFrameBuf_Struct->uwFramecount > 0)
  104. {
  105. UBYTE data[255];
  106. UBYTE datacount;
  107. datacount = USART_RxFrameBuf_Struct->uwDataCount[USART_RxFrameBuf_Struct->ucBufRdIndex];
  108. for(int i=0;i<datacount;i++)
  109. {
  110. data[i] = UART_ReadChar(USARTx_RxBuf_Struct,i);
  111. }
  112. UART_DelChar(USARTx_RxBuf_Struct,datacount);
  113. //UART_PutChar(&UART_TxBuff_Struct_OBC,datacount);
  114. /*解析1*/
  115. KM5S_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  116. /*解析2*/
  117. Lidian2_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  118. GNZH_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  119. #if (UART_ID == 3)
  120. Bafang_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  121. #endif
  122. Lanfeng_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  123. J_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  124. Lanfeng9_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  125. TORG4BB_USART_RxData_Process(USARTx_TxBuf_Struct, data, datacount);
  126. /*clear*/
  127. if(USARTx_RxBuf_Struct->ucBufRdInde!=USARTx_RxBuf_Struct->ucBufWrInde)
  128. USARTx_RxBuf_Struct->ucBufRdInde=USARTx_RxBuf_Struct->ucBufWrInde;
  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. UBYTE DataLength;
  306. DataLength = (UBYTE)(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, (UBYTE *)"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, (UBYTE *)"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, (UBYTE *)&MC_RunInfo.BikeSpeed);
  356. ulOBC_ComTimeOutCount = cp_ulSystickCnt;
  357. break;
  358. }
  359. case 0x3105: {
  360. if (power_stPowStateOut.powerstate == POWER_ON_END)
  361. {
  362. SendData(ptUartTx,ID_MC_BC, MODE_REPORT, 0x1305, (UBYTE *)"READY");
  363. }
  364. break;
  365. }
  366. case 0x3300: // OBC设置用户参数
  367. {
  368. OBC_SetCustomPara.uwWheelPerimeter = ass_ParaCong.uwWheelPerimeter;
  369. OBC_SetCustomPara.StartUpMod = ass_ParaCong.uwStartMode;
  370. OBC_SetCustomPara.BikeSpeedLimit = ass_ParaSet.uwAssistLimitBikeSpdStart;
  371. OBC_SetCustomPara.DeltDiameter = ass_ParaCong.swDeltPerimeter;
  372. OBC_SetCustomPara.AssistMod = ass_ParaSet.uwAsssistSelectNum;
  373. OBC_SetCustomPara.AutoPowerOffTime = ass_ParaCong.uwAutoPowerOffTime;
  374. OBC_SetCustomPara.scDeltaBikeSpeedLimit = (SBYTE)ass_ParaCong.swDeltaBikeSpeedLimit;
  375. OBC_SetCustomPara.ubControlFunCruise=(UBYTE)cp_stControlPara.uwControlFunEN;//巡航使能位
  376. SendData(ptUartTx, ID_MC_TO_PBU, MODE_REPORT, 0x5408, (UBYTE *)&OBC_SetCustomPara.uwWheelPerimeter);
  377. break;
  378. }
  379. case 0x3408: // OBC设置用户参数
  380. {
  381. OBC_SetCustomPara.DeltDiameter = Data[0];
  382. OBC_SetCustomPara.StartUpMod = Data[1];
  383. OBC_SetCustomPara.AssistMod = Data[2];
  384. OBC_SetCustomPara.AutoPowerOffTime = Data[3];
  385. if(OBC_SetCustomPara.DeltDiameter > 10)
  386. {
  387. OBC_SetCustomPara.DeltDiameter = 10;
  388. }
  389. else if(OBC_SetCustomPara.DeltDiameter < -10)
  390. {
  391. OBC_SetCustomPara.DeltDiameter = -10;
  392. }
  393. else
  394. {
  395. //do nothing
  396. }
  397. OBC_SetCustomPara.scDeltaBikeSpeedLimit = (SBYTE)Data[4];
  398. if(OBC_SetCustomPara.scDeltaBikeSpeedLimit > 0)
  399. {
  400. OBC_SetCustomPara.scDeltaBikeSpeedLimit = 0;
  401. }
  402. else if(OBC_SetCustomPara.scDeltaBikeSpeedLimit < (-ass_ParaSet.uwAssistLimitBikeSpdStart))
  403. {
  404. OBC_SetCustomPara.scDeltaBikeSpeedLimit = (-ass_ParaSet.uwAssistLimitBikeSpdStart);
  405. }
  406. else
  407. {
  408. //do nothing
  409. }
  410. OBC_ControlFUN.ubControlFunCruise= Data[5]; //控制器功能
  411. ass_ParaCong.swDeltPerimeter = OBC_SetCustomPara.DeltDiameter;
  412. ass_ParaCong.uwStartMode = OBC_SetCustomPara.StartUpMod;
  413. ass_ParaSet.uwAsssistSelectNum = OBC_SetCustomPara.AssistMod;
  414. ass_ParaCong.uwAutoPowerOffTime &= ~0x00FF;
  415. ass_ParaCong.uwAutoPowerOffTime |= OBC_SetCustomPara.AutoPowerOffTime;
  416. ass_ParaCong.swDeltaBikeSpeedLimit = (SWORD)OBC_SetCustomPara.scDeltaBikeSpeedLimit;
  417. cp_stControlPara.uwControlFunEN &=0xff00;
  418. cp_stControlPara.uwControlFunEN |=OBC_ControlFUN.ubControlFunCruise; //
  419. MC_UpcInfo.stBikeInfo.uwSaveFlg = TRUE;
  420. MC_UpcInfo.stBikeInfo.swWheelSizeAdjust = OBC_SetCustomPara.DeltDiameter;
  421. MC_UpcInfo.stBikeInfo.uwStartMode = OBC_SetCustomPara.StartUpMod;
  422. MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime = ass_ParaCong.uwAutoPowerOffTime;
  423. MC_UpcInfo.stBikeInfo2.uwSaveFlg = TRUE;
  424. MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit = (SWORD)OBC_SetCustomPara.scDeltaBikeSpeedLimit;
  425. MC_UpcInfo.stMContorlInfo.uwControlFunEN &=0xff00;
  426. MC_UpcInfo.stMContorlInfo.uwControlFunEN |=OBC_ControlFUN.ubControlFunCruise;//巡航
  427. cp_stFlg.ParaUpdateFlg = TRUE;
  428. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  429. cp_stFlg.ParaBikeInfo2UpdateFlg = TRUE;
  430. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  431. MC_UpcInfo.stMContorlInfo.uwSaveFlg=TRUE;
  432. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  433. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  434. if(( power_stPowStateOut.powerstate != POWER_OFF)&&( power_stPowStateOut.powerstate != POWER_OFF_END))
  435. {
  436. cp_stFlg.ParaSaveEEFlg = TRUE;
  437. }
  438. SendData(ptUartTx, ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  439. break;
  440. }
  441. case 0x3500: //查询骑行历史
  442. {
  443. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1510, (UBYTE *)&MC_RideLog.ODO_Km);
  444. break;
  445. }
  446. case 0x3605: // OBC清除TRIP信息
  447. {
  448. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  449. {
  450. MC_RideLog.TRIP_Km = 0;
  451. MC_RideLog.TRIP_Time = 0;
  452. SendData(ptUartTx, ID_MC_TO_PBU, MODE_REPORT, 0x5303, (UBYTE *)"ACK");
  453. MC_RunInfo.Ride_Km = 0;
  454. MC_RunInfo.Ride_Time = 0;
  455. cp_stHistoryPara.ulTripSum=0;
  456. cp_stHistoryPara.ulTripSumTime=0;
  457. cp_stBikeRunInfoPara.ulRiTirpTime=0;
  458. }
  459. break;
  460. }
  461. case 0x3900: //返回电机版本信息
  462. {
  463. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  464. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE *)Firmware_Special);
  465. break;
  466. }
  467. case 0x3A02: //OBC按键状态
  468. {
  469. OBC_ButtonStatus.Reserver = Data[0];
  470. OBC_ButtonStatus.ButtonStatu.KeyStatus = Data[1];
  471. OBC_ButtonStatus.ulButtonSetTimeCnt = cp_ulSystickCnt;
  472. OBC_ButtonStatus.blOBCbuttonPress = TRUE;
  473. break;
  474. }
  475. case 0x4300: //返回骑行参数
  476. {
  477. SendData(ptUartTx,ID_MC_TO_CDL, MODE_REPORT, 0xBC20, (UBYTE *)&MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1);
  478. break;
  479. }
  480. case 0x4420: //仪表修改骑行参数
  481. {
  482. memcpy((UBYTE*)&MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1, Data, DataLength);
  483. MC_UpcInfo.stRideParaInfo.uwSaveFlg = 1;
  484. cp_stFlg.ParaUpdateFlg = TRUE;
  485. cp_stFlg.ParaRideInfoUpdateFlg = TRUE;
  486. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  487. cp_stFlg.ParaSaveEEFlg = TRUE;
  488. SendData(ptUartTx,ID_MC_TO_CDL, MODE_REPORT, 0x5303, (UBYTE*)"ACK");
  489. break;
  490. }
  491. default:
  492. break;
  493. }
  494. break;
  495. }
  496. //处理上位机发送的指令
  497. case ID_CDL_BC:
  498. case ID_CDL_TO_MC: {
  499. switch (Cmd)
  500. {
  501. case 0xF000: // 上位机握手指令 返回应答指令
  502. {
  503. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xF000, (UBYTE *)0);
  504. break;
  505. }
  506. case 0x1200: //查询电机版本信息
  507. {
  508. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1240, (UBYTE *)MC_VerInfo.Mode);
  509. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1720, (UBYTE *)Firmware_Special);
  510. break;
  511. }
  512. case 0x1300: //查询自定义字符串1
  513. {
  514. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA610, (UBYTE *)MC_RsASSCII.CustomASCII1);
  515. break;
  516. }
  517. case 0x1410: //写入自定义字符串1
  518. {
  519. memcpy(MC_RsASSCII.CustomASCII1, Data, DataLength);
  520. //执行存储操作
  521. memcpy( Syspara2.flash_stPara.ubRsASSCII.CustomASCII1, MC_RsASSCII.CustomASCII1, sizeof(MC_RsASSCII.CustomASCII1));
  522. //...
  523. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  524. break;
  525. }
  526. case 0x1500: //查询自定义字符串2
  527. {
  528. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA710, (UBYTE *)MC_RsASSCII.CustomASCII2);
  529. break;
  530. }
  531. case 0x1610: //写入自定义字符串2
  532. {
  533. memcpy(MC_RsASSCII.CustomASCII2, Data, DataLength);
  534. //执行存储操作
  535. memcpy(Syspara2.flash_stPara.ubRsASSCII.CustomASCII2, MC_RsASSCII.CustomASCII2, sizeof(MC_RsASSCII.CustomASCII2));
  536. //...
  537. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  538. break;
  539. }
  540. case 0x1700: //查询自定义字符串3
  541. {
  542. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA810, (UBYTE *)MC_RsASSCII.CustomASCII3);
  543. break;
  544. }
  545. case 0x1810: //写入自定义字符串3
  546. {
  547. memcpy(MC_RsASSCII.CustomASCII3, Data, DataLength);
  548. //执行存储操作
  549. memcpy(Syspara2.flash_stPara.ubRsASSCII.CustomASCII3, MC_RsASSCII.CustomASCII3, sizeof(MC_RsASSCII.CustomASCII3));
  550. //...
  551. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  552. break;
  553. }
  554. case 0x1901: //写入电机工作模式
  555. {
  556. MC_WorkMode = *Data; // 0-运行模式,1-配置模式,2-调试模式
  557. break;
  558. }
  559. case 0x1A00: //按小牙盘原协议返回控制参数1
  560. {
  561. MC_ConfigParam1_Struct_t MC_ConfigParam1;
  562. MC_ConfigParam1.GasCtrlMode_Param = MC_UpcInfo.stBikeInfo.uwThrottleMaxSpdKmH;
  563. MC_ConfigParam1.StarModel = MC_UpcInfo.stBikeInfo.uwStartMode;
  564. MC_ConfigParam1.StopTime = 100;
  565. MC_ConfigParam1.SpeedLimit = MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart;
  566. MC_ConfigParam1.Deceleration = 3;
  567. MC_ConfigParam1.TeethNum_F = MC_UpcInfo.stBikeInfo.uwNmFrontChainring;
  568. MC_ConfigParam1.TeethNum_B = MC_UpcInfo.stBikeInfo.uwNmBackChainring;
  569. MC_ConfigParam1.CurrentLimit = MC_UpcInfo.stTestParaInfo.uwPwrLimit / MC_UpcInfo.stMotorInfo.uwRVolV;
  570. MC_ConfigParam1.TempTH_Alarm = MC_UpcInfo.stMContorlInfo.uwPwrLimitStartCe;
  571. MC_ConfigParam1.TempTH_Protect = MC_UpcInfo.stMContorlInfo.uwAlamOverHeatCe;
  572. MC_ConfigParam1.NoPBU_Flag = MC_UpcInfo.stBikeInfo2.uwNoneOBCEnable;
  573. MC_ConfigParam1.WheelSize = MC_UpcInfo.stBikeInfo.uwWheelPerimeter;
  574. MC_ConfigParam1.SerialNum = 1;
  575. MC_ConfigParam1.UserAdjParam1_ECO.Assist_K_GAIN = 100;
  576. MC_ConfigParam1.UserAdjParam1_ECO.StarModel_GAIN = 100;
  577. MC_ConfigParam1.UserAdjParam1_NORM.Assist_K_GAIN = 100;
  578. MC_ConfigParam1.UserAdjParam1_NORM.StarModel_GAIN = 100;
  579. MC_ConfigParam1.UserAdjParam1_SPORT.Assist_K_GAIN = 100;
  580. MC_ConfigParam1.UserAdjParam1_SPORT.StarModel_GAIN = 100;
  581. MC_ConfigParam1.UserAdjParam1_TURBO.Assist_K_GAIN = 100;
  582. MC_ConfigParam1.UserAdjParam1_TURBO.StarModel_GAIN = 100;
  583. MC_ConfigParam1.UserAdjParam1_SMART.Assist_K_GAIN = 100;
  584. MC_ConfigParam1.UserAdjParam1_SMART.StarModel_GAIN = 100;
  585. MC_ConfigParam1.SpeedSensorPoles = MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm;
  586. MC_ConfigParam1.CadenceStarNum = 2;
  587. MC_ConfigParam1.SpeedSignal = 0x55;
  588. MC_ConfigParam1.WheelSizeAdj = MC_UpcInfo.stBikeInfo.swWheelSizeAdjust;
  589. MC_ConfigParam1.UV_Protect_TH = MC_UpcInfo.stMContorlInfo.uwAlamUVolV;
  590. MC_ConfigParam1.WalkMode_SpeedLimit = MC_UpcInfo.stBikeInfo.uwCartSpdKmH;
  591. MC_ConfigParam1.WalkMode_MotorSpeedSet = 150;
  592. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA020, (UBYTE*)&MC_ConfigParam1.GasCtrlMode_Param);
  593. break;
  594. }
  595. case 0x1C00: //按小牙盘原协议返回马达参数
  596. {
  597. MC_MotorParam_Struct_t MC_MotorParam;
  598. MC_MotorParam.Rate_Power = MC_UpcInfo.stMotorInfo.uwRPwrWt;
  599. MC_MotorParam.Rate_Speed = MC_UpcInfo.stMotorInfo.uwRSpdRpm;
  600. MC_MotorParam.Coil_R = MC_UpcInfo.stMotorInfo.uwRsmOhm;
  601. MC_MotorParam.Coil_Lq = MC_UpcInfo.stMotorInfo.uwLquH;
  602. MC_MotorParam.Coil_Ld = MC_UpcInfo.stMotorInfo.uwLduH;
  603. MC_MotorParam.Back_EMF = (MC_UpcInfo.stMotorInfo.uwFluxmWb * MC_UpcInfo.stMotorInfo.uwPolePairs * 5940) >> 15; //Emf(@1000rpm) = Flux * 2 * 3.14 * 1000 * p / 60 * 1.732
  604. MC_MotorParam.Rate_Voltage = MC_UpcInfo.stMotorInfo.uwRVolV;
  605. MC_MotorParam.Pole = MC_UpcInfo.stMotorInfo.uwPolePairs;
  606. MC_MotorParam.RS[0] = 0;
  607. MC_MotorParam.RS[1] = 0;
  608. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA110, (UBYTE*)&MC_MotorParam.Rate_Power);
  609. break;
  610. }
  611. case 0x3000: //按小牙盘原协议返回控制参数2
  612. {
  613. MC_ConfigParam2_Struct_t MC_ConfigParam2;
  614. MC_ConfigParam2.ZeroAngle_Pitch = 0;
  615. MC_ConfigParam2.ZeroAngle_Roll = 0;
  616. MC_ConfigParam2.UseAttitudeAngle_Flag = 0xAA;
  617. MC_ConfigParam2.MC_Light_Mode = MC_UpcInfo.stBikeInfo.uwLightConfig >> 12;
  618. MC_ConfigParam2.HeadLightVol = MC_UpcInfo.stBikeInfo.uwLightConfig;
  619. MC_ConfigParam2.TailLightVol = (MC_UpcInfo.stBikeInfo.uwLightConfig >> 8) & 0x0F;
  620. MC_ConfigParam2.u16OverspeedWarnVal = 0;
  621. MC_ConfigParam2.u16EffectVal = MC_UpcInfo.stBikeInfo2.uwRearLightDuty;
  622. MC_ConfigParam2.u16Prediv = MC_UpcInfo.stBikeInfo2.uwRearLightCycle;
  623. MC_ConfigParam2.SpeedLimitStartAdj = 0;
  624. MC_ConfigParam2.SpeedLimitEndAdj = 0;
  625. MC_ConfigParam2.SpeedLimitAdj = MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit;
  626. MC_ConfigParam2.RS1 = 0;
  627. MC_ConfigParam2.UserAdjParam2_ECO.MaxCurrent_K_GAIN = 100;
  628. MC_ConfigParam2.UserAdjParam2_ECO.MaxTorque_K_GAIN = 100;
  629. MC_ConfigParam2.UserAdjParam2_NORM.MaxCurrent_K_GAIN = 100;
  630. MC_ConfigParam2.UserAdjParam2_NORM.MaxTorque_K_GAIN = 100;
  631. MC_ConfigParam2.UserAdjParam2_SPORT.MaxCurrent_K_GAIN = 100;
  632. MC_ConfigParam2.UserAdjParam2_SPORT.MaxTorque_K_GAIN = 100;
  633. MC_ConfigParam2.UserAdjParam2_TURBO.MaxCurrent_K_GAIN = 100;
  634. MC_ConfigParam2.UserAdjParam2_TURBO.MaxTorque_K_GAIN = 100;
  635. MC_ConfigParam2.UserAdjParam2_SMART.MaxCurrent_K_GAIN = 100;
  636. MC_ConfigParam2.UserAdjParam2_SMART.MaxTorque_K_GAIN = 100;
  637. MC_ConfigParam2.RS2[0] = 0;
  638. MC_ConfigParam2.RS2[1] = 0;
  639. MC_ConfigParam2.RS2[2] = 0;
  640. MC_ConfigParam2.RS2[3] = 0;
  641. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xAD20, (UBYTE*)&MC_ConfigParam2.ZeroAngle_Pitch);
  642. break;
  643. }
  644. case 0x1E00: //查询历史信息
  645. {
  646. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB74C, (UBYTE *)&MC_UpcInfo.stHistoryInfo.uwOpenTimes);
  647. break;
  648. }
  649. case 0x1F00: //查询电机生产信息
  650. {
  651. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA520, (UBYTE *)MC_MacInfo.Manufacturer);
  652. break;
  653. }
  654. case 0x2210: //写入电机型号
  655. {
  656. memcpy(MC_VerInfo.Mode, Data, DataLength);
  657. //执行存储操作
  658. // memcpy(Syspara2.flash_stPara.ubMotorVersion, MC_VerInfo.Mode, sizeof(Syspara2.flash_stPara.ubMotorVersion));
  659. memcpy(Productionpara.ubMotorVersion, MC_VerInfo.Mode, sizeof(Productionpara.ubMotorVersion));
  660. //...
  661. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  662. break;
  663. }
  664. case 0x2310: //写入电机SN
  665. {
  666. memcpy(MC_VerInfo.SN_Num, Data, DataLength);
  667. //执行存储操作
  668. //...
  669. //memcpy(Syspara2.flash_stPara.ubSN, MC_VerInfo.SN_Num, sizeof(Syspara2.flash_stPara.ubSN));
  670. memcpy(Productionpara.ubSN, MC_VerInfo.SN_Num, sizeof(Productionpara.ubSN));
  671. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  672. break;
  673. }
  674. case 0x2420: //写入电机生产信息
  675. {
  676. memcpy(MC_MacInfo.Manufacturer, Data, DataLength);
  677. //执行存储操作
  678. //...
  679. // memcpy(Syspara2.flash_stPara.ubProdInfo.Manufacturer, MC_MacInfo.Manufacturer, sizeof(Syspara2.flash_stPara.ubProdInfo));
  680. memcpy(Productionpara.ubProdInfo.Manufacturer, MC_MacInfo.Manufacturer, sizeof(Productionpara.ubProdInfo));
  681. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  682. break;
  683. }
  684. case 0x2505: //复位指令
  685. {
  686. if (strncmp("OFF..", (char *)Data, DataLength) == 0)
  687. {
  688. power_stPowStateOut.powerstate = POWER_OFF;
  689. power_stPowStateOut.blPowerStartupFlg = FALSE;
  690. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  691. }
  692. else if (strncmp("RESET", (char *)Data, DataLength) == 0)
  693. {
  694. //执行复位,跳转进入Bootloader
  695. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  696. // __set_FAULTMASK(1);//关闭所有中断
  697. DL_WWDT_disablePower(WWDT0_INST);
  698. NVIC_SystemReset();
  699. }
  700. break;
  701. }
  702. case 0x2605: //系统清除
  703. {
  704. if (strncmp("CLEAR", (char *)Data, DataLength) == 0)
  705. {
  706. DISABLE_IRQ;
  707. //flash_voParaInit();
  708. flash_voErrorClear();//历史信息
  709. que_voInit(&que_stFlashErrorLog);
  710. flash_voSysParaInit();
  711. CodeHistoryParaDelete();
  712. mn_voEEHistoryParaUpdate();
  713. flash_voSysParaInit();
  714. flash_voSysParaWrite();//
  715. flash_HistoryWrite(); //
  716. ENABLE_IRQ;
  717. /* DISABLE_IRQ;
  718. i2c_voDefaultWriteBuffer();
  719. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  720. CodeHistoryParaDelete();
  721. mn_voEEHistoryParaUpdate();
  722. i2c_voHistoryWriteBuffer();
  723. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  724. ENABLE_IRQ;*/
  725. // if (I2C_EEFltFlg != TRUE)
  726. {
  727. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  728. }
  729. //GPIO_ResetBits(POWER_LOCK_PORT,POWER_LOCK_PIN);
  730. }
  731. break;
  732. }
  733. case 0x2708: //参数还原
  734. {
  735. if (strncmp("RECOVERY", (char *)Data, DataLength) == 0)
  736. {
  737. DISABLE_IRQ;
  738. //flash_voParaInit();
  739. // flash_voWrite();
  740. flash_voSysParaInit();
  741. flash_voSysParaInit();
  742. flash_voSysParaWrite();//tbd
  743. ENABLE_IRQ;
  744. /*DISABLE_IRQ;
  745. i2c_voDefaultWriteBuffer();
  746. i2c_voInfoWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  747. cp_stFlg.ParaSaveEEFlg = FALSE;
  748. ENABLE_IRQ;*/
  749. cp_stFlg.ParaSaveEEFlg = FALSE;
  750. // if (I2C_EEFltFlg != TRUE)
  751. {
  752. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  753. }
  754. //GPIO_ResetBits(POWER_LOCK_PORT,POWER_LOCK_PIN);
  755. }
  756. break;
  757. }
  758. case 0x2802: //控制指令
  759. {
  760. memcpy(&MC_ControlCode.GearSt, Data, DataLength);
  761. MC_RunInfo.GearSt = MC_ControlCode.GearSt; //当前助力档位更新
  762. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch;
  763. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1020, (UBYTE *)&MC_RunInfo.BikeSpeed);
  764. break;
  765. }
  766. case 0x2C01: //控制指令
  767. {
  768. MC_MotorSPD_rpm_Percent = *Data;
  769. break;
  770. }
  771. case 0x2D08: //读取存储器指定地址数据 故障日志
  772. {
  773. do
  774. {
  775. uint32_t DataLength, AddressBegin, AddressEnd;
  776. AddressBegin = (uint32_t)((Data[0] << 24) + (Data[1] << 16) + (Data[2] << 8) + (Data[3]));
  777. AddressEnd = (uint32_t)((Data[4] << 24) + (Data[5] << 16) + (Data[6] << 8) + (Data[7]));
  778. if(((AddressBegin <= AddressEnd) &&(AddressBegin>0) &&(AddressEnd<=(uint32_t)(0x0001FFFF)))
  779. ||((AddressBegin <= AddressEnd) &&(AddressBegin>=(uint32_t)(0x20200000)) &&(AddressEnd<(uint32_t)(0x20208000))) )
  780. {
  781. DataLength = AddressEnd - AddressBegin+ 1;
  782. memcpy((UBYTE*)(Data + 8), (UBYTE*)(AddressBegin), DataLength);
  783. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, (0xAB08 + DataLength), (UBYTE*)Data);
  784. }
  785. } while (0);
  786. break;
  787. }
  788. case 0x2E00: //查询骑行历史信息
  789. {
  790. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0x1510, (UBYTE *)&MC_RideLog.ODO_Km);
  791. break;
  792. }
  793. case 0x3909: // 历史信息清除
  794. {
  795. if (strncmp("LOG CLEAR", (char *)Data, DataLength) == 0)
  796. {
  797. DISABLE_IRQ;
  798. flash_voErrorClear();//清故障日志
  799. que_voInit(&que_stFlashErrorLog);
  800. CodeHistoryParaDelete();
  801. mn_voEEHistoryParaUpdate();
  802. flash_HistoryWrite(); //
  803. ENABLE_IRQ;
  804. /*i2c_voHistoryWriteBuffer();
  805. i2c_voHistoryWrite2EE(&i2c_stTXCoef, &i2c_stTXOut);
  806. ENABLE_IRQ;*/
  807. // if (I2C_EEFltFlg != TRUE)
  808. {
  809. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  810. }
  811. //GPIO_ResetBits(POWER_LOCK_PORT,POWER_LOCK_PIN);
  812. }
  813. break;
  814. }
  815. ////////////////////////////////////////
  816. case 0x3A00: //读取马达信息
  817. {
  818. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB226, (UBYTE *)&MC_UpcInfo.stMotorInfo.uwPolePairs);
  819. break;
  820. }
  821. case 0x3B10:
  822. {
  823. memcpy(&MC_RideLog.ODO_Km, Data, DataLength);
  824. cp_stHistoryPara.ulODOTrip = MC_RideLog.ODO_Km;
  825. cp_stHistoryPara.ulODOTime = MC_RideLog.ODO_Time;
  826. cp_stHistoryPara.ulTripSum = MC_RideLog.TRIP_Km;
  827. cp_stHistoryPara.ulTripSumTime = MC_RideLog.TRIP_Time;
  828. MC_UpcInfo.stHistoryInfo.uwODOTripH = (UWORD)(cp_stHistoryPara.ulODOTrip >> 16);
  829. MC_UpcInfo.stHistoryInfo.uwODOTripL = (UWORD)cp_stHistoryPara.ulODOTrip;
  830. MC_UpcInfo.stHistoryInfo.uwODOTimeH = (UWORD)(cp_stHistoryPara.ulODOTime >> 16);
  831. MC_UpcInfo.stHistoryInfo.uwODOTimeL = (UWORD)cp_stHistoryPara.ulODOTime;
  832. MC_UpcInfo.stHistoryInfo.uwTripSumH = (UWORD)(cp_stHistoryPara.ulTripSum >> 16);
  833. MC_UpcInfo.stHistoryInfo.uwTripSumL = (UWORD)cp_stHistoryPara.ulTripSum;
  834. MC_UpcInfo.stHistoryInfo.uwTripSumTimeH = (UWORD)(cp_stHistoryPara.ulTripSumTime >> 16);
  835. MC_UpcInfo.stHistoryInfo.uwTripSumTimeL = (UWORD)cp_stHistoryPara.ulTripSumTime;
  836. cp_stBikeRunInfoPara.ulRiTime = 0;
  837. SendData(ptUartTx,ID_MC_TO_CDL, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  838. break;
  839. }
  840. case 0x3B28: //写入马达信息
  841. {
  842. memcpy(&MC_UpcInfo.stMotorInfo, Data, DataLength);
  843. if (MC_UpcInfo.stMotorInfo.uwSaveFlg == 1)
  844. {
  845. cp_stFlg.ParaSaveEEFlg = TRUE;
  846. }
  847. cp_stFlg.ParaUpdateFlg = TRUE;
  848. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  849. cp_stFlg.ParaMInfoUpdateFlg = TRUE;
  850. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  851. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  852. break;
  853. }
  854. case 0x3C00: //读取整车信息
  855. {
  856. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB31A, (UBYTE *)&MC_UpcInfo.stBikeInfo.uwWheelPerimeter);
  857. break;
  858. }
  859. case 0x3D1C: //写入整车信息
  860. {
  861. memcpy(&MC_UpcInfo.stBikeInfo, Data, DataLength);
  862. if (MC_UpcInfo.stBikeInfo.uwSaveFlg == 1)
  863. {
  864. cp_stFlg.ParaSaveEEFlg = TRUE;
  865. }
  866. cp_stFlg.ParaUpdateFlg = TRUE;
  867. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  868. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  869. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  870. break;
  871. }
  872. case 0x3D20: //写入电机标签信息
  873. {
  874. memcpy(MC_VerInfo.ProductLabel, Data, DataLength);
  875. //执行存储操作
  876. memcpy(Productionpara.ucProductLabel, MC_VerInfo.ProductLabel, sizeof(Productionpara.ucProductLabel));
  877. SendData(ptUartTx,ID_MC_BC,MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  878. break;
  879. }
  880. case 0x3E00: //查询控制器参数
  881. {
  882. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin = 0;//spi_stResolverOut.swSpiThetaOffsetOrignPu;
  883. MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetNow = 0;//spi_stResolverOut.swSpiThetaOffsetPu;
  884. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB420, (UBYTE *)&MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin);
  885. break;
  886. }
  887. case 0x3F22: //写入控制器参数
  888. {
  889. memcpy(&MC_UpcInfo.stMContorlInfo, Data, DataLength);
  890. if (MC_UpcInfo.stMContorlInfo.uwSaveFlg == 1)
  891. {
  892. cp_stFlg.ParaSaveEEFlg = TRUE;
  893. }
  894. cp_stFlg.ParaUpdateFlg = TRUE;
  895. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  896. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  897. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  898. break;
  899. }
  900. case 0x4000: //查询传感器参数
  901. {
  902. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin = torsensor_stTorSensorCof.uwTorqueOffsetOrign;
  903. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow1 = torsensor_stTorSensorCof.uwTorqueOffsetNow1;
  904. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow2 = torsensor_stTorSensorCof.uwTorqueOffsetNow2;
  905. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow3 = torsensor_stTorSensorCof.uwTorqueOffsetNow3;
  906. MC_UpcInfo.stSensorInfo.uwTorSensorOffsetNow4 = torsensor_stTorSensorCof.uwTorqueOffsetNow4;
  907. MC_UpcInfo.stSensorInfo.uwBikeTorMaxNm = torsensor_stTorSensorCof.uwMaxSensorTorquePu;
  908. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep1RealNm;
  909. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = torsensor_stTorSensorCof.uwBikeTorStep1ADC;
  910. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep2RealNm;
  911. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = torsensor_stTorSensorCof.uwBikeTorStep2ADC;
  912. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep3RealNm;
  913. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = torsensor_stTorSensorCof.uwBikeTorStep3ADC;
  914. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = torsensor_stTorSensorCof.uwBikeTorStep4RealNm;
  915. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = torsensor_stTorSensorCof.uwBikeTorStep4ADC;
  916. MC_UpcInfo.stSensorInfo.uwTorque_SensorPulseNm = cadence_stFreGetCof.uwTorque_NumbersPulses;
  917. MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm = bikespeed_stFreGetCof.uwNumbersPulses;
  918. MC_UpcInfo.stSensorInfo.uwCad_SensorPulseNm=cadence_stFreGetCof.uwCad_NumbersPulses;
  919. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB528, (UBYTE *)&MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin);
  920. break;
  921. }
  922. case 0x4104: //写入力矩传感器参数
  923. {
  924. UWORD SAVETemp[2];
  925. SWORD Temp;
  926. ULONG TempSum = 0;
  927. ULONG TimeDelayTick = 0;
  928. memcpy(&SAVETemp, Data, DataLength);
  929. for(UBYTE i = 0; i < 128; i++)
  930. {
  931. #ifdef TORSENSOR3NUM
  932. Temp = ((TORQUEVOLREG1() - torsensor_stTorSensorCof.uwTorqueOffsetNow1) +
  933. (TORQUEVOLREG2() - torsensor_stTorSensorCof.uwTorqueOffsetNow2) +
  934. (TORQUEVOLREG3() - torsensor_stTorSensorCof.uwTorqueOffsetNow3)) / 3;
  935. #else
  936. Temp = TORQUEVOLREG1() - torsensor_stTorSensorCof.uwTorqueOffsetNow1;
  937. #endif
  938. TempSum += (Temp < 0) ? 0 : Temp;
  939. TimeDelayTick = cp_ulSystickCnt;
  940. while((cp_ulSystickCnt - TimeDelayTick) < 10)
  941. {
  942. asm("NOP");
  943. }
  944. }
  945. if (SAVETemp[0] == 1)
  946. {
  947. MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm = SAVETemp[1];
  948. MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC = TempSum >> 7;
  949. }
  950. else if (SAVETemp[0] == 2)
  951. {
  952. MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm = SAVETemp[1];
  953. MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC = TempSum >> 7;
  954. }
  955. else if (SAVETemp[0] == 3)
  956. {
  957. MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm = SAVETemp[1];
  958. MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC = TempSum >> 7;
  959. }
  960. else if (SAVETemp[0] == 4)
  961. {
  962. MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm = SAVETemp[1];
  963. MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC = TempSum >> 7;
  964. }
  965. else
  966. {}
  967. cp_stFlg.ParaSaveEEFlg = TRUE;
  968. cp_stFlg.ParaUpdateFlg = TRUE;
  969. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  970. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  971. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  972. break;
  973. }
  974. case 0x420E: //写入其它传感器参数
  975. {
  976. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 2);
  977. memcpy(&MC_UpcInfo.stSensorInfo.uwTorque_SensorPulseNm, Data + 2, DataLength - 2);
  978. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  979. {
  980. cp_stFlg.ParaSaveEEFlg = TRUE;
  981. }
  982. cp_stFlg.ParaUpdateFlg = TRUE;
  983. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  984. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  985. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  986. break;
  987. }
  988. case 0x4304: //查询助力参数
  989. {
  990. memcpy(&MC_UpcInfo.stCurveOrderInfo, Data, DataLength);
  991. if(MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum > 15)
  992. {
  993. MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum = 15;
  994. }
  995. else if(MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum < 1)
  996. {
  997. MC_UpcInfo.stCurveOrderInfo.uwTorqueCurveNum = 1;
  998. }
  999. if(MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum > 5)
  1000. {
  1001. MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum = 5;
  1002. }
  1003. else if(MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum < 1)
  1004. {
  1005. MC_UpcInfo.stCurveOrderInfo.uwCadenceCurveNum = 1;
  1006. }
  1007. Can_AssistCoef_Read(&MC_UpcInfo.stCurveOrderInfo);
  1008. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB64C, (UBYTE *)&MC_UpcInfo.stAssistInfo.swStartupGain);
  1009. break;
  1010. }
  1011. case 0x4450: //写入助力参数
  1012. {
  1013. memcpy(&MC_UpcInfo.stAssistInfo, Data, DataLength);
  1014. if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum > 15)
  1015. {
  1016. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum = 15;
  1017. }
  1018. else if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum < 1)
  1019. {
  1020. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwTorqueCurveNum = 1;
  1021. }
  1022. if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum > 5)
  1023. {
  1024. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum = 5;
  1025. }
  1026. else if(MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum < 1)
  1027. {
  1028. MC_UpcInfo.stAssistInfo.stCurveOrderInfo.uwCadenceCurveNum = 1;
  1029. }
  1030. Can_AssistCoef_Write(&MC_UpcInfo.stAssistInfo.stCurveOrderInfo);
  1031. if (MC_UpcInfo.stAssistInfo.uwSaveFlg == 1)
  1032. {
  1033. cp_stFlg.ParaSaveEEFlg = TRUE;
  1034. }
  1035. cp_stFlg.ParaUpdateFlg = TRUE;
  1036. cp_stFlg.ParaAInfoUpdateFlg = TRUE;
  1037. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1038. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1039. break;
  1040. }
  1041. case 0x4500: //查询调试参数
  1042. {
  1043. MC_UpcInfo.stTestParaInfo.RunModelSelect = cp_stFlg.RunModelSelect;
  1044. MC_UpcInfo.stTestParaInfo.ThetaGetModelSelect = cp_stFlg.ThetaGetModelSelect;
  1045. MC_UpcInfo.stTestParaInfo.CurrentSampleModelSelect = cp_stFlg.CurrentSampleModelSelect;
  1046. MC_UpcInfo.stTestParaInfo.RotateDirectionSelect = cp_stFlg.RotateDirectionSelect;
  1047. MC_UpcInfo.stTestParaInfo.uwInitPosCurAmp = cp_stControlPara.swAlignCurAp ;
  1048. MC_UpcInfo.stTestParaInfo.uwVFControlVolAmp = cp_stControlPara.swDragVolAp ;
  1049. MC_UpcInfo.stTestParaInfo.uwIFControlCurAmp = cp_stControlPara.swDragCurAp ;
  1050. MC_UpcInfo.stTestParaInfo.uwVFIFTargetFreHz = cp_stControlPara.swDragSpdHz;
  1051. MC_UpcInfo.stTestParaInfo.uwSpeedLoopAccRate = cp_stControlPara.swSpeedAccRate ;
  1052. MC_UpcInfo.stTestParaInfo.uwSpeedLoopDecRate = cp_stControlPara.swSpeedDccRate;
  1053. MC_UpcInfo.stTestParaInfo.uwSpeedLoopBandWidthHz = cp_stControlPara.swAsrPIBandwidth;
  1054. MC_UpcInfo.stTestParaInfo.uwSpeedLoopCoefM = cp_stControlPara.swAsrPIM;
  1055. MC_UpcInfo.stTestParaInfo.uwCuerrentLoopBandWidthHz = cp_stControlPara.swAcrPIBandwidth;
  1056. MC_UpcInfo.stTestParaInfo.uwCurrentLoopCoefM = cp_stControlPara.swAcrRaCoef;
  1057. MC_UpcInfo.stTestParaInfo.uwFluxObsCoefM = cp_stControlPara.swObsFluxPIDampratio;
  1058. MC_UpcInfo.stTestParaInfo.uwFluxObsBandWidthHz = cp_stControlPara.swObsFluxPICrossfreHz;
  1059. MC_UpcInfo.stTestParaInfo.uwThetaObsPLLCoefM = cp_stControlPara.swObsSpdPLLM;
  1060. MC_UpcInfo.stTestParaInfo.uwThetaObsPLLBandWidthHz = cp_stControlPara.swObsSpdPLLBandWidthHz;
  1061. MC_UpcInfo.stTestParaInfo.uwPWMMaxDuty = cp_stControlPara.swPWMMaxDuty;
  1062. MC_UpcInfo.stTestParaInfo.uwPWM7to5Duty = cp_stControlPara.swPWM7to5Duty;
  1063. MC_UpcInfo.stTestParaInfo.uwPwrLimit = cp_stControlPara.swPwrLimitValWt;
  1064. MC_UpcInfo.stTestParaInfo.uwPwrLimitError = cp_stControlPara.swPwrLimitErrWt;
  1065. MC_UpcInfo.stTestParaInfo.uwPwrLimitKp = cp_stControlPara.swPwrLimitKpPu;
  1066. MC_UpcInfo.stTestParaInfo.uwPwrLimitKi = cp_stControlPara.swPwrLimitKiPu;
  1067. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB83A, (UBYTE *)&MC_UpcInfo.stTestParaInfo.RunModelSelect);
  1068. break;
  1069. }
  1070. case 0x463C: //写入调试参数
  1071. {
  1072. memcpy(&MC_UpcInfo.stTestParaInfo.uwTestParaSaveFlg, Data, DataLength);
  1073. // if (MC_UpcInfo.stTestParaInfo.uwSaveFlg == 1)
  1074. // {
  1075. cp_stFlg.ParaSaveEEFlg = TRUE;
  1076. if(MC_UpcInfo.stTestParaInfo.RunModelSelect <= 3)
  1077. {
  1078. MC_UpcInfo.stTestParaInfo.uwSaveFlg = FALSE;
  1079. }
  1080. else
  1081. {
  1082. MC_UpcInfo.stTestParaInfo.uwSaveFlg = TRUE;
  1083. }
  1084. // }
  1085. cp_stFlg.ParaUpdateFlg = TRUE;
  1086. cp_stFlg.TestParaInfoUpdateFlg = TRUE;
  1087. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1088. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1089. break;
  1090. }
  1091. case 0x472E://写入力矩传感器参数
  1092. {
  1093. memcpy(&MC_UpcInfo.stSensorInfo.uwSaveFlg, Data, 30);
  1094. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == 1)
  1095. {
  1096. cp_stFlg.ParaSaveEEFlg = TRUE;
  1097. }
  1098. cp_stFlg.ParaUpdateFlg = TRUE;
  1099. cp_stFlg.ParaSensorInfoUpdateFlg = TRUE;
  1100. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1101. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1102. break;
  1103. }
  1104. case 0x4800: //读取储存标志
  1105. {
  1106. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xB904, (UBYTE *)&MC_UpcInfo.stTestParaInfo.uwEEFirstDefaultSetFlg);
  1107. break;
  1108. }
  1109. case 0x4906: //写入储存标志
  1110. {
  1111. memcpy(&MC_UpcInfo.stTestParaInfo.uwSaveFlg, Data, DataLength);
  1112. if(MC_UpcInfo.stTestParaInfo.uwSaveFlg == 1)
  1113. {
  1114. cp_stFlg.ParaSaveEEFlg = TRUE;
  1115. }
  1116. cp_stFlg.ParaUpdateFlg = TRUE;
  1117. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  1118. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1119. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1120. break;
  1121. }
  1122. case 0x4A00:
  1123. {
  1124. SendData(ptUartTx,ID_MC_BC, MODE_REPORT, 0xBC20, (UBYTE *)&MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1);
  1125. break;
  1126. }
  1127. case 0x4A12: //内阻校准指令
  1128. {
  1129. memcpy(&MC_UpcInfo.stResistanceCalibInfo.uwSaveFlg, Data, DataLength);
  1130. memcpy(&Syspara2.EepromMosPara.EEP_K50,&MC_UpcInfo.stResistanceCalibInfo.Coeff1,10 );
  1131. MosResInside.blCalibFlag=TRUE;
  1132. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1133. break;
  1134. }
  1135. case 0x4B00: //读取内阻校准参数
  1136. {
  1137. MC_UpcInfo.stWriteResistanceCalibInfo.MOSResA = Syspara2.EepromMosPara.EEP_MOSA.uwTEMP_RES1;
  1138. MC_UpcInfo.stWriteResistanceCalibInfo.MOSResB = Syspara2.EepromMosPara.EEP_MOSB.uwTEMP_RES1;
  1139. MC_UpcInfo.stWriteResistanceCalibInfo.MOSResC = Syspara2.EepromMosPara.EEP_MOSC.uwTEMP_RES1;
  1140. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff1 = Syspara2.EepromMosPara.EEP_K50;
  1141. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff2 = Syspara2.EepromMosPara.EEP_K75;
  1142. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff3 = Syspara2.EepromMosPara.EEP_K100;
  1143. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff4 = Syspara2.EepromMosPara.EEP_K125;
  1144. MC_UpcInfo.stWriteResistanceCalibInfo.Coeff5 = Syspara2.EepromMosPara.EEP_K150;
  1145. MC_UpcInfo.stWriteResistanceCalibInfo.reserve1 = 0;
  1146. MC_UpcInfo.stWriteResistanceCalibInfo.reserve2 = 0;
  1147. MC_UpcInfo.stWriteResistanceCalibInfo.reserve3 = 0;
  1148. MC_UpcInfo.stWriteResistanceCalibInfo.reserve4 = 0;
  1149. MC_UpcInfo.stWriteResistanceCalibInfo.reserve5 = 0;
  1150. MC_UpcInfo.stWriteResistanceCalibInfo.reserve6 = 0;
  1151. MC_UpcInfo.stWriteResistanceCalibInfo.reserve7 = 0;
  1152. MC_UpcInfo.stWriteResistanceCalibInfo.reserve8 = 0;
  1153. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xBC20, (UBYTE *)&MC_UpcInfo.stWriteResistanceCalibInfo.MOSResA);
  1154. break;
  1155. }
  1156. case 0x4B22: //上位机设置骑行参数
  1157. {
  1158. memcpy(&MC_UpcInfo.stRideParaInfo.uwSaveFlg, Data, DataLength);
  1159. if (MC_UpcInfo.stRideParaInfo.uwSaveFlg == 1)
  1160. {
  1161. cp_stFlg.ParaSaveEEFlg = TRUE;
  1162. }
  1163. cp_stFlg.ParaUpdateFlg = TRUE;
  1164. cp_stFlg.ParaRideInfoUpdateFlg = TRUE;
  1165. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1166. SendData(ptUartTx,ID_MC_TO_CDL, MODE_REPORT, 0x5303, (UBYTE*)"ACK");
  1167. break;
  1168. }
  1169. case 0x4C00:
  1170. {
  1171. SendData(ptUartTx,ID_MC_BC, MODE_REPORT, 0xBD20, (UBYTE *)&MC_UpcInfo.stBikeInfo2.uwNoneOBCEnable);
  1172. break;
  1173. }
  1174. case 0x4C22: //写入内阻校准参数
  1175. {
  1176. // memcpy(&MC_UpcInfo.stWriteResistanceCalibInfo.uwSaveFlg, Data, DataLength);
  1177. // if(MC_UpcInfo.stWriteResistanceCalibInfo.uwSaveFlg == 1)
  1178. // {
  1179. // cp_stFlg.ParaSaveEEFlg = TRUE;
  1180. // }
  1181. // cp_stFlg.ParaUpdateFlg = TRUE;
  1182. // cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  1183. // cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1184. SendData(ptUartTx, ID_MC_BC, MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1185. break;
  1186. }
  1187. case 0x4D22:
  1188. {
  1189. memcpy(&MC_UpcInfo.stBikeInfo2.uwSaveFlg, Data, DataLength);
  1190. if(MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit > 0)
  1191. {
  1192. MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit = 0;
  1193. }
  1194. else if(MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit < (-ass_ParaSet.uwAssistLimitBikeSpdStart))
  1195. {
  1196. MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit = (-ass_ParaSet.uwAssistLimitBikeSpdStart);
  1197. }
  1198. else
  1199. {
  1200. //do nothing
  1201. }
  1202. if (MC_UpcInfo.stBikeInfo2.uwSaveFlg == 1)
  1203. {
  1204. cp_stFlg.ParaSaveEEFlg = TRUE;
  1205. }
  1206. cp_stFlg.ParaUpdateFlg = TRUE;
  1207. cp_stFlg.ParaBikeInfo2UpdateFlg = TRUE;
  1208. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1209. SendData(ptUartTx, ID_MC_BC,MODE_REPORT, 0xA903, (UBYTE *)"ACK");
  1210. break;
  1211. }
  1212. case 0x4E00:
  1213. {
  1214. SendData(ptUartTx, ID_MC_BC,MODE_REPORT, 0xBB20, (UBYTE *)MC_VerInfo.ProductLabel);
  1215. break;
  1216. }
  1217. case 0x5200: //读取故障日志地址范围
  1218. {
  1219. ManageError_Address.ulErrAStart_Address = ((StartServerManageError_Address & 0xFF000000) >> 24) | \
  1220. ((StartServerManageError_Address & 0x00FF0000) >> 8) | \
  1221. ((StartServerManageError_Address & 0x0000FF00) << 8) | \
  1222. ((StartServerManageError_Address & 0x000000FF) << 24);
  1223. ManageError_Address.ulErrEnd_Address = ((EndServerManageError_Address & 0xFF000000) >> 24) | \
  1224. ((EndServerManageError_Address & 0x00FF0000) >> 8) | \
  1225. ((EndServerManageError_Address & 0x0000FF00) << 8) | \
  1226. ((EndServerManageError_Address & 0x000000FF) << 24);
  1227. SendData(ptUartTx, ID_MC_TO_CDL, MODE_REPORT, 0xC008, (UBYTE *)&ManageError_Address.ulErrAStart_Address);
  1228. break;
  1229. }
  1230. default:
  1231. break;
  1232. }
  1233. break;
  1234. }
  1235. //切换解析函数
  1236. case 0x07FF: {
  1237. switch (Cmd)
  1238. {
  1239. case 0x7702:
  1240. {
  1241. ucUartAnalyseID = Data[0];
  1242. // #if (UART_ID == 3)
  1243. // usart_reset(UART_RxBuff_Struct_OBC.usart_periph);
  1244. // hw_voInitUART1(9600);
  1245. // #endif
  1246. }
  1247. default:
  1248. break;
  1249. }
  1250. break;
  1251. }
  1252. default:
  1253. break;
  1254. }
  1255. }
  1256. UBYTE UART_ReadChar(USART_Buf_TypeDef * ptRx, UBYTE ucNum)
  1257. {
  1258. UBYTE ucData;
  1259. UWORD i;
  1260. i = ucNum;
  1261. if ((*ptRx).ucBufCnt >= ucNum)
  1262. {
  1263. i += (*ptRx).ucBufRdInde;
  1264. if (i >= (*ptRx).ucBufSize)
  1265. {
  1266. i -=((*ptRx).ucBufSize);
  1267. }
  1268. }
  1269. else
  1270. {
  1271. i=0;
  1272. }
  1273. ucData = *((*ptRx).pcBufAddr + i);
  1274. return ucData;
  1275. }
  1276. void UART_DelChar(USART_Buf_TypeDef * ptRx, UBYTE ucNum)
  1277. {
  1278. UWORD i;
  1279. if ((*ptRx).ucBufCnt >= ucNum)
  1280. {
  1281. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, FALSE);
  1282. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1283. (*ptRx).ucBufCnt -= ucNum;
  1284. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, TRUE);
  1285. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1286. i = ucNum;
  1287. i += (*ptRx).ucBufRdInde;
  1288. if (i >= (*ptRx).ucBufSize)
  1289. {
  1290. i -= (*ptRx).ucBufSize;
  1291. }
  1292. (*ptRx).ucBufRdInde = i;
  1293. }
  1294. else
  1295. {
  1296. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, FALSE);
  1297. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1298. i = (*ptRx).ucBufCnt;
  1299. (*ptRx).ucBufCnt = 0;
  1300. // usart_interrupt_enable(ptRx->usart_periph, USART_RDBF_INT, TRUE);
  1301. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_RX );
  1302. i += (*ptRx).ucBufRdInde;
  1303. if (i >= (*ptRx).ucBufSize)
  1304. {
  1305. i -= (*ptRx).ucBufSize;
  1306. }
  1307. (*ptRx).ucBufRdInde = i;
  1308. }
  1309. }
  1310. void UART_PutChar(USART_Buf_TypeDef * ptTx, UBYTE ucData)
  1311. {
  1312. while ((*ptTx).ucBufCnt == (*ptTx).ucBufSize);
  1313. // usart_interrupt_enable(ptTx->usart_periph, USART_TDBE_INT, FALSE);
  1314. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1315. if((*ptTx).ucBufCnt == 0)
  1316. {
  1317. // if(usart_flag_get(ptTx->usart_periph, USART_TDBE_FLAG) == SET) //check if transmit data register full or not
  1318. if(DL_UART_isTXFIFOEmpty(UART_HMI_INST) == TRUE)
  1319. {
  1320. // usart_data_transmit(ptTx->usart_periph, ucData);
  1321. // usart_interrupt_enable(ptTx->usart_periph, USART_TDBE_INT, TRUE);
  1322. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1323. DL_UART_Main_transmitData(UART_HMI_INST, ucData);
  1324. return;
  1325. }
  1326. }
  1327. *((*ptTx).pcBufAddr + (*ptTx).ucBufWrInde) = ucData;
  1328. if(++(*ptTx).ucBufWrInde == (*ptTx).ucBufSize)
  1329. {
  1330. (*ptTx).ucBufWrInde = 0;
  1331. }
  1332. ++(*ptTx).ucBufCnt;
  1333. // usart_interrupt_enable(ptTx->usart_periph, USART_TDBE_INT, TRUE);
  1334. DL_UART_Main_enableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1335. }
  1336. void SendData(USART_Buf_TypeDef* ptUartTx, UWORD ID, UBYTE Mode, UWORD Command, UBYTE *Data)
  1337. {
  1338. if(ucCommType != 2)
  1339. {
  1340. ULONG CRC_Result = 0x00000000U;
  1341. UBYTE DataLength;
  1342. UBYTE CanSendData[255], CanSendData_CRC_Buf[255];
  1343. DataLength = (UBYTE)(Command & 0xFF);
  1344. CanSendData[0] = FRAME_BEGIN1;
  1345. CanSendData[1] = FRAME_BEGIN2;
  1346. CanSendData[2] = Mode;
  1347. CanSendData[3] = DataLength + 2;
  1348. CanSendData[4] = (UBYTE)((Command >> 8) & 0xFF);
  1349. CanSendData[5] = DataLength;
  1350. if((DataLength)> (255 - 6))
  1351. {
  1352. DataLength = 255 - 6;
  1353. }
  1354. memcpy(CanSendData + 6, Data, DataLength);
  1355. CanSendData_CRC_Buf[0] = FRAME_BEGIN1;
  1356. CanSendData_CRC_Buf[1] = FRAME_BEGIN2;
  1357. CanSendData_CRC_Buf[2] = (UBYTE)(ID >> 8);
  1358. CanSendData_CRC_Buf[3] = (UBYTE)(ID & 0xFF);
  1359. if((DataLength + 4 )> (255 - 4))
  1360. {
  1361. DataLength = 251 - 4 - 4;
  1362. }
  1363. memcpy(CanSendData_CRC_Buf + 4, CanSendData + 2, DataLength + 4);
  1364. CRC_Result = CRC32_Calculate(CanSendData_CRC_Buf, DataLength + 8); //帧头2bytes + ID 2bytes + 模式 1byte + 命令段长度 1byte + 命令字 2bytes
  1365. CanSendData[6 + DataLength] = (UBYTE)((CRC_Result >> 24) & 0xFF);
  1366. CanSendData[7 + DataLength] = (UBYTE)((CRC_Result >> 16) & 0xFF);
  1367. CanSendData[8 + DataLength] = (UBYTE)((CRC_Result >> 8) & 0xFF);
  1368. CanSendData[9 + DataLength] = (UBYTE)(CRC_Result & 0xFF);
  1369. CanSendData[10 + DataLength] = FRAME_END;
  1370. CAN_SendData(ID, ID_MODE_STANDARD, CanSendData, DataLength + 11);
  1371. }
  1372. if(ucCommType != 1)
  1373. {
  1374. UBYTE i = 0;
  1375. UBYTE len = 0;
  1376. UWORD checksum = 0;
  1377. UBYTE databuf[256] = {0};
  1378. len = (UBYTE)((Command & 0xff) + 4);
  1379. if(len > 247)
  1380. {
  1381. len = 247;
  1382. }
  1383. databuf[0] = UARTFRAME_BEGIN;
  1384. databuf[1] = UARTADDR_CDL;
  1385. databuf[2] = Mode;
  1386. databuf[3] = len;
  1387. databuf[4] = (UBYTE)((ID >> 8) & 0xFF);
  1388. databuf[5] = (UBYTE)(ID & 0xFF);
  1389. databuf[6] = (UBYTE)((Command >> 8) & 0xFF);
  1390. databuf[7] = (UBYTE)(Command & 0xFF);
  1391. for(i=0; i<(len-4); i++)
  1392. {
  1393. databuf[8+i] = Data[i];
  1394. }
  1395. for(i=1; i<(len+4); i++)
  1396. {
  1397. checksum = (UWORD)(databuf[i] + checksum);
  1398. }
  1399. databuf[4+len] = (UBYTE)checksum;
  1400. databuf[5+len] = (UBYTE)(checksum>>8);
  1401. databuf[6+len] = UARTFRAME_END1;
  1402. databuf[7+len] = UARTFRAME_END2;
  1403. for(i=0; i<(len+8); i++)
  1404. {
  1405. UART_PutChar(ptUartTx, databuf[i]);
  1406. }
  1407. }
  1408. }
  1409. void KM5S_OBCSetPara(UBYTE* Data)
  1410. {
  1411. UWORD tmpdata;
  1412. /*数据获取*/
  1413. if((Data[4] & 0x40) == 0x40) //助力方向
  1414. {
  1415. stOBC_SetInfo.AssistDir = Assist_Backward;
  1416. }
  1417. else
  1418. {
  1419. stOBC_SetInfo.AssistDir = Assist_Forward;
  1420. }
  1421. stOBC_SetInfo.ucAssistedMagnetSteel = (Data[4] & 0x3F);//助力过几个磁钢
  1422. stOBC_SetInfo.ucAssistRatio = Data[5];
  1423. stOBC_SetInfo.ucThrottleGt = ((Data[6] & 0x80)>>7);
  1424. stOBC_SetInfo.ucThrottleLimited = ((Data[6] & 0x40)>>6);
  1425. stOBC_SetInfo.ucSlowStartMode = ((Data[6] & 0x30)>>4);
  1426. stOBC_SetInfo.ucSpeedSensorPulses = (Data[6] & 0x0F);
  1427. if((Data[7] & 0x80) == 0x80)
  1428. {
  1429. stOBC_SetInfo.swUnderVoltageBias = (SWORD)(-1 * (Data[7] & 0x7F));//0.1V
  1430. }
  1431. else
  1432. {
  1433. stOBC_SetInfo.swUnderVoltageBias = (SWORD)(1 * (Data[7] & 0x7F));
  1434. }
  1435. if((Data[8] & 0xC0) == 0xC0)
  1436. {
  1437. stOBC_SetInfo.uwUnderVoltageBase = 420;//0.1V
  1438. }
  1439. else if((Data[8] & 0xC0) == 0x40)
  1440. {
  1441. stOBC_SetInfo.uwUnderVoltageBase = 210;
  1442. }
  1443. else
  1444. {
  1445. stOBC_SetInfo.uwUnderVoltageBase = 315;
  1446. }
  1447. stOBC_SetInfo.ucCurrentLimiation = (Data[8] & 0x3F);//0.5A
  1448. stOBC_SetInfo.ucShakingCode = Data[9];
  1449. stOBC_SetInfo.ucSpeedLimiation = ((Data[10] & 0xF8)>>3) + 10;//km/h
  1450. stOBC_SetInfo.ucWheelDiameterCode = (Data[10] & 0x07);
  1451. /*低压保护阈值更新*/
  1452. if(MC_UpcInfo.stMContorlInfo.uwAlamUVolV != (UWORD)(stOBC_SetInfo.uwUnderVoltageBase + stOBC_SetInfo.swUnderVoltageBias))
  1453. {
  1454. MC_UpcInfo.stMContorlInfo.uwAlamUVolV = (UWORD)(stOBC_SetInfo.uwUnderVoltageBase + stOBC_SetInfo.swUnderVoltageBias);
  1455. MC_UpcInfo.stMContorlInfo.uwSaveFlg = 1;
  1456. cp_stFlg.ParaSaveEEFlg = TRUE;
  1457. cp_stFlg.ParaUpdateFlg = TRUE;
  1458. cp_stFlg.ParaMCInfoUpdateFlg = TRUE;
  1459. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1460. }
  1461. /*功率限幅阈值更新*/
  1462. // #if (IPM_VOLTAGE_SEL == IPM_VOLTAGE_48V)
  1463. // UWORD uwVolt = 480;
  1464. // #elif (IPM_VOLTAGE_SEL == IPM_VOLTAGE_36V)
  1465. // UWORD uwVolt = 360;
  1466. // #else
  1467. // UWORD uwVolt = 360;
  1468. // #endif
  1469. UWORD uwVolt =cp_stMotorPara.swRUdcV;
  1470. if(MC_UpcInfo.stTestParaInfo.uwPwrLimit != ((stOBC_SetInfo.ucCurrentLimiation*uwVolt>>1) + 500))
  1471. {
  1472. MC_UpcInfo.stTestParaInfo.uwPwrLimit = (UWORD)((stOBC_SetInfo.ucCurrentLimiation*uwVolt>>1) + 500);
  1473. MC_UpcInfo.stTestParaInfo.uwSaveFlg = 1;
  1474. cp_stFlg.ParaSaveEEFlg = TRUE;
  1475. cp_stFlg.ParaUpdateFlg = TRUE;
  1476. cp_stFlg.TestParaInfoUpdateFlg = TRUE;
  1477. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  1478. }
  1479. /*限速阈值更新*/
  1480. if(MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart != stOBC_SetInfo.ucSpeedLimiation)
  1481. {
  1482. MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart = stOBC_SetInfo.ucSpeedLimiation;
  1483. MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStop = stOBC_SetInfo.ucSpeedLimiation + 2;
  1484. MC_UpcInfo.stBikeInfo.uwThrottleMaxSpdKmH = stOBC_SetInfo.ucSpeedLimiation;
  1485. MC_UpcInfo.stBikeInfo.uwSaveFlg = 1;
  1486. MC_UpcInfo.stAssistInfo.uwSaveFlg = 1;
  1487. cp_stFlg.ParaSaveEEFlg = TRUE;
  1488. cp_stFlg.ParaUpdateFlg = TRUE;
  1489. cp_stFlg.ParaAInfoUpdateFlg = TRUE;
  1490. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  1491. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1492. }
  1493. /*轮径更新*/
  1494. if(stOBC_SetInfo.ucWheelDiameterCode <= 5)
  1495. {
  1496. tmpdata = (stOBC_SetInfo.ucWheelDiameterCode*2 + 16) * 8; //3.14*2.54=7.9756=8
  1497. }
  1498. else if(stOBC_SetInfo.ucWheelDiameterCode == 6)
  1499. {
  1500. tmpdata = 219; //3.14*700mm=2198mm
  1501. }
  1502. else
  1503. {
  1504. tmpdata = 223; //3.14*2.54*28
  1505. }
  1506. if(MC_UpcInfo.stBikeInfo.uwWheelPerimeter != tmpdata)
  1507. {
  1508. MC_UpcInfo.stBikeInfo.uwWheelPerimeter = tmpdata;
  1509. MC_UpcInfo.stBikeInfo.uwSaveFlg = 1;
  1510. cp_stFlg.ParaSaveEEFlg = TRUE;
  1511. cp_stFlg.ParaUpdateFlg = TRUE;
  1512. cp_stFlg.ParaBikeInfoUpdateFlg = TRUE;
  1513. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  1514. }
  1515. }
  1516. void KM5S_SendData_OBC(USART_Buf_TypeDef* ptUartTx, UBYTE Mode, UBYTE Length, UBYTE checknum)
  1517. {
  1518. UBYTE i = 0;
  1519. UWORD checksum = 0;
  1520. UBYTE databuf[13] = {0};
  1521. UBYTE tmp = 0;
  1522. if(MC_RunInfo.BusVoltage > 63000)
  1523. {
  1524. tmp = 0x3F; //max=63V
  1525. }
  1526. else
  1527. {
  1528. tmp = (UBYTE)((MC_RunInfo.BusVoltage/1000)&0x3F);
  1529. }
  1530. stMC2OBC_RRunInfo.Stage = (UBYTE)(stOBC_RunInfo.ucLowPower << 7) //欠压,MC_ErrorCode.ERROR_Bit.Protect_UnderVoltage
  1531. | (bikeCruise.CruiseMode << 6) //巡航,由控制器判定
  1532. | tmp;
  1533. stMC2OBC_RRunInfo.Current = (UBYTE)(abs(MC_RunInfo.BusCurrent/1000)*3);//电流
  1534. if(bikespeed_stFreGetOut.uwLPFFrequencyPu == 0)
  1535. {
  1536. stMC2OBC_RRunInfo.Speed = 0;
  1537. }
  1538. else
  1539. {
  1540. stMC2OBC_RRunInfo.Speed = (UWORD)((SQWORD)(1000 << 20) / bikespeed_stFreGetOut.uwLPFFrequencyPu / FBASE); //车轮转动一圈时间,ms
  1541. }
  1542. //故障码
  1543. if(1 == MC_ErrorCode.ERROR_Bit.Protect_OverCurrent)
  1544. {
  1545. stMC2OBC_RRunInfo.ErrorCode = 0x21;//电流异常
  1546. }
  1547. else if(1 == MC_ErrorCode.ERROR_Bit.Fault_Throttle)
  1548. {
  1549. stMC2OBC_RRunInfo.ErrorCode = 0x22;//转把异常
  1550. }
  1551. else if(1 == MC_ErrorCode.ERROR_Bit.Fault_PhaseLine)
  1552. {
  1553. stMC2OBC_RRunInfo.ErrorCode = 0x23;//电机缺相
  1554. }
  1555. else if(1 == MC_ErrorCode.ERROR_Bit.Fault_HallSensor)
  1556. {
  1557. stMC2OBC_RRunInfo.ErrorCode = 0x24;//电机霍尔异常
  1558. }
  1559. /*else if(0)
  1560. {
  1561. stMC2OBC_RRunInfo.ErrorCode = 0x25;//刹车异常
  1562. }*/
  1563. else
  1564. {
  1565. stMC2OBC_RRunInfo.ErrorCode = 0x00;
  1566. }
  1567. databuf[0] = UARTFRAME_BEGIN;
  1568. databuf[1] = UARTADDR_OBC;
  1569. databuf[2] = Mode;
  1570. databuf[3] = Length;
  1571. databuf[4] = stMC2OBC_RRunInfo.Stage;
  1572. databuf[5] = stMC2OBC_RRunInfo.Current;
  1573. databuf[6] = (UBYTE)((stMC2OBC_RRunInfo.Speed &0xFF00)>>8);
  1574. databuf[7] = (UBYTE)(stMC2OBC_RRunInfo.Speed &0xFF);
  1575. if(Mode == 0x53)
  1576. {
  1577. if(checknum > 63)
  1578. {
  1579. checknum = 63;
  1580. }
  1581. databuf[7] = ucOBC_password[checknum];//握手查表
  1582. }
  1583. databuf[8] = stMC2OBC_RRunInfo.ErrorCode;
  1584. for(i=1; i<(Length+4); i++)
  1585. {
  1586. checksum = (UWORD)(databuf[i] + checksum);
  1587. }
  1588. databuf[4+Length] = (UBYTE)checksum;
  1589. databuf[5+Length] = (UBYTE)(checksum>>8);
  1590. databuf[6+Length] = UARTFRAME_END1;
  1591. databuf[7+Length] = UARTFRAME_END2;
  1592. for(i=0; i<(Length+8); i++)
  1593. {
  1594. UART_PutChar(ptUartTx, databuf[i]);
  1595. }
  1596. }
  1597. /*******************************************************************************
  1598. * Function:void USARTx_Rx_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct)
  1599. * Discrible:
  1600. * Input:
  1601. * Output:
  1602. * Return:
  1603. * Others:
  1604. * date version author record
  1605. * -----------------------------------------------
  1606. * 20151107 V1.0 VINCENT Create
  1607. *********************************************************************************/
  1608. //void USARTx_Rx_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct)
  1609. //{
  1610. // UBYTE ucData;
  1611. //
  1612. //// if(USARTx_RxBuf_Struct->usart_periph->ctrl1_bit.rdbfien != RESET) //接收中斷
  1613. // if((DL_UART_Main_getPendingInterrupt(UART_HMI_INST))==DL_UART_MAIN_IIDX_RX)
  1614. // {
  1615. //// if(RESET != usart_flag_get(USARTx_RxBuf_Struct->usart_periph, USART_RDBF_FLAG))
  1616. // {
  1617. //// ucData = (UBYTE)usart_data_receive(USARTx_RxBuf_Struct->usart_periph);
  1618. // ucData = DL_UART_Main_receiveDataBlocking(UART_HMI_INST);
  1619. //
  1620. // {
  1621. // *((* USARTx_RxBuf_Struct).pcBufAddr + (* USARTx_RxBuf_Struct).ucBufWrInde) = ucData;
  1622. // if(++(* USARTx_RxBuf_Struct).ucBufWrInde >= (* USARTx_RxBuf_Struct).ucBufSize)
  1623. // {
  1624. // (* USARTx_RxBuf_Struct).ucBufWrInde = 0;
  1625. // }
  1626. // if(++(* USARTx_RxBuf_Struct).ucBufCnt > (* USARTx_RxBuf_Struct).ucBufSize)
  1627. // {
  1628. // (* USARTx_RxBuf_Struct).ucBufCnt = (* USARTx_RxBuf_Struct).ucBufSize;
  1629. // (* USARTx_RxBuf_Struct).ucBufOvf = 1;
  1630. // }
  1631. // }
  1632. // }
  1633. // }
  1634. //}
  1635. //
  1636. //void USARTx_Tx_IRQ(USART_Buf_TypeDef *USARTx_TxBuf_Struct)
  1637. //{
  1638. //// if(USARTx_TxBuf_Struct->usart_periph->ctrl1_bit.tdbeien != RESET)
  1639. // if( (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))==DL_UART_MAIN_IIDX_EOT_DONE)
  1640. // // if( (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))== DL_UART_MAIN_IIDX_EOT_DONE)
  1641. // {
  1642. //// if(RESET != usart_flag_get(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_FLAG))
  1643. // // if(DL_UART_isTXFIFOEmpty(UART_HMI_INST) == TRUE)
  1644. // {
  1645. //
  1646. // if((* USARTx_TxBuf_Struct).ucBufCnt)
  1647. // {
  1648. // --(* USARTx_TxBuf_Struct).ucBufCnt;
  1649. // /* write one byte to the transmit data register */
  1650. //// usart_data_transmit(USARTx_TxBuf_Struct->usart_periph, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1651. // DL_UART_Main_transmitData(UART_HMI_INST, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1652. // if(++(* USARTx_TxBuf_Struct).ucBufRdInde >= (* USARTx_TxBuf_Struct).ucBufSize)
  1653. // {
  1654. // (* USARTx_TxBuf_Struct).ucBufRdInde = 0;
  1655. // }
  1656. // }
  1657. // else
  1658. // {
  1659. // /* Disable the UART Transmit Data Register Empty Interrupt */
  1660. //// usart_interrupt_enable(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_INT, FALSE);
  1661. // DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1662. // }
  1663. // }
  1664. // }
  1665. //}
  1666. unsigned uartcnt=0;
  1667. void USARTx_RxTX_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct,USART_Buf_TypeDef *USARTx_TxBuf_Struct,USART_FrameBuf_TypeDef *USART_RxFrameBuf_Struct)
  1668. {
  1669. UBYTE ucData;
  1670. switch (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))
  1671. {
  1672. case DL_UART_MAIN_IIDX_RX:
  1673. ucData = (UBYTE) DL_UART_Main_receiveDataBlocking(UART_HMI_INST);
  1674. USARTx_RxBuf_Struct->ul_UartComTimeOutCount = 0;
  1675. USART_RxFrameBuf_Struct->uwDataCount[USART_RxFrameBuf_Struct->ucBufWrIndex]++;
  1676. //if(((USARTx_RxBuf_Struct->ptUartHandel->Instance->SR) & 0x0000) == 0)
  1677. {
  1678. *((* USARTx_RxBuf_Struct).pcBufAddr + (* USARTx_RxBuf_Struct).ucBufWrInde) = ucData;
  1679. if(++(* USARTx_RxBuf_Struct).ucBufWrInde >= (* USARTx_RxBuf_Struct).ucBufSize)
  1680. {
  1681. (* USARTx_RxBuf_Struct).ucBufWrInde = 0;
  1682. }
  1683. if(++(* USARTx_RxBuf_Struct).ucBufCnt > (* USARTx_RxBuf_Struct).ucBufSize)
  1684. {
  1685. (* USARTx_RxBuf_Struct).ucBufCnt = (* USARTx_RxBuf_Struct).ucBufSize;
  1686. (* USARTx_RxBuf_Struct).ucBufOvf = 1;
  1687. }
  1688. }
  1689. break;
  1690. case DL_UART_MAIN_IIDX_EOT_DONE:
  1691. uartcnt++;
  1692. if((* USARTx_TxBuf_Struct).ucBufCnt)
  1693. {
  1694. --(* USARTx_TxBuf_Struct).ucBufCnt;
  1695. /* write one byte to the transmit data register */
  1696. // usart_data_transmit(USARTx_TxBuf_Struct->usart_periph, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1697. DL_UART_Main_transmitData(UART_HMI_INST, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1698. if(++(* USARTx_TxBuf_Struct).ucBufRdInde >= (* USARTx_TxBuf_Struct).ucBufSize)
  1699. {
  1700. (* USARTx_TxBuf_Struct).ucBufRdInde = 0;
  1701. }
  1702. }
  1703. else
  1704. {
  1705. /* Disable the UART Transmit Data Register Empty Interrupt */
  1706. // usart_interrupt_enable(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_INT, FALSE);
  1707. DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1708. }
  1709. //-----------
  1710. break;
  1711. default:
  1712. break;
  1713. }
  1714. }
  1715. //void USARTx_RxTX_IRQ(USART_Buf_TypeDef *USARTx_RxBuf_Struct,USART_Buf_TypeDef *USARTx_TxBuf_Struct)
  1716. //{
  1717. // static unsigned uartcnt=0;
  1718. // UBYTE ucData;
  1719. // switch (DL_UART_Main_getPendingInterrupt(UART_HMI_INST))
  1720. // {
  1721. // case DL_UART_MAIN_IIDX_RX:
  1722. // ucData = DL_UART_Main_receiveDataBlocking(UART_HMI_INST);
  1723. //
  1724. // *((* USARTx_RxBuf_Struct).pcBufAddr + (* USARTx_RxBuf_Struct).ucBufWrInde) = ucData;
  1725. // if(++(* USARTx_RxBuf_Struct).ucBufWrInde >= (* USARTx_RxBuf_Struct).ucBufSize)
  1726. // {
  1727. // (* USARTx_RxBuf_Struct).ucBufWrInde = 0;
  1728. // }
  1729. // if(++(* USARTx_RxBuf_Struct).ucBufCnt > (* USARTx_RxBuf_Struct).ucBufSize)
  1730. // {
  1731. // (* USARTx_RxBuf_Struct).ucBufCnt = (* USARTx_RxBuf_Struct).ucBufSize;
  1732. // (* USARTx_RxBuf_Struct).ucBufOvf = 1;
  1733. // }
  1734. //
  1735. // break;
  1736. // case DL_UART_MAIN_IIDX_EOT_DONE:
  1737. //
  1738. // uartcnt++;
  1739. // if((* USARTx_TxBuf_Struct).ucBufCnt)
  1740. // {
  1741. // --(* USARTx_TxBuf_Struct).ucBufCnt;
  1742. // /* write one byte to the transmit data register */
  1743. // // usart_data_transmit(USARTx_TxBuf_Struct->usart_periph, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1744. // DL_UART_Main_transmitData(UART_HMI_INST, *(USARTx_TxBuf_Struct->pcBufAddr + USARTx_TxBuf_Struct->ucBufRdInde));
  1745. // if(++(* USARTx_TxBuf_Struct).ucBufRdInde >= (* USARTx_TxBuf_Struct).ucBufSize)
  1746. // {
  1747. // (* USARTx_TxBuf_Struct).ucBufRdInde = 0;
  1748. // }
  1749. // }
  1750. // else
  1751. // {
  1752. // /* Disable the UART Transmit Data Register Empty Interrupt */
  1753. // // usart_interrupt_enable(USARTx_TxBuf_Struct->usart_periph, USART_TDBE_INT, FALSE);
  1754. // DL_UART_Main_disableInterrupt(UART_HMI_INST, DL_UART_MAIN_INTERRUPT_EOT_DONE );
  1755. // }
  1756. // break;
  1757. // default:
  1758. // break;
  1759. // }
  1760. //}
  1761. /************************ (C) END OF FILE *********************************/