12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188 |
- /****************************************************************************
- *
- * Copy right: Qx.
- * File name: UartTask.c
- * Description: 串口任务
- * History: 2021-03-05
- *
- * 2021-04-11:可以通过Ota线路升级Bms保护板
- ****************************************************************************/
- #include "bsp.h"
- #include "bsp_custom.h"
- #include "osasys.h"
- #include "ostask.h"
- #include "queue.h"
- #include "ps_event_callback.h"
- #include "cmisim.h"
- #include "cmimm.h"
- #include "cmips.h"
- #include "sockets.h"
- #include "psifevent.h"
- #include "ps_lib_api.h"
- #include "lwip/netdb.h"
- //#include <cis_def.h>
- #include "debug_log.h"
- #include "slpman_ec616.h"
- #include "plat_config.h"
- #include "ec_tcpip_api.h"
- #include "hal_module_adapter.h"
- #include "UartTask.h"
- #include "MainTask.h"
- #include <stdlib.h>
- #include "app.h"
- #include "numeric.h"
- #include "Fota.h"
- #include "signal.h"
- //全局变量输入区
- extern UINT32 Timer_count;
- extern volatile BOOL Sleep_flag;
- extern AppNVMDataType AppNVMData;
- extern AppDataBody AppDataInfo;
- extern UINT8 UDSSwitch;
- //全局变量输出区
- BOOL UartBattInfoRecvFlag = false;
- QueueHandle_t UartWriteCmdHandle = NULL;
- UINT8 BattChrgEndFlag;
- UINT8 Ringtimes = 0;
- UINT8 ret = 0x00;
- //
- extern ARM_DRIVER_USART Driver_USART1;
- static ARM_DRIVER_USART *USARTdrv = &Driver_USART1;
- volatile bool isRecvTimeout = false;
- volatile bool isRecvComplete = false;
- //线程声明区
- static StaticTask_t gProcess_Uart_Task_t;
- static UINT8 gProcess_Uart_TaskStack[PROC_UART_TASK_STACK_SIZE];
- static osThreadId_t UartTaskId = NULL;
- static process_Uart gProcess_Uart_Task = PROCESS_UART_STATE_IDLE;
- #define PROC_UART_STATE_SWITCH(a) (gProcess_Uart_Task = a)
- //函数声明区
- void USART_callback(uint32_t event);
- UINT8 Uart_DataRecv_func(Uart_Read_Msg_Type Uart_Read_Msg_Fun,UINT8* Uart_Recv_Buffer_Fun);
- static BOOL uartBattInfoDecode(UINT8* dataPtr);
- UINT8 Uart_WriteCmd_func(Uart_Write_Data_Type UartWriteData);
- UINT16 crc_chk(UINT8* data, UINT8 length);
- void battSOCDisplay(void);
- void battErrorStateDisplay(void);
- void battWarningStateDisplay(void);
- void battLockStateDisplay(UINT8 lockState);
- void relayControlFunc(float DutyRatio,UINT8 BuzzerPeriod);
- void SP_BMS_Update_Service(void);
- BOOL BattHeaterSwitch(UINT8* heaterSwitch,UINT8 HeatForceControl);
- UINT16 encryptionAlgorithm (UINT16 plainText);
- UINT8 decryptionAlgorithm (UINT16 cipherText);
- UINT8 Uart_Encrypt_Send(void);
- UINT8 BmsErrorDecode(UINT32 battWarningState);
- #ifdef SOC_TEST
- void Uart_Data_recv_SOC_test(void);
- #endif
- //BMS升级函数声明
- UINT8 SP_BMS_Update_CheckSUM(UINT8* pSendData,UINT8 len);
- void SP_BMS_Update_Service();
- UINT8 SP_BMS_Update_Query(UINT8* pSend,UINT32 sendLen, UINT8* pRead, UINT32 readLen, UINT32 timeout);
- updateBMSStatus MS_BMS_Update_Service();
- UINT16 MS_BMS_Update_CRC16(UINT8* pSendData,UINT16 len);
- UINT8 MS_BMS_Update_Query(UINT8* pSend,UINT32 sendLen, UINT8* pRead, UINT32 readLen, UINT32 timeout);
- static osThreadId_t ControlTaskId = NULL;
- void controlTask(void *arg);
- //Uart线程任务区
- static void UartTask(void* arg)
- {
- USARTdrv->Initialize(USART_callback);
- USARTdrv->PowerControl(ARM_POWER_FULL);
- USARTdrv->Control(ARM_USART_MODE_ASYNCHRONOUS |
- ARM_USART_DATA_BITS_8 |
- ARM_USART_PARITY_NONE |
- ARM_USART_STOP_BITS_1 |
- ARM_USART_FLOW_CONTROL_NONE, 9600);
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_ENCRYPT);
- UINT16 Reg_Num = 0;
- Uart_Read_Msg_Type Uart_Read_Msg;
- memset(&(Uart_Read_Msg),0x00,sizeof(Uart_Read_Msg_Type));
- Uart_Write_Data_Type UartWriteData; //Uart控制命令
- memset(&(UartWriteData),0x00,sizeof(Uart_Write_Data_Type));
- UartReadMsgType UartReadMsg;
- if(UartWriteCmdHandle == NULL)//Uart控制命令传输指针
- {
- UartWriteCmdHandle = osMessageQueueNew(1,sizeof(Uart_Write_Data_Type), NULL);
- }
- if(ControlTaskId == NULL)
- {
- xTaskCreate(controlTask,
- "ControlTaskName",
- 256,( void * ) NULL,
- osPriorityNormal6,
- &ControlTaskId);
- }
- //上电起始控制区域
- UINT8 HeatSwitch = 0;
- UINT8 heatErrorCounter = 0;
- UINT8 UartErrorCounter = 0;
- while (1)
- {
- switch (gProcess_Uart_Task)
- {
- case PROCESS_UART_STATE_ENCRYPT:
- {
- UINT8 EncryptFlag=0x00;
- UINT8 EncryptCount=0;
- while(EncryptFlag!=0x01&&EncryptCount<=3)
- {
- EncryptFlag = Uart_Encrypt_Send();
- EncryptCount++;
- }
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_IDLE);
- break;
- }
- case PROCESS_UART_STATE_IDLE:
- {
- osDelay(100);
- if(Sleep_flag)
- {
- Ringtimes = 0;
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_SLEEP);
- break;
- }
- else if(Timer_count%10==0)
- {
- #ifdef USING_PRINTF1
- printf("[%d]AvgBattTemp :%d,UartBattInfoRecvFlag:%d,battHeatEnableState:%d \n",__LINE__,AvgBattTemp,UartBattInfoRecvFlag,battHeatEnableState);
- #endif
- if(osMessageQueueGet(UartWriteCmdHandle,&UartWriteData,0,0)==osOK && UartBattInfoRecvFlag==TRUE)
- {
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_WRITE);
- break;
- }
- else
- {
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_READ);
- break;
- }
- }
- if(maxCellVol>4400&&maxCellVol<6000)//过压断开继电器
- {
- AppDataInfo.RelayControl=TRUE;
- }
- if((AvgBattTemp>=45+40)&&(battHeatEnableState==0x00)&&(MOSTemp>=70+40))//温度的判定需要加40摄氏度,如果模组最高>=45度,模组最低>=45度,mos温度>=70度,并且加热关闭,持续超过10s,则断开继电器,锁定放电mos
- {
- heatErrorCounter++;
- if(heatErrorCounter>100)
- {
- AppDataInfo.ErrorMsg = 20;
- heatErrorCounter = 0;
- AppDataInfo.appDataModify = TRUE;
- AppNVMData.appDataModify = TRUE;
- AppDataInfo.RelayControl=TRUE;
- AppNVMData.isBattLocked = TRUE;
- }
- }
- if(BMS_Fota_update_flag)
- {
- if(BattWorkStateDelay==0x00)
- {
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_UPDATE);
- break;
- }
- }
- //限制充电测试
- if((maxCellVol>4170&&maxCellVol<6000)&&(BattWorkStateDelay ==0x02)&&(((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x02)!=0x00)&&(UartBattInfoRecvFlag==TRUE))//try to lock lock the charge
- {
- #ifdef USING_PRINTF
- printf("[%d]try to lock charge \n",__LINE__);
- #endif
- UartWriteData.WriteCmd = 0x01;
- UartWriteData.Data[0] = 0x00|(UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2]);
- UartWriteData.Data[1] = 0x00|((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x01);
- osMessageQueuePut(UartWriteCmdHandle,&UartWriteData,0,0);
- }
- else if((maxCellVol<4100&&maxCellVol>0)&&(((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x02)!=0x02)&&(UartBattInfoRecvFlag==TRUE))//try to unlock lock the charge
- {
- #ifdef USING_PRINTF
- printf("[%d]try to unlock charge \n",__LINE__);
- #endif
- UartWriteData.WriteCmd = 0x01;
- UartWriteData.Data[0] = 0x00|(UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2]);
- UartWriteData.Data[1] = 0x02|((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x01);
- osMessageQueuePut(UartWriteCmdHandle,&UartWriteData,0,0);
- }
- if((battWorkState ==0x00) && (AppNVMData.isBattLocked==TRUE) && (((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x01)!=0x00)&&(UartBattInfoRecvFlag==TRUE))//try to lock lock the discharge
- {
- #ifdef USING_PRINTF
- printf("[%d]try to lock discharge \n",__LINE__);
- #endif
- UartWriteData.WriteCmd = 0x01;
- UartWriteData.Data[0] = 0x00|(UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2]);
- UartWriteData.Data[1] = 0x00|((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x02);
- osMessageQueuePut(UartWriteCmdHandle,&UartWriteData,0,0);
- }
- else if (battWorkState ==0x00 && AppNVMData.isBattLocked==FALSE && (((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x01)!=0x01)&&(UartBattInfoRecvFlag==TRUE)) // try to unlock
- {
- #ifdef USING_PRINTF
- printf("[%d]try to unlock discharge \n",__LINE__);
- #endif
- UartWriteData.WriteCmd = 0x01;
- UartWriteData.Data[0] = 0x00|(UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2]);
- UartWriteData.Data[1] = 0x01|((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x02);
- osMessageQueuePut(UartWriteCmdHandle,&UartWriteData,0,0);
- }
- if((AppDataInfo.RelayControl==TRUE) && (((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2])&0x80)==0x00)&&(UartBattInfoRecvFlag==TRUE))//继电器断开
- {
- #ifdef USING_PRINTF
- printf("[%d]try to cut relay \n",__LINE__);
- #endif
- UartWriteData.WriteCmd = 0x03;
- UartWriteData.Data[0] = 0x80;
- UartWriteData.Data[1] = 0x00|(UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1]);
- osMessageQueuePut(UartWriteCmdHandle,&UartWriteData,0,0);
- }
- else if((AppDataInfo.RelayControl==FALSE) && (((UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2])&0x80)==0x80)&&(UartBattInfoRecvFlag==TRUE))//继电器闭合
- {
- #ifdef USING_PRINTF
- printf("[%d]try to recover relay \n",__LINE__);
- #endif
- UartWriteData.WriteCmd = 0x03;
- UartWriteData.Data[0] = 0x00;
- UartWriteData.Data[1] = 0x00|(UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1]);
- osMessageQueuePut(UartWriteCmdHandle,&UartWriteData,0,0);
- }
- if(BattHeaterSwitch(&HeatSwitch,HeatForceControl)==TRUE&&(UartBattInfoRecvFlag==TRUE))
- {
- #ifdef USING_PRINTF
- printf("[%d]try to change heatstate \n",__LINE__);
- #endif
- UartWriteData.WriteCmd = 0x02;
- UartWriteData.Data[0] = 0x00;
- UartWriteData.Data[1] = HeatSwitch&0xFF;
- osMessageQueuePut(UartWriteCmdHandle,&UartWriteData,0,0);
- }
- break;
- }
- case PROCESS_UART_STATE_READ:
- {
- UINT16 CRC_chk_buffer;
- UINT16 Uart_Recv_LEN = 0;
- Reg_Num = 0x21+BATT_CELL_VOL_NUM+BATT_TEMP_NUM + BATT_OTHER_TEMP_NUM;//按照协议里面的0x21+X+N的结束地址
- Uart_Read_Msg.Bms_Address = BMS_ADDRESS_CODE;
- Uart_Read_Msg.Bms_Funcode = UART_READ_CODE;
- Uart_Read_Msg.Reg_Begin_H = 0x00;
- Uart_Read_Msg.Reg_Begin_L= 0x00;
- Uart_Read_Msg.Reg_Num_H = Reg_Num>>8;
- Uart_Read_Msg.Reg_Num_L = Reg_Num;
- memset((UINT8 *)&UartReadMsg,0x00,sizeof(UartReadMsgType));
- CRC_chk_buffer = crc_chk((UINT8 *)&Uart_Read_Msg,6);
- Uart_Read_Msg.CRC_L = CRC_chk_buffer;
- Uart_Read_Msg.CRC_H = CRC_chk_buffer>>8;
- //Uart_Recv_LEN = Uart_DataRecv_func((UINT8 *)&Uart_Read_Msg,(UINT8*)UartReadMsg.Header);
- Uart_Recv_LEN = Uart_DataRecv_func(Uart_Read_Msg,(UINT8 *)&UartReadMsg);
- if(Uart_Recv_LEN>0)
- {
- UartErrorCounter = 0;
- UartBattInfoRecvFlag = TRUE;
- uartBattInfoDecode(UartReadMsg.data);
- }
- else
- {
- UartBattInfoRecvFlag = FALSE;
- UartErrorCounter++;
- }
- if(UartErrorCounter>=5)
- {
- if(osOK==osMutexAcquire(Error_Mutex, 100))
- {
- UINT8 ErrorNumTemp = 33;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- }
- osMutexRelease(Error_Mutex);
- UartErrorCounter = 5;
- uartBattInfoDecode(UartReadMsg.data);
- }
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_IDLE);
- #ifdef USING_PRINTF1
- printf("[%d]lock:%X,permit:%X,Mos:%x\n",__LINE__,AppNVMData.isBattLocked,(UartReadMsg.data[(0x1B+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM)*2+1])&0x03,((UartReadMsg.data[(0x09+BATT_CELL_VOL_NUM+BATT_OTHER_TEMP_NUM)*2+1])>>1)&0x03);
- #endif
- //SOC问题测试
- #ifdef SOC_TEST
- if(bmsSwVersion==8)
- {
- Uart_Data_recv_SOC_test();
- }
- #endif
- break;
- }
- case PROCESS_UART_STATE_WRITE:
- {
- ret = Uart_WriteCmd_func(UartWriteData);
- osDelay(500);
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_READ);
- break;
- }
- case PROCESS_UART_STATE_UPDATE:
- UartBattInfoRecvFlag = FALSE;
- #if BMS_MANUFACTURE==1
- {
- SP_BMS_Update_Service();
- }
- #elif BMS_MANUFACTURE==2
- BmsUpdateState = MS_BMS_Update_Service();
- #endif
- PROC_UART_STATE_SWITCH(PROCESS_UART_STATE_IDLE);
- BMS_Fota_update_flag = FALSE;
- break;
- case PROCESS_UART_STATE_SLEEP:
- {
- USARTdrv->PowerControl(ARM_POWER_LOW);
- vTaskDelete(ControlTaskId);
- while(TRUE)
- {
- osDelay(60000/portTICK_PERIOD_MS);
- }
- osThreadExit();
- break;
- }
- }
- }
- }
- //Uart 接收的数据解码
- static BOOL uartBattInfoDecode(UINT8* dataPtr)
- {
- //BattInfoType battInfo;
- UINT8 i,temp=0;
- UINT8 TEMP_NUM = BATT_TEMP_NUM + BATT_OTHER_TEMP_NUM;
- UINT16 Batt_current;
- INT8 BattCurrentNegFlag = 1;
- for(i=0;i<BATT_CELL_VOL_NUM;i++)
- {
- battCellU[i] = (dataPtr[(0x02+i)*2] << 8) | dataPtr[(0x02+i)*2 + 1];
- }
-
- battWorkState = (dataPtr[(0x03+BATT_CELL_VOL_NUM)*2+1])&0x03;//电池状态(原始数据),0表示静置,1表示放电,2表示充电
-
- for(i=0; i<BATT_TEMP_NUM; i++)
- {
- battCellTemp[i] = dataPtr[(0x06+BATT_CELL_VOL_NUM+i)*2+1];
- }
- MOSTemp = dataPtr[(0x06+BATT_CELL_VOL_NUM+BATT_TEMP_NUM)*2+1];
- packTemp = dataPtr[(0x06+BATT_CELL_VOL_NUM+BATT_TEMP_NUM+1)*2+1];
- Data_Current = (dataPtr[(0x02+BATT_CELL_VOL_NUM)*2]<<8)|(dataPtr[(0x02+BATT_CELL_VOL_NUM)*2+1]);
- Batt_current = (dataPtr[(0x02+BATT_CELL_VOL_NUM)*2]<<8)|(dataPtr[(0x02+BATT_CELL_VOL_NUM)*2+1]);
- //原始数据:充电为负,放电为正
- if(battWorkState == 0x02) //充电过程
- {
- if(Batt_current >0x8000)// 数据为负
- {
- //求补码,结果为负
- Batt_current = (UINT16)((UINT16)(~(Batt_current))+1);
- Batt_current = Batt_current/10;
- BattCurrentNegFlag = -1;
- }
- else
- {
- //源码,结果为负
- Batt_current = Batt_current/10;
- BattCurrentNegFlag = -1;
- }
- }
- else //放电过程
- {
- if(Batt_current >0x8000)// 数据为负
- {
- //求补码,结果为正
- Batt_current = (UINT16)((UINT16)(~(Batt_current))+1);
- Batt_current = Batt_current/10;
- BattCurrentNegFlag = 1;
- }
- else
- {
- //源码,结果为正
- Batt_current = Batt_current/10;
- BattCurrentNegFlag = 1;
- }
- }
- battI = Batt_current*BattCurrentNegFlag + 0x2710;
- //bit0 ~ bit31 represent cell0 ~ cell31
- 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);
- chargerConnectState = (dataPtr[(0x03+BATT_CELL_VOL_NUM)*2+1]>>2)&0x01;//充电器连接状态,0表示未连接,1表示已连接
- bmsHwVersion = dataPtr[(0x08+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1];
- bmsSwVersion = dataPtr[(0x08+BATT_CELL_VOL_NUM+TEMP_NUM)*2];
- temp = ((dataPtr[(0x09+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1])>>1)&0x03;
- battMOSSwitchState = ((temp&0x01)<<1)|((temp&0x02)>>1);
- #ifdef USING_PRINTF1
- printf("[%d]battMOSSwitchState :%x\n",__LINE__,battMOSSwitchState);
- #endif
- if(AppNVMData.isBattLocked==TRUE)
- {
- battMOSSwitchState = battMOSSwitchState |(0x01<<2);
- }
- else
- {
- battMOSSwitchState = battMOSSwitchState |(0x00<<2);
- }
- 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]);
- battSOC = dataPtr[(0x0B+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1];
- battSOH = dataPtr[(0x0C+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1];
- 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]);
- BattRemainCap = (dataPtr[(0x12+BATT_CELL_VOL_NUM+TEMP_NUM)*2])<<24|(dataPtr[(0x12+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1])<<16|(dataPtr[(0x13+BATT_CELL_VOL_NUM+TEMP_NUM)*2])<<8|(dataPtr[(0x13+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1]);
- 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]);
- battPackVol =((dataPtr[(0x18+BATT_CELL_VOL_NUM+TEMP_NUM)*2])<<8|(dataPtr[(0x18+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1]))/10; //uint 100mV
- maxCellVol = (dataPtr[(0x19+BATT_CELL_VOL_NUM+TEMP_NUM)*2] << 8) | dataPtr[(0x19+BATT_CELL_VOL_NUM+TEMP_NUM)*2 + 1];
- minCellVol = (dataPtr[(0x1A+BATT_CELL_VOL_NUM+TEMP_NUM)*2] << 8) | dataPtr[(0x1A+BATT_CELL_VOL_NUM+TEMP_NUM)*2 + 1];
- RelayControlState = (dataPtr[(0x1B+BATT_CELL_VOL_NUM+TEMP_NUM)*2])&0x80;
- battHeatEnableState = dataPtr[(0x1C+BATT_CELL_VOL_NUM+TEMP_NUM)*2+1]&0x01;
- //SOC问题紧急修复
- #ifdef SOC_TEST
- static UINT8 Soc_change_flag = 0;//0-BMS原始值,1-计算值
- if((battI>10200U)||(battWorkState==2))//放电电流超过20A,使用上一时刻值,//如果有充电,使用计算值,最大不超过100
- {
- SOC1 = max((battPackVol*45-27000)/100,SOC1);
- SOC1 = min(100,SOC1);
- }
- else
- {
- SOC1 = min((battPackVol*45-27000)/100,SOC1);
- }
- SOC2 = battSOC;
- if(Soc_change_flag == 0)//使用原始值
- {
- if((SOC2 - SOC1>=10)&&(battPackVol>500)&&(battPackVol<900))
- {
- Soc_change_flag = 1;
- }
- }
- else
- {
- if((SOC2 - SOC1<5)||(battPackVol<500)||(battPackVol>900))
- {
- Soc_change_flag = 0;
- }
- }
- if(Soc_change_flag==0)
- {
- battSOC = SOC2;
- }
- else
- {
- battSOC = SOC1;
- if(osOK==osMutexAcquire(Error_Mutex, 100))
- {
- UINT8 ErrorNumTemp = 238;
- PutErrorNum((UINT16 *)ErrorNum,sizeof(ErrorNum),ErrorNumTemp);
- }
- osMutexRelease(Error_Mutex);
- }
- #endif
- //SOC紧急修复
- maxCellTemp = 0x00;
- minCellTemp = 0xFF;
- UINT16 TempBuffer = 0;
- for(i=0;i<BATT_TEMP_NUM;i++)
- {
- TempBuffer = battCellTemp[i] + TempBuffer;
- maxCellTemp = max(maxCellTemp,battCellTemp[i]);
- minCellTemp = min(minCellTemp,battCellTemp[i]);
- }
- AvgBattTemp = (TempBuffer-maxCellTemp-minCellTemp)/(BATT_TEMP_NUM - 2);
- nbSwVersion = APPSWVERSION;
- nbHwVersion = HWVERSION;
- BmsErrorDecode(battWarningState);
- return true;
- }
- #ifdef SOC_TEST
- void Uart_Data_recv_SOC_test(void)
- {
- UINT16 CRC_chk_buffer;
- Uart_Read_Msg_Type Uart_Read_Msg;
- memset(&(Uart_Read_Msg),0x00,sizeof(Uart_Read_Msg_Type));
- UartReadMsgType UartReadMsg;
- memset(&(UartReadMsg),0x00,sizeof(UartReadMsgType));
- UINT8 Reg = 0,Uart_Uds_LEN = 0,Uart_Recv_LEN;
- Reg = 0x33+BATT_CELL_VOL_NUM+BATT_TEMP_NUM + BATT_OTHER_TEMP_NUM;
- Uart_Read_Msg.Bms_Address = BMS_ADDRESS_CODE;
- Uart_Read_Msg.Bms_Funcode = UART_READ_CODE;
- Uart_Read_Msg.Reg_Begin_H = Reg>>8;
- Uart_Read_Msg.Reg_Begin_L= Reg;
- Uart_Read_Msg.Reg_Num_H = 0;
- Uart_Read_Msg.Reg_Num_L = 16;
- Uart_Uds_LEN = 17*2;
- memset(UartReadMsg.Header,0x00,Uart_Uds_LEN);
- CRC_chk_buffer = crc_chk((UINT8 *)&Uart_Read_Msg,6);
- Uart_Read_Msg.CRC_L = CRC_chk_buffer;
- Uart_Read_Msg.CRC_H = CRC_chk_buffer>>8;
- Uart_Recv_LEN = Uart_DataRecv_func(Uart_Read_Msg,(UINT8*)(UartReadMsg.Header));
- if(Uart_Recv_LEN>0)
- {
- Data_33 = (UartReadMsg.data[0]<<8|UartReadMsg.data[1]);
- Data_34 = (UartReadMsg.data[2]<<8|UartReadMsg.data[3]);
- Data_35 = (UartReadMsg.data[4]<<24|UartReadMsg.data[5]<<16|UartReadMsg.data[6]<<8|UartReadMsg.data[7]);
- Data_37 = (UartReadMsg.data[8]<<8|UartReadMsg.data[9]);
- Data_38 = (UartReadMsg.data[10]<<8|UartReadMsg.data[11]);
- Data_39 = (UartReadMsg.data[12]<<8|UartReadMsg.data[13]);
- Data_3A = (UartReadMsg.data[14]<<8|UartReadMsg.data[15]);
- Data_3B = (UartReadMsg.data[16]<<8|UartReadMsg.data[17]);
- Data_3C = (UartReadMsg.data[18]<<8|UartReadMsg.data[19]);
- Data_3D = (UartReadMsg.data[20]<<8|UartReadMsg.data[21]);
- Data_3E = (UartReadMsg.data[22]<<8|UartReadMsg.data[23]);
- Data_3F = (UartReadMsg.data[24]<<8|UartReadMsg.data[25]);
- Data_40 = (UartReadMsg.data[26]<<8|UartReadMsg.data[27]);
- Data_41 = (UartReadMsg.data[28]<<8|UartReadMsg.data[29]);
- Data_42 = (UartReadMsg.data[30]<<8|UartReadMsg.data[31]);
- Data_43 = (UartReadMsg.data[32]<<8|UartReadMsg.data[33]);
- }
- }
- #endif
- //Uart线程初始化
- void UartTaskInit(void *arg)
- {
- osThreadAttr_t task_attr;
- memset(&task_attr,0,sizeof(task_attr));
- memset(gProcess_Uart_TaskStack, 0xA5, PROC_UART_TASK_STACK_SIZE);
- task_attr.name = "Uart_Task";
- task_attr.stack_mem = gProcess_Uart_TaskStack;
- task_attr.stack_size = PROC_UART_TASK_STACK_SIZE;
- task_attr.priority = osPriorityBelowNormal7;
- task_attr.cb_mem = &gProcess_Uart_Task_t;
- task_attr.cb_size = sizeof(StaticTask_t);
- UartTaskId = osThreadNew(UartTask, NULL, &task_attr);
- }
- void UartTaskDeInit(void *arg)
- {
- osThreadTerminate(UartTaskId);
- UartTaskId = NULL;
- }
- //函数区
- //Uart回调程序
- void USART_callback(uint32_t event)
- {
- if(event & ARM_USART_EVENT_RX_TIMEOUT)
- {
- isRecvTimeout = true;
- }
- if(event & ARM_USART_EVENT_RECEIVE_COMPLETE)
- {
- isRecvComplete = true;
- }
- }
- //Uart校验程序
- UINT16 crc_chk(UINT8* data, UINT8 length)
- {
- UINT8 j;
- UINT16 reg_crc=0xFFFF;
- while(length--)
- {
- reg_crc ^= *data++;
- for(j=0;j<8;j++)
- {
- if(reg_crc & 0x01)
- {
- reg_crc=(reg_crc>>1) ^ 0xA001;
- }
- else
- {
- reg_crc=reg_crc >>1;
- }
- }
- }
- return reg_crc;
- }
- //Uart写命令函数
- UINT8 Uart_WriteCmd_func(Uart_Write_Data_Type UartWriteData)
- {
- Uart_Write_Msg_Type Uart_Write_Msg;
- UINT16 RegAddress = 0x0000;
- UINT16 CRC_chk_buffer;
- UINT8 timeout = 0x00;
- UINT8 Uart_Recv_Buffer[8];
- #ifdef USING_PRINTF
- printf("\nUart_WriteCmd_func: %x ",UartWriteData.WriteCmd);
- #endif
- switch (UartWriteData.WriteCmd)
- {
- case 0x01://是否锁定
- {
- RegAddress = 0x1B + BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM;
- Uart_Write_Msg.Bms_Address = BMS_ADDRESS_CODE;
- Uart_Write_Msg.Bms_Funcode = UART_WRITE_CODE;
- Uart_Write_Msg.Reg_Begin_H = RegAddress>>8;
- Uart_Write_Msg.Reg_Begin_L = RegAddress;
- Uart_Write_Msg.Reg_Num_H = 0x00;
- Uart_Write_Msg.Reg_Num_L = 0x01;
- Uart_Write_Msg.Data_Count = 0x02;//要写入的字节数
- memcpy(Uart_Write_Msg.Data,UartWriteData.Data,2);
- CRC_chk_buffer = crc_chk((UINT8 *)&Uart_Write_Msg,sizeof(Uart_Write_Msg)-2);
- Uart_Write_Msg.CRC_L = CRC_chk_buffer;
- Uart_Write_Msg.CRC_H = CRC_chk_buffer>>8;
- break;
- }
- case 0x02://是否加热
- {
- RegAddress = 0x1C + BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM;
- Uart_Write_Msg.Bms_Address = BMS_ADDRESS_CODE;
- Uart_Write_Msg.Bms_Funcode = UART_WRITE_CODE;
- Uart_Write_Msg.Reg_Begin_H = RegAddress>>8;
- Uart_Write_Msg.Reg_Begin_L = RegAddress;
- Uart_Write_Msg.Reg_Num_H = 0x00;
- Uart_Write_Msg.Reg_Num_L = 0x01;
- Uart_Write_Msg.Data_Count = 0x02;//要写入的字节数
- memcpy(Uart_Write_Msg.Data,UartWriteData.Data,2);
- CRC_chk_buffer = crc_chk((UINT8 *)&Uart_Write_Msg,sizeof(Uart_Write_Msg)-2);
- Uart_Write_Msg.CRC_L = CRC_chk_buffer;
- Uart_Write_Msg.CRC_H = CRC_chk_buffer>>8;
- break;
- }
- case 0x03://是否继电器控制
- {
- RegAddress = 0x1B + BATT_CELL_VOL_NUM+BATT_TEMP_NUM+BATT_OTHER_TEMP_NUM;
- Uart_Write_Msg.Bms_Address = BMS_ADDRESS_CODE;
- Uart_Write_Msg.Bms_Funcode = UART_WRITE_CODE;
- Uart_Write_Msg.Reg_Begin_H = RegAddress>>8;
- Uart_Write_Msg.Reg_Begin_L = RegAddress;
- Uart_Write_Msg.Reg_Num_H = 0x00;
- Uart_Write_Msg.Reg_Num_L = 0x01;
- Uart_Write_Msg.Data_Count = 0x02;//要写入的字节数
- memcpy(Uart_Write_Msg.Data,UartWriteData.Data,2);
- CRC_chk_buffer = crc_chk((UINT8 *)&Uart_Write_Msg,sizeof(Uart_Write_Msg)-2);
- Uart_Write_Msg.CRC_L = CRC_chk_buffer;
- Uart_Write_Msg.CRC_H = CRC_chk_buffer>>8;
- break;
- }
- default:
- {
- UartWriteData.WriteCmd = 0x00;
- return 0;
- break;
- }
- }
- USARTdrv->Send((UINT8 *)&Uart_Write_Msg,sizeof(Uart_Write_Msg));
- #ifdef USING_PRINTF
- printf("Uart_Send_buffer: ");
- for(int i=0;i<sizeof(Uart_Write_Msg);i++)
- {
- printf("%x ",*((UINT8 *)&Uart_Write_Msg+i));
- }
- printf("\n");
- #endif
- USARTdrv->Receive(Uart_Recv_Buffer,8);
- while((isRecvTimeout == false) && (isRecvComplete == false))
- {
- timeout++;
- osDelay(100);
- if (timeout>=10)
- {
- timeout =0;
- isRecvTimeout = true;
- break;
- }
- }
- if (isRecvComplete == true)
- {
- #ifdef USING_PRINTF
- printf("Uart_Rece_buffer: ");
- for(int i=0;i<8;i++)
- {
- printf("%x ",Uart_Recv_Buffer[i]);
- }
- printf("\n");
- #endif
- isRecvComplete = false;
- if(Uart_Recv_Buffer[1]==0x10)
- {
- return UartWriteData.WriteCmd;
- }
- else
- {
- return 0x00;
- }
- }
- else
- {
- isRecvTimeout = false;
- return 0x00;
- }
- }
- //Uart发送接收函数
- UINT8 Uart_DataRecv_func(Uart_Read_Msg_Type Uart_Read_Msg_Fun,UINT8* Uart_Recv_Buffer_Fun)
- {
- UINT16 CRC_Rece_buffer;
- UINT16 CRC_chk_buffer;
- UINT16 Data_Len ;
- UINT8 timeout = 0x00;
- UINT8 pSendCmd[8];
- memcpy(pSendCmd,(UINT8*)(&Uart_Read_Msg_Fun),8);
- Data_Len = ((Uart_Read_Msg_Fun.Reg_Num_H<<8)|(Uart_Read_Msg_Fun.Reg_Num_L))*2+5;
- USARTdrv->Send(pSendCmd,8);
- #ifdef USING_PRINTF1
-
- printf("Uart_Send_buffer: ");
- for(int i=0;i<8;i++)
- // {
- printf("%x ",pSendCmd[i]);
- // }
- printf("end\n");
- //printf("%x ",*(Uart_Read_Msg_Fun));
- //UINT8 temp = *(Uart_Read_Msg_Fun);
- #endif
- USARTdrv->Receive(Uart_Recv_Buffer_Fun,Data_Len);
- while(true)
- {
- timeout++;
- if((isRecvTimeout == true) || (isRecvComplete == true))
- {
- break;
- }
- else
- {
- osDelay(100);
- if (timeout>=10)
- {
- timeout =0;
- isRecvTimeout = true;
- }
- }
- }
- #ifdef USING_PRINTF1
- printf("Uart_Rece_buffer1: ");
- for(int j=0;j<Data_Len;j++)
- {
- printf("%x ",*(Uart_Recv_Buffer_Fun+j));
- }
- #endif
- if (isRecvComplete == true)
- {
- isRecvComplete = false;
- CRC_Rece_buffer =*(Uart_Recv_Buffer_Fun+Data_Len-1)<<8|*(Uart_Recv_Buffer_Fun+Data_Len-2);
- CRC_chk_buffer = crc_chk(Uart_Recv_Buffer_Fun,Data_Len-2);
- #ifdef USING_PRINTF1
- printf("Uart_Rece_buffer after Crc: ");
- for(int i=0;i<Data_Len;i++)
- {
- printf("%x ",*(Uart_Recv_Buffer_Fun+i));
- }
- printf("\tcrcchk:%x,%x\n ",CRC_chk_buffer,CRC_Rece_buffer);
- #endif
- if (CRC_Rece_buffer == CRC_chk_buffer)//满足校验
- {
- return Data_Len;//此处指针移位出现重启问题
- }
- else //接收数据的校验不过
- {
- USARTdrv->Uninitialize();
- osDelay(1000);
- USARTdrv->Initialize(USART_callback);
- USARTdrv->PowerControl(ARM_POWER_FULL);
- USARTdrv->Control(ARM_USART_MODE_ASYNCHRONOUS |
- ARM_USART_DATA_BITS_8 |
- ARM_USART_PARITY_NONE |
- ARM_USART_STOP_BITS_1 |
- ARM_USART_FLOW_CONTROL_NONE, 9600);
- memset(Uart_Recv_Buffer_Fun,0x00,Data_Len);
- return 0;
- }
- }
- else
- {
- memset(Uart_Recv_Buffer_Fun,0x00,Data_Len);
- isRecvTimeout = false;
- return 0;
- }
- return 0;
- }
- /**
- \fn BOOL BattHeaterSwitch(UINT8* heaterSwitch)
- \param[in] (UINT8*) heaterSwitch: the heater switch state
- \brief according to the current switch state and all the cell temp, it will turn on/off the switch
- \return (BOOL) isNeedtoSwitch: true: need to send cmd to turn on/off the switch
- false: do not need to do anything
- */
- BOOL BattHeaterSwitch(UINT8* heaterSwitch,UINT8 HeatForceControl)
- {
- BOOL isNeedtoSwitch = FALSE;
-
- UINT8 i =0;
- UINT8 currentSwitchState = 0;
- //get the current switch state and the cell temp
- currentSwitchState = battHeatEnableState & 0x01;
- if(HeatForceControl==1)//强制开启
- {
- if(currentSwitchState==0)
- {
- *heaterSwitch = 1;
- isNeedtoSwitch = true;
- }
- }
- else if(HeatForceControl==2)//强制关闭
- {
- if(currentSwitchState==1)
- {
- *heaterSwitch = 0;
- isNeedtoSwitch = true;
- }
- }
- else//不强制控制
- {
- if(currentSwitchState==0) //当前状态为关闭,判断是否应该开启
- {
- if((chargerConnectState == 1 && minCellTemp<5+40 && minCellTemp>=-29+40 && maxCellTemp<25+40)||(chargerConnectState==0 && minCellTemp<5+40 && minCellTemp>=-29+40 && battSOC>=10 && (((battProtectState>> 21)&0x01) == 0)))//温度偏移为40
- {
- *heaterSwitch = 1;
- isNeedtoSwitch = true;
- }
- }
- else //当前状态为开启,判断是否应该关闭
- {
- if((minCellTemp>=10+40 || maxCellTemp>=30+40)||(chargerConnectState == 0 && minCellTemp<5+40 && minCellTemp>=-29+40 && battSOC<5))
- {
- *heaterSwitch = 0;
- isNeedtoSwitch= true;
- }
- }
- }
- return isNeedtoSwitch;
- }
- void battSOCDisplay()
- {
-
- static UINT8 lightTimer = 0;
- UINT8 socLowLEDFlashPeriod = 10;//10*100 = 1000ms
- UINT8 chargeLEDFlashPeriod = 6;//6*100 = 600ms
- float dutyRatio = 0.4;
- UINT8 temp;
- if(AppNVMData.isBattLocked == TRUE)
- {
- return;
- }
- if(UartBattInfoRecvFlag == true)
- {
- lightTimer++;
-
- if(battWorkState == 0||battWorkState == 1) //静置或放电状态
- {
- if(battSOC<=10)
- {
- if(lightTimer<(UINT8)(socLowLEDFlashPeriod*dutyRatio))
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else if(lightTimer>=(UINT8)(socLowLEDFlashPeriod*dutyRatio) && lightTimer<socLowLEDFlashPeriod)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- }
- else if(battSOC>10&&battSOC<=25)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- else if(battSOC>25&&battSOC<=50)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- else if(battSOC>50&&battSOC<=75)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- else if(battSOC>75&&battSOC<=100)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_ON);
- lightTimer = 0;
- }
- }
- else if(battWorkState == 2)
- {
- if(battSOC<=25)
- {
- if(lightTimer<(UINT8)(chargeLEDFlashPeriod*dutyRatio))
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else if(lightTimer>=(UINT8)(chargeLEDFlashPeriod*dutyRatio) && lightTimer<chargeLEDFlashPeriod)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- }
- else if(battSOC>25&&battSOC<=50)
- {
- if(lightTimer<(UINT8)(chargeLEDFlashPeriod*dutyRatio))
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else if(lightTimer>=(UINT8)(chargeLEDFlashPeriod*dutyRatio) && lightTimer<chargeLEDFlashPeriod)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- }
- else if(battSOC>50&&battSOC<=75)
- {
- if(lightTimer<(UINT8)(chargeLEDFlashPeriod*dutyRatio))
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else if(lightTimer>=(UINT8)(chargeLEDFlashPeriod*dutyRatio) && lightTimer<chargeLEDFlashPeriod)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- }
- else if(battSOC>75&&battSOC<=97)
- {
- if(lightTimer<(UINT8)(chargeLEDFlashPeriod*dutyRatio))
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_ON);
- }
- else if(lightTimer>=(UINT8)(chargeLEDFlashPeriod*dutyRatio) && lightTimer<chargeLEDFlashPeriod)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- }
- else
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- lightTimer = 0;
- }
- }
- else if(battSOC>97&&battSOC<=100)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_ON);
- }
- }
- }
-
- }
- void battErrorStateDisplay()
- {
- static UINT8 errorLightTimer = 0;
- //static UINT32 currentTimerCount=0;
-
- UINT8 errorLEDFlashPeriod = 6;//600ms
- float errorDutyRatio = 0.4;
- if(AppNVMData.isBattLocked == TRUE)
- {
- return;
- }
-
- if(UartBattInfoRecvFlag == true)
- {
-
- errorLightTimer++;
- if(battWorkState == 0x02) //充电模式下,如果只有“SOC低故障”,那么就不显示故障灯 zhengchao20210713 add
- {
- if((((battWarningState >> 10) & 0x01) == 0x01) && ((battWarningState & 0xFFFFFBFF) == 0x00))
- return;
- }
- if(battWarningState != 0 )
- {
- if(errorLightTimer<(UINT8)(errorLEDFlashPeriod*errorDutyRatio))
- {
-
- FaultDisplay(LED_TURN_ON);
-
- }
- else if(errorLightTimer>=(UINT8)(errorLEDFlashPeriod*errorDutyRatio) && errorLightTimer<errorLEDFlashPeriod)
- {
-
- FaultDisplay(LED_TURN_OFF);
-
- }
- else
- {
-
- FaultDisplay(LED_TURN_OFF);
- errorLightTimer = 0;
- }
-
- }
- else
- {
- FaultDisplay(LED_TURN_OFF);
- errorLightTimer = 0;
- }
- }
- }
- void battWarningStateDisplay()
- {
- static UINT8 warningLightTimer = 0;
- //static UINT32 currentTimerCount=0;
-
- UINT8 warningLEDFlashPeriod = 6;//600ms
- float warningDutyRatio = 0.4;
- if(AppNVMData.isBattLocked == TRUE)
- {
- return;
- }
-
- if(UartBattInfoRecvFlag == false)
- {
- warningLightTimer++;
- //if(battWarningState != 0)
- {
- if(warningLightTimer<(UINT8)(warningLEDFlashPeriod*warningDutyRatio))
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- FaultDisplay(LED_TURN_ON);
-
- }
- else if(warningLightTimer>=(UINT8)(warningLEDFlashPeriod*warningDutyRatio) && warningLightTimer<warningLEDFlashPeriod)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- FaultDisplay(LED_TURN_OFF);
-
- }
- else
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- FaultDisplay(LED_TURN_OFF);
- warningLightTimer = 0;
- }
-
- }
-
- }
- }
- void battLockStateDisplay(UINT8 lockState)
- {
- static UINT8 currentState = 0;
- static UINT8 errorLightTimer = 0;
- //static UINT32 currentTimerCount=0;
-
- UINT8 errorLEDFlashPeriod = 10;//1000ms
- float errorDutyRatio = 0.4;
-
- //printf("lockState = %d\ncurrent State = %d\n",lockState,currentState);
- if(lockState==0)//no error
- {
- if(currentState!=lockState)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- FaultDisplay(LED_TURN_OFF);
- currentState = lockState;
- errorLightTimer = 0;
- }
- else
- {
- return;
- }
- }
- else // error occurred, errorState = 1
- {
- if(errorLightTimer<(UINT8)(errorLEDFlashPeriod*errorDutyRatio))
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_ON);
- NetSocDisplay(LED_SOC_1,LED_TURN_ON);
- NetSocDisplay(LED_SOC_2,LED_TURN_ON);
- NetSocDisplay(LED_SOC_3,LED_TURN_ON);
- FaultDisplay(LED_TURN_ON);
-
- }
- else if(errorLightTimer>=(UINT8)(errorLEDFlashPeriod*errorDutyRatio) && errorLightTimer<errorLEDFlashPeriod)
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- FaultDisplay(LED_TURN_OFF);
- }
- else
- {
- NetSocDisplay(LED_SOC_0,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_1,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_2,LED_TURN_OFF);
- NetSocDisplay(LED_SOC_3,LED_TURN_OFF);
- FaultDisplay(LED_TURN_OFF);
- errorLightTimer = 0;
- }
- }
- errorLightTimer++;
- }
- void relayControlFunc(float DutyRatio,UINT8 BuzzerPeriod)
- {
- static UINT8 BuzzerTimer = 0;
- BuzzerTimer++;
- if(BuzzerTimer<(UINT8)(BuzzerPeriod*DutyRatio))
- {
- relayControl(TRUE);
- }
- else if(BuzzerTimer>=(UINT8)(BuzzerPeriod*DutyRatio) && BuzzerTimer<BuzzerPeriod)
- {
- relayControl(FALSE);
- }
- else
- {
- relayControl(FALSE);
- BuzzerTimer = 0;
- }
- }
- UINT8 decryptionAlgorithm (UINT16 cipherText)
- {
- UINT16 plainText = 1;
- UINT16 publicKeyD = 43;
- UINT16 publicKeyN = 10961;
- cipherText = cipherText % publicKeyN;
- while(publicKeyD >0)
- {
- if(publicKeyD % 2 ==1)
- {
- plainText = plainText * cipherText % publicKeyN;
- }
- publicKeyD = publicKeyD/2;
- cipherText = (cipherText * cipherText) % publicKeyN;
- }
- return (UINT8)plainText;
- }
- UINT16 encryptionAlgorithm (UINT16 plainText)
- {
- UINT16 cipherText = 1;
- UINT16 privateKeyE = 37507;
- UINT16 privateKeyN = 10961;
- plainText = plainText % privateKeyN;
- while(privateKeyE >0)
- {
- if(privateKeyE % 2 ==1)
- {
- cipherText = ( cipherText * plainText) % privateKeyN;
- }
- privateKeyE = privateKeyE/2;
- plainText = (plainText * plainText) % privateKeyN;
- }
- return cipherText;
- }
- UINT8 Uart_Encrypt_Send()
- {
- UINT8 SeedNumberArrray[4]={0x38,0x56,0xfe,0xac};
- UINT16 EncodeNumberArray[4];
- UINT8 UartEncryptBuffer[17];
- UINT8 UartDecryptBuffer[5];
- UINT16 CRC_chk_buffer;
- UINT8 timeCount = 0;
- UartEncryptBuffer[0] = BMS_ADDRESS_CODE;
- UartEncryptBuffer[1] = UART_ENCRYPT_CODE;
- UartEncryptBuffer[2] = 0x0c;
- for(int i=0;i<4;i++)
- {
- SeedNumberArrray[i]=rand();
- EncodeNumberArray[i] = encryptionAlgorithm(SeedNumberArrray[i]);
- UartEncryptBuffer[i+3] = SeedNumberArrray[i];
- UartEncryptBuffer[i*2+7] = EncodeNumberArray[i]>>8;
- UartEncryptBuffer[i*2+8] = EncodeNumberArray[i];
- }
- CRC_chk_buffer = crc_chk(UartEncryptBuffer,17-2);
- UartEncryptBuffer[15] = CRC_chk_buffer;
- UartEncryptBuffer[16] = CRC_chk_buffer>>8;
- USARTdrv->Send(UartEncryptBuffer,17);
- USARTdrv->Receive(UartDecryptBuffer,5);
- while((isRecvTimeout == false) && (isRecvComplete == false))
- {
- timeCount++;
- osDelay(100);
- if (timeCount>=10)
- {
- timeCount =0;
- isRecvTimeout = true;
- break;
- }
- }
- #ifdef USING_PRINTF
- printf("Uart_Rece_buffer: ");
- for(int i=0;i<5;i++)
- {
- printf("%x ",UartDecryptBuffer[i]);
- }
- #endif
- if (isRecvComplete == true)
- {
- isRecvComplete = false;
- return UartDecryptBuffer[2];
- }
- else
- {
- isRecvTimeout = false;
- return 0x03;
- }
- }
- void controlTask(void *arg)
- {
- while (TRUE)
- { osDelay(100);
- if(AppNVMData.isBattLocked != 0)
- {
- battLockStateDisplay(TRUE);
- }
- else if(UartBattInfoRecvFlag)
- {
- battSOCDisplay();
- battErrorStateDisplay();
- }
- else
- {
- battWarningStateDisplay();
- }
- if(AppNVMData.isBattLocked==FALSE && ret==0x01)
- {
- relayControlFunc(0.6,5);//表示1s响2次,占比80%
- Ringtimes++;
- if(Ringtimes>=15)
- {
- relayControl(FALSE);
- ret = 0;
- Ringtimes = 0;
- }
- }
- else if (AppNVMData.isBattLocked==TRUE && ret==0x01)
- {
- relayControlFunc(0.6,5);//表示1s响2次,占比80%
- Ringtimes++;
- if(Ringtimes>=10)
- {
- relayControl(FALSE);
- ret = 0;
- Ringtimes = 0;
- }
- }
- else if(CanMsgFlag==1 && Ringtimes<=50)
- {
- relayControlFunc(0.6,5);//表示1s响2次,占比80%
- Ringtimes++;
- if(Ringtimes>=50)
- {
- Ringtimes = 51;
- relayControl(FALSE);
- }
- }
- else if(BuzzerControl==TRUE)
- {
- relayControlFunc(0.6,5);//表示1s响2次,占比80%
- }
- }
- }
- /*-----------------------------------------------------------------------------*/
- void SP_BMS_Update_Service() //超力源BMS升级服务
- {
-
- UINT8 errorCount = 0;
- UINT8 resetCount = 0;
- UINT16 currentPackage = 0;
- UINT32 updateDataTotalByteLen = 0;
- UpdateStep updateStep = UPDATE_STEP_CHECK_VERSION;
-
- UINT8 i,j,ret=0;
- UINT8 dataLen = 0;
-
- UINT8 pUpdateMsgSend[80];
- UINT32 updateMsgSendLen = 0;
- UINT32 currentPackageStartAddr = 0;
- BMS_Update_Recv_Msg_Type pUpdateMsgRecv;
- UINT8 bmsUpdateFlag = 1;
- //BMS_Update_Recv_Msg_Type bmsMsg;
- //static UpdateStep step = UPDATE_STEP_CHECK_VERSION;
- UINT8 Cycle_conut = 0;
- while(bmsUpdateFlag && Cycle_conut<2)
- {
- switch (updateStep)
- {
- case UPDATE_STEP_CHECK_VERSION:
- dataLen = 0;
- updateMsgSendLen = 7;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x01; //read
- pUpdateMsgSend[3] = 0x03; //data len
- pUpdateMsgSend[4] = 0x90; //cmd
- pUpdateMsgSend[5] = 0x93; //checksum
- pUpdateMsgSend[6] = 0xF5; //end flag
- //printf("updateMsgSendLen0 = %x\n",updateMsgSendLen);
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv),sizeof(BMS_Update_Recv_Msg_Type), 500);
- //printf("updateMsgSendLen1 = %x\n",updateMsgSendLen);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x90)
- {
- if(pUpdateMsgRecv.data != 0xFF)
- {
- updateStep = UPDATE_STEP_REQUEST_UPDATE;
- errorCount = 0;
- }
- else
- {
- updateStep = UPDATE_STEP_SET_BAUD_RATE;
- errorCount = 0;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
-
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
-
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
- osDelay(50);
- break;
-
- case UPDATE_STEP_REQUEST_UPDATE:
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x80; //cmd
- pUpdateMsgSend[5] = 0x22; //data
- pUpdateMsgSend[6] = 0xA6; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), sizeof(BMS_Update_Recv_Msg_Type), 500);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x80)
- {
- if(pUpdateMsgRecv.data == 0x33)
- {
- updateStep = UPDATE_STEP_START_UPDATE;
- errorCount = 0;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
-
- #ifdef USING_PRINTF1
- printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- osDelay(50);
- break;
- case UPDATE_STEP_START_UPDATE:
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x80; //cmd
- pUpdateMsgSend[5] = 0x55; //data
- pUpdateMsgSend[6] = 0xD9; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), 0, 500);
- //updateStep = UPDATE_STEP_SET_BAUD_RATE;
- updateStep = UPDATE_STEP_CHECK_VERSION_AGAIN;//2021-04-09跳过波特率设置
- #ifdef USING_PRINTF1
-
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
-
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- break;
- case UPDATE_STEP_CHECK_VERSION_AGAIN:
- dataLen = 0;
- updateMsgSendLen = 7;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x01; //read
- pUpdateMsgSend[3] = 0x03; //data len
- pUpdateMsgSend[4] = 0x90; //cmd
- pUpdateMsgSend[5] = 0x93; //checksum
- pUpdateMsgSend[6] = 0xF5; //end flag
- //printf("updateMsgSendLen0 = %x\n",updateMsgSendLen);
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv),sizeof(BMS_Update_Recv_Msg_Type), 100);
- //printf("updateMsgSendLen1 = %x\n",updateMsgSendLen);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x90)
- {
- if(pUpdateMsgRecv.data != 0xFF)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
- else
- {
- updateStep = UPDATE_STEP_SET_BAUD_RATE;
- errorCount = 0;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
-
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
-
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
- osDelay(50);
- break;
- case UPDATE_STEP_SET_BAUD_RATE:
- printf("start step %d\n",updateStep);
- dataLen = 4;
- updateMsgSendLen = 12;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x08; //data len
- pUpdateMsgSend[4] = 0x81; //cmd
- pUpdateMsgSend[5] = 0x33; //data
- pUpdateMsgSend[6] = 0x00; //baud rate:9600
- pUpdateMsgSend[7] = 0x00;
- pUpdateMsgSend[8] = 0x25;
- pUpdateMsgSend[9] = 0x80;
- pUpdateMsgSend[10] = 0x61; //check
- pUpdateMsgSend[11] = 0xF5; //end flag
- #ifdef USING_PRINTF1
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\n");
- #endif
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), sizeof(BMS_Update_Recv_Msg_Type), 500);
- printf("ret = %d\n",ret);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x81)
- {
- if(pUpdateMsgRecv.data == 0x11)
- {
- updateStep = UPDATE_STEP_PREPARE_SEND_DATA_LEN;
- errorCount = 0;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
-
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- osDelay(50);
- break;
-
-
- case UPDATE_STEP_PREPARE_SEND_DATA_LEN:
- printf("start step %d\n",updateStep);
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x81; //cmd
- pUpdateMsgSend[5] = 0x44; //data
- pUpdateMsgSend[6] = 0xC9; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), sizeof(BMS_Update_Recv_Msg_Type), 500);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x81)
- {
- if(pUpdateMsgRecv.data == 0x11)
- {
- updateStep = UPDATE_STEP_SEND_DATA_LEN;
- errorCount = 0;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
-
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- osDelay(50);
- break;
- case UPDATE_STEP_SEND_DATA_LEN:
-
- dataLen = 4;
- BSP_QSPI_Read_Safe(&updateDataTotalByteLen,FLASH_BMS_FOTA_START_ADDR,4);
- updateDataTotalByteLen = (((updateDataTotalByteLen)&0xFF)<<24)|(((updateDataTotalByteLen>>8)&0xFF)<<16)|(((updateDataTotalByteLen>>16)&0xFF)<<8)|(((updateDataTotalByteLen>>24)&0xFF));
- updateMsgSendLen = 11;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x07; //data len
- pUpdateMsgSend[4] = 0x82; //cmd
- pUpdateMsgSend[5] = (updateDataTotalByteLen>>24)&0xFF; //data: package byte len
- pUpdateMsgSend[6] = (updateDataTotalByteLen>>16)&0xFF;
- pUpdateMsgSend[7] = (updateDataTotalByteLen>>8)&0xFF;
- pUpdateMsgSend[8] = (updateDataTotalByteLen)&0xFF;
- pUpdateMsgSend[9] = SP_BMS_Update_CheckSUM(&pUpdateMsgSend[3], dataLen+2); //check sum
- pUpdateMsgSend[10] = 0xF5; //end flag
-
- memset((UINT8*)(&pUpdateMsgRecv),0,sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), sizeof(BMS_Update_Recv_Msg_Type), 500);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x81)
- {
- if(pUpdateMsgRecv.data == 0x11)
- {
- updateStep = UPDATE_STEP_PREPARE_SEND_UPDATE_DATA;
- errorCount = 0;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
-
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- osDelay(50);
- break;
-
- case UPDATE_STEP_PREPARE_SEND_UPDATE_DATA:
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x81; //cmd
- pUpdateMsgSend[5] = 0x55; //data
- pUpdateMsgSend[6] = 0xDA; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen,(UINT8*)(&pUpdateMsgRecv), sizeof(BMS_Update_Recv_Msg_Type), 500);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x81)
- {
- if(pUpdateMsgRecv.data == 0x11)
- {
- updateStep = UPDATE_STEP_SEND_UPDATE_DATA;
- errorCount = 0;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
-
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- osDelay(50);
- break;
- case UPDATE_STEP_SEND_UPDATE_DATA:
- dataLen = 64;
- updateMsgSendLen = 75;
-
- for(currentPackage=0;currentPackage<updateDataTotalByteLen/64;currentPackage++)
- {
- currentPackageStartAddr = currentPackage*64;
-
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x47; //data len
- pUpdateMsgSend[4] = 0x82; //cmd
- pUpdateMsgSend[5] = (currentPackageStartAddr>>24)&0xFF;
- pUpdateMsgSend[6] = (currentPackageStartAddr>>16)&0xFF;
- pUpdateMsgSend[7] = (currentPackageStartAddr>>8)&0xFF;
- pUpdateMsgSend[8] = currentPackageStartAddr&0xFF;
- BSP_QSPI_Read_Safe(&pUpdateMsgSend[9], FLASH_BMS_FOTA_START_ADDR+4+currentPackage*dataLen, dataLen); //data
- pUpdateMsgSend[8+dataLen+1] = SP_BMS_Update_CheckSUM(&pUpdateMsgSend[3], dataLen+6); //check sum
- pUpdateMsgSend[8+dataLen+2] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), sizeof(BMS_Update_Recv_Msg_Type), 500);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x81)
- {
- if(pUpdateMsgRecv.data == 0x11)
- {
- if(currentPackage+1 == updateDataTotalByteLen/64)
- {
- updateStep = UPDATE_STEP_SEND_DATA_END;
- }
- errorCount = 0;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- break;
- }
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- }
- osDelay(50);
- break;
- case UPDATE_STEP_SEND_DATA_END:
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x81; //cmd
- pUpdateMsgSend[5] = 0x66; //data
- pUpdateMsgSend[6] = 0xEB; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- ret = SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), sizeof(BMS_Update_Recv_Msg_Type), 500);
- if(ret!=0)
- {
- if(pUpdateMsgRecv.startFlag == 0xEB && pUpdateMsgRecv.endFlag == 0xF5)
- {
- if(pUpdateMsgRecv.cmd == 0x81)
- {
- if(pUpdateMsgRecv.data == 0x11)
- {
- updateStep = UPDATE_STEP_START_INSTALL;
- errorCount = 0;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = UPDATE_STEP_RESET;
- errorCount = 0;
- }
-
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- osDelay(50);
- break;
- case UPDATE_STEP_START_INSTALL:
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x81; //cmd
- pUpdateMsgSend[5] = 0x99; //data
- pUpdateMsgSend[6] = 0x1E; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), 0, 500);
-
- updateStep = UPDATE_STEP_END;
-
- #ifdef USING_PRINTF1
- //printf("update step:%d\n",updateStep);
- printf("query:");
- for(j=0;j<updateMsgSendLen;j++)
- {
- printf("%x ",pUpdateMsgSend[j]);
- }
- printf("\nanswer:");
- for(j=0;j<sizeof(BMS_Update_Recv_Msg_Type);j++)
- {
- printf("%x ",*(((UINT8*)&pUpdateMsgRecv)+j));
- }
- printf("\n");
- printf("next update step:%d\n",updateStep);
- #endif
- osDelay(50);
- break;
- case UPDATE_STEP_END:
- updateStep = UPDATE_STEP_CHECK_VERSION;
- printf("update end\n");
- bmsUpdateFlag = 0;
- break;
- case UPDATE_STEP_RESET:
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x81; //cmd
- pUpdateMsgSend[5] = 0xAA; //data
- pUpdateMsgSend[6] = 0x2F; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), 0, 500);
- osDelay(50);
-
- resetCount++;
- if(resetCount>=2)
- {
- updateStep = UPDATE_STEP_DOWNLOAD_BREAK_OFF;
- resetCount = 0;
- }
- else
- {
- updateStep = UPDATE_STEP_PREPARE_SEND_DATA_LEN;
- }
- #ifdef USING_PRINTF
- printf("update error!!\n rest and start send data lenth again!!\n continue update!\n");
- #endif
- break;
- case UPDATE_STEP_DOWNLOAD_BREAK_OFF:
- dataLen = 1;
- updateMsgSendLen = 8;
- pUpdateMsgSend[0] = 0xEB; //start flag
- pUpdateMsgSend[1] = 0x01; //add flag
- pUpdateMsgSend[2] = 0x00; //write
- pUpdateMsgSend[3] = 0x04; //data len
- pUpdateMsgSend[4] = 0x81; //cmd
- pUpdateMsgSend[5] = 0xBB; //data
- pUpdateMsgSend[6] = 0x40; //check
- pUpdateMsgSend[7] = 0xF5; //end flag
- memset((UINT8*)(&pUpdateMsgRecv) , 0, sizeof(BMS_Update_Recv_Msg_Type));
- SP_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(&pUpdateMsgRecv), 0, 500);
- osDelay(50);
- updateStep = UPDATE_STEP_CHECK_VERSION;
- Cycle_conut++;
- break;
- case UPDATE_STEP_ERROR:
- updateStep = UPDATE_STEP_CHECK_VERSION;
- printf("update error end\n");
- bmsUpdateFlag = 0;
- break;
- default:
- updateStep = UPDATE_STEP_CHECK_VERSION;
- printf("update default end\n");
- bmsUpdateFlag = 0;
- break;
- }
- }
- }
- UINT8 SP_BMS_Update_Query(UINT8* pSend,UINT32 sendLen, UINT8* pRead, UINT32 readLen, UINT32 timeout)
- {
- UINT8 timeCount = 0;
- UINT8 j=0;
- USARTdrv->Send(pSend,sendLen);
- #ifdef USING_PRINTF
- printf("query in:");
- for(j=0;j<sendLen;j++)
- {
- printf("%x ",*(pSend+j));
- }
- printf("\n");
- #endif
- if(readLen>0)
- {
- USARTdrv->Receive(pRead,readLen);
- while((isRecvTimeout == false) && (isRecvComplete == false))
- {
- timeCount++;
- osDelay(100);
- if (timeCount>=timeout/100)
- {
- timeCount =0;
- isRecvTimeout = true;
- break;
- }
- }
- #ifdef USING_PRINTF
- printf("\nanswer in:");
- for(j=0;j<readLen;j++)
- {
- printf("%x ",*(pRead+j));
- }
- printf("\n");
- #endif
- if (isRecvComplete == true)
- {
- isRecvComplete = false;
- if(*(pRead+0)!=0xEB)
- {
- USARTdrv->Uninitialize();
- osDelay(100);
- USARTdrv->Initialize(USART_callback);
- USARTdrv->PowerControl(ARM_POWER_FULL);
- USARTdrv->Control(ARM_USART_MODE_ASYNCHRONOUS |
- ARM_USART_DATA_BITS_8 |
- ARM_USART_PARITY_NONE |
- ARM_USART_STOP_BITS_1 |
- ARM_USART_FLOW_CONTROL_NONE, 9600);
- #ifdef USING_PRINTF
- printf("\nuart reset in \n");
- #endif
- return 0;
- }
- return readLen;
- }
- else
- {
- memset(pRead,0x00,readLen);
- isRecvTimeout = false;
- return 0;
- }
- }
- else
- {
- return 1;
- }
- }
- UINT8 SP_BMS_Update_CheckSUM(UINT8* pSendData,UINT8 len)
- {
- UINT8 ret = 0;
- UINT8 i=0;
- for(i=0;i<len;i++)
- {
- ret +=*(pSendData+i);
- }
- return ret&0xFF;
- }
- //________________________________________________________________________________
- updateBMSStatus MS_BMS_Update_Service() //美顺BMS升级服务
- {
- #ifdef USING_PRINTF
- UINT8 ii = 0;
- #endif
-
- UINT8 errorCount = 0;
- UINT16 currentPackage = 0;
- UINT32 updateDataTotalByteLen = 0;
- UINT16 updateDataPackageCount = 0;
- UINT8 ReadNVMTemp[64];
- UpdateStep_MS_BMS updateStep = MS_UPDATE_STEP_SEND_FIRMWARE_UPDATE_REQUEST_AND_JUMP_TO_BOOTLOADER;
-
-
- UINT16 i,j=0;
- UINT8 dataLen = 0;
- UINT8 ret0 = 0;
- updateBMSStatus ret = updateFailed;
-
- UINT8 pUpdateMsgSend[80];
- UINT32 updateMsgSendLen = 0;
- UINT32 updateMsgReadLen = 0;
-
- BOOL bmsUpdateFlag = TRUE;
- UINT8 bmsAnswerMsg[8];
-
- //static UpdateStep step = UPDATE_STEP_CHECK_VERSION;
- UINT8 Cycle_conut = 0;
- UINT16 CRCtemp = 0;
- UINT8 headerLen = 5;
- UINT8 checkSum = 0x00;
- UINT8 checkSumCal = 0x00;
- UINT8 tempLen = 0x00;
- BSP_QSPI_Read_Safe(&checkSum,FLASH_BMS_FOTA_START_ADDR,1);
- memset(ReadNVMTemp, 0, 64);
- BSP_QSPI_Read_Safe(ReadNVMTemp, FLASH_BMS_FOTA_START_ADDR+1, 4); //data
- updateDataTotalByteLen = ((ReadNVMTemp[0]<<24)&0xFF000000) | ((ReadNVMTemp[1]<<16)&0xFF0000) | ((ReadNVMTemp[2]<<8)&0xFF00) | (ReadNVMTemp[3]&0xFF) ;
- updateDataPackageCount = (updateDataTotalByteLen+(64-1))/64; //进一法 e = (a+(b-1))/b
- for(i=0; i<((updateDataTotalByteLen+headerLen-1)+(64-1))/64;i++)//
- {
- memset(ReadNVMTemp, 0, 64);
- if((i+1)*64 <= (updateDataTotalByteLen+headerLen-1))
- {
- tempLen = 64;
- BSP_QSPI_Read_Safe(ReadNVMTemp,FLASH_BMS_FOTA_START_ADDR+1+i*64,64);
- }
- else
- {
- tempLen = (updateDataTotalByteLen+headerLen-1) - i*64;
- BSP_QSPI_Read_Safe(ReadNVMTemp,FLASH_BMS_FOTA_START_ADDR+1+i*64,tempLen);
- }
-
- for(j = 0; j< tempLen; j++)
- {
- checkSumCal = (checkSumCal + ReadNVMTemp[j]) & 0xFF;
- }
- osDelay(10);
- }
- if(checkSum != checkSumCal)
- {
- #ifdef USING_PRINTF
- printf("checksum error: checksum = %x, checksumCal = %x\n",checkSum,checkSumCal);
- #endif
- ret = updateErrorCheckSumError;
- return ret;
- }
- else
- {
- #ifdef USING_PRINTF
- printf("checksum OK: checksum = %x, checksumCal = %x\n",checkSum,checkSumCal);
- #endif
- }
- #ifdef USING_PRINTF
- printf(" bmsUpdateFlag = %x, Cycle_conut = %x\n",bmsUpdateFlag,Cycle_conut);
- #endif
- while(bmsUpdateFlag && Cycle_conut<2)
- {
- #ifdef USING_PRINTF
- printf("update ms bms step %d\n:",updateStep);
- #endif
- switch (updateStep)
- {
-
- case MS_UPDATE_STEP_SEND_FIRMWARE_UPDATE_REQUEST_AND_JUMP_TO_BOOTLOADER: //0x01
- dataLen = 0x00;
- updateMsgSendLen = 6+dataLen;
- updateMsgReadLen = 8;
-
- pUpdateMsgSend[0] = 0x01; //node byte
- pUpdateMsgSend[1] = 0x40; //func byte
- pUpdateMsgSend[2] = updateStep; //cmd byte
- pUpdateMsgSend[3] = dataLen; //data len
- //no data type
- CRCtemp = MS_BMS_Update_CRC16(pUpdateMsgSend, 4);
- pUpdateMsgSend[4] = (CRCtemp>>8)&0xFF; // CRC High
- pUpdateMsgSend[5] = CRCtemp&0xFF; //CRC Low
-
- memset((UINT8*)(bmsAnswerMsg) , 0, 8);
- ret0 = MS_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(bmsAnswerMsg), updateMsgReadLen, 1000);
- #ifdef USING_PRINTF
- printf("update step 1 answer,updateMsgReadLen = %x:\n",updateMsgReadLen);
-
- for(ii=0;ii<updateMsgReadLen;ii++)
- printf("%x ",bmsAnswerMsg[ii]);
- printf("\nret0 = %d",ret0);
- printf("\n");
- #endif
- if(ret0!=0)
- {
- if(bmsAnswerMsg[0] == 0x01 && bmsAnswerMsg[1] == 0x40) // node and func byte
- {
- if(bmsAnswerMsg[2] == MS_UPDATE_STEP_FIRMWARE_UPDATE_REQUEST_ANSWER && bmsAnswerMsg[3] == 0x02) //answer cmd byte:0x02, answer data len:0x02
- {
- if(bmsAnswerMsg[4] == 0x00) //answer data byte1
- {
- if(bmsAnswerMsg[5] == 0x00) //answer data byte2
- {
- updateStep = MS_UPDATE_STEP_SEND_FIRMWARE_INFO;
- errorCount = 0;
- }
- }
- else if(bmsAnswerMsg[4] == 0x01) //不允许升级
- {
- if(bmsAnswerMsg[5] == 0x01)//电量过低
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- ret = updateErrorBMSPowerLow;
- }
- else if(bmsAnswerMsg[5] == 0x02)//电池存在保护状态不允许升级
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- ret = updateErrorBMSWarningProtect;
- }
- else if(bmsAnswerMsg[5] == 0x03) //不支持升级
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- ret = updateErrorBMSNotSurport;
- }
- else if(bmsAnswerMsg[5] == 0x04) //当前电池处于充放电状态
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- ret = updateErrorBMSWorkState;
- }
- else
- {
- errorCount++;
- }
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- errorCount = 0;
- }
- osDelay(50);
- printf(" step 1 ret = %d\n",ret);
- break;
- case MS_UPDATE_STEP_SEND_FIRMWARE_INFO: //0x03
- dataLen = 52;
- updateMsgSendLen = 6+dataLen;
- updateMsgReadLen = 7;
- pUpdateMsgSend[0] = 0x01; //node byte
- pUpdateMsgSend[1] = 0x40; //func byte
- pUpdateMsgSend[2] = updateStep; //cmd byte
- pUpdateMsgSend[3] = dataLen; //data len
- memset(ReadNVMTemp, 0, 64);
- BSP_QSPI_Read_Safe(ReadNVMTemp, FLASH_BMS_FOTA_START_ADDR+headerLen, 16); //data
- MEMCPY(&pUpdateMsgSend[4], ReadNVMTemp, 16); //厂家信息,未开启校验
- MEMCPY(&pUpdateMsgSend[4+16], ReadNVMTemp, 16); //保护板硬件序列号,未开启校验
- pUpdateMsgSend[4+16*2 + 0] = (updateDataTotalByteLen>>24)&0xFF; //固件包大小
- pUpdateMsgSend[4+16*2 + 1] = (updateDataTotalByteLen>>16)&0xFF;
- pUpdateMsgSend[4+16*2 + 2] = (updateDataTotalByteLen>>8)&0xFF;
- pUpdateMsgSend[4+16*2 + 3] = (updateDataTotalByteLen)&0xFF;
- MEMCPY(&pUpdateMsgSend[4+16*2+4], ReadNVMTemp, 16); // 固件包头信息,未开启校验
-
- CRCtemp = MS_BMS_Update_CRC16(pUpdateMsgSend, 4+dataLen);
-
- pUpdateMsgSend[4+dataLen] = (CRCtemp>>8)&0xFF; // CRC High
- pUpdateMsgSend[5+dataLen] = CRCtemp&0xFF; //CRC Low
-
- memset((UINT8*)(bmsAnswerMsg) , 0, 8);
- ret0 = MS_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(bmsAnswerMsg), updateMsgReadLen, 1000);
- #ifdef USING_PRINTF
- printf("update step 3 answer:\n");
- for(ii=0;ii<updateMsgReadLen;ii++)
- printf("%x ",bmsAnswerMsg[ii]);
- printf("\nret0 = %d",ret0);
- printf("\n");
- #endif
- if(ret0!=0)
- {
- if(bmsAnswerMsg[0] == 0x01 && bmsAnswerMsg[1] == 0x40) // node and func byte
- {
- if(bmsAnswerMsg[2] == MS_UPDATE_STEP_FIRMWARE_INFO_CHECK_AND_UPDATE_REQEST_ANSWER && bmsAnswerMsg[3] == 0x01) //answer cmd byte:0x04, answer data len:0x01
- {
- if(bmsAnswerMsg[4] == 0x00) //answer data byte1
- {
- updateStep = MS_UPDATE_STEP_EREASE_APP_FLASH_REQUEST;
- errorCount = 0;
- }
- else if(bmsAnswerMsg[4] == 0x01) //厂家信息错误
- {
- errorCount++;
- ret = updateErrorFirmwareInfoError;
- }
- else if(bmsAnswerMsg[4] == 0x02) //硬件序列号不匹配
- {
- errorCount++;
- ret = updateErrorFirmwareInfoError;
- }
- else if(bmsAnswerMsg[4] == 0x03) //固件大小超出范围
- {
- errorCount++;
- ret = updateErrorFirmwareSizeError;
- }
- else if(bmsAnswerMsg[4] == 0x04) //固件包头信息错误
- {
- errorCount++;
- ret = updateErrorFirmwareInfoError;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- errorCount = 0;
- }
- printf(" step 3 ret = %d\n",ret);
- osDelay(50);
- break;
- case MS_UPDATE_STEP_EREASE_APP_FLASH_REQUEST: //0x05
- dataLen = 0;
- updateMsgSendLen = 6+dataLen;
- updateMsgReadLen = 8;
- pUpdateMsgSend[0] = 0x01; //node byte
- pUpdateMsgSend[1] = 0x40; //func byte
- pUpdateMsgSend[2] = updateStep; //cmd byte
- pUpdateMsgSend[3] = dataLen; //data len
-
- CRCtemp = MS_BMS_Update_CRC16(pUpdateMsgSend, 4+dataLen);
-
- pUpdateMsgSend[4+dataLen] = (CRCtemp>>8)&0xFF; // CRC High
- pUpdateMsgSend[5+dataLen] = CRCtemp&0xFF; //CRC Low
-
- memset((UINT8*)(bmsAnswerMsg) , 0, 8);
- ret0 = MS_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(bmsAnswerMsg), updateMsgReadLen, 1000);
- #ifdef USING_PRINTF
- printf("update step 5 answer:\n");
- for(ii=0;ii<updateMsgReadLen;ii++)
- printf("%x ",bmsAnswerMsg[ii]);
- printf("\nret0 = %d",ret0);
- printf("\n");
- #endif
- if(ret0!=0)
- {
- if(bmsAnswerMsg[0] == 0x01 && bmsAnswerMsg[1] == 0x40) // node and func byte
- {
- if(bmsAnswerMsg[2] == MS_UPDATE_STEP_EREASE_FLASH_ANSWER && bmsAnswerMsg[3] == 0x02) //answer cmd byte:0x06, answer data len:0x02
- {
- if(bmsAnswerMsg[4] == 0x00) //answer data byte1, erease successed
- {
- updateStep = MS_UPDATE_STEP_SEND_UPDATE_DATA; //0x07
- errorCount = 0;
- }
- else if(bmsAnswerMsg[4] == 0x01) //擦除失败
- {
- errorCount++;
- ret = updateErrorAppErease;
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>10)
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- errorCount = 0;
- }
- osDelay(50);
- break;
- case MS_UPDATE_STEP_SEND_UPDATE_DATA: //0x07
-
- updateMsgReadLen = 7;
- pUpdateMsgSend[0] = 0x01; //node byte
- pUpdateMsgSend[1] = 0x40; //func byte
- pUpdateMsgSend[2] = updateStep; //cmd byte
-
- for(i = 0; i < updateDataPackageCount ; i++ )
- {
-
- memset(ReadNVMTemp, 0, 64);
-
- if((i+1)*64 <= (updateDataTotalByteLen))
- {
- tempLen = 64;
- BSP_QSPI_Read_Safe(ReadNVMTemp,FLASH_BMS_FOTA_START_ADDR+headerLen+i*64,64);
- }
- else
- {
- tempLen = (updateDataTotalByteLen) - i*64;//
- BSP_QSPI_Read_Safe(ReadNVMTemp,FLASH_BMS_FOTA_START_ADDR+headerLen+i*64,tempLen);
- }
- CRCtemp = MS_BMS_Update_CRC16(ReadNVMTemp, tempLen);
- dataLen = tempLen+6; //data len =count(2+2 byte) + crc(2byte) + update data len
- updateMsgSendLen = 6+dataLen; // updateMsgSendLen = data len + header len(6byte)
- pUpdateMsgSend[3] = dataLen; //data len
-
- pUpdateMsgSend[4] = ((i+1)>>8)&0xFF; //当前包序号,大端模式
- pUpdateMsgSend[5] = (i+1)&0xFF;
- pUpdateMsgSend[6] = (updateDataPackageCount>>8)&0xFF;
- pUpdateMsgSend[7] = updateDataPackageCount&0xFF;
- pUpdateMsgSend[8] = (CRCtemp>>8)&0xFF; // data CRC High
- pUpdateMsgSend[9] = CRCtemp&0xFF; //data CRC Low
-
- MEMCPY(&pUpdateMsgSend[4+6], ReadNVMTemp, 64); //升级数据,64字节
-
-
- CRCtemp = MS_BMS_Update_CRC16(pUpdateMsgSend, 4+dataLen);
-
- pUpdateMsgSend[4+dataLen] = (CRCtemp>>8)&0xFF; // CRC High
- pUpdateMsgSend[5+dataLen] = CRCtemp&0xFF; //CRC Low
-
- memset((UINT8*)(bmsAnswerMsg) , 0, 8);
- ret0 = MS_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(bmsAnswerMsg), updateMsgReadLen, 1000);
- #ifdef USING_PRINTF
- printf("update step 7 answer:\n");
- for(ii=0;ii<updateMsgReadLen;ii++)
- printf("%x ",bmsAnswerMsg[ii]);
- printf("\nret0 = %d",ret0);
- printf("\n");
- #endif
- if(ret0!=0)
- {
- if(bmsAnswerMsg[0] == 0x01 && bmsAnswerMsg[1] == 0x40) // node and func byte
- {
- if(bmsAnswerMsg[2] == MS_UPDATE_STEP_UPDATE_DATA_WRITE_ANSWER && bmsAnswerMsg[3] == 0x01) //answer cmd byte:0x04, answer data len:0x01
- {
- if(bmsAnswerMsg[4] == 0x00) //answer data byte1,接收并操作成功
- {
- updateStep = MS_UPDATE_STEP_EREASE_APP_FLASH_REQUEST;
- errorCount = 0;
- }
- else if(bmsAnswerMsg[4] == 0x01) //固件块校验失败
- {
- errorCount=10;
- ret = updateErrorPackageCRC;
- }
- else if(bmsAnswerMsg[4] == 0x02) //烧写失败
- {
- errorCount=10;
- ret = updateErrorPackageWrite;
- }
- else if(bmsAnswerMsg[4] == 0x03) //固件块编号异常
- {
- errorCount=10;
- ret = updateErrorPackageNo;
- }
- else
- {
- errorCount=10;
- }
- }
- else
- {
- errorCount=10;
- }
- }
- else
- {
- errorCount=10;
- }
- }
- else
- {
- errorCount=10;
- }
- if(errorCount>=10)
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- errorCount = 0;
- i--;
- break;
- }
- osDelay(50);
- }
- if(i == updateDataPackageCount)
- {
- updateStep = MS_UPDATE_STEP_SEND_UPDATE_DATA_END_AND_JUMP_TO_APP;
- }
- break;
- case MS_UPDATE_STEP_SEND_UPDATE_DATA_END_AND_JUMP_TO_APP: //0x09
- dataLen = 0x00;
- updateMsgSendLen = 6+dataLen;
- updateMsgReadLen = 7;
-
- pUpdateMsgSend[0] = 0x01; //node byte
- pUpdateMsgSend[1] = 0x40; //func byte
- pUpdateMsgSend[2] = updateStep; //cmd byte
- pUpdateMsgSend[3] = dataLen; //data len
- //no data type
- CRCtemp = MS_BMS_Update_CRC16(pUpdateMsgSend, 4);
- pUpdateMsgSend[4] = (CRCtemp>>8)&0xFF; // CRC High
- pUpdateMsgSend[5] = CRCtemp&0xFF; //CRC Low
-
- memset((UINT8*)(bmsAnswerMsg) , 0, 8);
- ret0 = MS_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(bmsAnswerMsg), updateMsgReadLen, 1000);
- #ifdef USING_PRINTF
- printf("update step 9 answer:\n");
- for(ii=0;ii<updateMsgReadLen;ii++)
- printf("%x ",bmsAnswerMsg[ii]);
- printf("\nret0 = %d",ret0);
- printf("\n");
- #endif
- if(ret0!=0)
- {
- if(bmsAnswerMsg[0] == 0x01 && bmsAnswerMsg[1] == 0x40) // node and func byte
- {
- if(bmsAnswerMsg[2] == MS_UPDATE_STEP_JUMP_TO_APP_ANSWER && bmsAnswerMsg[3] == 0x01) //answer cmd byte:0x0A, answer data len:0x01
- {
- if(bmsAnswerMsg[4] == 0x00) //answer data byte1, update succeed
- {
- errorCount = 0;
- updateStep = MS_UPDATE_STEP_READ_CURRENT_RUNNING_MODE; //0x0B
- }
- else if(bmsAnswerMsg[4] == 0x01) //升级失败
- {
- errorCount = 10;
- ret = updateFailed;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>=10)
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- errorCount = 0;
- }
- osDelay(50);
- break;
- case MS_UPDATE_STEP_READ_CURRENT_RUNNING_MODE: //0x0B
- dataLen = 0x00;
- updateMsgSendLen = 6+dataLen;
- updateMsgReadLen = 8;
-
- pUpdateMsgSend[0] = 0x01; //node byte
- pUpdateMsgSend[1] = 0x40; //func byte
- pUpdateMsgSend[2] = updateStep; //cmd byte
- pUpdateMsgSend[3] = dataLen; //data len
- //no data type
- CRCtemp = MS_BMS_Update_CRC16(pUpdateMsgSend, 4);
- pUpdateMsgSend[4] = (CRCtemp>>8)&0xFF; // CRC High
- pUpdateMsgSend[5] = CRCtemp&0xFF; //CRC Low
-
- memset((UINT8*)(bmsAnswerMsg) , 0, 8);
- ret0 = MS_BMS_Update_Query(pUpdateMsgSend, updateMsgSendLen, (UINT8*)(bmsAnswerMsg), updateMsgReadLen, 1000);
- #ifdef USING_PRINTF
- printf("update step A answer:\n");
- for(ii=0;ii<updateMsgReadLen;ii++)
- printf("%x ",bmsAnswerMsg[ii]);
- printf("\nret0 = %d",ret0);
- printf("\n");
- #endif
- if(ret0!=0)
- {
- if(bmsAnswerMsg[0] == 0x01 && bmsAnswerMsg[1] == 0x40) // node and func byte
- {
- if(bmsAnswerMsg[2] == MS_UPDATE_STEP_CURRENT_RUNNING_MODE_ANSWER && bmsAnswerMsg[3] == 0x02) //answer cmd byte:0x0C, answer data len:0x02
- {
- if(bmsAnswerMsg[4] == 0x01) //answer data byte1, update succeed, app is running
- {
- errorCount = 0;
- updateStep = MS_UPDATE_STEP_END;
- }
- else if(bmsAnswerMsg[4] == 0x00) //update failed , boot is running,error
- {
- errorCount = 10;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- }
- else
- {
- errorCount++;
- }
- if(errorCount>=3)
- {
- updateStep = MS_UPDATE_STEP_ERROR;
- errorCount = 0;
- }
- osDelay(50);
- break;
- case MS_UPDATE_STEP_END: //0x0D
- errorCount = 0;
- bmsUpdateFlag = FALSE;
- ret = updateOK;
- break;
- case MS_UPDATE_STEP_ERROR: //0x0E
- errorCount = 0;
- bmsUpdateFlag = true;
- Cycle_conut++;
- if(Cycle_conut>2)
- {
- ret = updateErrorTimeout;
- bmsUpdateFlag = FALSE;
- }
- break;
- default:
- bmsUpdateFlag = FALSE;
- break;
- }
- }
- #ifdef USING_PRINTF
- printf("last ret = %x\n",ret);
- #endif
- return ret;
- }
- UINT8 MS_BMS_Update_Query(UINT8* pSend,UINT32 sendLen, UINT8* pRead, UINT32 readLen, UINT32 timeout)
- {
- UINT8 timeCount = 0;
- UINT8 j=0;
- USARTdrv->Send(pSend,sendLen);
- #ifdef USING_PRINTF
- printf("query in:");
- for(j=0;j<sendLen;j++)
- {
- printf("%x ",*(pSend+j));
- }
- printf("\n");
- #endif
- if(readLen>0)
- {
- USARTdrv->Receive(pRead,readLen);
- while((isRecvTimeout == false) && (isRecvComplete == false))
- {
- timeCount++;
- osDelay(100);
- if (timeCount>=timeout/100)
- {
- timeCount =0;
- isRecvTimeout = true;
- break;
- }
- }
- #ifdef USING_PRINTF
- printf("\nanswer in:");
- for(j=0;j<readLen;j++)
- {
- printf("%x ",*(pRead+j));
- }
- printf("\n");
- #endif
- if (isRecvComplete == true)
- {
- isRecvComplete = false;
- if(*(pRead+0)!=0x01)
- {
- USARTdrv->Uninitialize();
- osDelay(100);
- USARTdrv->Initialize(USART_callback);
- USARTdrv->PowerControl(ARM_POWER_FULL);
- USARTdrv->Control(ARM_USART_MODE_ASYNCHRONOUS |
- ARM_USART_DATA_BITS_8 |
- ARM_USART_PARITY_NONE |
- ARM_USART_STOP_BITS_1 |
- ARM_USART_FLOW_CONTROL_NONE, 9600);
- #ifdef USING_PRINTF
- printf("\nuart reset in \n");
- #endif
- return 0;
- }
- return readLen;
- }
- else
- {
- memset(pRead,0x00,readLen);
- isRecvTimeout = false;
- return 0;
- }
- }
- else
- {
- return 1;
- }
- }
- static void __invert_uint8(UINT8* dBuf, UINT8* srcBuf)
- {
- int i;
- UINT8 tmp[4];
- tmp[0] = 0;
- for (i = 0;i < 8;i++)
- {
- if(srcBuf[0] & (1 << i))
- {
- tmp[0] |= 1<<(7-i);
- }
- }
- dBuf[0] = tmp[0];
- }
- static void __invert_uint16(UINT16* dBuf, UINT16* srcBuf)
- {
- int i;
- UINT16 tmp[4];
- tmp[0] = 0;
- for (i = 0;i < 16;i++)
- {
- if(srcBuf[0] & (1 << i))
- {
- tmp[0] |= 1 << (15 - i);
- }
- }
- dBuf[0] = tmp[0];
- }
- UINT16 MS_BMS_Update_CRC16(UINT8* pSendData,UINT16 len)
- {
-
- UINT16 wCRCin = 0xFFFF;
- UINT16 wCPoly = 0x8005;
- UINT8 wChar = 0;
- UINT16 crc_rslt = 0;
- int i;
- while (len--)
- {
- wChar = *(pSendData++);
- __invert_uint8(&wChar, &wChar);
- wCRCin ^= (wChar << 8);
- for (i = 0;i < 8;i++)
- {
- if(wCRCin & 0x8000)
- {
- wCRCin = (wCRCin << 1) ^ wCPoly;
- }
- else
- {
- wCRCin = wCRCin << 1;
- }
- }
- }
- __invert_uint16(&wCRCin, &wCRCin);
- crc_rslt = ((wCRCin << 8) & 0xFF00) | ((wCRCin >> 8) & 0x00FF);
- return (crc_rslt);
- }
- UINT8 BmsErrorDecode(UINT32 battWarningState)
- {
- UINT16 ErrorNumTemp;
- UINT8 ret;
- if(battWarningState==0)
- {
- return 0;
- }
- else
- {
- if(osOK==osMutexAcquire(Error_Mutex, 100))
- {
- ret = ((battWarningState) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 7;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在电芯过放告警故障!!\n";单体电压过低
- }
- ret = ((battWarningState >> 1) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 10;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在总电压过放告警故障!!\n";总电压过低
- }
- ret = ((battWarningState >> 2) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 8;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在电芯过压告警故障!!\n";
- }
- ret = ((battWarningState >> 3) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 11;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在总电压过压告警故障!!\n";
- }
- ret = ((battWarningState >> 4) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 12;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在放电过流告警故障!!\n";
- }
- ret = ((battWarningState >> 5) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 13;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在充电过流告警故障!!\n";
- }
- ret = ((battWarningState >> 6) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 2;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在放电过温告警故障!!\n";
- }
- ret = ((battWarningState >> 7) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 2;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在充电过温告警故障!!\n";
- }
- ret = ((battWarningState >> 8) & 0x01) == 1 ;
- if (ret)
- {
- //str += "ERROR:存在环境高温告警故障!!\n";
- }
- ret = ((battWarningState >> 9) & 0x01) == 1 ;
- if (ret)
- {
- //str += "ERROR:存在环境低温告警故障!!\n";
- }
- ret = ((battWarningState >> 10) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 27;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在battSOC低告警故障!!\n";
- }
- ret = ((battWarningState >> 11) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 3;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在MOS高温告警故障!!\n";
- }
- ret = ((battWarningState >> 16) & 0x01) == 1;
- if (ret)
- {
- ErrorNumTemp = 18;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在温度采集失效/传感器故障!!\n";
- }
- ret = ((battWarningState >> 17) & 0x01) == 1;
- if (ret)
- {
- ErrorNumTemp = 19;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在电压采集失效/断线故障!!\n";
- }
- ret = ((battWarningState >> 18) & 0x01) == 1;
- if (ret)
- {
- ErrorNumTemp = 17;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在放电MOS失效故障!!\n";
- }
- ret = ((battWarningState >> 19) & 0x01) == 1;
- if (ret)
- {
- ErrorNumTemp = 16;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在充电MOS失效故障!!\n";
- }
- ret = ((battWarningState >> 20) & 0x01) == 1;
- if (ret)
- {
- if(battSOC>95)
- {
- ErrorNumTemp = 22;
- }
- else
- {
- ErrorNumTemp = 0;
- }
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在电芯不均衡告警!!\n";
- }
- ret = ((battWarningState >> 22) & 0x01) == 1;
- if (ret)
- {
- ErrorNumTemp = 1;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在放电低温告警故障!!\n";
- }
- ret = ((battWarningState >> 23) & 0x01) == 1 ;
- if (ret)
- {
- ErrorNumTemp = 1;
- PutErrorNum((UINT16 *)ErrorNum,ErrorNumLen,ErrorNumTemp);
- //str += "ERROR:存在充电低温告警故障!!\n";
- }
- }
- else
- {
- #ifdef USING_PRINTF
- printf("get Muxtex error\n");
- #endif
- }
- osMutexRelease(Error_Mutex);
- }
- return 1;
- }
|