AppFunc.c 80 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637
  1. /*
  2. * @Author : ChenJie
  3. * @Date : 2021-10-14 09:27:15
  4. * @Version : V3.0
  5. * @LastEditors : ChenJie
  6. * @LastEditTime : 2021-10-18 10:10:55
  7. * @Description : 应用层函数定义区,UTF-8
  8. * @FilePath : \PLAT\project\ec616_0h00\apps\qx_app\src\AppFunc.c
  9. */
  10. #include "AppFunc.h"
  11. #include "numeric.h"
  12. #include "hal_module_adapter.h"
  13. /**
  14. * @brief : 故障代码处理函数,将故障代码进行排序并输出
  15. * @param {*}
  16. * @return {*}
  17. */
  18. void ErrorNumHandleFunc(void)
  19. {
  20. UINT16 ErrorArrayBuffer[20] = {0};
  21. MEMCPY(ErrorArrayBuffer, sfmv_idx_fltCode, sfmd_num_fltNum * 2);
  22. BOOL isSorted;
  23. UINT16 temp = 0;
  24. for (UINT8 i = 0; i < sfmd_num_fltNum; i++)
  25. {
  26. isSorted = TRUE; //假设剩下的元素已经排序好了
  27. for (UINT8 j = 0; j < sfmd_num_fltNum - i; j++)
  28. {
  29. if (ErrorArrayBuffer[j] < ErrorArrayBuffer[j + 1])
  30. {
  31. temp = ErrorArrayBuffer[j];
  32. ErrorArrayBuffer[j] = ErrorArrayBuffer[j + 1];
  33. ErrorArrayBuffer[j + 1] = temp;
  34. isSorted = FALSE; //一旦需要交换数组元素,就说明剩下的元素没有排序好
  35. }
  36. }
  37. if (isSorted)
  38. break; //如果没有发生交换,说明剩下的元素已经排序好了
  39. }
  40. if (osOK == osMutexAcquire(Error_Mutex, 1))
  41. {
  42. for (UINT8 index = 0; index < 20; index++)
  43. {
  44. if (ErrorArrayBuffer[index] != 0)
  45. {
  46. PutErrorNum((UINT16 *)ErrorNum, ErrorNumLength, (ErrorArrayBuffer[index] % 10000U));
  47. }
  48. }
  49. }
  50. osMutexRelease(Error_Mutex);
  51. }
  52. /**
  53. * @brief : 租期到期日期计算函数
  54. * @param {UINT8} *StartTimeArray
  55. * @param {UINT16} rentalDays
  56. * @param {UINT8} *ExpiryTimeArray
  57. * @return {*}
  58. */
  59. void ExpiryTimeCal(UINT8 *StartTimeArray, UINT16 rentalDays, UINT8 *ExpiryTimeArray)
  60. {
  61. UINT8 lastday = 0;
  62. UINT8 year = 0, month = 0, hour = 0, minute = 0, second = 0;
  63. UINT16 day = 0;
  64. year = *(StartTimeArray + 0);
  65. month = *(StartTimeArray + 1);
  66. day = *(StartTimeArray + 2) + rentalDays;
  67. if (month == 1 || month == 3 || month == 5 || month == 7 || month == 8 || month == 10 || month == 12)
  68. {
  69. lastday = 31;
  70. }
  71. else if (month == 4 || month == 6 || month == 9 || month == 11)
  72. {
  73. lastday = 30;
  74. }
  75. else
  76. {
  77. if ((year % 400 == 0) || (year % 4 == 0 && year % 100 != 0))
  78. lastday = 29;
  79. else
  80. lastday = 28;
  81. }
  82. while (day > lastday)
  83. {
  84. day -= lastday;
  85. month += 1;
  86. if (month > 12)
  87. {
  88. month -= 12;
  89. year += 1;
  90. }
  91. if (month == 1 || month == 3 || month == 5 || month == 7 || month == 8 || month == 10 || month == 12)
  92. {
  93. lastday = 31;
  94. }
  95. else if (month == 4 || month == 6 || month == 9 || month == 11)
  96. {
  97. lastday = 30;
  98. }
  99. else
  100. {
  101. if ((year % 400 == 0) || (year % 4 == 0 && year % 100 != 0))
  102. lastday = 29;
  103. else
  104. lastday = 28;
  105. }
  106. }
  107. *(ExpiryTimeArray + 0) = year;
  108. *(ExpiryTimeArray + 1) = month;
  109. *(ExpiryTimeArray + 2) = day;
  110. *(ExpiryTimeArray + 3) = *(StartTimeArray + 3);
  111. *(ExpiryTimeArray + 4) = *(StartTimeArray + 4);
  112. *(ExpiryTimeArray + 5) = *(StartTimeArray + 5);
  113. return;
  114. }
  115. /**
  116. * @brief :租期到期判断函数
  117. * @param {*}
  118. * @return {*}
  119. */
  120. INT8 rentalEndDetectFunc(void)
  121. {
  122. OsaUtcTimeTValue TimeStracture;
  123. UTC8TimeType UTC8Time, ExpiryTime;
  124. UINT16 year;
  125. UINT8 month, day, hour, minute, sec;
  126. appGetSystemTimeUtcSync(&TimeStracture);
  127. year = (TimeStracture.UTCtimer1 & 0xffff0000) >> 16;
  128. month = (TimeStracture.UTCtimer1 & 0xff00) >> 8;
  129. day = TimeStracture.UTCtimer1 & 0xff;
  130. hour = (TimeStracture.UTCtimer2 & 0xff000000) >> 24;
  131. minute = (TimeStracture.UTCtimer2 & 0xff0000) >> 16;
  132. sec = (TimeStracture.UTCtimer2 & 0xff00) >> 8;
  133. UTCToBeijing((UTC8TimeType *)&UTC8Time, year, month, day, hour, minute, sec);
  134. if (UTC8Time.year > 2000)
  135. {
  136. #ifdef USING_PRINTF
  137. printf("retal Jug:%d %d %d %d,%d %d %d %d\n", UTC8Time.year, UTC8Time.month, UTC8Time.day, UTC8Time.hour, AppDataInfo.ExpiryTimeArray[0], AppDataInfo.ExpiryTimeArray[1], AppDataInfo.ExpiryTimeArray[2], AppDataInfo.ExpiryTimeArray[3]);
  138. #endif
  139. if (((UTC8Time.year - 0x07D0) & 0xFF) == AppDataInfo.ExpiryTimeArray[0]) //年份相等判定月份
  140. {
  141. if (UTC8Time.month == AppDataInfo.ExpiryTimeArray[1]) //月份相等判定日期
  142. {
  143. if (UTC8Time.day == AppDataInfo.ExpiryTimeArray[2]) //日期相等判定小时
  144. {
  145. // if(UTC8Time.hour<=AppDataInfo.ExpiryTimeArray[3])//小时相等不锁定,小时超出锁定
  146. // {
  147. // return 0;
  148. // }
  149. // else
  150. // {
  151. // return 1;
  152. // }
  153. return 0;
  154. }
  155. else if (UTC8Time.day > AppDataInfo.ExpiryTimeArray[2])
  156. {
  157. return 1;
  158. }
  159. else if (UTC8Time.day < AppDataInfo.ExpiryTimeArray[2])
  160. {
  161. return 0;
  162. }
  163. }
  164. else if (UTC8Time.month > AppDataInfo.ExpiryTimeArray[1]) //实际月份大于终止月份
  165. {
  166. return 1;
  167. }
  168. else if (UTC8Time.month < AppDataInfo.ExpiryTimeArray[1]) //实际月份小于终止月份
  169. {
  170. return 0;
  171. }
  172. }
  173. else if (((UTC8Time.year - 0x07D0) & 0xFF) > AppDataInfo.ExpiryTimeArray[0]) //实际年份大于终止年份
  174. {
  175. return 1;
  176. }
  177. else if (((UTC8Time.year - 0x07D0) & 0xFF) < AppDataInfo.ExpiryTimeArray[0]) //年比较,实际年份小于终止年份
  178. {
  179. return 0;
  180. }
  181. }
  182. else
  183. {
  184. return -1; //没有获取到时间返回
  185. }
  186. }
  187. /**
  188. * @brief :电池是否业务锁定判断函数(锁定放电)
  189. * @param {*}
  190. * @return {*}
  191. */
  192. void BattLockFunc(void)
  193. {
  194. if (AppDataInfo.RentalType == 0) //测试模式
  195. {
  196. ;
  197. }
  198. else if (AppDataInfo.RentalType == 1) //零售模式
  199. {
  200. if (AppDataInfo.RentalLock == TRUE)
  201. {
  202. AppDataInfo.UserLock = FALSE;
  203. AppDataInfo.RentalLock = FALSE;
  204. AppDataInfo.appDataModify = TRUE;
  205. }
  206. }
  207. else if (AppDataInfo.RentalType == 2) // 租赁模式
  208. {
  209. INT8 ret = -1;
  210. ret = rentalEndDetectFunc();
  211. if (ret == 1 && AppDataInfo.RentalLock == FALSE) //租期判定是否超期函数
  212. {
  213. #ifdef USING_PRINTF
  214. printf("retal lock,%d\n", ret);
  215. #endif
  216. AppDataInfo.RentalLock = TRUE;
  217. AppDataInfo.appDataModify = TRUE;
  218. }
  219. else if (ret == 0 && AppDataInfo.RentalLock == TRUE)
  220. {
  221. #ifdef USING_PRINTF
  222. printf("retal unlock,%d\n", ret);
  223. #endif
  224. AppDataInfo.RentalLock = FALSE;
  225. AppDataInfo.appDataModify = TRUE;
  226. AppDataInfo.UserLock = FALSE;
  227. }
  228. }
  229. if (AppDataInfo.BattForceLock == FALSE)
  230. {
  231. if (AppDataInfo.RentalLock == FALSE && AppDataInfo.UserLock == FALSE)
  232. {
  233. AppDataInfo.BattLock = FALSE;
  234. AppDataInfo.appDataModify = TRUE;
  235. }
  236. else if (AppDataInfo.RentalLock == TRUE || AppDataInfo.UserLock == TRUE)
  237. {
  238. AppDataInfo.BattLock = TRUE;
  239. AppDataInfo.appDataModify = TRUE;
  240. }
  241. }
  242. else
  243. {
  244. AppDataInfo.BattLock = TRUE;
  245. AppDataInfo.appDataModify = TRUE;
  246. }
  247. return;
  248. }
  249. /**
  250. * @brief : 电池工作模式延时处理函数
  251. * @param {UINT8} battWorkCurrentState
  252. * @return {*}
  253. */
  254. void BattWorkDelayFunc(UINT8 battWorkCurrentState)
  255. {
  256. static UINT16 workDelayCounter = 0;
  257. if (battWorkCurrentState == BATT_IDLE_SYM && BattWorkStateDelay == BATT_DISCHARGE_SYM) //从放电转静置 10s延时
  258. {
  259. workDelayCounter++;
  260. if (workDelayCounter >= 10)
  261. {
  262. workDelayCounter = 0;
  263. BattWorkStateDelay = battWorkCurrentState;
  264. }
  265. }
  266. else if (battWorkCurrentState == BATT_IDLE_SYM && BattWorkStateDelay == BATT_CHARGE_SYM) //从充电转静置10s延时
  267. {
  268. workDelayCounter++;
  269. if (workDelayCounter >= 10)
  270. {
  271. workDelayCounter = 0;
  272. BattWorkStateDelay = battWorkCurrentState;
  273. }
  274. }
  275. else if (battWorkCurrentState == BATT_DISCHARGE_SYM && BattWorkStateDelay != BATT_DISCHARGE_SYM) //从 充电或者静置 转放电 1s延时
  276. {
  277. workDelayCounter++;
  278. if (workDelayCounter >= 1)
  279. {
  280. workDelayCounter = 0;
  281. BattWorkStateDelay = battWorkCurrentState;
  282. }
  283. }
  284. else if (battWorkCurrentState == BATT_CHARGE_SYM && BattWorkStateDelay != BATT_CHARGE_SYM) //从 放电或者静置 转充电 30s延时
  285. {
  286. workDelayCounter++;
  287. if (workDelayCounter >= 30)
  288. {
  289. workDelayCounter = 0;
  290. BattWorkStateDelay = battWorkCurrentState;
  291. }
  292. }
  293. else
  294. {
  295. BattWorkStateDelay = battWorkCurrentState;
  296. workDelayCounter = 0;
  297. }
  298. return;
  299. }
  300. /**
  301. * @brief : R-T查表函数 (需优化)
  302. * @param {UINT32} R_value
  303. * @return {*}
  304. */
  305. UINT8 LookUpRTtable(UINT32 R_value)
  306. {
  307. UINT8 Temp_Table1[23] = {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22};
  308. UINT8 Temp_Table2[217] = {23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48,
  309. 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83,
  310. 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103, 104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114,
  311. 115, 116, 117, 118, 119, 120, 121, 122, 123, 124, 125, 126, 127, 128, 129, 130, 131, 132, 133, 134, 135, 136, 137, 138, 139, 140, 141,
  312. 142, 143, 144, 145, 146, 147, 148, 149, 150, 151, 152, 153, 154, 155, 156, 157, 158, 159, 160, 161, 162, 163, 164, 165, 166, 167, 168,
  313. 169, 170, 171, 172, 173, 174, 175, 176, 177, 178, 179, 180, 181, 182, 183, 184, 185, 186, 187, 188, 189, 190, 191, 192, 193, 194, 195,
  314. 196, 197, 198, 199, 200, 201, 202, 203, 204, 205, 206, 207, 208, 209, 210, 211, 212, 213, 214, 215, 216, 217, 218, 219, 220, 221, 222,
  315. 223, 224, 225, 226, 227, 228, 229, 230, 231, 232, 233, 234, 235, 236, 237, 238, 239};
  316. UINT32 R_Table1[23] = {202269, 191063, 180554, 170694, 161438, 152746, 144580, 136905, 129687, 122898, 116508,
  317. 110493, 104827, 99488, 94455, 89710, 85233, 81008, 77019, 73252, 69693, 66329, 63148};
  318. UINT16 R_Table2[217] = {
  319. 60140, 57293, 54599, 52049, 49633, 47343, 45174, 43117, 41166, 39315, 37558, 35891, 34307, 32802, 31373,
  320. 30014, 28722, 27493, 26324, 25211, 24152, 23144, 22183, 21268, 20395, 19564, 18771, 18015, 17293, 16604,
  321. 15947, 15319, 14720, 14147, 13600, 13077, 12577, 12098, 11641, 11203, 10784, 10383, 10000, 9632, 9280, 8942,
  322. 8619, 8309, 8012, 7727, 7454, 7191, 6940, 6698, 6466, 6244, 6030, 5825, 5627, 5438, 5255, 5080, 4911, 4749, 4593,
  323. 4443, 4299, 4160, 4026, 3898, 3773, 3654, 3539, 3428, 3321, 3218, 3119, 3023, 2931, 2841, 2755, 2672, 2592, 2515,
  324. 2441, 2369, 2299, 2232, 2167, 2104, 2044, 1985, 1928, 1874, 1821, 1769, 1720, 1672, 1626, 1581, 1537, 1495, 1455,
  325. 1415, 1377, 1340, 1305, 1270, 1236, 1204, 1172, 1142, 1112, 1083, 1056, 1029, 1002, 977, 952, 928, 905, 883, 861,
  326. 839, 819, 799, 779, 760, 742, 724, 707, 690, 674, 658, 642, 627, 613, 599, 585, 571, 558, 546, 533, 521, 509, 498, 487,
  327. 476, 466, 455, 445, 436, 426, 417, 408, 399, 391, 382, 374, 366, 359, 351, 344, 337, 330, 323, 316, 310, 304, 298, 292,
  328. 286, 280, 274, 269, 264, 259, 254, 249, 244, 239, 234, 230, 226, 221, 217, 213, 209, 205, 201, 198, 194, 190, 187, 183,
  329. 180, 177, 174, 171, 168, 165, 162, 159, 156, 153, 151, 148, 145, 143, 141, 138, 136, 133, 131, 129, 127, 125};
  330. if (R_value > R_Table2[0])
  331. {
  332. if (R_value <= R_Table1[22]) //判断是否超出表尾
  333. {
  334. return Temp_Table1[22];
  335. }
  336. else if (R_value >= R_Table1[0]) //判断是否超出表头
  337. {
  338. return Temp_Table1[0];
  339. }
  340. else
  341. {
  342. for (int i = 0; i < 23 - 1; i++)
  343. {
  344. if ((R_value <= R_Table1[i]) && (R_value > R_Table1[i + 1])) //中间判断
  345. {
  346. return Temp_Table1[i];
  347. }
  348. else
  349. {
  350. continue;
  351. }
  352. }
  353. }
  354. } //R-1
  355. else
  356. {
  357. if (R_value <= R_Table2[216]) //判断是否超出表尾
  358. {
  359. return Temp_Table2[216];
  360. }
  361. else if (R_value >= R_Table2[0]) //判断是否超出表头
  362. {
  363. return Temp_Table2[0];
  364. }
  365. else
  366. {
  367. for (int i = 0; i < 217 - 1; i++)
  368. {
  369. if ((R_value < R_Table2[i]) && (R_value >= R_Table2[i + 1])) //中间判断
  370. {
  371. return Temp_Table2[i + 1];
  372. }
  373. else
  374. {
  375. continue;
  376. }
  377. }
  378. }
  379. } //R-2
  380. }
  381. /**
  382. * @brief : tcp校验函数
  383. * @param {UINT8} *data
  384. * @param {UINT16} length
  385. * @return {*}
  386. */
  387. UINT8 bcc_chk(UINT8 *data, UINT16 length)
  388. {
  389. UINT8 bcc_chk_return = 0x00;
  390. UINT16 count = 0;
  391. while (count < length)
  392. {
  393. bcc_chk_return ^= data[count];
  394. count++;
  395. }
  396. return bcc_chk_return;
  397. }
  398. /**
  399. * @brief : 加热判断函数,根据当前状态判断是否需要改变状态
  400. * @param {UINT8} *heaterSwitch
  401. * @param {UINT8} HeatForceControl
  402. * @return {*}
  403. */
  404. BOOL BattHeaterSwitch(UINT8 *heaterSwitch, UINT8 HeatForceControl)
  405. {
  406. BOOL isNeedtoSwitch = FALSE;
  407. UINT8 currentSwitchState = 0;
  408. currentSwitchState = battHeatEnableState & 0x01;
  409. if (currentSwitchState == 0) //当前状态为关闭,判断是否应该开启
  410. {
  411. if (tmsd_st_heatAct == 1)
  412. {
  413. *heaterSwitch = 1;
  414. isNeedtoSwitch = true;
  415. }
  416. }
  417. else //当前状态为开启,判断是否应该关闭
  418. {
  419. if (tmsd_st_heatAct == 0)
  420. {
  421. *heaterSwitch = 0;
  422. isNeedtoSwitch = true;
  423. }
  424. }
  425. return isNeedtoSwitch;
  426. }
  427. /**
  428. * @brief : 蜂鸣器控制函数
  429. * @param {UINT8} BuzzerPeriod
  430. * @param {float} DutyRatio
  431. * @return {*}
  432. */
  433. void relayControlFunc(UINT8 BuzzerPeriod, float DutyRatio)
  434. {
  435. static UINT8 BuzzerTimer = 0;
  436. BuzzerTimer++;
  437. if (BuzzerTimer < (UINT8)(BuzzerPeriod * DutyRatio))
  438. {
  439. relayControl(TRUE);
  440. }
  441. else if (BuzzerTimer >= (UINT8)(BuzzerPeriod * DutyRatio) && BuzzerTimer < BuzzerPeriod)
  442. {
  443. relayControl(FALSE);
  444. }
  445. else
  446. {
  447. relayControl(FALSE);
  448. BuzzerTimer = 0;
  449. }
  450. }
  451. /**
  452. * @brief : LED控制函数,根据不同状态进行LED显示
  453. * @param {*}
  454. * @return {*}
  455. */
  456. void LEDDisplay(void)
  457. {
  458. UINT8 LedBattSoc = 0;
  459. LedBattSoc = socd_pct_bcuSoc / 10;
  460. static UINT8 currentState = 0;
  461. static UINT8 LightTimer = 0;
  462. static UINT8 ErrorLightTimer = 0;
  463. UINT8 LEDFlashPeriod = 10; //1000ms
  464. float DutyRatio = 0.4;
  465. LightTimer++;
  466. ErrorLightTimer++;
  467. #ifdef USING_PRINTF1
  468. printf("[%d]-%d-%d-%d\n", __LINE__, LightTimer, ErrorLightTimer, battSOC);
  469. #endif
  470. if (AppDataInfo.BattLock == TRUE) //电池整处于锁定状态
  471. {
  472. if (LightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  473. {
  474. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  475. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  476. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  477. NetSocDisplay(LED_SOC_3, LED_TURN_ON);
  478. FaultDisplay(LED_TURN_ON);
  479. }
  480. else if (LightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && LightTimer < LEDFlashPeriod)
  481. {
  482. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  483. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  484. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  485. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  486. FaultDisplay(LED_TURN_OFF);
  487. }
  488. else
  489. {
  490. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  491. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  492. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  493. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  494. FaultDisplay(LED_TURN_OFF);
  495. LightTimer = 0;
  496. }
  497. return;
  498. }
  499. else //电池未处于锁定状态
  500. {
  501. if (currentState != AppDataInfo.BattLock)
  502. {
  503. currentState = AppDataInfo.BattLock;
  504. LightTimer = 0;
  505. }
  506. else if (UartErrorFlag == 1) //电池未收到UART信息,出现Uart故障
  507. {
  508. if (LightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  509. {
  510. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  511. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  512. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  513. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  514. FaultDisplay(LED_TURN_ON);
  515. }
  516. else if (LightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && LightTimer < LEDFlashPeriod)
  517. {
  518. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  519. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  520. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  521. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  522. FaultDisplay(LED_TURN_OFF);
  523. }
  524. else
  525. {
  526. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  527. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  528. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  529. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  530. FaultDisplay(LED_TURN_OFF);
  531. LightTimer = 0;
  532. }
  533. return;
  534. }
  535. else if (UartRecvFlag == 1) //电池接收到UART信息,且正确运行
  536. {
  537. if (battWorkState == 0x02) //充电模式下,如果只有“SOC低故障”,那么就不显示故障灯 zhengchao20210713 add
  538. {
  539. if ((((battWarningState >> 10) & 0x01) == 0x01) && ((battWarningState & 0xFFFFFBFF) == 0x00))
  540. return;
  541. }
  542. if (getbit(sfmd_st_fltAct, 1) == 1) //电池存在故障
  543. {
  544. if (ErrorLightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  545. {
  546. FaultDisplay(LED_TURN_ON);
  547. }
  548. else if (ErrorLightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && ErrorLightTimer < LEDFlashPeriod)
  549. {
  550. FaultDisplay(LED_TURN_OFF);
  551. }
  552. else
  553. {
  554. FaultDisplay(LED_TURN_OFF);
  555. ErrorLightTimer = 0;
  556. }
  557. }
  558. else
  559. {
  560. FaultDisplay(LED_TURN_OFF);
  561. ErrorLightTimer = 0;
  562. }
  563. if (battWorkState == 0 || battWorkState == 1) //静置或放电状态
  564. {
  565. if (LedBattSoc <= 10)
  566. {
  567. if (LightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  568. {
  569. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  570. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  571. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  572. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  573. }
  574. else if (LightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && LightTimer < LEDFlashPeriod)
  575. {
  576. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  577. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  578. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  579. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  580. }
  581. else
  582. {
  583. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  584. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  585. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  586. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  587. LightTimer = 0;
  588. }
  589. }
  590. else if (LedBattSoc > 10 && LedBattSoc <= 25)
  591. {
  592. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  593. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  594. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  595. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  596. LightTimer = 0;
  597. }
  598. else if (LedBattSoc > 25 && LedBattSoc <= 50)
  599. {
  600. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  601. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  602. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  603. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  604. LightTimer = 0;
  605. }
  606. else if (LedBattSoc > 50 && LedBattSoc <= 75)
  607. {
  608. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  609. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  610. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  611. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  612. LightTimer = 0;
  613. }
  614. else if (LedBattSoc > 75 && LedBattSoc <= 100)
  615. {
  616. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  617. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  618. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  619. NetSocDisplay(LED_SOC_3, LED_TURN_ON);
  620. LightTimer = 0;
  621. }
  622. }
  623. else if (battWorkState == 2)
  624. {
  625. if (LedBattSoc <= 25)
  626. {
  627. if (LightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  628. {
  629. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  630. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  631. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  632. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  633. }
  634. else if (LightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && LightTimer < LEDFlashPeriod)
  635. {
  636. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  637. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  638. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  639. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  640. }
  641. else
  642. {
  643. NetSocDisplay(LED_SOC_0, LED_TURN_OFF);
  644. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  645. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  646. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  647. LightTimer = 0;
  648. }
  649. }
  650. else if (LedBattSoc > 25 && LedBattSoc <= 50)
  651. {
  652. if (LightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  653. {
  654. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  655. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  656. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  657. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  658. }
  659. else if (LightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && LightTimer < LEDFlashPeriod)
  660. {
  661. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  662. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  663. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  664. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  665. }
  666. else
  667. {
  668. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  669. NetSocDisplay(LED_SOC_1, LED_TURN_OFF);
  670. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  671. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  672. LightTimer = 0;
  673. }
  674. }
  675. else if (LedBattSoc > 50 && LedBattSoc <= 75)
  676. {
  677. if (LightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  678. {
  679. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  680. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  681. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  682. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  683. }
  684. else if (LightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && LightTimer < LEDFlashPeriod)
  685. {
  686. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  687. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  688. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  689. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  690. }
  691. else
  692. {
  693. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  694. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  695. NetSocDisplay(LED_SOC_2, LED_TURN_OFF);
  696. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  697. LightTimer = 0;
  698. }
  699. }
  700. else if (LedBattSoc > 75 && LedBattSoc <= 97)
  701. {
  702. if (LightTimer < (UINT8)(LEDFlashPeriod * DutyRatio))
  703. {
  704. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  705. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  706. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  707. NetSocDisplay(LED_SOC_3, LED_TURN_ON);
  708. }
  709. else if (LightTimer >= (UINT8)(LEDFlashPeriod * DutyRatio) && LightTimer < LEDFlashPeriod)
  710. {
  711. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  712. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  713. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  714. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  715. }
  716. else
  717. {
  718. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  719. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  720. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  721. NetSocDisplay(LED_SOC_3, LED_TURN_OFF);
  722. LightTimer = 0;
  723. }
  724. }
  725. else if (LedBattSoc > 97 && LedBattSoc <= 100)
  726. {
  727. NetSocDisplay(LED_SOC_0, LED_TURN_ON);
  728. NetSocDisplay(LED_SOC_1, LED_TURN_ON);
  729. NetSocDisplay(LED_SOC_2, LED_TURN_ON);
  730. NetSocDisplay(LED_SOC_3, LED_TURN_ON);
  731. }
  732. }
  733. }
  734. }
  735. }
  736. /**
  737. * @brief : 串口数据解码函数
  738. * @param {UINT8} *dataPtr
  739. * @return {*}
  740. */
  741. BOOL uartBattInfoDecode(UINT8 *dataPtr)
  742. {
  743. UINT8 i = 0, temp = 0;
  744. INT8 BattCurrentNegFlag = 1;
  745. UINT8 TEMP_NUM = 0;
  746. UINT16 Batt_current;
  747. UINT8 BATT_CELL_VOL_NUM = 0, BATT_TEMP_NUM = 0;
  748. UINT32 Battsumvoltage = 0;
  749. BATT_CELL_VOL_NUM = (dataPtr[(0x00) * 2] << 8) | (dataPtr[(0x00) * 2 + 1]);
  750. BATT_TEMP_NUM = ((dataPtr[(0x01) * 2] << 8) | (dataPtr[(0x01) * 2 + 1])) - BMS_OTHER_TEMP;
  751. if ((AppDataInfo.BattCellCount != BATT_CELL_VOL_NUM || AppDataInfo.BattTempCount != BATT_TEMP_NUM) && (BATT_CELL_VOL_NUM != 0) && (BATT_TEMP_NUM != 0))
  752. {
  753. AppDataInfo.appDataModify = TRUE;
  754. AppDataInfo.BattCellCount = BATT_CELL_VOL_NUM;
  755. AppDataInfo.BattTempCount = BATT_TEMP_NUM;
  756. }
  757. else
  758. {
  759. BATT_CELL_VOL_NUM = AppDataInfo.BattCellCount;
  760. BATT_TEMP_NUM = AppDataInfo.BattTempCount;
  761. }
  762. #ifdef USING_PRINTF1
  763. printf("BattCellCount:%d,BATT_CELL_VOL_NUM:%d ", AppDataInfo.BattCellCount, BATT_CELL_VOL_NUM);
  764. printf("BattTempCount:%d,BATT_TEMP_NUM:%d ", AppDataInfo.BattTempCount, BATT_TEMP_NUM);
  765. #endif
  766. for (i = 0; i < BATT_CELL_VOL_NUM; i++)
  767. {
  768. battCellU[i] = (dataPtr[(0x02 + i) * 2] << 8) | dataPtr[(0x02 + i) * 2 + 1];
  769. Battsumvoltage = Battsumvoltage + battCellU[i];
  770. }
  771. battWorkState = (dataPtr[(0x03 + BATT_CELL_VOL_NUM) * 2 + 1]) & 0x03; //电池状态(原始数据),0表示静置,1表示放电,2表示充电
  772. TEMP_NUM = BATT_TEMP_NUM + BMS_OTHER_TEMP;
  773. for (i = 0; i < BATT_TEMP_NUM; i++)
  774. {
  775. battCellTemp[i] = dataPtr[(0x06 + BATT_CELL_VOL_NUM + i) * 2 + 1];
  776. }
  777. avrgCellVol = Battsumvoltage / BATT_CELL_VOL_NUM;
  778. MOSTemp = dataPtr[(0x06 + BATT_CELL_VOL_NUM + BATT_TEMP_NUM) * 2 + 1];
  779. packTemp = dataPtr[(0x06 + BATT_CELL_VOL_NUM + BATT_TEMP_NUM + 1) * 2 + 1];
  780. chargerConnectState = (dataPtr[(0x03 + BATT_CELL_VOL_NUM) * 2 + 1] >> 2) & 0x01; //充电器连接状态,0表示未连接,1表示已连接
  781. Batt_current = (dataPtr[(0x02 + BATT_CELL_VOL_NUM) * 2] << 8) | (dataPtr[(0x02 + BATT_CELL_VOL_NUM) * 2 + 1]);
  782. //原始数据:充电为负,放电为正
  783. if (battWorkState == 0x02) //充电过程
  784. {
  785. if (Batt_current > 0x8000) // 数据为负
  786. {
  787. //求补码,结果为负
  788. Batt_current = (UINT16)((UINT16)(~(Batt_current)) + 1);
  789. Batt_current = Batt_current / 10;
  790. BattCurrentNegFlag = -1;
  791. }
  792. else
  793. {
  794. //源码,结果为负
  795. Batt_current = Batt_current / 10;
  796. BattCurrentNegFlag = -1;
  797. }
  798. }
  799. else //放电过程
  800. {
  801. if (Batt_current > 0x8000) // 数据为负
  802. {
  803. //求补码,结果为正
  804. Batt_current = (UINT16)((UINT16)(~(Batt_current)) + 1);
  805. Batt_current = Batt_current / 10;
  806. BattCurrentNegFlag = 1;
  807. }
  808. else
  809. {
  810. //源码,结果为正
  811. Batt_current = Batt_current / 10;
  812. BattCurrentNegFlag = 1;
  813. }
  814. }
  815. battI = Batt_current * BattCurrentNegFlag + 0x2710;
  816. //bit0 ~ bit31 represent cell0 ~ cell31
  817. battBalanceoInfo = dataPtr[(0x06 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1] | (dataPtr[(0x06 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2] << 8) + (dataPtr[(0x07 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1] << 16) | (dataPtr[(0x07 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2] << 24);
  818. bmsHwVersion = dataPtr[(0x08 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1];
  819. bmsSwVersion = dataPtr[(0x08 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2];
  820. #ifdef USING_PRINTF1
  821. printf("[%d]-%x\n", __LINE__, (dataPtr[(0x09 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1]));
  822. printf("[%d]-%x\n", __LINE__, (dataPtr[(0x1B + BATT_CELL_VOL_NUM + TEMP_NUM) * 2]));
  823. #endif
  824. temp = ((dataPtr[(0x09 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1]) >> 1) & 0x03;
  825. battMOSSwitchState = ((temp & 0x01) << 1) | ((temp & 0x02) >> 1);
  826. if (AppDataInfo.BattLock == TRUE)
  827. {
  828. battMOSSwitchState = battMOSSwitchState | (0x01 << 2);
  829. }
  830. else
  831. {
  832. battMOSSwitchState = battMOSSwitchState | (0x00 << 2);
  833. }
  834. battWarningState = (dataPtr[(0x09 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 0] << 16) | (dataPtr[(0x0A + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 0] << 8) | (dataPtr[(0x0A + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1]);
  835. battProtectState = (dataPtr[(0x03 + BATT_CELL_VOL_NUM) * 2 + 0] << 24) | (dataPtr[(0x04 + BATT_CELL_VOL_NUM) * 2 + 0] << 16) | (dataPtr[(0x04 + BATT_CELL_VOL_NUM) * 2 + 1] << 8) | (dataPtr[(0x05 + BATT_CELL_VOL_NUM) * 2 + 1]);
  836. battSOC = dataPtr[(0x0B + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1];
  837. battSOH = dataPtr[(0x0C + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1];
  838. Battdesigncap = (dataPtr[(0x0E + BATT_CELL_VOL_NUM + TEMP_NUM) * 2]) << 24 | (dataPtr[(0x0E + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1]) << 16 | (dataPtr[(0x0F + BATT_CELL_VOL_NUM + TEMP_NUM) * 2]) << 8 | (dataPtr[(0x0F + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1]);
  839. battPackVol = ((dataPtr[(0x18 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2]) << 8 | (dataPtr[(0x18 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1])) / 10; //uint 100mV
  840. maxCellVol = (dataPtr[(0x19 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2] << 8) | dataPtr[(0x19 + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1];
  841. minCellVol = (dataPtr[(0x1A + BATT_CELL_VOL_NUM + TEMP_NUM) * 2] << 8) | dataPtr[(0x1A + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1];
  842. battHeatEnableState = dataPtr[(0x1C + BATT_CELL_VOL_NUM + TEMP_NUM) * 2 + 1] & 0x01;
  843. maxCellTemp = 0x00;
  844. minCellTemp = 0xFF;
  845. AvgBattTemp = 0;
  846. UINT16 SumBattTemp = 0;
  847. for (i = 0; i < BATT_TEMP_NUM; i++)
  848. {
  849. SumBattTemp = SumBattTemp + battCellTemp[i];
  850. maxCellTemp = max(maxCellTemp, battCellTemp[i]);
  851. minCellTemp = min(minCellTemp, battCellTemp[i]);
  852. }
  853. AvgBattTemp = (SumBattTemp - maxCellTemp - minCellTemp) / (BATT_TEMP_NUM - 2);
  854. nbSwVersion = APPSWVERSION;
  855. nbHwVersion = HWVERSION;
  856. return true;
  857. }
  858. /**
  859. * @brief : 获取故障码函数,从故障数组中获取故障码,并将之前的故障码向前移动
  860. * @param {UINT16} *ErrorArray
  861. * @param {UINT8} Errorlen
  862. * @return {*}
  863. */
  864. UINT16 GetErrorNum(UINT16 *ErrorArray, UINT8 Errorlen)
  865. {
  866. UINT16 OutNum;
  867. OutNum = *(ErrorArray);
  868. for (UINT8 i = 0; i < Errorlen - 1; i++)
  869. {
  870. *(ErrorArray + i) = *(ErrorArray + i + 1);
  871. if (*(ErrorArray + i + 1) == 0)
  872. break;
  873. }
  874. return OutNum;
  875. }
  876. /**
  877. * @brief : 故障码注入函数,将故障码写入到故障数组中,如果存在则不写入,如果存在则不写入
  878. * @param {UINT16} *ErrorArray
  879. * @param {UINT8} Errorlen
  880. * @param {UINT16} ErrorNum
  881. * @return {*}
  882. */
  883. UINT8 PutErrorNum(UINT16 *ErrorArray, UINT8 Errorlen, UINT16 ErrorNum)
  884. {
  885. for (UINT8 i = 0; i < Errorlen; i++)
  886. {
  887. if (*(ErrorArray + i) == 0)
  888. {
  889. *(ErrorArray + i) = ErrorNum;
  890. return 0;
  891. }
  892. else
  893. {
  894. if (*(ErrorArray + i) == ErrorNum)
  895. {
  896. return 1;
  897. }
  898. else
  899. {
  900. continue;
  901. }
  902. }
  903. }
  904. return 2;
  905. }
  906. /**
  907. * @brief : App运行数据存储函数
  908. * @param {*}
  909. * @return {*}
  910. */
  911. void SaveAppData(void)
  912. {
  913. OSAFILE fp = PNULL;
  914. UINT32 writeCount = 0;
  915. AppDataHeader AppDataHr;
  916. fp = OsaFopen(APP_DATAINFO_FILE_NAME, "wb"); //read & write
  917. if (OsaFseek(fp, 0, SEEK_SET) != 0)
  918. {
  919. #ifdef USING_PRINTF
  920. printf("Seek file failed [%d] \r\n", __LINE__);
  921. #endif
  922. OsaFclose(fp);
  923. return;
  924. }
  925. if (fp == PNULL)
  926. {
  927. #ifdef USING_PRINTF
  928. printf(" NVM, can't open/create NVM: 'qxappconfig.nvm', save NVM failed\n");
  929. #endif
  930. return;
  931. }
  932. AppDataHr.fileBodySize = sizeof(AppDataInfo);
  933. AppDataHr.checkSum = OsaCalcCrcValue((UINT8 *)&AppDataInfo, sizeof(AppDataInfo));
  934. writeCount = OsaFwrite(&AppDataHr, sizeof(AppDataHr), 1, fp);
  935. if (writeCount != 1)
  936. {
  937. #ifdef USING_PRINTF
  938. printf(" NVM: 'qxappconfig.nvm', write the file header failed\n");
  939. #endif
  940. OsaFclose(fp);
  941. return;
  942. }
  943. AppDataInfo.appDataModify = FALSE;
  944. writeCount = OsaFwrite(&AppDataInfo, sizeof(AppDataInfo), 1, fp);
  945. if (writeCount != 1)
  946. {
  947. #ifdef USING_PRINTF
  948. printf(" NVM: 'qxappconfig.nvm', write the file body failed\n");
  949. #endif
  950. OsaFclose(fp);
  951. return;
  952. }
  953. OsaFclose(fp);
  954. return;
  955. }
  956. /**
  957. * @brief : bcu数据存储函数
  958. * @param {*}
  959. * @return {*}
  960. */
  961. void SaveBcuData(void)
  962. {
  963. OSAFILE fp = PNULL;
  964. UINT32 writeCount = 0;
  965. BcuDataHeader BcuDataHr;
  966. fp = OsaFopen(BCU_DATAINFO_FILE_NAME, "wb"); //read & write
  967. if (OsaFseek(fp, 0, SEEK_SET) != 0)
  968. {
  969. OsaFclose(fp);
  970. return;
  971. }
  972. if (fp == PNULL)
  973. {
  974. return;
  975. }
  976. BcuDataHr.fileBodySize = sizeof(BcuDataInfo);
  977. BcuDataHr.checkSum = OsaCalcCrcValue((UINT8 *)&BcuDataInfo, sizeof(BcuDataInfo));
  978. writeCount = OsaFwrite(&BcuDataHr, sizeof(BcuDataHr), 1, fp);
  979. if (writeCount != 1)
  980. {
  981. OsaFclose(fp);
  982. return;
  983. }
  984. BcuDataInfo.appDataModify = FALSE;
  985. writeCount = OsaFwrite(&BcuDataInfo, sizeof(BcuDataInfo), 1, fp);
  986. if (writeCount != 1)
  987. {
  988. OsaFclose(fp);
  989. return;
  990. }
  991. OsaFclose(fp);
  992. return;
  993. }
  994. /**
  995. * @brief : 运行数据加载函数,将运行数据进行加载,若新增了数据项,则保持前面数据项不动
  996. * @param {*}
  997. * @return {*}
  998. */
  999. void LoadAppData(void)
  1000. {
  1001. OSAFILE fp = PNULL;
  1002. UINT32 readCount = 0;
  1003. UINT8 crcCheck = 0;
  1004. void *pReadAppConfig = (void *)&AppDataInfo;
  1005. AppDataHeader AppDataHr;
  1006. fp = OsaFopen(APP_DATAINFO_FILE_NAME, "rb"); //read only
  1007. if (fp == PNULL)
  1008. {
  1009. #ifdef USING_PRINTF
  1010. printf(" NVM, can't open NVM: 'qxappData.nvm', use the defult value\n");
  1011. #endif
  1012. setDefaultAppDataInfo();
  1013. SaveAppData();
  1014. return;
  1015. }
  1016. readCount = OsaFread(&AppDataHr, sizeof(AppDataHr), 1, fp);
  1017. UINT8 readtimes = 0;
  1018. while (readCount != 1 && readtimes <= 5)
  1019. {
  1020. readtimes++;
  1021. readCount = OsaFread(&AppDataHr, sizeof(AppDataHr), 1, fp);
  1022. osDelay(10);
  1023. }
  1024. if (readtimes > 5)
  1025. {
  1026. OsaFclose(fp);
  1027. setDefaultAppDataInfo();
  1028. SaveAppData();
  1029. return;
  1030. }
  1031. if (AppDataHr.fileBodySize == sizeof(AppDataInfo)) //结构体数据没变动,可直接读出
  1032. {
  1033. readCount = OsaFread(pReadAppConfig, AppDataHr.fileBodySize, 1, fp);
  1034. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1035. readtimes = 0;
  1036. while (readtimes <= 5 && readCount != 1)
  1037. {
  1038. readtimes++;
  1039. readCount = OsaFread(pReadAppConfig, AppDataHr.fileBodySize, 1, fp);
  1040. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1041. }
  1042. }
  1043. else
  1044. {
  1045. setDefaultAppDataInfo();
  1046. readCount = OsaFread(pReadAppConfig, AppDataHr.fileBodySize, 1, fp);
  1047. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1048. readtimes = 0;
  1049. while (readtimes <= 5 && readCount != 1)
  1050. {
  1051. readtimes++;
  1052. readCount = OsaFread(pReadAppConfig, AppDataHr.fileBodySize, 1, fp);
  1053. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1054. }
  1055. SaveAppData();
  1056. #ifdef USING_PRINTF
  1057. printf(" Struct update\n");
  1058. #endif
  1059. }
  1060. OsaFclose(fp);
  1061. return;
  1062. }
  1063. /**
  1064. * @brief : Bcu存储数据加载函数
  1065. * @param {*}
  1066. * @return {*}
  1067. */
  1068. void LoadBcuData(void)
  1069. {
  1070. OSAFILE fp = PNULL;
  1071. UINT32 readCount = 0;
  1072. UINT8 crcCheck = 0;
  1073. void *pReadAppConfig = (void *)&BcuDataInfo;
  1074. BcuDataHeader BcuDataHr;
  1075. fp = OsaFopen(BCU_DATAINFO_FILE_NAME, "rb"); //read only
  1076. if (fp == PNULL)
  1077. {
  1078. #ifdef USING_PRINTF
  1079. printf(" NVM, can't open NVM: 'qxappData.nvm', use the defult value\n");
  1080. #endif
  1081. setDefaultBcuDataInfo();
  1082. SaveBcuData();
  1083. return;
  1084. }
  1085. readCount = OsaFread(&BcuDataHr, sizeof(BcuDataHr), 1, fp);
  1086. UINT8 readtimes = 0;
  1087. while (readCount != 1 && readtimes <= 5)
  1088. {
  1089. readtimes++;
  1090. readCount = OsaFread(&BcuDataHr, sizeof(BcuDataHr), 1, fp);
  1091. osDelay(10);
  1092. }
  1093. if (readtimes > 5)
  1094. {
  1095. OsaFclose(fp);
  1096. setDefaultBcuDataInfo();
  1097. SaveBcuData();
  1098. return;
  1099. }
  1100. if (BcuDataHr.fileBodySize == sizeof(BcuDataInfo)) //结构体数据没变动,可直接读出
  1101. {
  1102. readCount = OsaFread(pReadAppConfig, BcuDataHr.fileBodySize, 1, fp);
  1103. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1104. readtimes = 0;
  1105. while (readtimes <= 5 && readCount != 1)
  1106. {
  1107. readtimes++;
  1108. readCount = OsaFread(pReadAppConfig, BcuDataHr.fileBodySize, 1, fp);
  1109. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1110. }
  1111. }
  1112. else
  1113. {
  1114. setDefaultBcuDataInfo();
  1115. readCount = OsaFread(pReadAppConfig, BcuDataHr.fileBodySize, 1, fp);
  1116. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1117. readtimes = 0;
  1118. while (readtimes <= 5 && readCount != 1)
  1119. {
  1120. readtimes++;
  1121. readCount = OsaFread(pReadAppConfig, BcuDataHr.fileBodySize, 1, fp);
  1122. //crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1123. }
  1124. SaveBcuData();
  1125. #ifdef USING_PRINTF
  1126. printf(" Struct update\n");
  1127. #endif
  1128. }
  1129. OsaFclose(fp);
  1130. return;
  1131. }
  1132. /**
  1133. * @brief : App配置文件保存函数
  1134. * @param {*}
  1135. * @return {*}
  1136. */
  1137. void SaveAppConfig(void)
  1138. {
  1139. OSAFILE fp = PNULL;
  1140. UINT32 writeCount = 0;
  1141. AppConfigDataHeader AppConfigHr; //4 bytes
  1142. /*
  1143. * open the NVM file
  1144. */
  1145. AppNVMData.appDataModify = FALSE;
  1146. fp = OsaFopen(APP_CONFIG_FILE_NAME, "wb"); //read & write
  1147. if (OsaFseek(fp, 0, SEEK_SET) != 0)
  1148. {
  1149. #ifdef USING_PRINTF
  1150. printf("Seek file failed [%d] \r\n", __LINE__);
  1151. #endif
  1152. OsaFclose(fp);
  1153. return;
  1154. }
  1155. if (fp == PNULL)
  1156. {
  1157. #ifdef USING_PRINTF
  1158. printf(" NVM, can't open/create NVM: 'qxappconfig.nvm', save NVM failed\n");
  1159. #endif
  1160. return;
  1161. }
  1162. /*
  1163. * write the header
  1164. */
  1165. AppConfigHr.fileBodySize = sizeof(AppNVMData);
  1166. AppConfigHr.checkSum = OsaCalcCrcValue((UINT8 *)&AppNVMData, sizeof(AppNVMData));
  1167. writeCount = OsaFwrite(&AppConfigHr, sizeof(AppConfigHr), 1, fp);
  1168. if (writeCount != 1)
  1169. {
  1170. #ifdef USING_PRINTF
  1171. printf(" NVM: 'qxappconfig.nvm', write the file header failed\n");
  1172. #endif
  1173. OsaFclose(fp);
  1174. return;
  1175. }
  1176. /*
  1177. * write the file body
  1178. */
  1179. writeCount = OsaFwrite(&AppNVMData, sizeof(AppNVMData), 1, fp);
  1180. if (writeCount != 1)
  1181. {
  1182. #ifdef USING_PRINTF
  1183. printf(" NVM: 'qxappconfig.nvm', write the file body failed\n");
  1184. #endif
  1185. }
  1186. OsaFclose(fp);
  1187. return;
  1188. }
  1189. /**
  1190. * @brief : App配置文件加载函数
  1191. * @param {*}
  1192. * @return {*}
  1193. */
  1194. void LoadAppConfig(void)
  1195. {
  1196. OSAFILE fp = PNULL;
  1197. UINT32 readCount = 0;
  1198. AppConfigDataHeader AppConfigHr;
  1199. UINT8 crcCheck = 0;
  1200. void *pReadAppConfig = (void *)&AppNVMData;
  1201. /*
  1202. * open the NVM file
  1203. */
  1204. fp = OsaFopen(APP_CONFIG_FILE_NAME, "rb"); //read only
  1205. if (fp == PNULL)
  1206. {
  1207. #ifdef USING_PRINTF
  1208. printf(" NVM, can't open NVM: 'qxappConfig.nvm', use the defult value\n");
  1209. #endif
  1210. setDefaultAppConfigData();
  1211. SaveAppConfig();
  1212. return;
  1213. }
  1214. /*
  1215. * read the file header
  1216. */
  1217. readCount = OsaFread(&AppConfigHr, sizeof(AppConfigHr), 1, fp);
  1218. UINT8 readtimes = 0;
  1219. while (readCount != 1 && readtimes <= 5)
  1220. {
  1221. #ifdef USING_PRINTF
  1222. printf("NVM: 'qxappconfig.nvm', can't read header, return: %d, use the defult value \n");
  1223. #endif
  1224. readtimes++;
  1225. readCount = OsaFread(&AppConfigHr, sizeof(AppConfigHr), 1, fp);
  1226. osDelay(10);
  1227. }
  1228. if (readtimes > 5)
  1229. {
  1230. OsaFclose(fp);
  1231. setDefaultAppConfigData();
  1232. SaveAppConfig();
  1233. return;
  1234. }
  1235. if (AppConfigHr.fileBodySize != sizeof(AppNVMData)) //file version is the same, but NVM file size not right
  1236. {
  1237. #ifdef USING_PRINTF
  1238. printf("MW NVM: 'midwareconfig.nvm', file body size not right: (%u/%u), use the defult value",
  1239. AppConfigHr.fileBodySize, sizeof(AppNVMData));
  1240. #endif
  1241. OsaFclose(fp);
  1242. setDefaultAppConfigData();
  1243. SaveAppConfig();
  1244. return;
  1245. }
  1246. /*
  1247. * read the file body
  1248. */
  1249. readCount = OsaFread(pReadAppConfig, AppConfigHr.fileBodySize, 1, fp);
  1250. crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1251. readtimes = 0;
  1252. //while (readtimes<=5 && crcCheck != AppConfigHr.checkSum)
  1253. while (readtimes <= 5 && readCount != 1 && crcCheck != AppConfigHr.checkSum)
  1254. {
  1255. readtimes++;
  1256. readCount = OsaFread(pReadAppConfig, AppConfigHr.fileBodySize, 1, fp);
  1257. crcCheck = OsaCalcCrcValue((UINT8 *)pReadAppConfig, sizeof(AppNVMData));
  1258. }
  1259. if (readtimes > 5)
  1260. {
  1261. #ifdef USING_PRINTF
  1262. printf(" NVM: 'qxappconfig.nvm', can't read body, or body not right, (%u/%u), use the defult value\n ",
  1263. crcCheck, AppConfigHr.checkSum);
  1264. #endif
  1265. OsaFclose(fp);
  1266. setDefaultAppConfigData();
  1267. SaveAppConfig();
  1268. return;
  1269. }
  1270. OsaFclose(fp);
  1271. return;
  1272. }
  1273. /**
  1274. * @brief : App配置文件初始化函数
  1275. * @param {*}
  1276. * @return {*}
  1277. */
  1278. static void setDefaultAppConfigData(void)
  1279. {
  1280. UINT8 i = 0;
  1281. memset(&AppNVMData, 0x00, sizeof(AppConfigDataType));
  1282. AppNVMData.appDataModify = TRUE; //数据更改标志位
  1283. memcpy(AppNVMData.battSN, DEFAULT_SN, BATT_SN_LEN);
  1284. AppNVMData.isBattLocked = 0;
  1285. AppNVMData.reserved1 = 0;
  1286. AppNVMData.reserved2 = 0;
  1287. AppNVMData.reserved3 = 0;
  1288. AppNVMData.reserved4 = 0;
  1289. AppNVMData.reserved5 = 0;
  1290. AppNVMData.reserved6 = 0;
  1291. AppNVMData.reserved7 = 0;
  1292. AppNVMData.reserved8 = 0;
  1293. AppNVMData.EOLState = EOLSTATE;
  1294. return;
  1295. }
  1296. /**
  1297. * @brief : App数据初始化函数
  1298. * @param {*}
  1299. * @return {*}
  1300. */
  1301. static void setDefaultAppDataInfo(void)
  1302. {
  1303. memset(&AppDataInfo, 0x00, sizeof(AppDataInfo));
  1304. AppDataInfo.appDataModify = false;
  1305. AppDataInfo.BattCellCount = 17;
  1306. AppDataInfo.BattTempCount = 5;
  1307. AppDataInfo.BattInfoSendFreqHigh = 10;
  1308. AppDataInfo.BattInfoSendFreqNomal = 30;
  1309. AppDataInfo.BattInfoSendFreqLow = 60;
  1310. AppDataInfo.PosInfoSendFreqHigh = 10;
  1311. AppDataInfo.PosInfoSendFreqNormal = 30;
  1312. AppDataInfo.PosInfoSendFreqLow = 60;
  1313. AppDataInfo.AccMileage = 0;
  1314. AppDataInfo.SysReStartCount = 0;
  1315. AppDataInfo.RelayControl = 0;
  1316. AppDataInfo.BattForceLock = 0;
  1317. AppDataInfo.BattLock = 0;
  1318. AppDataInfo.BattStolenFlag = 0;
  1319. AppDataInfo.UserLock = 0; // 用户锁锁定
  1320. AppDataInfo.RentalLock = 0; //租期锁锁定
  1321. AppDataInfo.RentalType = 0; //租期类型
  1322. memset(AppDataInfo.ExpiryTimeArray, 0x00, 6); //超期时间
  1323. AppDataInfo.ErrorMsg = 0;
  1324. return;
  1325. }
  1326. /**
  1327. * @brief : BCU存储量初始化函数
  1328. * @param {*}
  1329. * @return {*}
  1330. */
  1331. static void setDefaultBcuDataInfo(void)
  1332. {
  1333. memset(&BcuDataInfo, 0x00, sizeof(BcuDataInfo));
  1334. BcuDataInfo.appDataModify = false;
  1335. memset(BcuDataInfo.blcv_Q_totalCpE, 0x00, 28 * sizeof(UINT32));
  1336. memset(BcuDataInfo.blcv_Q_reqCpE, 0x00, 28 * sizeof(UINT16));
  1337. BcuDataInfo.socd_pct_bcuSocE = 1200;
  1338. BcuDataInfo.socd_pct_battSocE = 1200;
  1339. BcuDataInfo.sohd_tm_chrgStartStatE = 0;
  1340. BcuDataInfo.sohd_flg_chrgEndE = 0;
  1341. BcuDataInfo.sohv_Q_cellCapArrE[28];
  1342. memset(BcuDataInfo.sohv_Q_cellCapArrE, 0, 28 * sizeof(UINT16));
  1343. memset(BcuDataInfo.sohv_V_chrgStartStatE, 0, 28 * sizeof(UINT16));
  1344. BcuDataInfo.sohd_Q_chrgE = 0;
  1345. memset(BcuDataInfo.sohv_Q_packCapArrE, 0, 10 * sizeof(UINT16));
  1346. BcuDataInfo.sfmd_flg_mainCirClosFltE = 0;
  1347. BcuDataInfo.sfmd_flg_heatCirClosFltE = 0;
  1348. BcuDataInfo.sfmd_flg_heatCirOpenFltE = 0;
  1349. return;
  1350. }
  1351. /**
  1352. * @brief : 认证加密函数,将明文加密为译文
  1353. * @param {UINT16} plainText
  1354. * @return {*}
  1355. */
  1356. UINT16 encryptionAlgorithm(UINT16 plainText)
  1357. {
  1358. UINT16 cipherText = 1;
  1359. UINT16 privateKeyE = 37507;
  1360. UINT16 privateKeyN = 10961;
  1361. plainText = plainText % privateKeyN;
  1362. while (privateKeyE > 0)
  1363. {
  1364. if (privateKeyE % 2 == 1)
  1365. {
  1366. cipherText = (cipherText * plainText) % privateKeyN;
  1367. }
  1368. privateKeyE = privateKeyE / 2;
  1369. plainText = (plainText * plainText) % privateKeyN;
  1370. }
  1371. return cipherText;
  1372. }
  1373. /**
  1374. * @brief : 认证解密函数,将译文解密为明文
  1375. * @param {UINT16} cipherText
  1376. * @return {*}
  1377. */
  1378. // UINT8 decryptionAlgorithm (UINT16 cipherText)
  1379. // {
  1380. // UINT16 plainText = 1;
  1381. // UINT16 publicKeyD = 43;
  1382. // UINT16 publicKeyN = 10961;
  1383. // cipherText = cipherText % publicKeyN;
  1384. // while(publicKeyD >0)
  1385. // {
  1386. // if(publicKeyD % 2 ==1)
  1387. // {
  1388. // plainText = plainText * cipherText % publicKeyN;
  1389. // }
  1390. // publicKeyD = publicKeyD/2;
  1391. // cipherText = (cipherText * cipherText) % publicKeyN;
  1392. // }
  1393. // return (UINT8)plainText;
  1394. // }
  1395. /**
  1396. * @brief : Fota升级处理函数,将接收的数据进行校验,搬运至升级区域,并进行应答
  1397. * @param {UINT8} *DataPtr
  1398. * @param {INT32} connectId
  1399. * @return {*}
  1400. */
  1401. void Fota_Func(UINT8 *DataPtr, INT32 connectId)
  1402. {
  1403. Fota_Type Fota_S;
  1404. UINT8 Fota_Answer[43];
  1405. UINT8 Fota_Cmd;
  1406. INT8 ret;
  1407. UINT8 *Data_Read_Buffer = PNULL;
  1408. UINT8 Data_Read_Crc;
  1409. if (*(DataPtr + 30) == 0x01)
  1410. {
  1411. Fota_S.Fota_Flash_Addres = FLASH_FOTA_REGION_START;
  1412. Fota_Cmd = *(DataPtr + 31);
  1413. Fota_Answer[0] = TCP_START_SYM1;
  1414. Fota_Answer[1] = TCP_START_SYM2;
  1415. Fota_Answer[2] = TCP_CONCMD_SYM;
  1416. switch (Fota_Cmd)
  1417. {
  1418. case 0x01:
  1419. {
  1420. Fota_S.Fota_All_Data_Len = *(DataPtr + 33) << 24 | *(DataPtr + 34) << 16 | *(DataPtr + 35) << 8 | *(DataPtr + 36);
  1421. Fota_S.Fota_Current_Addres = *(DataPtr + 37) << 24 | *(DataPtr + 38) << 16 | *(DataPtr + 39) << 8 | *(DataPtr + 40);
  1422. if (Fota_S.Fota_All_Data_Len >= (FLASH_BMS_FOTA_START_ADDR - FLASH_FOTA_REGION_START))
  1423. {
  1424. Fota_Answer[3] = 0x02;
  1425. }
  1426. else
  1427. {
  1428. Fota_Answer[3] = 0x01;
  1429. BSP_QSPI_Erase_Safe(Fota_S.Fota_Flash_Addres, (FLASH_BMS_FOTA_START_ADDR - FLASH_FOTA_REGION_START)); //512k-32k = 480k -> 0x75300 0x78000
  1430. }
  1431. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1432. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1433. Fota_Answer[22] = 0x00;
  1434. Fota_Answer[23] = 0x12;
  1435. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1436. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1437. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1438. break;
  1439. }
  1440. case 0x02:
  1441. {
  1442. Fota_S.Fota_All_Data_Len = *(DataPtr + 33) << 24 | *(DataPtr + 34) << 16 | *(DataPtr + 35) << 8 | *(DataPtr + 36);
  1443. Fota_S.Fota_Current_Addres = *(DataPtr + 37) << 24 | *(DataPtr + 38) << 16 | *(DataPtr + 39) << 8 | *(DataPtr + 40);
  1444. Fota_S.Fota_Recv_Data_Len = *(DataPtr + 41);
  1445. memset(Fota_S.Fota_Recv_Data, 0x00, 100);
  1446. memcpy(Fota_S.Fota_Recv_Data, (DataPtr + 42), *(DataPtr + 41));
  1447. Fota_S.Fota_CRC = Fota_crc_chk(Fota_S.Fota_Recv_Data, Fota_S.Fota_Recv_Data_Len);
  1448. Data_Read_Buffer = malloc(Fota_S.Fota_Recv_Data_Len);
  1449. if (Fota_S.Fota_CRC == *(DataPtr + Fota_S.Fota_Recv_Data_Len + 42) || Data_Read_Buffer != PNULL)
  1450. {
  1451. UINT8 Fota_Recv_Data_Len_4 = 0;
  1452. if (Fota_S.Fota_Recv_Data_Len % 4 != 0)
  1453. {
  1454. Fota_Recv_Data_Len_4 = Fota_S.Fota_Recv_Data_Len + 4 - (Fota_S.Fota_Recv_Data_Len % 4);
  1455. }
  1456. else
  1457. {
  1458. Fota_Recv_Data_Len_4 = Fota_S.Fota_Recv_Data_Len;
  1459. }
  1460. BSP_QSPI_Write_Safe(Fota_S.Fota_Recv_Data, Fota_S.Fota_Flash_Addres + Fota_S.Fota_Current_Addres, Fota_Recv_Data_Len_4);
  1461. memset(Data_Read_Buffer, 0x00, Fota_S.Fota_Recv_Data_Len);
  1462. BSP_QSPI_Read_Safe(Data_Read_Buffer, Fota_S.Fota_Flash_Addres + Fota_S.Fota_Current_Addres, Fota_S.Fota_Recv_Data_Len);
  1463. Data_Read_Crc = Fota_crc_chk(Data_Read_Buffer, Fota_S.Fota_Recv_Data_Len);
  1464. #ifdef USING_PRINTF1
  1465. printf("Data_Read_Buffer:\n");
  1466. for (int i = 0; i < Fota_S.Fota_Recv_Data_Len; i++)
  1467. {
  1468. printf("%x ", *(Data_Read_Buffer + i));
  1469. }
  1470. printf("\n");
  1471. #endif
  1472. if (Data_Read_Crc == Fota_S.Fota_CRC)
  1473. {
  1474. Fota_Answer[3] = 0x01;
  1475. }
  1476. else
  1477. {
  1478. Fota_Answer[3] = 0x02;
  1479. BSP_QSPI_Erase_Safe(Fota_S.Fota_Flash_Addres + Fota_S.Fota_Current_Addres, Fota_Recv_Data_Len_4);
  1480. }
  1481. }
  1482. else //数据校验失败
  1483. {
  1484. Fota_Answer[3] = 0x02;
  1485. }
  1486. if (Data_Read_Buffer != PNULL)
  1487. free(Data_Read_Buffer);
  1488. Data_Read_Buffer = PNULL;
  1489. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1490. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1491. Fota_Answer[22] = 0x00;
  1492. Fota_Answer[23] = 0x12;
  1493. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1494. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1495. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1496. break;
  1497. }
  1498. case 0x03:
  1499. {
  1500. Fota_S.Fota_All_Data_Len = *(DataPtr + 33) << 24 | *(DataPtr + 34) << 16 | *(DataPtr + 35) << 8 | *(DataPtr + 36);
  1501. Fota_S.Fota_Current_Addres = *(DataPtr + 37) << 24 | *(DataPtr + 38) << 16 | *(DataPtr + 39) << 8 | *(DataPtr + 40);
  1502. Fota_Answer[3] = 0x01;
  1503. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1504. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1505. Fota_Answer[22] = 0x00;
  1506. Fota_Answer[23] = 0x12;
  1507. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1508. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1509. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1510. if (Fota_S.Fota_All_Data_Len == Fota_S.Fota_Current_Addres)
  1511. {
  1512. NB_Fota_update_flag = TRUE;
  1513. }
  1514. else
  1515. {
  1516. NB_Fota_update_flag = FALSE;
  1517. }
  1518. break;
  1519. }
  1520. default:
  1521. {
  1522. Fota_Answer[3] = 0x02;
  1523. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1524. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1525. Fota_Answer[22] = 0x00;
  1526. Fota_Answer[23] = 0x12;
  1527. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1528. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1529. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1530. break;
  1531. }
  1532. }
  1533. }
  1534. else if (*(DataPtr + 30) == 0x88) //BMS升级文件存放
  1535. {
  1536. Fota_S.Fota_Flash_Addres = FLASH_BMS_FOTA_START_ADDR;
  1537. Fota_Cmd = *(DataPtr + 31);
  1538. Fota_Answer[0] = TCP_START_SYM1;
  1539. Fota_Answer[1] = TCP_START_SYM2;
  1540. Fota_Answer[2] = TCP_CONCMD_SYM;
  1541. switch (Fota_Cmd)
  1542. {
  1543. case 0x01:
  1544. {
  1545. Fota_S.Fota_All_Data_Len = *(DataPtr + 33) << 24 | *(DataPtr + 34) << 16 | *(DataPtr + 35) << 8 | *(DataPtr + 36);
  1546. Fota_S.Fota_Current_Addres = *(DataPtr + 37) << 24 | *(DataPtr + 38) << 16 | *(DataPtr + 39) << 8 | *(DataPtr + 40);
  1547. if (Fota_S.Fota_All_Data_Len >= (FLASH_BMS_FOTA_END_ADDR - FLASH_BMS_FOTA_START_ADDR))
  1548. {
  1549. Fota_Answer[3] = 0x02;
  1550. }
  1551. else
  1552. {
  1553. Fota_Answer[3] = 0x01;
  1554. BSP_QSPI_Erase_Safe(Fota_S.Fota_Flash_Addres, (FLASH_BMS_FOTA_END_ADDR - FLASH_BMS_FOTA_START_ADDR)); //512k-32k = 480k -> 0x75300 0x78000
  1555. }
  1556. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1557. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1558. Fota_Answer[22] = 0x00;
  1559. Fota_Answer[23] = 0x12;
  1560. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1561. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1562. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1563. break;
  1564. }
  1565. case 0x02:
  1566. {
  1567. Fota_S.Fota_All_Data_Len = *(DataPtr + 33) << 24 | *(DataPtr + 34) << 16 | *(DataPtr + 35) << 8 | *(DataPtr + 36);
  1568. Fota_S.Fota_Current_Addres = *(DataPtr + 37) << 24 | *(DataPtr + 38) << 16 | *(DataPtr + 39) << 8 | *(DataPtr + 40);
  1569. Fota_S.Fota_Recv_Data_Len = *(DataPtr + 41);
  1570. memset(Fota_S.Fota_Recv_Data, 0x00, 100);
  1571. memcpy(Fota_S.Fota_Recv_Data, (DataPtr + 42), *(DataPtr + 41));
  1572. Fota_S.Fota_CRC = Fota_crc_chk(Fota_S.Fota_Recv_Data, Fota_S.Fota_Recv_Data_Len);
  1573. Data_Read_Buffer = malloc(Fota_S.Fota_Recv_Data_Len);
  1574. if (Fota_S.Fota_CRC == *(DataPtr + Fota_S.Fota_Recv_Data_Len + 42) || Data_Read_Buffer != PNULL)
  1575. {
  1576. UINT8 Fota_Recv_Data_Len_4 = 0;
  1577. if (Fota_S.Fota_Recv_Data_Len % 4 != 0)
  1578. {
  1579. Fota_Recv_Data_Len_4 = Fota_S.Fota_Recv_Data_Len + 4 - (Fota_S.Fota_Recv_Data_Len % 4);
  1580. }
  1581. else
  1582. {
  1583. Fota_Recv_Data_Len_4 = Fota_S.Fota_Recv_Data_Len;
  1584. }
  1585. BSP_QSPI_Write_Safe(Fota_S.Fota_Recv_Data, Fota_S.Fota_Flash_Addres + Fota_S.Fota_Current_Addres, Fota_Recv_Data_Len_4);
  1586. memset(Data_Read_Buffer, 0x00, Fota_S.Fota_Recv_Data_Len);
  1587. BSP_QSPI_Read_Safe(Data_Read_Buffer, Fota_S.Fota_Flash_Addres + Fota_S.Fota_Current_Addres, Fota_S.Fota_Recv_Data_Len);
  1588. Data_Read_Crc = Fota_crc_chk(Data_Read_Buffer, Fota_S.Fota_Recv_Data_Len);
  1589. #ifdef USING_PRINTF1
  1590. printf("\n\n\n");
  1591. UINT8 temp[1];
  1592. for (int i = 0; i < Fota_S.Fota_Recv_Data_Len; i++)
  1593. {
  1594. printf("%x ", *(Data_Read_Buffer + i));
  1595. }
  1596. printf("\n\n\n");
  1597. #endif
  1598. if (Data_Read_Crc == Fota_S.Fota_CRC)
  1599. {
  1600. Fota_Answer[3] = 0x01;
  1601. }
  1602. else
  1603. {
  1604. Fota_Answer[3] = 0x02;
  1605. BSP_QSPI_Erase_Safe(Fota_S.Fota_Flash_Addres + Fota_S.Fota_Current_Addres, Fota_Recv_Data_Len_4);
  1606. }
  1607. }
  1608. else //数据校验失败
  1609. {
  1610. Fota_Answer[3] = 0x02;
  1611. }
  1612. if (Data_Read_Buffer != PNULL)
  1613. free(Data_Read_Buffer);
  1614. Data_Read_Buffer = PNULL;
  1615. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1616. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1617. Fota_Answer[22] = 0x00;
  1618. Fota_Answer[23] = 0x12;
  1619. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1620. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1621. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1622. break;
  1623. }
  1624. case 0x03:
  1625. {
  1626. Fota_S.Fota_All_Data_Len = *(DataPtr + 33) << 24 | *(DataPtr + 34) << 16 | *(DataPtr + 35) << 8 | *(DataPtr + 36);
  1627. Fota_S.Fota_Current_Addres = *(DataPtr + 37) << 24 | *(DataPtr + 38) << 16 | *(DataPtr + 39) << 8 | *(DataPtr + 40);
  1628. Fota_Answer[3] = 0x01;
  1629. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1630. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1631. Fota_Answer[22] = 0x00;
  1632. Fota_Answer[23] = 0x12;
  1633. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1634. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1635. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1636. if (Fota_S.Fota_All_Data_Len == Fota_S.Fota_Current_Addres)
  1637. {
  1638. BMS_Fota_update_flag = TRUE;
  1639. }
  1640. else
  1641. {
  1642. BMS_Fota_update_flag = FALSE;
  1643. }
  1644. break;
  1645. }
  1646. default:
  1647. {
  1648. Fota_Answer[3] = 0x02;
  1649. memcpy(&Fota_Answer[4], (DataPtr + 4), BATT_SN_LEN);
  1650. Fota_Answer[21] = TCP_ENCPT_DISABLE;
  1651. Fota_Answer[22] = 0x00;
  1652. Fota_Answer[23] = 0x12;
  1653. memcpy(&Fota_Answer[24], (DataPtr + 24), 18);
  1654. Fota_Answer[42] = bcc_chk_fota(Fota_Answer, 42);
  1655. tcpipConnectionSend(connectId, Fota_Answer, 43, 0, 0, 0);
  1656. break;
  1657. }
  1658. }
  1659. }
  1660. }
  1661. /**
  1662. * @brief : fota网络校验函数
  1663. * @param {UINT8} *data
  1664. * @param {UINT8} length
  1665. * @return {*}
  1666. */
  1667. static UINT8 bcc_chk_fota(UINT8 *data, UINT8 length)
  1668. {
  1669. UINT8 bcc_chk_return = 0x00;
  1670. UINT8 count = 0;
  1671. while (count < length)
  1672. {
  1673. bcc_chk_return ^= data[count];
  1674. count++;
  1675. }
  1676. return bcc_chk_return;
  1677. }
  1678. /**
  1679. * @brief : Fota校验函数
  1680. * @param {UINT8} *data
  1681. * @param {UINT8} length
  1682. * @return {*}
  1683. */
  1684. static UINT8 Fota_crc_chk(UINT8 *data, UINT8 length)
  1685. {
  1686. UINT8 reg_crc = 0x00;
  1687. while (length--)
  1688. {
  1689. reg_crc ^= *data++;
  1690. }
  1691. return reg_crc;
  1692. }
  1693. /**
  1694. * @brief : 1000ms 周期姓发送报文,根据调用周期及计时器,每100ms发送2帧报文,报文周期为1000ms
  1695. * @param {*}
  1696. * @return {*}
  1697. */
  1698. void CanMsgTx1000ms()
  1699. {
  1700. static UINT32 timerRecord = 0;
  1701. UINT8 count = 0;
  1702. CAN_Msg_Type canMsg;
  1703. UINT16 COMOutTable[28] = {
  1704. 0x6A0, 0x6A1, 0x6A2, 0x6A3, 0x6A4, 0x6A5, 0x6A6,
  1705. 0x6B0, 0x6BA,
  1706. 0x6C0, 0x6C1, 0x6C2, 0x6C3, 0x6C4,
  1707. 0x7C0, 0x7C1, 0x7C2, 0x7C3, 0x7C4, 0x7C5, 0x7C6, 0x7C7, 0x7C8, 0x7C9, 0x7CA, 0x7CB, 0x7CC, 0x7CD};
  1708. if (TimeCounter - timerRecord > 0)
  1709. {
  1710. timerRecord = TimeCounter;
  1711. count = TimeCounter % 10;
  1712. switch (count)
  1713. {
  1714. case 0: //send cell batt info 0x6A0、0x6A1
  1715. canMsg.DLC = 8;
  1716. canMsg.Id = COMOutTable[count * 2];
  1717. CANEncodeFunction(COMOutTable[count * 2], canMsg.Data);
  1718. HAL_Can_Transmit(canMsg);
  1719. canMsg.DLC = 8;
  1720. canMsg.Id = COMOutTable[count * 2 + 1];
  1721. CANEncodeFunction(COMOutTable[count * 2 + 1], canMsg.Data);
  1722. HAL_Can_Transmit(canMsg);
  1723. break;
  1724. case 1: //send cell batt info 0x6A2、0x6A3
  1725. canMsg.DLC = 8;
  1726. canMsg.Id = COMOutTable[count * 2];
  1727. CANEncodeFunction(COMOutTable[count * 2], canMsg.Data);
  1728. HAL_Can_Transmit(canMsg);
  1729. canMsg.DLC = 8;
  1730. canMsg.Id = COMOutTable[count * 2 + 1];
  1731. CANEncodeFunction(COMOutTable[count * 2 + 1], canMsg.Data);
  1732. HAL_Can_Transmit(canMsg);
  1733. break;
  1734. case 2: //send cell batt info 0x6A4、 0x6A5
  1735. canMsg.DLC = 8;
  1736. canMsg.Id = COMOutTable[count * 2];
  1737. CANEncodeFunction(COMOutTable[count * 2], canMsg.Data);
  1738. HAL_Can_Transmit(canMsg);
  1739. canMsg.DLC = 8;
  1740. canMsg.Id = COMOutTable[count * 2 + 1];
  1741. CANEncodeFunction(COMOutTable[count * 2 + 1], canMsg.Data);
  1742. HAL_Can_Transmit(canMsg);
  1743. break;
  1744. case 3: //send cell batt info 0x6A6、0x6B0
  1745. canMsg.DLC = 8;
  1746. canMsg.Id = COMOutTable[count * 2];
  1747. CANEncodeFunction(COMOutTable[count * 2], canMsg.Data);
  1748. HAL_Can_Transmit(canMsg);
  1749. canMsg.DLC = 8;
  1750. canMsg.Id = COMOutTable[count * 2 + 1];
  1751. CANEncodeFunction(COMOutTable[count * 2 + 1], canMsg.Data);
  1752. HAL_Can_Transmit(canMsg);
  1753. break;
  1754. case 4: //send batt temp info 0x6BA、0x6C0
  1755. canMsg.DLC = 8;
  1756. canMsg.Id = COMOutTable[count * 2];
  1757. CANEncodeFunction(COMOutTable[count * 2], canMsg.Data);
  1758. HAL_Can_Transmit(canMsg);
  1759. canMsg.DLC = 8;
  1760. canMsg.Id = COMOutTable[count * 2 + 1];
  1761. CANEncodeFunction(COMOutTable[count * 2 + 1], canMsg.Data);
  1762. HAL_Can_Transmit(canMsg);
  1763. break;
  1764. case 5: //send batt other info 0x6C1、0x6C2
  1765. canMsg.DLC = 8;
  1766. canMsg.Id = COMOutTable[count * 2];
  1767. CANEncodeFunction(COMOutTable[count * 2], canMsg.Data);
  1768. HAL_Can_Transmit(canMsg);
  1769. canMsg.DLC = 8;
  1770. canMsg.Id = COMOutTable[count * 2 + 1];
  1771. CANEncodeFunction(COMOutTable[count * 2 + 1], canMsg.Data);
  1772. HAL_Can_Transmit(canMsg);
  1773. break;
  1774. case 6: //send batt other info 0x6C3、0x6C4
  1775. canMsg.DLC = 8;
  1776. canMsg.Id = COMOutTable[count * 2];
  1777. CANEncodeFunction(COMOutTable[count * 2], canMsg.Data);
  1778. HAL_Can_Transmit(canMsg);
  1779. canMsg.DLC = 8;
  1780. canMsg.Id = COMOutTable[count * 2 + 1];
  1781. CANEncodeFunction(COMOutTable[count * 2 + 1], canMsg.Data);
  1782. HAL_Can_Transmit(canMsg);
  1783. break;
  1784. default:
  1785. break;
  1786. }
  1787. }
  1788. }
  1789. /**
  1790. * @brief : 周期性报文组包,根据不同的ID,进行组包,并放入指针中
  1791. * @param {UINT32} ID
  1792. * @param {UINT8} *msgData
  1793. * @return {*}
  1794. */
  1795. void CANEncodeFunction(UINT32 ID, UINT8 *msgData)
  1796. {
  1797. memset(msgData, 0xFF, 8);
  1798. switch (ID)
  1799. {
  1800. case 0x6A0:
  1801. *(UINT16 *)(msgData + 0) = ((battCellU[0] >> 8) & 0xFF) | (((battCellU[0] & 0xFF) << 8) & 0xFF00);
  1802. *(UINT16 *)(msgData + 2) = ((battCellU[1] >> 8) & 0xFF) | (((battCellU[1] & 0xFF) << 8) & 0xFF00);
  1803. *(UINT16 *)(msgData + 4) = ((battCellU[2] >> 8) & 0xFF) | (((battCellU[2] & 0xFF) << 8) & 0xFF00);
  1804. *(UINT16 *)(msgData + 6) = ((battCellU[3] >> 8) & 0xFF) | (((battCellU[3] & 0xFF) << 8) & 0xFF00);
  1805. break;
  1806. case 0x6A1:
  1807. *(UINT16 *)(msgData + 0) = ((battCellU[4] >> 8) & 0xFF) | (((battCellU[4] & 0xFF) << 8) & 0xFF00);
  1808. *(UINT16 *)(msgData + 2) = ((battCellU[5] >> 8) & 0xFF) | (((battCellU[5] & 0xFF) << 8) & 0xFF00);
  1809. *(UINT16 *)(msgData + 4) = ((battCellU[6] >> 8) & 0xFF) | (((battCellU[6] & 0xFF) << 8) & 0xFF00);
  1810. *(UINT16 *)(msgData + 6) = ((battCellU[7] >> 8) & 0xFF) | (((battCellU[7] & 0xFF) << 8) & 0xFF00);
  1811. break;
  1812. case 0x6A2:
  1813. *(UINT16 *)(msgData + 0) = ((battCellU[8] >> 8) & 0xFF) | (((battCellU[8] & 0xFF) << 8) & 0xFF00);
  1814. *(UINT16 *)(msgData + 2) = ((battCellU[9] >> 8) & 0xFF) | (((battCellU[9] & 0xFF) << 8) & 0xFF00);
  1815. *(UINT16 *)(msgData + 4) = ((battCellU[10] >> 8) & 0xFF) | (((battCellU[10] & 0xFF) << 8) & 0xFF00);
  1816. *(UINT16 *)(msgData + 6) = ((battCellU[11] >> 8) & 0xFF) | (((battCellU[11] & 0xFF) << 8) & 0xFF00);
  1817. break;
  1818. case 0x6A3:
  1819. *(UINT16 *)(msgData + 0) = ((battCellU[12] >> 8) & 0xFF) | (((battCellU[12] & 0xFF) << 8) & 0xFF00);
  1820. *(UINT16 *)(msgData + 2) = ((battCellU[13] >> 8) & 0xFF) | (((battCellU[13] & 0xFF) << 8) & 0xFF00);
  1821. *(UINT16 *)(msgData + 4) = ((battCellU[14] >> 8) & 0xFF) | (((battCellU[14] & 0xFF) << 8) & 0xFF00);
  1822. *(UINT16 *)(msgData + 6) = ((battCellU[15] >> 8) & 0xFF) | (((battCellU[15] & 0xFF) << 8) & 0xFF00);
  1823. break;
  1824. case 0x6A4:
  1825. *(UINT16 *)(msgData + 0) = ((battCellU[16] >> 8) & 0xFF) | (((battCellU[16] & 0xFF) << 8) & 0xFF00);
  1826. *(UINT16 *)(msgData + 2) = ((battCellU[17] >> 8) & 0xFF) | (((battCellU[17] & 0xFF) << 8) & 0xFF00);
  1827. *(UINT16 *)(msgData + 4) = ((battCellU[18] >> 8) & 0xFF) | (((battCellU[18] & 0xFF) << 8) & 0xFF00);
  1828. *(UINT16 *)(msgData + 6) = ((battCellU[19] >> 8) & 0xFF) | (((battCellU[19] & 0xFF) << 8) & 0xFF00);
  1829. break;
  1830. case 0x6A5:
  1831. *(UINT16 *)(msgData + 0) = ((battCellU[20] >> 8) & 0xFF) | (((battCellU[20] & 0xFF) << 8) & 0xFF00);
  1832. *(UINT16 *)(msgData + 2) = ((battCellU[21] >> 8) & 0xFF) | (((battCellU[21] & 0xFF) << 8) & 0xFF00);
  1833. *(UINT16 *)(msgData + 4) = ((battCellU[22] >> 8) & 0xFF) | (((battCellU[22] & 0xFF) << 8) & 0xFF00);
  1834. *(UINT16 *)(msgData + 6) = ((battCellU[23] >> 8) & 0xFF) | (((battCellU[23] & 0xFF) << 8) & 0xFF00);
  1835. break;
  1836. case 0x6A6:
  1837. *(UINT16 *)(msgData + 0) = ((battCellU[24] >> 8) & 0xFF) | (((battCellU[24] & 0xFF) << 8) & 0xFF00);
  1838. *(UINT16 *)(msgData + 2) = ((battCellU[25] >> 8) & 0xFF) | (((battCellU[25] & 0xFF) << 8) & 0xFF00);
  1839. *(UINT16 *)(msgData + 4) = ((battCellU[26] >> 8) & 0xFF) | (((battCellU[26] & 0xFF) << 8) & 0xFF00);
  1840. *(UINT16 *)(msgData + 6) = ((battCellU[27] >> 8) & 0xFF) | (((battCellU[27] & 0xFF) << 8) & 0xFF00);
  1841. break;
  1842. case 0x6B0:
  1843. *(UINT8 *)(msgData + 0) = battCellTemp[0] & 0xFF;
  1844. *(UINT8 *)(msgData + 1) = battCellTemp[1] & 0xFF;
  1845. *(UINT8 *)(msgData + 2) = battCellTemp[2] & 0xFF;
  1846. *(UINT8 *)(msgData + 3) = battCellTemp[3] & 0xFF;
  1847. *(UINT8 *)(msgData + 4) = battCellTemp[4] & 0xFF;
  1848. *(UINT8 *)(msgData + 5) = battCellTemp[5] & 0xFF;
  1849. *(UINT8 *)(msgData + 6) = battCellTemp[6] & 0xFF;
  1850. *(UINT8 *)(msgData + 7) = battCellTemp[7] & 0xFF;
  1851. break;
  1852. case 0x6BA:
  1853. *(UINT8 *)(msgData + 0) = MOSTemp & 0xFF;
  1854. *(UINT8 *)(msgData + 1) = packTemp & 0xFF;
  1855. *(UINT8 *)(msgData + 2) = fastChargeTemp & 0xFF;
  1856. *(UINT8 *)(msgData + 3) = normalChargeTemp & 0xFF;
  1857. *(UINT8 *)(msgData + 4) = heatTemp1 & 0xFF;
  1858. *(UINT8 *)(msgData + 5) = heatTemp2 & 0xFF;
  1859. *(UINT8 *)(msgData + 6) = nbReservedTemp1 & 0xFF;
  1860. *(UINT8 *)(msgData + 7) = nbReservedTemp2 & 0xFF;
  1861. break;
  1862. case 0x6C0:
  1863. *(UINT16 *)(msgData + 0) = ((minCellVol >> 8) & 0xFF) | (((minCellVol & 0xFF) << 8) & 0xFF00);
  1864. *(UINT16 *)(msgData + 2) = ((maxCellVol >> 8) & 0xFF) | (((maxCellVol & 0xFF) << 8) & 0xFF00);
  1865. *(UINT16 *)(msgData + 4) = ((battPackVol >> 8) & 0xFF) | (((battPackVol & 0xFF) << 8) & 0xFF00);
  1866. *(UINT8 *)(msgData + 6) = maxCellTemp & 0xFF;
  1867. *(UINT8 *)(msgData + 7) = minCellTemp & 0xFF;
  1868. break;
  1869. case 0x6C1:
  1870. *(UINT8 *)(msgData + 0) = battSOC & 0xFF;
  1871. *(UINT8 *)(msgData + 1) = battSOH & 0xFF;
  1872. *(UINT16 *)(msgData + 2) = ((battI >> 8) & 0xFF) | (((battI & 0xFF) << 8) & 0xFF00);
  1873. *(UINT8 *)(msgData + 4) = battWorkState & 0xFF;
  1874. *(UINT32 *)(msgData + 5) = ((battWarningState >> 16) & 0xFF) | ((battWarningState)&0xFF00) | (((battWarningState & 0xFF) << 16) & 0xFF0000);
  1875. break;
  1876. case 0x6C2:
  1877. *(UINT32 *)(msgData + 0) = ((nbSwVersion >> 24) & 0xFF) | ((nbSwVersion >> 8) & 0xFF00) | ((nbSwVersion << 8) & 0xFF0000) | (((nbSwVersion & 0xFF) << 24) & 0xFF000000);
  1878. *(UINT16 *)(msgData + 4) = ((nbHwVersion >> 8) & 0xFF) | (((nbHwVersion & 0xFF) << 8) & 0xFF00);
  1879. *(UINT8 *)(msgData + 6) = bmsSwVersion & 0xFF;
  1880. *(UINT8 *)(msgData + 7) = bmsHwVersion & 0xFF;
  1881. break;
  1882. case 0x6C3:
  1883. *(UINT32 *)(msgData + 0) = ((battBalanceoInfo >> 24) & 0xFF) | ((battBalanceoInfo >> 8) & 0xFF00) | ((battBalanceoInfo << 8) & 0xFF0000) | (((battBalanceoInfo & 0xFF) << 24) & 0xFF000000);
  1884. *(UINT8 *)(msgData + 4) = battMOSSwitchState & 0xFF;
  1885. *(UINT8 *)(msgData + 5) = battHeatEnableState & 0xFF;
  1886. break;
  1887. case 0x6C4:
  1888. reservedSignal1 = battProtectState & 0xFF;
  1889. reservedSignal2 = (battProtectState >> 8) & 0xFF;
  1890. reservedSignal3 = (battProtectState >> 16) & 0xFF;
  1891. reservedSignal4 = (battProtectState >> 24) & 0xFF;
  1892. *(UINT8 *)(msgData + 0) = reservedSignal1 & 0xFF;
  1893. *(UINT8 *)(msgData + 1) = reservedSignal2 & 0xFF;
  1894. *(UINT8 *)(msgData + 2) = reservedSignal3 & 0xFF;
  1895. *(UINT8 *)(msgData + 3) = reservedSignal4 & 0xFF;
  1896. *(UINT8 *)(msgData + 4) = reservedSignal5 & 0xFF;
  1897. *(UINT8 *)(msgData + 5) = reservedSignal6 & 0xFF;
  1898. *(UINT8 *)(msgData + 6) = reservedSignal7 & 0xFF;
  1899. *(UINT8 *)(msgData + 7) = reservedSignal8 & 0xFF;
  1900. break;
  1901. case 0x7C0:
  1902. *(UINT16 *)(msgData + 0) = ((battCellU[0] >> 8) & 0xFF) | (((battCellU[0] & 0xFF) << 8) & 0xFF00);
  1903. *(UINT16 *)(msgData + 2) = ((battCellU[1] >> 8) & 0xFF) | (((battCellU[1] & 0xFF) << 8) & 0xFF00);
  1904. *(UINT16 *)(msgData + 4) = ((battCellU[2] >> 8) & 0xFF) | (((battCellU[2] & 0xFF) << 8) & 0xFF00);
  1905. *(UINT16 *)(msgData + 6) = ((battCellU[3] >> 8) & 0xFF) | (((battCellU[3] & 0xFF) << 8) & 0xFF00);
  1906. break;
  1907. case 0x7C1:
  1908. *(UINT16 *)(msgData + 0) = ((battCellU[4] >> 8) & 0xFF) | (((battCellU[4] & 0xFF) << 8) & 0xFF00);
  1909. *(UINT16 *)(msgData + 2) = ((battCellU[5] >> 8) & 0xFF) | (((battCellU[5] & 0xFF) << 8) & 0xFF00);
  1910. *(UINT16 *)(msgData + 4) = ((battCellU[6] >> 8) & 0xFF) | (((battCellU[6] & 0xFF) << 8) & 0xFF00);
  1911. *(UINT16 *)(msgData + 6) = ((battCellU[7] >> 8) & 0xFF) | (((battCellU[7] & 0xFF) << 8) & 0xFF00);
  1912. break;
  1913. case 0x7C2:
  1914. *(UINT16 *)(msgData + 0) = ((battCellU[8] >> 8) & 0xFF) | (((battCellU[8] & 0xFF) << 8) & 0xFF00);
  1915. *(UINT16 *)(msgData + 2) = ((battCellU[9] >> 8) & 0xFF) | (((battCellU[9] & 0xFF) << 8) & 0xFF00);
  1916. *(UINT16 *)(msgData + 4) = ((battCellU[10] >> 8) & 0xFF) | (((battCellU[10] & 0xFF) << 8) & 0xFF00);
  1917. *(UINT16 *)(msgData + 6) = ((battCellU[11] >> 8) & 0xFF) | (((battCellU[11] & 0xFF) << 8) & 0xFF00);
  1918. break;
  1919. case 0x7C3:
  1920. *(UINT16 *)(msgData + 0) = ((battCellU[12] >> 8) & 0xFF) | (((battCellU[12] & 0xFF) << 8) & 0xFF00);
  1921. *(UINT16 *)(msgData + 2) = ((battCellU[13] >> 8) & 0xFF) | (((battCellU[13] & 0xFF) << 8) & 0xFF00);
  1922. *(UINT16 *)(msgData + 4) = ((battCellU[14] >> 8) & 0xFF) | (((battCellU[14] & 0xFF) << 8) & 0xFF00);
  1923. *(UINT16 *)(msgData + 6) = ((battCellU[15] >> 8) & 0xFF) | (((battCellU[15] & 0xFF) << 8) & 0xFF00);
  1924. break;
  1925. case 0x7C4:
  1926. *(UINT16 *)(msgData + 0) = ((battCellU[16] >> 8) & 0xFF) | (((battCellU[16] & 0xFF) << 8) & 0xFF00);
  1927. *(UINT16 *)(msgData + 2) = ((battCellU[17] >> 8) & 0xFF) | (((battCellU[17] & 0xFF) << 8) & 0xFF00);
  1928. *(UINT16 *)(msgData + 4) = ((battCellU[18] >> 8) & 0xFF) | (((battCellU[18] & 0xFF) << 8) & 0xFF00);
  1929. *(UINT16 *)(msgData + 6) = ((battCellU[19] >> 8) & 0xFF) | (((battCellU[19] & 0xFF) << 8) & 0xFF00);
  1930. break;
  1931. case 0x7C5:
  1932. *(UINT16 *)(msgData + 0) = ((battCellU[20] >> 8) & 0xFF) | (((battCellU[20] & 0xFF) << 8) & 0xFF00);
  1933. *(UINT16 *)(msgData + 2) = ((battCellU[21] >> 8) & 0xFF) | (((battCellU[21] & 0xFF) << 8) & 0xFF00);
  1934. *(UINT16 *)(msgData + 4) = ((battCellU[22] >> 8) & 0xFF) | (((battCellU[22] & 0xFF) << 8) & 0xFF00);
  1935. *(UINT16 *)(msgData + 6) = ((battCellU[23] >> 8) & 0xFF) | (((battCellU[23] & 0xFF) << 8) & 0xFF00);
  1936. break;
  1937. case 0x7C6:
  1938. *(UINT16 *)(msgData + 0) = ((battCellU[24] >> 8) & 0xFF) | (((battCellU[24] & 0xFF) << 8) & 0xFF00);
  1939. *(UINT16 *)(msgData + 2) = ((battCellU[25] >> 8) & 0xFF) | (((battCellU[25] & 0xFF) << 8) & 0xFF00);
  1940. *(UINT16 *)(msgData + 4) = ((battCellU[26] >> 8) & 0xFF) | (((battCellU[26] & 0xFF) << 8) & 0xFF00);
  1941. *(UINT16 *)(msgData + 6) = ((battCellU[27] >> 8) & 0xFF) | (((battCellU[27] & 0xFF) << 8) & 0xFF00);
  1942. break;
  1943. case 0x7C7:
  1944. *(UINT8 *)(msgData + 0) = battCellTemp[0] & 0xFF;
  1945. *(UINT8 *)(msgData + 1) = battCellTemp[1] & 0xFF;
  1946. *(UINT8 *)(msgData + 2) = battCellTemp[2] & 0xFF;
  1947. *(UINT8 *)(msgData + 3) = battCellTemp[3] & 0xFF;
  1948. *(UINT8 *)(msgData + 4) = battCellTemp[4] & 0xFF;
  1949. *(UINT8 *)(msgData + 5) = battCellTemp[5] & 0xFF;
  1950. *(UINT8 *)(msgData + 6) = battCellTemp[6] & 0xFF;
  1951. *(UINT8 *)(msgData + 7) = battCellTemp[7] & 0xFF;
  1952. break;
  1953. case 0x7C8:
  1954. *(UINT8 *)(msgData + 0) = MOSTemp & 0xFF;
  1955. *(UINT8 *)(msgData + 1) = packTemp & 0xFF;
  1956. *(UINT8 *)(msgData + 2) = fastChargeTemp & 0xFF;
  1957. *(UINT8 *)(msgData + 3) = normalChargeTemp & 0xFF;
  1958. *(UINT8 *)(msgData + 4) = heatTemp1 & 0xFF;
  1959. *(UINT8 *)(msgData + 5) = heatTemp2 & 0xFF;
  1960. *(UINT8 *)(msgData + 6) = nbReservedTemp1 & 0xFF;
  1961. *(UINT8 *)(msgData + 7) = nbReservedTemp2 & 0xFF;
  1962. break;
  1963. case 0x7C9:
  1964. *(UINT16 *)(msgData + 0) = ((minCellVol >> 8) & 0xFF) | (((minCellVol & 0xFF) << 8) & 0xFF00);
  1965. *(UINT16 *)(msgData + 2) = ((maxCellVol >> 8) & 0xFF) | (((maxCellVol & 0xFF) << 8) & 0xFF00);
  1966. *(UINT16 *)(msgData + 4) = ((battPackVol >> 8) & 0xFF) | (((battPackVol & 0xFF) << 8) & 0xFF00);
  1967. *(UINT8 *)(msgData + 6) = maxCellTemp & 0xFF;
  1968. *(UINT8 *)(msgData + 7) = minCellTemp & 0xFF;
  1969. break;
  1970. case 0x7CA:
  1971. *(UINT8 *)(msgData + 0) = battSOC & 0xFF;
  1972. *(UINT8 *)(msgData + 1) = battSOH & 0xFF;
  1973. *(UINT16 *)(msgData + 2) = ((battI >> 8) & 0xFF) | (((battI & 0xFF) << 8) & 0xFF00);
  1974. *(UINT8 *)(msgData + 4) = battWorkState & 0xFF;
  1975. *(UINT32 *)(msgData + 5) = ((battWarningState >> 16) & 0xFF) | ((battWarningState)&0xFF00) | (((battWarningState & 0xFF) << 16) & 0xFF0000);
  1976. break;
  1977. case 0x7CB:
  1978. *(UINT32 *)(msgData + 0) = ((nbSwVersion >> 24) & 0xFF) | ((nbSwVersion >> 8) & 0xFF00) | ((nbSwVersion << 8) & 0xFF0000) | (((nbSwVersion & 0xFF) << 24) & 0xFF000000);
  1979. *(UINT16 *)(msgData + 4) = ((nbHwVersion >> 8) & 0xFF) | (((nbHwVersion & 0xFF) << 8) & 0xFF00);
  1980. *(UINT8 *)(msgData + 6) = bmsSwVersion & 0xFF;
  1981. *(UINT8 *)(msgData + 7) = bmsHwVersion & 0xFF;
  1982. break;
  1983. case 0x7CC:
  1984. *(UINT32 *)(msgData + 0) = ((battBalanceoInfo >> 24) & 0xFF) | ((battBalanceoInfo >> 8) & 0xFF00) | ((battBalanceoInfo << 8) & 0xFF0000) | (((battBalanceoInfo & 0xFF) << 24) & 0xFF000000);
  1985. *(UINT8 *)(msgData + 4) = battMOSSwitchState & 0xFF;
  1986. *(UINT8 *)(msgData + 5) = battHeatEnableState & 0xFF;
  1987. break;
  1988. case 0x7CD:
  1989. reservedSignal1 = battProtectState & 0xFF;
  1990. reservedSignal2 = (battProtectState >> 8) & 0xFF;
  1991. reservedSignal3 = (battProtectState >> 16) & 0xFF;
  1992. reservedSignal4 = (battProtectState >> 24) & 0xFF;
  1993. *(UINT8 *)(msgData + 0) = reservedSignal1 & 0xFF;
  1994. *(UINT8 *)(msgData + 1) = reservedSignal2 & 0xFF;
  1995. *(UINT8 *)(msgData + 2) = reservedSignal3 & 0xFF;
  1996. *(UINT8 *)(msgData + 3) = reservedSignal4 & 0xFF;
  1997. *(UINT8 *)(msgData + 4) = reservedSignal5 & 0xFF;
  1998. *(UINT8 *)(msgData + 5) = reservedSignal6 & 0xFF;
  1999. *(UINT8 *)(msgData + 6) = reservedSignal7 & 0xFF;
  2000. *(UINT8 *)(msgData + 7) = reservedSignal8 & 0xFF;
  2001. break;
  2002. case 0x7B0:
  2003. *(UINT8 *)(msgData + 0) = (AppNVMData.battSN[0]) & 0xFF;
  2004. *(UINT8 *)(msgData + 1) = (AppNVMData.battSN[1]) & 0xFF;
  2005. *(UINT8 *)(msgData + 2) = (AppNVMData.battSN[2]) & 0xFF;
  2006. *(UINT8 *)(msgData + 3) = (AppNVMData.battSN[3]) & 0xFF;
  2007. *(UINT8 *)(msgData + 4) = (AppNVMData.battSN[4]) & 0xFF;
  2008. *(UINT8 *)(msgData + 5) = (AppNVMData.battSN[5]) & 0xFF;
  2009. *(UINT8 *)(msgData + 6) = (AppNVMData.battSN[6]) & 0xFF;
  2010. *(UINT8 *)(msgData + 7) = (AppNVMData.battSN[7]) & 0xFF;
  2011. break;
  2012. case 0x7B1:
  2013. *(UINT8 *)(msgData + 0) = (AppNVMData.battSN[8]) & 0xFF;
  2014. *(UINT8 *)(msgData + 1) = (AppNVMData.battSN[9]) & 0xFF;
  2015. *(UINT8 *)(msgData + 2) = (AppNVMData.battSN[10]) & 0xFF;
  2016. *(UINT8 *)(msgData + 3) = (AppNVMData.battSN[11]) & 0xFF;
  2017. *(UINT8 *)(msgData + 4) = (AppNVMData.battSN[12]) & 0xFF;
  2018. *(UINT8 *)(msgData + 5) = (AppNVMData.battSN[13]) & 0xFF;
  2019. *(UINT8 *)(msgData + 6) = (AppNVMData.battSN[14]) & 0xFF;
  2020. *(UINT8 *)(msgData + 7) = (AppNVMData.battSN[15]) & 0xFF;
  2021. break;
  2022. case 0x7B2:
  2023. *(UINT8 *)(msgData + 0) = (AppNVMData.battSN[16]) & 0xFF;
  2024. break;
  2025. default:
  2026. break;
  2027. }
  2028. }
  2029. /**
  2030. * @brief : UDS函数,根据报文内容,进行包括读取版本号、读写SN、查询状态,用于完成下线检测和通过CAN接收升级包等操作
  2031. * @param {CAN_Msg_Type} *CanRxMsg
  2032. * @return {*}
  2033. */
  2034. void UDS_Service(CAN_Msg_Type *CanRxMsg)
  2035. {
  2036. UINT8 i, j = 0;
  2037. UINT32 k = 0;
  2038. INT8 ret, errorCount = 0;
  2039. BOOL boolRet = false;
  2040. static UINT8 snFlag = 0;
  2041. static UINT32 sliceCounterFlag = 0;
  2042. UINT32 tempSliceCounter = 0;
  2043. static UINT8 counter = 0;
  2044. CAN_Msg_Type UDSAnswer = {0};
  2045. UINT32 posCode, negCode;
  2046. UINT32 updateDifferDataByteLen = 0;
  2047. static UINT8 updateDataBuffer[100];
  2048. static UINT8 controllerFlag = 0xFF;
  2049. UINT32 flashStartAddr = 0x00;
  2050. static UINT32 updateDifferDataSliceCounter = 0;
  2051. static UINT8 UDSSwitch = 0;
  2052. static UINT8 UDSDialogMode = 01;
  2053. static UINT8 UDSBattSN[BATT_SN_LEN];
  2054. for (i = 0; i < 2; i++)
  2055. {
  2056. UDSAnswer.DLC = 8;
  2057. memset(UDSAnswer.Data, 0, UDSAnswer.DLC);
  2058. UDSService[i] = CanRxMsg[i].Data[0];
  2059. UDSSubService[i] = CanRxMsg[i].Data[1];
  2060. UDSSubServiceActionCode[i] = CanRxMsg[i].Data[2];
  2061. if (CanRxMsg[i].Id == 0x7A0)
  2062. {
  2063. switch (UDSService[i])
  2064. {
  2065. case 0x10:
  2066. if (UDSSubService[i] == 0x01)
  2067. {
  2068. if ((UDSDialogMode == 0x01 || UDSDialogMode == 0x02) || UDSSwitch == 0)
  2069. {
  2070. UDSPositiveAnswer(0x04, i, 0x00);
  2071. UDSSwitch = 0;
  2072. UDSDialogMode = 1;
  2073. }
  2074. else
  2075. {
  2076. UDSNegtiveAnswer(0x05, i, 0xFF);
  2077. }
  2078. }
  2079. else if (UDSSubService[i] == 0x02)
  2080. {
  2081. UDSPositiveAnswer(0x04, i, 0x00);
  2082. UDSSwitch = 1;
  2083. UDSDialogMode = 2;
  2084. }
  2085. else if (UDSSubService[i] == 0x03)
  2086. {
  2087. if (UDSSwitch == 1)
  2088. {
  2089. UDSPositiveAnswer(0x04, i, 0x00);
  2090. UDSSwitch = 1;
  2091. UDSDialogMode = 3;
  2092. }
  2093. else
  2094. {
  2095. UDSNegtiveAnswer(0x05, i, 0xFF);
  2096. }
  2097. }
  2098. else if (UDSSubService[i] == 0x11) //make NB software reset
  2099. {
  2100. if (UDSDialogMode == 2)
  2101. {
  2102. UDSPositiveAnswer(0x04, i, 0x00);
  2103. osDelay(100);
  2104. //SaveAppConfig();
  2105. appSetCFUN(0);
  2106. osDelay(1000);
  2107. EC_SystemReset();
  2108. }
  2109. else
  2110. {
  2111. UDSNegtiveAnswer(0x05, i, 0xFF);
  2112. }
  2113. }
  2114. else
  2115. {
  2116. UDSNegtiveAnswer(0x05, i, 0xEE);
  2117. }
  2118. break;
  2119. case 0x22:
  2120. if (UDSDialogMode == 2)
  2121. {
  2122. if (UDSSubService[i] == 0x01) //check the sw of NB
  2123. {
  2124. UDSPositiveAnswer(0x08, i, APPSWVERSION);
  2125. }
  2126. else if (UDSSubService[i] == 0x02) //check the hw of NB
  2127. {
  2128. UDSPositiveAnswer(0x06, i, HWVERSION);
  2129. }
  2130. else if (UDSSubService[i] == 0x03) //check the SN number
  2131. {
  2132. switch (UDSSubServiceActionCode[i])
  2133. {
  2134. case 00:
  2135. UDSAnswer.Id = 0x7B0;
  2136. CANEncodeFunction(UDSAnswer.Id, UDSAnswer.Data);
  2137. ret = HAL_Can_Transmit(UDSAnswer);
  2138. break;
  2139. case 01:
  2140. UDSAnswer.Id = 0x7B1;
  2141. CANEncodeFunction(UDSAnswer.Id, UDSAnswer.Data);
  2142. ret = HAL_Can_Transmit(UDSAnswer);
  2143. break;
  2144. case 02:
  2145. UDSAnswer.Id = 0x7B2;
  2146. CANEncodeFunction(UDSAnswer.Id, UDSAnswer.Data);
  2147. ret = HAL_Can_Transmit(UDSAnswer);
  2148. break;
  2149. default:
  2150. break;
  2151. }
  2152. }
  2153. else if (UDSSubService[i] == 0x04) //check the batt message
  2154. {
  2155. UDSAnswer.Id = 0x7C0 + UDSSubServiceActionCode[i];
  2156. CANEncodeFunction(UDSAnswer.Id, UDSAnswer.Data);
  2157. ret = HAL_Can_Transmit(UDSAnswer);
  2158. }
  2159. else if (UDSSubService[i] == 0x05) //check the enviroment temp of NB
  2160. {
  2161. UINT32 temp = ((fastChargeTemp << 24) & 0xFF000000) | ((normalChargeTemp << 16) & 0xFF0000) | ((heatTemp1 << 8) & 0xFF00) | (heatTemp2 & 0xFF);
  2162. UDSPositiveAnswer(0x08, i, temp); //ntcvalue
  2163. }
  2164. else if (UDSSubService[i] == 0x06) //check the tcp link of NB
  2165. {
  2166. UDSPositiveAnswer(0x06, i, TcpSendLen); //TcpconnectStatus
  2167. }
  2168. else if (UDSSubService[i] == 0x07) //check the GPS link of NB
  2169. {
  2170. posCode = GpsFlag;
  2171. UDSPositiveAnswer(0x05, i, posCode); //gps satellite num(uint8), should be modified
  2172. }
  2173. else
  2174. {
  2175. UDSNegtiveAnswer(0x05, i, 0xEE);
  2176. }
  2177. }
  2178. else //the service is not surpported in current dialog mode
  2179. {
  2180. UDSNegtiveAnswer(0x05, i, 0xFF);
  2181. }
  2182. break;
  2183. case 0x2E: //write service
  2184. if (UDSDialogMode == 2)
  2185. {
  2186. if (UDSSubService[i] == 0x03) // write the battSN
  2187. {
  2188. if (UDSSubServiceActionCode[i] == 0x00 && snFlag == 0x00)
  2189. {
  2190. for (j = 0; j < 5; j++)
  2191. {
  2192. UDSBattSN[j + 5 * 0] = CanRxMsg[i].Data[j + 3];
  2193. }
  2194. snFlag = snFlag | 0x01;
  2195. }
  2196. else if (UDSSubServiceActionCode[i] == 0x01 && snFlag == 0x01)
  2197. {
  2198. for (j = 0; j < 5; j++)
  2199. {
  2200. UDSBattSN[j + 5 * 1] = CanRxMsg[i].Data[j + 3];
  2201. }
  2202. snFlag = snFlag | 0x02;
  2203. }
  2204. else if (UDSSubServiceActionCode[i] == 0x02 && snFlag == 0x03)
  2205. {
  2206. for (j = 0; j < 5; j++)
  2207. {
  2208. UDSBattSN[j + 5 * 2] = CanRxMsg[i].Data[j + 3];
  2209. }
  2210. snFlag = snFlag | 0x04;
  2211. }
  2212. else if (UDSSubServiceActionCode[i] == 0x03 && snFlag == 0x07)
  2213. {
  2214. for (j = 0; j < 2; j++)
  2215. {
  2216. UDSBattSN[j + 5 * 3] = CanRxMsg[i].Data[j + 3];
  2217. }
  2218. snFlag = snFlag | 0x08;
  2219. }
  2220. if (snFlag == 0x0F)
  2221. {
  2222. snFlag = 0;
  2223. UDSPositiveAnswer(0x04, i, 00);
  2224. MEMCPY(AppNVMData.battSN, UDSBattSN, BATT_SN_LEN);
  2225. AppNVMData.EOLState = 1; //SN号写入完成,表明已经进行过下线配置
  2226. SaveAppConfig();
  2227. }
  2228. else
  2229. {
  2230. UDSAnswer.Id = 0x7A8;
  2231. UDSAnswer.Data[0] = 0x05;
  2232. UDSAnswer.Data[1] = 0x3E;
  2233. UDSAnswer.Data[2] = UDSService[i];
  2234. UDSAnswer.Data[3] = UDSSubService[i];
  2235. UDSAnswer.Data[4] = snFlag;
  2236. ret = HAL_Can_Transmit(UDSAnswer);
  2237. }
  2238. }
  2239. else if (UDSSubService[i] == 0x0F) //write the update config:updateDifferDataByteLen
  2240. {
  2241. updateDifferDataByteLen = (CanRxMsg[i].Data[2] << 16) | (CanRxMsg[i].Data[3] << 8) | CanRxMsg[i].Data[4];
  2242. UDSPositiveAnswer(0x04, i, 00);
  2243. }
  2244. else
  2245. {
  2246. UDSNegtiveAnswer(0x05, i, 0xEE);
  2247. }
  2248. break;
  2249. }
  2250. else
  2251. {
  2252. UDSNegtiveAnswer(0x05, i, 0xFF);
  2253. }
  2254. break;
  2255. case 0x31: //clear the flash service
  2256. if (UDSDialogMode == 3)
  2257. {
  2258. if (UDSSubService[i] == 0x0F) //clear the fota flash
  2259. {
  2260. if (UDSSubServiceActionCode[i] != 0x00 && UDSSubServiceActionCode[i] != 0xFF)
  2261. {
  2262. //Clear the Flash
  2263. controllerFlag = UDSSubServiceActionCode[i];
  2264. boolRet = UDSClearFotaDownloadRegion(controllerFlag);
  2265. //if ok
  2266. UDSPositiveAnswer(0x05, i, (UINT32)boolRet);
  2267. }
  2268. else
  2269. {
  2270. UDSNegtiveAnswer(0x06, i, UDSSubServiceActionCode[i] << 8 | 0xFF); //重点测试
  2271. }
  2272. }
  2273. else
  2274. {
  2275. UDSNegtiveAnswer(0x05, i, 0xEE); //the subservice is not surpported
  2276. }
  2277. }
  2278. else
  2279. {
  2280. UDSNegtiveAnswer(0x05, i, 0xFF); //the survie is not surpported in current dialog mode
  2281. }
  2282. break;
  2283. case 0x34: //prepare for some one process
  2284. if (UDSDialogMode == 3)
  2285. {
  2286. if (UDSSubService[i] == 0x0F) //ask for download update data
  2287. {
  2288. boolRet = UDSAskforDownLoadData();
  2289. //if ok
  2290. UDSPositiveAnswer(0x05, i, (UINT32)boolRet);
  2291. }
  2292. else
  2293. {
  2294. UDSNegtiveAnswer(0x05, i, 0xEE);
  2295. }
  2296. }
  2297. else
  2298. {
  2299. UDSNegtiveAnswer(0x05, i, 0xFF);
  2300. }
  2301. break;
  2302. case 0x36: //download the update data
  2303. if (UDSDialogMode == 3)
  2304. {
  2305. if (downloadReady == TRUE)
  2306. {
  2307. counter++; //记录报文数量
  2308. tempSliceCounter = (CanRxMsg[i].Data[1] << 16) | (CanRxMsg[i].Data[2] << 8) | (CanRxMsg[i].Data[3]);
  2309. /*
  2310. #ifdef USING_PRINTF
  2311. printf("tempSliceCounter = %x\n",tempSliceCounter);
  2312. #endif
  2313. */
  2314. if (tempSliceCounter < (updateDifferDataPackageCounter + 1) * 25 && tempSliceCounter >= updateDifferDataPackageCounter * 25)
  2315. {
  2316. updateDifferDataSliceCounter = tempSliceCounter % 25;
  2317. for (j = 0; j < 4; j++)
  2318. {
  2319. updateDataBuffer[updateDifferDataSliceCounter * 4 + j] = CanRxMsg[i].Data[4 + j];
  2320. }
  2321. if (updateDifferDataSliceCounter > 0)
  2322. {
  2323. sliceCounterFlag = sliceCounterFlag | (0x01 << updateDifferDataSliceCounter);
  2324. }
  2325. else
  2326. {
  2327. sliceCounterFlag = sliceCounterFlag | 0x01;
  2328. }
  2329. /*
  2330. #ifdef USING_PRINTF
  2331. printf("sliceCounterFlag = %x counter=%d\n",sliceCounterFlag,counter);
  2332. #endif
  2333. */
  2334. }
  2335. else
  2336. {
  2337. counter--;
  2338. }
  2339. if (counter == 25)
  2340. {
  2341. counter = 0;
  2342. if (sliceCounterFlag == 0x1FFFFFF) //received all the 25 message of current package
  2343. {
  2344. //write the buffer(100 byte) to flash
  2345. if (controllerFlag == 0x01)
  2346. {
  2347. flashStartAddr = FLASH_FOTA_REGION_START;
  2348. }
  2349. else if (controllerFlag == 0x02 || controllerFlag == 0x03)
  2350. {
  2351. flashStartAddr = FLASH_BMS_FOTA_START_ADDR;
  2352. }
  2353. else
  2354. {
  2355. UDSNegtiveAnswer(0x08, i, 0xFFFFFFFF);
  2356. return;
  2357. }
  2358. ret = (uint8_t)BSP_QSPI_Write_Safe(updateDataBuffer, flashStartAddr + (updateDifferDataPackageCounter)*100, 100);
  2359. errorCount = 0;
  2360. while (ret != QSPI_OK && errorCount < 3) //try to write most 3 times
  2361. {
  2362. errorCount++;
  2363. BSP_QSPI_Erase_Safe(flashStartAddr + (updateDifferDataPackageCounter)*100, 100);
  2364. ret = (uint8_t)BSP_QSPI_Write_Safe(updateDataBuffer, flashStartAddr + (updateDifferDataPackageCounter)*100, 100);
  2365. }
  2366. if (ret == QSPI_OK) // write successed
  2367. {
  2368. UDSPositiveAnswer(0x08, i, tempSliceCounter);
  2369. memset(updateDataBuffer, 0, 100);
  2370. sliceCounterFlag = 0x0;
  2371. updateDifferDataPackageCounter++;
  2372. }
  2373. else //write fail
  2374. {
  2375. UDSNegtiveAnswer(0x08, i, 0xFFFFFFFF); //failed to write this package to flash
  2376. }
  2377. }
  2378. else
  2379. {
  2380. //received 25 messages, but lose one or more messages
  2381. //in this case, updater will try to send the package again(most 4 times)
  2382. UDSNegtiveAnswer(0x08, i, sliceCounterFlag);
  2383. }
  2384. }
  2385. }
  2386. else
  2387. {
  2388. UDSNegtiveAnswer(0x05, i, 0xEF); //the download process is not ready
  2389. counter = 0;
  2390. }
  2391. }
  2392. else
  2393. {
  2394. UDSNegtiveAnswer(0x05, i, 0xFF); //the service is not surpported in current dialog mode
  2395. }
  2396. break;
  2397. case 0x37: //exit some one process
  2398. if (UDSDialogMode == 3)
  2399. {
  2400. if (UDSSubService[i] == 0x0F) // exit the download
  2401. {
  2402. if (UDSSubServiceActionCode[i] == controllerFlag)
  2403. {
  2404. if (controllerFlag == 0x02 || controllerFlag == 0x03) //update bms
  2405. {
  2406. BMS_Fota_update_flag = true;
  2407. }
  2408. downloadReady = FALSE;
  2409. UDSPositiveAnswer(0x04, i, UDSSubServiceActionCode[i]);
  2410. }
  2411. else
  2412. {
  2413. UDSNegtiveAnswer(0x05, i, 0xEE);
  2414. }
  2415. }
  2416. else
  2417. {
  2418. UDSNegtiveAnswer(0x05, i, 0xEE);
  2419. }
  2420. }
  2421. else
  2422. {
  2423. UDSNegtiveAnswer(0x05, i, 0xFF);
  2424. }
  2425. break;
  2426. default:
  2427. UDSNegtiveAnswer(0x04, i, 0xFF); //the service is not surpported
  2428. break;
  2429. }
  2430. }
  2431. }
  2432. for (i = 0; i < 2; i++)
  2433. {
  2434. UDSService[i] = 0;
  2435. UDSSubService[i] = 0;
  2436. }
  2437. }
  2438. /**
  2439. * @brief : UDS肯定响应,发送肯定响应报文
  2440. * @param {UINT8} answerLen
  2441. * @param {UINT8} messageIndex
  2442. * @param {UINT32} posCode
  2443. * @return {*}
  2444. */
  2445. UINT8 UDSPositiveAnswer(UINT8 answerLen, UINT8 messageIndex, UINT32 posCode)
  2446. {
  2447. CAN_Msg_Type UDSAnswer;
  2448. UINT8 ret;
  2449. UDSAnswer.Id = 0x7A8;
  2450. UDSAnswer.DLC = 8;
  2451. UDSAnswer.Data[0] = answerLen;
  2452. UDSAnswer.Data[1] = 0x78;
  2453. UDSAnswer.Data[2] = UDSService[messageIndex];
  2454. UDSAnswer.Data[3] = UDSSubService[messageIndex];
  2455. if (answerLen == 4)
  2456. {
  2457. UDSAnswer.Data[4] = 0x00;
  2458. UDSAnswer.Data[5] = 0x00;
  2459. UDSAnswer.Data[6] = 0x00;
  2460. UDSAnswer.Data[7] = 0x00;
  2461. }
  2462. else if (answerLen == 5)
  2463. {
  2464. UDSAnswer.Data[4] = posCode;
  2465. UDSAnswer.Data[5] = 0x00;
  2466. UDSAnswer.Data[6] = 0x00;
  2467. UDSAnswer.Data[7] = 0x00;
  2468. }
  2469. else if (answerLen == 6)
  2470. {
  2471. UDSAnswer.Data[4] = posCode >> 8;
  2472. UDSAnswer.Data[5] = posCode;
  2473. UDSAnswer.Data[6] = 0x00;
  2474. UDSAnswer.Data[7] = 0x00;
  2475. }
  2476. else if (answerLen == 7)
  2477. {
  2478. UDSAnswer.Data[4] = posCode >> 16;
  2479. UDSAnswer.Data[5] = posCode >> 8;
  2480. UDSAnswer.Data[6] = posCode;
  2481. UDSAnswer.Data[7] = 0x00;
  2482. }
  2483. else if (answerLen == 8)
  2484. {
  2485. UDSAnswer.Data[4] = posCode >> 24;
  2486. UDSAnswer.Data[5] = posCode >> 16;
  2487. UDSAnswer.Data[6] = posCode >> 8;
  2488. UDSAnswer.Data[7] = posCode;
  2489. }
  2490. ret = HAL_Can_Transmit(UDSAnswer);
  2491. return ret;
  2492. }
  2493. /**
  2494. * @brief : UDS否定响应,发送否定响应报文
  2495. * @param {UINT8} answerLen
  2496. * @param {UINT8} messageIndex
  2497. * @param {UINT32} negCode
  2498. * @return {*}
  2499. */
  2500. UINT8 UDSNegtiveAnswer(UINT8 answerLen, UINT8 messageIndex, UINT32 negCode)
  2501. {
  2502. CAN_Msg_Type UDSAnswer;
  2503. UINT8 ret;
  2504. UDSAnswer.Id = 0x7A8;
  2505. UDSAnswer.DLC = 8;
  2506. UDSAnswer.Data[0] = answerLen;
  2507. UDSAnswer.Data[1] = 0x7F;
  2508. UDSAnswer.Data[2] = UDSService[messageIndex];
  2509. UDSAnswer.Data[3] = UDSSubService[messageIndex];
  2510. if (answerLen == 4)
  2511. {
  2512. UDSAnswer.Data[3] = negCode;
  2513. UDSAnswer.Data[4] = 0x00;
  2514. UDSAnswer.Data[5] = 0x00;
  2515. UDSAnswer.Data[6] = 0x00;
  2516. UDSAnswer.Data[7] = 0x00;
  2517. }
  2518. if (answerLen == 5)
  2519. {
  2520. UDSAnswer.Data[4] = negCode;
  2521. UDSAnswer.Data[5] = 0x00;
  2522. UDSAnswer.Data[6] = 0x00;
  2523. UDSAnswer.Data[7] = 0x00;
  2524. }
  2525. else if (answerLen == 6)
  2526. {
  2527. UDSAnswer.Data[4] = negCode >> 8;
  2528. UDSAnswer.Data[5] = negCode;
  2529. UDSAnswer.Data[6] = 0x00;
  2530. UDSAnswer.Data[7] = 0x00;
  2531. }
  2532. else if (answerLen == 7)
  2533. {
  2534. UDSAnswer.Data[4] = negCode >> 16;
  2535. UDSAnswer.Data[5] = negCode >> 8;
  2536. UDSAnswer.Data[6] = negCode;
  2537. UDSAnswer.Data[7] = 0x00;
  2538. }
  2539. else if (answerLen == 8)
  2540. {
  2541. UDSAnswer.Data[4] = negCode >> 24;
  2542. UDSAnswer.Data[5] = negCode >> 16;
  2543. UDSAnswer.Data[6] = negCode >> 8;
  2544. UDSAnswer.Data[7] = negCode;
  2545. }
  2546. ret = HAL_Can_Transmit(UDSAnswer);
  2547. return ret;
  2548. }
  2549. /**
  2550. * @brief : 清空计数,并准备接收数据包
  2551. * @param {*}
  2552. * @return {*}
  2553. */
  2554. BOOL UDSAskforDownLoadData()
  2555. {
  2556. updateDifferDataPackageCounter = 0;
  2557. downloadReady = true;
  2558. return TRUE;
  2559. }
  2560. /**
  2561. * @brief : 清除数据接收的flash区域
  2562. * @param {UINT8} controllerFlag
  2563. * @return {*}
  2564. */
  2565. BOOL UDSClearFotaDownloadRegion(UINT8 controllerFlag)
  2566. {
  2567. UINT8 ret = FALSE;
  2568. if (controllerFlag == 0x01)
  2569. {
  2570. ret = BSP_QSPI_Erase_Safe(FLASH_FOTA_REGION_START, 0x46000); //512k-32k -200k = 280k -> 0x46000
  2571. }
  2572. else if (controllerFlag == 0x02 || controllerFlag == 0x03)
  2573. {
  2574. ret = BSP_QSPI_Erase_Safe(FLASH_BMS_FOTA_START_ADDR, FLASH_BMS_FOTA_LEN);
  2575. }
  2576. if (ret == QSPI_OK)
  2577. {
  2578. return TRUE;
  2579. }
  2580. else
  2581. {
  2582. return FALSE;
  2583. }
  2584. }