12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473 |
- /* USER CODE BEGIN Header */
- /**
- ******************************************************************************
- * @file : main.c
- * @brief : Main program body
- ******************************************************************************
- * @attention
- *
- * <h2><center>© Copyright (c) 2021 STMicroelectronics.
- * All rights reserved.</center></h2>
- *
- * This software component is licensed by ST under Ultimate Liberty license
- * SLA0044, the "License"; You may not use this file except in compliance with
- * the License. You may obtain a copy of the License at:
- * www.st.com/SLA0044
- *
- ******************************************************************************
- */
- /* USER CODE END Header */
- /* Includes ------------------------------------------------------------------*/
- #include "main.h"
- #include "cmsis_os.h"
- #include "FreeRTOS.h"
- #include "task.h"
- #include "timers.h"
- #include "event_groups.h"
- /* Private includes ----------------------------------------------------------*/
- /* USER CODE BEGIN Includes */
- #include "string.h"
- #include "stdio.h"
- #include "usart.h"
- #include "config.h"
- #include "rkg.h"
- #include "cang.h"
- #include "kzq.h"
- #include "level.h"
- #include "tem.h"
- #include "angle.h"
- #include "xyf.h"
- #include "hdf.h"
- #include "bgy.h"
- #include "yqhs.h"
- #include "pressure.h"
- #include "iap.h"
- /* USER CODE END Includes */
- #if 0
- #define IR_ROM1 0x08000000
- #else
- #define IR_ROM1 0x08020000
- #endif
- /* Private typedef -----------------------------------------------------------*/
- /* USER CODE BEGIN PTD */
- #define ADDR_Is_In_ElecFence 0x05D0 // 1488 车是否在电子围栏内
- uint8_t REST = 0;
- uint32_t usage_Tsk12=0;
- //============================================================
- sT2C_RemoteCaliDat T2C_RemoteCaliDat001 =
- {
-
- 0x3901,
- 0x9551000,
- 0x0003,
- ADDR_Is_In_ElecFence,//0x0000,
- 0x0001, //操作的数据个数
- 0x55aa55aa, //保留字4字节
- {1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,\
- 25,26,27,28,29,30,31,32,33,34,35,36,37,38,39,40,41,42,43,44},
- 0x7788,//保留字2字节
- 0x99aa //校验2字节
- };
- sT2C_RemoteCaliDat *pT2C_RemoteCaliData = &T2C_RemoteCaliDat001;
- /* USER CODE END PTD */
- /* Private define ------------------------------------------------------------*/
- /* USER CODE BEGIN PD */
- #define RT_ERRORCNT 60 //串口收发数据错误上限
- /* USER CODE END PD */
- /* Private macro -------------------------------------------------------------*/
- /* USER CODE BEGIN PM */
- uint8_t CMD_KZQ[256] =
- {0x39,0x01,0x95,0x50,0x00,0x01,0x00,0x03,
- 0x00,0x00,0x00,0x00,0x95,0x05,0xaa,0xaa,
- 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
- 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
- 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
- 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
- 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
- 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
- };
- //卸油阀指令
- uint8_t CMD_XYF[8] = {0x11,0x03,0x00,0x00,0x00,0x01,0x00,0x00};
- uint8_t Data_Head[2] = {0x0D,0x0A};
- //海底阀指令
- uint8_t CMD_HDF[16] =
- {0x21,0x03,0x2a,0,0,0,0,0,0xaa,0xbb,0xcc,0xdd,0xee,0xdd,0xcc,0xbb};
- //人孔盖指令31 03 00 02 00 02
- uint8_t CMD_RKG[8] = {0x31,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
- uint8_t CMD_RKG_CBM[12] = {0x0D,0x0A,0x31,0x03,0x00,0x02,0x00,0x02,0x00,0x00,0x0D,0x0A};
- uint8_t CMD_RKG_XG[12] = {0x41,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
-
- //油气回收
- uint8_t CMD_YQHS[8] = {0xE4,0x03,0x00,0x00,0x00,0x01,0x00,0x00};
- //倾角传感器读取协议 01 03 00 02 00 02 CRC
- uint8_t CMD_Angle_XY[] = {0x71,0x03,0x00,0x3d,0x00,0x03,0x00,0x00};
- //卸尽传感器读取协议
- uint8_t CMD_Biguayou[] = {0x81,0x03,0x00,0x00,0x00,0x01,0x9B,0xCA};
- //uint8_t CMD_Angle_X[] = {0xE0,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
- //uint8_t CMD_Angle_Y[] = {0xE1,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
- uint8_t CMD_LDYW[8]={LEVEL_STARTADDR,0x04,0x0a,0x0f,0x00,0x02, 0, 0};//设备地址,功能码,地址4字节 反回:设备地址,功能码,数据长度,数据4字节
- uint8_t CMD_GetTempAndYewei[8]={0x51, 0x04, 00, 00, 00, 0x10, 0x03 ,0xae};//读取编号为04地址的温度传感器数据
- //61-6f 03 00 04 00 01 C6 8A----读取华天传感器的第1个温度点,地址为x10;最接近电子仓的温度点
- uint8_t CMD_GetTempHuaTian[8]={0x61, 0x03, 00, 04, 00, 01,0,0};//读取华天传感器的第一个温度点
- uint8_t CMD_TemAng[8]={TEM_STARTADDR, 0x03, 00, 00, 00, 02,0,0};//FST100-611 通过模拟量模块,读取温度
- uint8_t CMD_Temperature[8]={TEM_STARTADDR, 0x03, 00, 02, 00, 02,0,0};
- uint8_t CMD_Pressure[8]={PRESSURE_STARTADDR, 0x03, 0x00, 0x00, 0x00, 0x02,0,0}; //FST800-801 读取压力数据, 没有标零指令
- //uint8_t CMD_FSTTem[8]={TEM_STARTADDR, 0x03, 00, 02, 00, 02,0,0};//FST100-1007G371C //温压一体, 读温度指令
- //uint8_t CMD_FSTPressure[8]={PRESSURE_STARTADDR, 0x03, 00, 00, 00, 02,0,0};//FST100-1007G371C //温压一体, 读压力指令
- //磁编码传感器读取协议 。
- /* USER CODE END PM */
- /* Private variables ---------------------------------------------------------*/
- CRC_HandleTypeDef hcrc;
- DAC_HandleTypeDef hdac;
- DMA_HandleTypeDef hdma_dac_ch2;
- TIM_HandleTypeDef htim1;
- TIM_HandleTypeDef htim4;
- UART_HandleTypeDef huart5;
- UART_HandleTypeDef huart1;
- UART_HandleTypeDef huart2;
- UART_HandleTypeDef huart3;
- DMA_HandleTypeDef hdma_usart1_rx;
- DMA_HandleTypeDef hdma_usart1_tx;
- DMA_HandleTypeDef hdma_usart2_rx;
- DMA_HandleTypeDef hdma_usart3_rx;
- uint8_t bufMain[128];
- /* Definitions for defaultTask */
- osThreadId_t defaultTaskHandle;
- const osThreadAttr_t defaultTask_attributes = {
- .name = "defaultTask",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityNormal,
- };
- /* Definitions for myTask02 */
- osThreadId_t myTask02Handle;
- const osThreadAttr_t myTask02_attributes = {
- .name = "myTask02",
- .stack_size = 256 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask03 */
- osThreadId_t myTask03Handle;
- const osThreadAttr_t myTask03_attributes = {
- .name = "myTask03",
- .stack_size = 256 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask04 */
- osThreadId_t myTask04Handle;
- const osThreadAttr_t myTask04_attributes = {
- .name = "myTask04",
- .stack_size = 256 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask05 */
- osThreadId_t myTask05Handle;
- const osThreadAttr_t myTask05_attributes = {
- .name = "myTask05",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask06 */
- osThreadId_t myTask06Handle;
- const osThreadAttr_t myTask06_attributes = {
- .name = "myTask06",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask07 */
- osThreadId_t myTask07Handle;
- const osThreadAttr_t myTask07_attributes = {
- .name = "myTask07",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask08 */
- osThreadId_t myTask08Handle;
- const osThreadAttr_t myTask08_attributes = {
- .name = "myTask08",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask09 */
- osThreadId_t myTask09Handle;
- const osThreadAttr_t myTask09_attributes = {
- .name = "myTask09",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask10 */
- osThreadId_t myTask10Handle;
- const osThreadAttr_t myTask10_attributes = {
- .name = "myTask10",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask11 */
- osThreadId_t myTask11Handle;
- const osThreadAttr_t myTask11_attributes = {
- .name = "myTask11",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) osPriorityLow,
- };
- /* Definitions for myTask12 */
- osThreadId_t myTask12Handle;
- const osThreadAttr_t myTask12_attributes = {
- .name = "myTask12",
- .stack_size = 128 * 4,
- .priority = (osPriority_t) (osPriorityLow-6),
- };
- /* Definitions for myQueue01 */
- osMessageQueueId_t myQueue01Handle;
- const osMessageQueueAttr_t myQueue01_attributes = {
- .name = "myQueue01"
- };
- /* Definitions for myQueue02 */
- osMessageQueueId_t myQueue02Handle;
- const osMessageQueueAttr_t myQueue02_attributes = {
- .name = "myQueue02"
- };
- /* Definitions for myQueue03 */
- osMessageQueueId_t myQueue03Handle;
- const osMessageQueueAttr_t myQueue03_attributes = {
- .name = "myQueue03"
- };
- /* Definitions for myQueue04 */
- osMessageQueueId_t myQueue04Handle;
- const osMessageQueueAttr_t myQueue04_attributes = {
- .name = "myQueue04"
- };
- /* Definitions for myQueue05 */
- osMessageQueueId_t myQueue05Handle;
- const osMessageQueueAttr_t myQueue05_attributes = {
- .name = "myQueue05"
- };
- /* Definitions for myQueue06 */
- osMessageQueueId_t myQueue06Handle;
- const osMessageQueueAttr_t myQueue06_attributes = {
- .name = "myQueue06"
- };
- /* Definitions for myTimer01 */
- osTimerId_t myTimer01Handle;
- const osTimerAttr_t myTimer01_attributes = {
- .name = "myTimer01"
- };
- /* Definitions for myTimer02 */
- osTimerId_t myTimer02Handle;
- const osTimerAttr_t myTimer02_attributes = {
- .name = "myTimer02"
- };
- /* Definitions for myTimer03 */
- osTimerId_t myTimer03Handle;
- const osTimerAttr_t myTimer03_attributes = {
- .name = "myTimer03"
- };
- /* Definitions for myTimer04 */
- osTimerId_t myTimer04Handle;
- const osTimerAttr_t myTimer04_attributes = {
- .name = "myTimer04"
- };
- /* Definitions for myTimer05 */
- osTimerId_t myTimer05Handle;
- const osTimerAttr_t myTimer05_attributes = {
- .name = "myTimer05"
- };
- /* Definitions for myTimer06 */
- osTimerId_t myTimer06Handle;
- const osTimerAttr_t myTimer06_attributes = {
- .name = "myTimer06"
- };
- /* Definitions for myTimer07 */
- osTimerId_t myTimer07Handle;
- const osTimerAttr_t myTimer07_attributes = {
- .name = "myTimer07"
- };
- /* Definitions for myTimer08 */
- osTimerId_t myTimer08Handle;
- const osTimerAttr_t myTimer08_attributes = {
- .name = "myTimer08"
- };
- /* Definitions for myTimer09 */
- osTimerId_t myTimer09Handle;
- const osTimerAttr_t myTimer09_attributes = {
- .name = "myTimer09"
- };
- /* Definitions for myTimer10 */
- osTimerId_t myTimer10Handle;
- const osTimerAttr_t myTimer10_attributes = {
- .name = "myTimer10"
- };
- /* Definitions for myMutex01 */
- osMutexId_t myMutex01Handle;
- const osMutexAttr_t myMutex01_attributes = {
- .name = "myMutex01"
- };
- /* Definitions for myMutex02 */
- osMutexId_t myMutex02Handle;
- const osMutexAttr_t myMutex02_attributes = {
- .name = "myMutex02"
- };
- /* Definitions for myMutex03 */
- osMutexId_t myMutex03Handle;
- const osMutexAttr_t myMutex03_attributes = {
- .name = "myMutex03"
- };
- /* Definitions for myMutex04 */
- osMutexId_t myMutex04Handle;
- const osMutexAttr_t myMutex04_attributes = {
- .name = "myMutex04"
- };
- /* Definitions for myMutex05 */
- osMutexId_t myMutex05Handle;
- const osMutexAttr_t myMutex05_attributes = {
- .name = "myMutex05"
- };
- /* Definitions for myMutex06 */
- osMutexId_t myMutex06Handle;
- const osMutexAttr_t myMutex06_attributes = {
- .name = "myMutex06"
- };
- /* Definitions for myMutex07 */
- osMutexId_t myMutex07Handle;
- const osMutexAttr_t myMutex07_attributes = {
- .name = "myMutex07"
- };
- /* Definitions for myMutex08 */
- osMutexId_t myMutex08Handle;
- const osMutexAttr_t myMutex08_attributes = {
- .name = "myMutex08"
- };
- /* Definitions for myRecursiveMutex01 */
- osMutexId_t myRecursiveMutex01Handle;
- const osMutexAttr_t myRecursiveMutex01_attributes = {
- .name = "myRecursiveMutex01",
- .attr_bits = osMutexRecursive,
- };
- /* Definitions for myRecursiveMutex02 */
- osMutexId_t myRecursiveMutex02Handle;
- const osMutexAttr_t myRecursiveMutex02_attributes = {
- .name = "myRecursiveMutex02",
- .attr_bits = osMutexRecursive,
- };
- /* Definitions for myRecursiveMutex03 */
- osMutexId_t myRecursiveMutex03Handle;
- const osMutexAttr_t myRecursiveMutex03_attributes = {
- .name = "myRecursiveMutex03",
- .attr_bits = osMutexRecursive,
- };
- /* Definitions for myRecursiveMutex04 */
- osMutexId_t myRecursiveMutex04Handle;
- const osMutexAttr_t myRecursiveMutex04_attributes = {
- .name = "myRecursiveMutex04",
- .attr_bits = osMutexRecursive,
- };
- /* Definitions for myBinarySem01 */
- osSemaphoreId_t myBinarySem01Handle;
- const osSemaphoreAttr_t myBinarySem01_attributes = {
- .name = "myBinarySem01"
- };
- /* Definitions for myBinarySem02 */
- osSemaphoreId_t myBinarySem02Handle;
- const osSemaphoreAttr_t myBinarySem02_attributes = {
- .name = "myBinarySem02"
- };
- /* Definitions for myBinarySem03 */
- osSemaphoreId_t myBinarySem03Handle;
- const osSemaphoreAttr_t myBinarySem03_attributes = {
- .name = "myBinarySem03"
- };
- /* Definitions for myBinarySem04 */
- osSemaphoreId_t myBinarySem04Handle;
- const osSemaphoreAttr_t myBinarySem04_attributes = {
- .name = "myBinarySem04"
- };
- /* Definitions for myBinarySem05 */
- osSemaphoreId_t myBinarySem05Handle;
- const osSemaphoreAttr_t myBinarySem05_attributes = {
- .name = "myBinarySem05"
- };
- /* Definitions for myBinarySem06 */
- osSemaphoreId_t myBinarySem06Handle;
- const osSemaphoreAttr_t myBinarySem06_attributes = {
- .name = "myBinarySem06"
- };
- /* Definitions for myBinarySem07 */
- osSemaphoreId_t myBinarySem07Handle;
- const osSemaphoreAttr_t myBinarySem07_attributes = {
- .name = "myBinarySem07"
- };
- /* Definitions for myBinarySem08 */
- osSemaphoreId_t myBinarySem08Handle;
- const osSemaphoreAttr_t myBinarySem08_attributes = {
- .name = "myBinarySem08"
- };
- /* Definitions for myCountingSem01 */
- osSemaphoreId_t myCountingSem01Handle;
- const osSemaphoreAttr_t myCountingSem01_attributes = {
- .name = "myCountingSem01"
- };
- /* Definitions for myCountingSem02 */
- osSemaphoreId_t myCountingSem02Handle;
- const osSemaphoreAttr_t myCountingSem02_attributes = {
- .name = "myCountingSem02"
- };
- /* Definitions for myCountingSem03 */
- osSemaphoreId_t myCountingSem03Handle;
- const osSemaphoreAttr_t myCountingSem03_attributes = {
- .name = "myCountingSem03"
- };
- /* Definitions for myCountingSem04 */
- osSemaphoreId_t myCountingSem04Handle;
- const osSemaphoreAttr_t myCountingSem04_attributes = {
- .name = "myCountingSem04"
- };
- /* Definitions for myEvent01 */
- osEventFlagsId_t myEvent01Handle;
- const osEventFlagsAttr_t myEvent01_attributes = {
- .name = "myEvent01"
- };
- /* Definitions for myEvent02 */
- osEventFlagsId_t myEvent02Handle;
- const osEventFlagsAttr_t myEvent02_attributes = {
- .name = "myEvent02"
- };
- /* Definitions for myEvent03 */
- osEventFlagsId_t myEvent03Handle;
- const osEventFlagsAttr_t myEvent03_attributes = {
- .name = "myEvent03"
- };
- /* Definitions for myEvent04 */
- osEventFlagsId_t myEvent04Handle;
- const osEventFlagsAttr_t myEvent04_attributes = {
- .name = "myEvent04"
- };
- /* Definitions for myEvent05 */
- osEventFlagsId_t myEvent05Handle;
- const osEventFlagsAttr_t myEvent05_attributes = {
- .name = "myEvent05"
- };
- /* Definitions for myEvent06 */
- osEventFlagsId_t myEvent06Handle;
- const osEventFlagsAttr_t myEvent06_attributes = {
- .name = "myEvent06"
- };
- /* Definitions for myEvent07 */
- osEventFlagsId_t myEvent07Handle;
- const osEventFlagsAttr_t myEvent07_attributes = {
- .name = "myEvent07"
- };
- /* Definitions for myEvent08 */
- osEventFlagsId_t myEvent08Handle;
- const osEventFlagsAttr_t myEvent08_attributes = {
- .name = "myEvent08"
- };
- /* USER CODE BEGIN PV */
- /* USER CODE END PV */
- /* Private function prototypes -----------------------------------------------*/
- void SystemClock_Config(void);
- static void MX_GPIO_Init(void);
- static void MX_DMA_Init(void);
- static void MX_USART1_UART_Init(void);
- static void MX_UART5_Init(void);
- static void MX_USART2_UART_Init(void);
- static void MX_USART3_UART_Init(void);
- static void MX_CRC_Init(void);
- static void MX_DAC_Init(void);
- static void MX_TIM1_Init(void);
- static void MX_TIM4_Init(void);
- void StartDefaultTask(void *argument);
- void StartTask02(void *argument);
- void StartTask03(void *argument);
- void StartTask04(void *argument);
- void StartTask05(void *argument);
- void StartTask06(void *argument);
- void StartTask07(void *argument);
- void StartTask08(void *argument);
- void StartTask09(void *argument);
- void StartTask10(void *argument);
- void StartTask11(void *argument);
- void StartTask12(void *argument);
- void Callback01(void *argument);
- void Callback02(void *argument);
- void Callback03(void *argument);
- void Callback04(void *argument);
- void Callback05(void *argument);
- void Callback06(void *argument);
- void Callback07(void *argument);
- void Callback08(void *argument);
- void Callback09(void *argument);
- void Callback010(void *argument);
- void Cang_Init(void);
- static void MX_NVIC_Init(void);
- // for debug,将信息输出到指定的uart总线上
- static void DumpMsg(uint8_t *msg)
- {
- HAL_GPIO_WritePin(GPIOA,con03_uart2_kongzhiqi_Pin,GPIO_PIN_RESET);
- delay_sys_us(80);
- HAL_UART_Transmit_IT(&huart2,msg,strlen(msg));
- while (huart2.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOA,con03_uart2_kongzhiqi_Pin,GPIO_PIN_SET);
- }
- #include <stdarg.h>
- void printx(const char *log,...)
- {
- osMutexAcquire(myMutex01Handle, portMAX_DELAY);
- va_list ap;
- va_start(ap,log);
- vsnprintf(bufMain,sizeof(bufMain),log,ap);
- va_end(ap);
- DumpMsg(bufMain);
- osMutexRelease(myMutex01Handle);
- }
- /* USER CODE BEGIN PFP */
- void Flash_ReadBytes(uint16_t* sorBuf,uint32_t FlashAddr,uint16_t len)
- {
- uint16_t* p = sorBuf;
- uint8_t i = 0,j = 0;
- uint32_t addr = FlashAddr;
- while(len--)
- {
- i = *(uint32_t*)addr++;
- j = *(uint32_t*)addr++;
- *p++ = j<<8|i;
- }
- }
- uint16_t Flashbuf[2048]__attribute__ ((at(0X20001000)));// {0};
- //uint8_t UART_RX_BUF[1024] __attribute__ ((at(0X20001000)));
- void Flash_WriteBytes(uint16_t* sorBuf,uint32_t FlashAddr,uint16_t len)
- {
- uint32_t Offset_ADDR = 0,Page_StartAddr = 0,i = 0;
- Offset_ADDR = FlashAddr%0x800;
- Page_StartAddr = FlashAddr - Offset_ADDR;
- //设置PageError
- uint32_t PageError = 0;
- FLASH_EraseInitTypeDef f;
- f.TypeErase = FLASH_TYPEERASE_PAGES;
- __nop();
- f.PageAddress =Page_StartAddr;
- f.NbPages = 1;
- Flash_ReadBytes(Flashbuf,Page_StartAddr,0x400);
-
- for(i = 0;i<len;i++)
- Flashbuf[Offset_ADDR/2+i] = sorBuf[i];
-
- //1、解锁FLASH
- HAL_FLASH_Unlock();
- __nop();
- //2、擦除FLASH
- //初始化FLASH_EraseInitTypeDef
- //调用擦除函数
- HAL_FLASHEx_Erase(&f, &PageError);
-
- __nop();
- //3、对FLASH烧写
- for(uint16_t i = 0;i< 0x400 ;i++)
- {
- HAL_FLASH_Program(FLASH_TYPEPROGRAM_HALFWORD , Page_StartAddr + (i * 2), Flashbuf[i]);
- }
- //4、锁住FLASH
- HAL_FLASH_Lock();
-
- }
- typedef union{
- float Ldcal_zero_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float1;
- Hex_to_float1 hex_to_float1;
-
-
-
- void Cang_Init(void)
- {
- Cang_Inf* pcang = &cang_inf;
- RKG_Inf* prkg = rkg_inf;
- XYF_Inf* pxyf = xyf_inf;
- HDF_Inf* phdf = hdf_inf;
- Angle_Inf* pangle = &angle_inf;
- Level_Inf* plevel = level_inf;
- Tem_Inf* ptem = tem_inf;
-
- uint16_t Flash_buff[64] = {0};
- uint16_t i = 0;
-
-
- Flash_ReadBytes(Flash_buff,ADDR_CANG_NUM,6);
- if(Flash_buff[0] == 0xffff)
- {
- //Flash_WriteBytes(Volume_1cang,ADD_CANG1_TABLE,200);
- //Flash_WriteBytes(Volume_2cang,ADD_CANG2_TABLE,200);
- //Flash_WriteBytes(Volume_3cang,ADD_CANG3_TABLE,200);
- //Flash_WriteBytes(Volume_4cang,ADD_CANG4_TABLE,200);
- pcang->Cang_Num = 3; //默认三仓
- }
- else
- pcang->Cang_Num = Flash_buff[0];
- if(Flash_buff[1] == 0xffff)
- {
- i = 0;
- while(i < pcang->Cang_Num)
- {
- pcang->RKG_Num[i] = 1; //默认每仓1人孔大盖
- pcang->RKG_DG = 1; //默认有大盖
- i++;
- }
- }
- else
- {
- i = 0;
- while(i <pcang->Cang_Num)
- {
- pcang->RKG_Num[i] = Flash_buff[1]; //默认每仓1人孔盖
- pcang->RKG_DG = Flash_buff[1];
- i++;
- }
- }
-
- if(Flash_buff[2] == 0xffff)
- pcang->RKG_XG = 0; //默认无人孔小盖
- else
- pcang->RKG_XG = Flash_buff[2];
-
- if(Flash_buff[3] == 0xffff)
- {
- i = 0;
- while(i <pcang->Cang_Num)
- {
- pcang->XYF_INSTALL = 1; // 默认有卸油阀SLM
- pcang->XYF_Num[i] = 1; //默认每仓1卸油阀
- i++;
- }
- }
- else
- {
- i = 0;
- while(i <pcang->Cang_Num)
- {
- pcang->XYF_INSTALL = 1; // 默认有卸油阀SLM
- pcang->XYF_Num[i] = Flash_buff[3]; i++;
- }
- }
-
- if(Flash_buff[4] == 0xffff)
- {
- i = 0;
- while(i <pcang->Cang_Num)
- {
- pcang->HDF_INSTALL = 1;
- pcang->HDF_Num[i] = 1; //默认每仓1海底阀
- i++;
- }
- }
- else
- {
- i = 0;
- while(i <pcang->Cang_Num)
- {
- pcang->HDF_INSTALL = 1;//slm
- pcang->HDF_Num[i] = Flash_buff[4];
- i++;
- }
- }
-
- Flash_ReadBytes(Flash_buff,ADDR_RKGSENSOR_TYPE,1);
- if(Flash_buff[0] == 0xffff)
- pcang->RKG_Type = 1; //默认人孔盖角度传感器 1磁电编码传感器
- else
- pcang->RKG_Type = Flash_buff[0];
- Flash_ReadBytes(Flash_buff,ADDR_XYFSENSOR_TYPE,1);
- if(Flash_buff[0] == 0xffff)
- pcang->XYF_Type = 0; //默认卸油阀霍尔二合一
- else
- pcang->XYF_Type = Flash_buff[0];
- Flash_ReadBytes(Flash_buff,ADDR_HDFSENSOR_TYPE,1);
- if(Flash_buff[0] == 0xffff)
- pcang->HDF_Type = 1; //默认底阀监测器 1智能底阀
- else
- pcang->HDF_Type = Flash_buff[0];
-
-
- Flash_ReadBytes(Flash_buff,ADDR_RKG_NUM,8); //检测是否对阀门种类及数量进行配置
- for(i = 0;i < 8;i++)
- {
- if((Flash_buff[i] < 8))
- pcang->RKG_Num[i] = Flash_buff[i];
- else
- pcang->RKG_Num[i] = 1; //默认每仓1人孔阀
- }
- Flash_ReadBytes(Flash_buff,ADDR_XYF_NUM,8);
- for(i = 0;i < 8;i++)
- {
- if((Flash_buff[i] < 8))
- pcang->XYF_Num[i] = Flash_buff[i];
- else
- pcang->XYF_Num[i] = 1; //默认每仓1卸油阀 slm
- }
- Flash_ReadBytes(Flash_buff,ADDR_HDF_NUM,8);
- for(i = 0;i < 8;i++)
- {
- if((Flash_buff[i] < 8))
- pcang->HDF_Num[i] = Flash_buff[i];
- else
- pcang->HDF_Num[i] = 1; //默认每仓1海底阀 slm
- }
-
-
- Flash_ReadBytes(Flash_buff,ADDR_YQHS_TYPE,1);
- if(Flash_buff[0] == 0xffff)
- pcang->YQHS = 0; //默认无油气回收 slm
- else
- pcang->YQHS = Flash_buff[0];
-
- Flash_ReadBytes(Flash_buff,ADDR_LEVEL_TYPE,1);
- if(Flash_buff[0] == 0xffff)
- pcang->Level = LEVEL_NONE; //默认无液位传感器 slm
- else
- pcang->Level = Flash_buff[0];
- Flash_ReadBytes(Flash_buff,CANG1_LEVEL_CAL,8);
- if(Flash_buff[0] == 0xffff)
- {
- for(i=0;i<pcang->Cang_Num;++i)
- {
- plevel[i].zero = 0;
- }
- }
- else
- {
- for (i = 0; i < pcang->Cang_Num; ++i)
- {
- hex_to_float1.arr[3] = (uint8_t)(Flash_buff[0+2*i] >> 8);
- hex_to_float1.arr[2] = (uint8_t)(Flash_buff[0+2*i] & 0xFF); // Flash_buff[3];
- hex_to_float1.arr[1] = (uint8_t)(Flash_buff[1+2*i] >> 8);
- hex_to_float1.arr[0] = (uint8_t)(Flash_buff[1+2*i] & 0xFF);
- plevel[i].zero = hex_to_float1.Ldcal_zero_temp;
- }
- }
-
- Flash_ReadBytes(Flash_buff,ADDR_SENSOR_BUS_MAX_RETRY,1);
- if(Flash_buff[0] == 0xffff)
- pcang->sensorBusMaxReTry = 10;
- else
- pcang->sensorBusMaxReTry = Flash_buff[0];
- Flash_ReadBytes(Flash_buff,ADDR_PIN_IO_HIT_SAME,1);
- if(Flash_buff[0] == 0xffff)
- pcang->pinIOHitSameParam = 3;
- else
- pcang->pinIOHitSameParam = Flash_buff[0];
-
- Flash_ReadBytes(Flash_buff,ADDR_TEM_TYPE,1);
- if(Flash_buff[0] == 0xffff)
- pcang->Temperture = 1; //默认无温度传感器
- else
- pcang->Temperture = Flash_buff[0];
-
- Flash_ReadBytes(Flash_buff,ADDR_ANGLE_TYPE,1);
- if(Flash_buff[0] == 0xffff)
- pcang->Angle = 1; //默认无姿态传感器
- else
- pcang->Angle = Flash_buff[0];
-
- Flash_ReadBytes(Flash_buff,ADDR_SDATEJUDGE_NUM,1);
- if(Flash_buff[0] == 0xffff)
- {
- for (i = 0; i < 8; i++)
- {
- prkg[i].RKG_StateKeepNum = 5; //默认人孔盖角度传感器
- pxyf[i].XYF_StateKeepNum = 5;
- plevel[i].StateKeepNum = 5;
- ptem[i].StateKeepNum = 5;
- }
-
-
- phdf->HDF_StateKeepNum = 5;
- pangle->Angle_StateKeepNum = 5;
- //plevel->StateKeepNum = 5;
- //ptem->TEM_StateKeepNum = 5;
- }
- else
- {
- for (i = 0; i < 8; i++)
- {
- prkg[i].RKG_StateKeepNum = Flash_buff[0];
- pxyf[i].XYF_StateKeepNum = Flash_buff[0];
- plevel[i].StateKeepNum = Flash_buff[0];
- ptem[i].StateKeepNum = Flash_buff[0];
- }
- pxyf->XYF_StateKeepNum = Flash_buff[0];
- phdf->HDF_StateKeepNum = Flash_buff[0];
-
- __NOP();
- pangle->Angle_StateKeepNum = Flash_buff[0];
- //plevel->StateKeepNum = Flash_buff[0];
- //ptem->TEM_StateKeepNum = Flash_buff[0];
- }
- }
- /* USER CODE END PFP */
- /* Private user code ---------------------------------------------------------*/
- /* USER CODE BEGIN 0 */
- /* USER CODE END 0 */
- /**4
- * @brief The application entry point.
- * @retval int
- */
- int main(void)
- {
- /* USER CODE BEGIN 1 */
- GPIO_InitTypeDef GPIO_InitStruct = {0};
- int spr000;
- /* USER CODE END 1 */
- #if IR_ROM1 == 0x08000000
- Start_BootLoader();
- #else
- SCB->VTOR = 0x08020000;
- __set_PRIMASK(0);
- #endif
- /* MCU Configuration--------------------------------------------------------*/
- /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
- HAL_Init();
- /* USER CODE BEGIN Init */
- Cang_Init(); //应用程序初始化函数
- RKG_Init();
- XYF_Init();
- BGY_Init();
- Pressure_Init();
- /* USER CODE END Init */
- /* Configure the system clock */
- SystemClock_Config();
- /* USER CODE BEGIN SysInit */
- /* USER CODE END SysInit */
-
- /* Initialize all configured peripherals */
- MX_GPIO_Init();
- MX_DMA_Init();
- MX_USART1_UART_Init();
- MX_UART5_Init();
- MX_USART2_UART_Init();
- MX_USART3_UART_Init();
- MX_CRC_Init();
- MX_DAC_Init();
- MX_TIM1_Init();
- MX_TIM4_Init();
- /* Initialize interrupts */
- MX_NVIC_Init();
- /* USER CODE BEGIN 2 */
-
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//切换为接收模式
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//切换为接收模式
- HAL_GPIO_WritePin(con03_uart2_kongzhiqi_GPIO_Port,con03_uart2_kongzhiqi_Pin,GPIO_PIN_SET);//切换为接收模式
-
- //看门狗重新根据宏定义初始化
- GPIO_InitStruct.Pin = WDI_sp706_kanmemgou_Pin;
- if(WatchDogOn)//打开看门狗sp706
- //if(1)//打开看门狗sp706
- {
- //
- GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
-
- }
- else
- {
- GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
-
- }
-
- GPIO_InitStruct.Pull = GPIO_NOPULL;
- GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
- HAL_GPIO_Init(WDI_sp706_kanmemgou_GPIO_Port, &GPIO_InitStruct);
-
-
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//切换为发送模式CON=0;//
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//切换为接收模式
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//切换为接收模式
- HAL_GPIO_WritePin(con03_uart2_kongzhiqi_GPIO_Port,con03_uart2_kongzhiqi_Pin,GPIO_PIN_RESET);//切换为接收模式
-
- HAL_Delay(2);
- memset(bufMain,0,128);
- spr000=sprintf((char*)bufMain,"sysytem reset...%5d, watchDogOn=%d, version:%d-%d",5,WatchDogOn,Version_Soft[7],Version_Soft[3]);
- //HAL_UART_Transmit(&huart1,bufMain,32,300);
- HAL_UART_Transmit(&huart2,bufMain,spr000,300);
- //HAL_UART_Transmit(&huart3,bufMain,32,300);
-
-
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//切换为接收模式
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//切换为接收模式
- HAL_GPIO_WritePin(con03_uart2_kongzhiqi_GPIO_Port,con03_uart2_kongzhiqi_Pin,GPIO_PIN_SET);//切换为接收模式
-
- /* USER CODE END 2 */
- /* Init scheduler */
- osKernelInitialize();
- /* Create the mutex(es) */
- /* creation of myMutex01 */
- myMutex01Handle = osMutexNew(&myMutex01_attributes);
- /* creation of myMutex02 */
- myMutex02Handle = osMutexNew(&myMutex02_attributes);
- /* creation of myMutex03 */
- myMutex03Handle = osMutexNew(&myMutex03_attributes);
- /* creation of myMutex04 */
- myMutex04Handle = osMutexNew(&myMutex04_attributes);
- /* creation of myMutex05 */
- myMutex05Handle = osMutexNew(&myMutex05_attributes);
- /* creation of myMutex06 */
- myMutex06Handle = osMutexNew(&myMutex06_attributes);
- /* creation of myMutex07 */
- myMutex07Handle = osMutexNew(&myMutex07_attributes);
- /* creation of myMutex08 */
- myMutex08Handle = osMutexNew(&myMutex08_attributes);
- /* Create the recursive mutex(es) */
- /* creation of myRecursiveMutex01 */
- myRecursiveMutex01Handle = osMutexNew(&myRecursiveMutex01_attributes);
- /* creation of myRecursiveMutex02 */
- myRecursiveMutex02Handle = osMutexNew(&myRecursiveMutex02_attributes);
- /* creation of myRecursiveMutex03 */
- myRecursiveMutex03Handle = osMutexNew(&myRecursiveMutex03_attributes);
- /* creation of myRecursiveMutex04 */
- myRecursiveMutex04Handle = osMutexNew(&myRecursiveMutex04_attributes);
- /* USER CODE BEGIN RTOS_MUTEX */
- /* add mutexes, ... */
- /* USER CODE END RTOS_MUTEX */
- /* Create the semaphores(s) */
- /* creation of myBinarySem01 */
- myBinarySem01Handle = osSemaphoreNew(1, 1, &myBinarySem01_attributes);
- /* creation of myBinarySem02 */
- myBinarySem02Handle = osSemaphoreNew(1, 1, &myBinarySem02_attributes);
- /* creation of myBinarySem03 */
- myBinarySem03Handle = osSemaphoreNew(1, 1, &myBinarySem03_attributes);
- /* creation of myBinarySem04 */
- myBinarySem04Handle = osSemaphoreNew(1, 1, &myBinarySem04_attributes);
- /* creation of myBinarySem05 */
- myBinarySem05Handle = osSemaphoreNew(1, 1, &myBinarySem05_attributes);
- /* creation of myBinarySem06 */
- myBinarySem06Handle = osSemaphoreNew(1, 1, &myBinarySem06_attributes);
- /* creation of myBinarySem07 */
- myBinarySem07Handle = osSemaphoreNew(1, 1, &myBinarySem07_attributes);
- /* creation of myBinarySem08 */
- myBinarySem08Handle = osSemaphoreNew(1, 1, &myBinarySem08_attributes);
- /* creation of myCountingSem01 */
- myCountingSem01Handle = osSemaphoreNew(2, 2, &myCountingSem01_attributes);
- /* creation of myCountingSem02 */
- myCountingSem02Handle = osSemaphoreNew(2, 2, &myCountingSem02_attributes);
- /* creation of myCountingSem03 */
- myCountingSem03Handle = osSemaphoreNew(2, 2, &myCountingSem03_attributes);
- /* creation of myCountingSem04 */
- myCountingSem04Handle = osSemaphoreNew(2, 2, &myCountingSem04_attributes);
- /* USER CODE BEGIN RTOS_SEMAPHORES */
- /* add semaphores, ... */
- /* USER CODE END RTOS_SEMAPHORES */
- /* Create the timer(s) */
- /* creation of myTimer01 */
- myTimer01Handle = osTimerNew(Callback01, osTimerPeriodic, NULL, &myTimer01_attributes);
- /* creation of myTimer02 */
- myTimer02Handle = osTimerNew(Callback02, osTimerPeriodic, NULL, &myTimer02_attributes);
- /* creation of myTimer03 */
- myTimer03Handle = osTimerNew(Callback03, osTimerPeriodic, NULL, &myTimer03_attributes);
- /* creation of myTimer04 */
- myTimer04Handle = osTimerNew(Callback04, osTimerPeriodic, NULL, &myTimer04_attributes);
- /* creation of myTimer05 */
- myTimer05Handle = osTimerNew(Callback05, osTimerPeriodic, NULL, &myTimer05_attributes);
- /* creation of myTimer06 */
- myTimer06Handle = osTimerNew(Callback06, osTimerPeriodic, NULL, &myTimer06_attributes);
- /* creation of myTimer07 */
- myTimer07Handle = osTimerNew(Callback07, osTimerPeriodic, NULL, &myTimer07_attributes);
- /* creation of myTimer08 */
- myTimer08Handle = osTimerNew(Callback08, osTimerPeriodic, NULL, &myTimer08_attributes);
- /* creation of myTimer09 */
- myTimer09Handle = osTimerNew(Callback09, osTimerPeriodic, NULL, &myTimer09_attributes);
- /* creation of myTimer10 */
- myTimer10Handle = osTimerNew(Callback010, osTimerPeriodic, NULL, &myTimer10_attributes);
- /* USER CODE BEGIN RTOS_TIMERS */
- /* start timers, add new ones, ... */
- /* USER CODE END RTOS_TIMERS */
- /* Create the queue(s) */
- /* creation of myQueue01 */
- myQueue01Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue01_attributes);
- /* creation of myQueue02 */
- myQueue02Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue02_attributes);
- /* creation of myQueue03 */
- myQueue03Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue03_attributes);
- /* creation of myQueue04 */
- myQueue04Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue04_attributes);
- /* creation of myQueue05 */
- myQueue05Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue05_attributes);
- /* creation of myQueue06 */
- myQueue06Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue06_attributes);
- /* USER CODE BEGIN RTOS_QUEUES */
- /* add queues, ... */
- /* USER CODE END RTOS_QUEUES */
- /* Create the thread(s) */
- /* creation of defaultTask */
- defaultTaskHandle = osThreadNew(StartDefaultTask, NULL, &defaultTask_attributes);
- /* creation of myTask02 */
- myTask02Handle = osThreadNew(StartTask02, NULL, &myTask02_attributes);
- /* creation of myTask03 */
- myTask03Handle = osThreadNew(StartTask03, NULL, &myTask03_attributes);
- /* creation of myTask04 */
- myTask04Handle = osThreadNew(StartTask04, NULL, &myTask04_attributes);
- /* creation of myTask05 */
- myTask05Handle = osThreadNew(StartTask05, NULL, &myTask05_attributes);
- /* creation of myTask06 */
- myTask06Handle = osThreadNew(StartTask06, NULL, &myTask06_attributes);
- /* creation of myTask07 */
- myTask07Handle = osThreadNew(StartTask07, NULL, &myTask07_attributes);
- /* creation of myTask08 */
- myTask08Handle = osThreadNew(StartTask08, NULL, &myTask08_attributes);
- /* creation of myTask09 */
- myTask09Handle = osThreadNew(StartTask09, NULL, &myTask09_attributes);
- /* creation of myTask10 */
- myTask10Handle = osThreadNew(StartTask10, NULL, &myTask10_attributes);
- /* creation of myTask11 */
- myTask11Handle = osThreadNew(StartTask11, NULL, &myTask11_attributes);
- /* creation of myTask12 */
- myTask12Handle = osThreadNew(StartTask12, NULL, &myTask12_attributes);
- /* USER CODE BEGIN RTOS_THREADS */
- /* add threads, ... */
- /* USER CODE END RTOS_THREADS */
- /* creation of myEvent01 */
- myEvent01Handle = osEventFlagsNew(&myEvent01_attributes);
- /* creation of myEvent02 */
- myEvent02Handle = osEventFlagsNew(&myEvent02_attributes);
- /* creation of myEvent03 */
- myEvent03Handle = osEventFlagsNew(&myEvent03_attributes);
- /* creation of myEvent04 */
- myEvent04Handle = osEventFlagsNew(&myEvent04_attributes);
- /* creation of myEvent05 */
- myEvent05Handle = osEventFlagsNew(&myEvent05_attributes);
- /* creation of myEvent06 */
- myEvent06Handle = osEventFlagsNew(&myEvent06_attributes);
- /* creation of myEvent07 */
- myEvent07Handle = osEventFlagsNew(&myEvent07_attributes);
- /* creation of myEvent08 */
- myEvent08Handle = osEventFlagsNew(&myEvent08_attributes);
- /* USER CODE BEGIN RTOS_EVENTS */
- /* add events, ... */
- /* USER CODE END RTOS_EVENTS */
- /* Start scheduler */
- osKernelStart();
- /* We should never get here as control is now taken by the scheduler */
- /* Infinite loop */
- /* USER CODE BEGIN WHILE */
- while (1)
- {
-
-
-
- }
- /* USER CODE END WHILE */
- /* USER CODE BEGIN 3 */
- /* USER CODE END 3 */
- }
- /**
- * @brief System Clock Configuration
- * @retval None
- */
- void SystemClock_Config(void)
- {
- RCC_OscInitTypeDef RCC_OscInitStruct = {0};
- RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
- /** Initializes the RCC Oscillators according to the specified parameters
- * in the RCC_OscInitTypeDef structure.
- */
- RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
- RCC_OscInitStruct.HSEState = RCC_HSE_ON;
- RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
- RCC_OscInitStruct.HSIState = RCC_HSI_ON;
- RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
- RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
- RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
- if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
- {
- Error_Handler();
- }
- /** Initializes the CPU, AHB and APB buses clocks
- */
- RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
- |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
- RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
- RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
- RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
- RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
- if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
- {
- Error_Handler();
- }
- }
- /**
- * @brief NVIC Configuration.
- * @retval None
- */
- static void MX_NVIC_Init(void)
- {
- /* USART3_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(USART3_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(USART3_IRQn);
- /* USART1_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(USART1_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(USART1_IRQn);
- /* USART2_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(USART2_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(USART2_IRQn);
- /* TIM4_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(TIM4_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(TIM4_IRQn);
- /* TIM1_UP_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(TIM1_UP_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(TIM1_UP_IRQn);
- /* DMA1_Channel6_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(DMA1_Channel6_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(DMA1_Channel6_IRQn);
- /* DMA1_Channel5_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(DMA1_Channel5_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(DMA1_Channel5_IRQn);
- /* DMA1_Channel3_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(DMA1_Channel3_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(DMA1_Channel3_IRQn);
- }
- /**
- * @brief CRC Initialization Function
- * @param None
- * @retval None
- */
- static void MX_CRC_Init(void)
- {
- /* USER CODE BEGIN CRC_Init 0 */
- /* USER CODE END CRC_Init 0 */
- /* USER CODE BEGIN CRC_Init 1 */
- /* USER CODE END CRC_Init 1 */
- hcrc.Instance = CRC;
- if (HAL_CRC_Init(&hcrc) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN CRC_Init 2 */
- /* USER CODE END CRC_Init 2 */
- }
- /**
- * @brief DAC Initialization Function
- * @param None
- * @retval None
- */
- static void MX_DAC_Init(void)
- {
- /* USER CODE BEGIN DAC_Init 0 */
- /* USER CODE END DAC_Init 0 */
- DAC_ChannelConfTypeDef sConfig = {0};
- /* USER CODE BEGIN DAC_Init 1 */
- /* USER CODE END DAC_Init 1 */
- /** DAC Initialization
- */
- hdac.Instance = DAC;
- if (HAL_DAC_Init(&hdac) != HAL_OK)
- {
- Error_Handler();
- }
- /** DAC channel OUT2 config
- */
- sConfig.DAC_Trigger = DAC_TRIGGER_SOFTWARE;
- sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
- if (HAL_DAC_ConfigChannel(&hdac, &sConfig, DAC_CHANNEL_2) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN DAC_Init 2 */
- /* USER CODE END DAC_Init 2 */
- }
- /**
- * @brief TIM1 Initialization Function
- * @param None
- * @retval None
- */
- static void MX_TIM1_Init(void)
- {
- /* USER CODE BEGIN TIM1_Init 0 */
- /* USER CODE END TIM1_Init 0 */
- TIM_ClockConfigTypeDef sClockSourceConfig = {0};
- TIM_MasterConfigTypeDef sMasterConfig = {0};
- /* USER CODE BEGIN TIM1_Init 1 */
- /* USER CODE END TIM1_Init 1 */
- htim1.Instance = TIM1;
- htim1.Init.Prescaler = 0;
- htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
- htim1.Init.Period = 65535;
- htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV4;
- htim1.Init.RepetitionCounter = 0;
- htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
- if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
- {
- Error_Handler();
- }
- sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
- if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
- {
- Error_Handler();
- }
- sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
- sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
- if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN TIM1_Init 2 */
- /* USER CODE END TIM1_Init 2 */
- }
- /**
- * @brief TIM4 Initialization Function
- * @param None
- * @retval None
- */
- static void MX_TIM4_Init(void)
- {
- /* USER CODE BEGIN TIM4_Init 0 */
- /* USER CODE END TIM4_Init 0 */
- TIM_ClockConfigTypeDef sClockSourceConfig = {0};
- TIM_MasterConfigTypeDef sMasterConfig = {0};
- /* USER CODE BEGIN TIM4_Init 1 */
- /* USER CODE END TIM4_Init 1 */
- htim4.Instance = TIM4;
- htim4.Init.Prescaler = 0;
- htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
- htim4.Init.Period = 65535;
- htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
- htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
- if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
- {
- Error_Handler();
- }
- sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
- if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
- {
- Error_Handler();
- }
- sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
- sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
- if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN TIM4_Init 2 */
- /* USER CODE END TIM4_Init 2 */
- }
- /**
- * @brief UART5 Initialization Function
- * @param None
- * @retval None
- */
- static void MX_UART5_Init(void)
- {
- /* USER CODE BEGIN UART5_Init 0 */
- /* USER CODE END UART5_Init 0 */
- /* USER CODE BEGIN UART5_Init 1 */
- /* USER CODE END UART5_Init 1 */
- huart5.Instance = UART5;
- huart5.Init.BaudRate = 115200;
- huart5.Init.WordLength = UART_WORDLENGTH_8B;
- huart5.Init.StopBits = UART_STOPBITS_1;
- huart5.Init.Parity = UART_PARITY_NONE;
- huart5.Init.Mode = UART_MODE_TX_RX;
- huart5.Init.HwFlowCtl = UART_HWCONTROL_NONE;
- huart5.Init.OverSampling = UART_OVERSAMPLING_16;
- if (HAL_UART_Init(&huart5) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN UART5_Init 2 */
- /* USER CODE END UART5_Init 2 */
- }
- /**
- * @brief USART1 Initialization Function
- * @param None
- * @retval None
- */
- static void MX_USART1_UART_Init(void)
- {
- /* USER CODE BEGIN USART1_Init 0 */
- extern uint8_t USART1_RX_BUF[Uart1_BUF_SIZE];
- /* USER CODE END USART1_Init 0 */
- /* USER CODE BEGIN USART1_Init 1 */
- /* USER CODE END USART1_Init 1 */
- huart1.Instance = USART1;
- huart1.Init.BaudRate = 9600;
- huart1.Init.WordLength = UART_WORDLENGTH_8B;
- huart1.Init.StopBits = UART_STOPBITS_1;
- huart1.Init.Parity = UART_PARITY_NONE;
- huart1.Init.Mode = UART_MODE_TX_RX;
- huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
- huart1.Init.OverSampling = UART_OVERSAMPLING_16;
- if (HAL_UART_Init(&huart1) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN USART1_Init 2 */
-
- __HAL_UART_ENABLE_IT(&huart1, UART_IT_IDLE);
-
- HAL_UART_Receive_DMA(&huart1,USART1_RX_BUF,Uart1_BUF_SIZE);
- /* USER CODE END USART1_Init 2 */
- }
- /**
- * @brief USART2 Initialization Function
- * @param None
- * @retval None
- */
- static void MX_USART2_UART_Init(void)
- {
- /* USER CODE BEGIN USART2_Init 0 */
- /* USER CODE END USART2_Init 0 */
- /* USER CODE BEGIN USART2_Init 1 */
- /* USER CODE END USART2_Init 1 */
- huart2.Instance = USART2;
- huart2.Init.BaudRate = 19200;//19200
- huart2.Init.WordLength = UART_WORDLENGTH_8B;
- huart2.Init.StopBits = UART_STOPBITS_1;
- huart2.Init.Parity = UART_PARITY_NONE;
- huart2.Init.Mode = UART_MODE_TX_RX;
- huart2.Init.HwFlowCtl = UART_HWCONTROL_NONE;
- huart2.Init.OverSampling = UART_OVERSAMPLING_16;
- if (HAL_UART_Init(&huart2) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN USART2_Init 2 */
- __HAL_UART_ENABLE_IT(&huart2, UART_IT_IDLE);
-
-
-
- HAL_UART_Receive_DMA(&huart2,USART2_RX_BUF,Uart2_BUF_SIZE);
- /* USER CODE END USART2_Init 2 */
- }
- /**
- * @brief USART3 Initialization Function
- * @param None
- * @retval None
- */
- static void MX_USART3_UART_Init(void)
- {
- /* USER CODE BEGIN USART3_Init 0 */
- /* USER CODE END USART3_Init 0 */
- /* USER CODE BEGIN USART3_Init 1 */
- /* USER CODE END USART3_Init 1 */
- huart3.Instance = USART3;
- huart3.Init.BaudRate = 9600;
- huart3.Init.WordLength = UART_WORDLENGTH_8B;
- huart3.Init.StopBits = UART_STOPBITS_1;
- huart3.Init.Parity = UART_PARITY_NONE;
- huart3.Init.Mode = UART_MODE_TX_RX;
- huart3.Init.HwFlowCtl = UART_HWCONTROL_NONE;
- huart3.Init.OverSampling = UART_OVERSAMPLING_16;
- if (HAL_UART_Init(&huart3) != HAL_OK)
- {
- Error_Handler();
- }
- /* USER CODE BEGIN USART3_Init 2 */
-
-
- __HAL_UART_ENABLE_IT(&huart3, UART_IT_IDLE);
- HAL_UART_Receive_DMA(&huart3,USART3_RX_BUF,Uart3_BUF_SIZE);
- /* USER CODE END USART3_Init 2 */
- }
- /**
- * Enable DMA controller clock
- */
- static void MX_DMA_Init(void)
- {
- /* DMA controller clock enable */
- __HAL_RCC_DMA1_CLK_ENABLE();
- __HAL_RCC_DMA2_CLK_ENABLE();
- /* DMA interrupt init */
- /* DMA1_Channel4_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(DMA1_Channel4_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(DMA1_Channel4_IRQn);
- /* DMA2_Channel4_5_IRQn interrupt configuration */
- HAL_NVIC_SetPriority(DMA2_Channel4_5_IRQn, 5, 0);
- HAL_NVIC_EnableIRQ(DMA2_Channel4_5_IRQn);
- }
- /**
- * @brief GPIO Initialization Function
- * @param None
- * @retval None
- */
- static void MX_GPIO_Init(void)
- {
- GPIO_InitTypeDef GPIO_InitStruct = {0};
- /* GPIO Ports Clock Enable */
- __HAL_RCC_GPIOD_CLK_ENABLE();
- __HAL_RCC_GPIOA_CLK_ENABLE();
- __HAL_RCC_GPIOB_CLK_ENABLE();
- __HAL_RCC_GPIOC_CLK_ENABLE();
- /*Configure GPIO pin Output Level */
- HAL_GPIO_WritePin(GPIOA, LED1_Pin|LED2_Pin|con03_uart2_kongzhiqi_Pin, GPIO_PIN_RESET);
- /*Configure GPIO pin Output Level */
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin|Con01_uart1_rankonggai_Pin, GPIO_PIN_RESET);
- /*Configure GPIO pin Output Level */
- HAL_GPIO_WritePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin, GPIO_PIN_RESET);
-
- /*Configure GPIO pins : LED1_Pin LED2_Pin con03_uart2_kongzhiqi_Pin */
- GPIO_InitStruct.Pin = LED1_Pin|LED2_Pin|con03_uart2_kongzhiqi_Pin;
- GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
- GPIO_InitStruct.Pull = GPIO_NOPULL;
- GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
- HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
- /*Configure GPIO pins : con02_uart3_xieyoufa_Pin Con01_uart1_rankonggai_Pin */
- GPIO_InitStruct.Pin = con02_uart3_xieyoufa_Pin|Con01_uart1_rankonggai_Pin;
- GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
- GPIO_InitStruct.Pull = GPIO_NOPULL;
- GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
- HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
- /*Configure GPIO pins : IN01_Pin PB15 */
- GPIO_InitStruct.Pin = GPIO_PIN_14|GPIO_PIN_15;
- GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
- GPIO_InitStruct.Pull = GPIO_NOPULL;
- HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
- /*Configure GPIO pins : PC6 PC7 PC8 PC9 */
- GPIO_InitStruct.Pin = GPIO_PIN_6|GPIO_PIN_7|GPIO_PIN_8|GPIO_PIN_9;
- GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
- GPIO_InitStruct.Pull = GPIO_NOPULL;
- HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
- /*Configure GPIO pins : PA8 PA11 */
- GPIO_InitStruct.Pin = GPIO_PIN_8|GPIO_PIN_11;
- GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
- GPIO_InitStruct.Pull = GPIO_NOPULL;
- HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
- /*Configure GPIO pin : WDI_sp706_kanmemgou_Pin */
- GPIO_InitStruct.Pin = WDI_sp706_kanmemgou_Pin;
- if(WatchDogOn)//打开看门狗sp706
- //if(1)//打开看门狗sp706
- {
- //
- GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
-
- }
- else
- {
- GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
-
- }
- GPIO_InitStruct.Pull = GPIO_NOPULL;
- GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
- HAL_GPIO_Init(WDI_sp706_kanmemgou_GPIO_Port, &GPIO_InitStruct);
- }
- /* USER CODE BEGIN 4 */
- /**
- * @funNm : delay_sys_us
- * @brief : 延时nus
- * @param : nus:要延时的us数. 0~204522252(最大值即2^32/fac_us@fac_us=168)
- * @retval: void
- */
- void delay_sys_us(uint32_t Delay)//1个delay,大概1.5us
- {
- uint32_t cnt = Delay * 8;
- uint32_t i = 0;
- for(i = 0; i < cnt; i++)__NOP();
- }
- /* USER CODE END 4 */
- /* USER CODE BEGIN Header_StartDefaultTask */
- /**
- * @brief Function implementing the defaultTask thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartDefaultTask */
- void StartDefaultTask(void *argument)
- {
- /* USER CODE BEGIN 5 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(1);
- }
- /* USER CODE END 5 */
- }
- /* USER CODE BEGIN Header_StartTask02 */
- /**
- * @brief Function implementing the myTask02 thread.
- * @param argument: Not used
- * @retval None
- */
- uint8_t Flash_Change = 0; //定义接收数组
- uni_float tprture001,tprture002,tprture003,Yewei001,tprtureAver;
- /* USER CODE END Header_StartTask02 */
- /*
- //发送卸油阀传感器命令轮询
- //发送角度传感器命令轮询
- //发送壁挂油传感器命令轮询
- //发送智能海底阀传感器命令轮询
- //发送油气回收传感器命令轮询
- */
- void StartTask02(void *argument) //卸油阀总线传感器命令轮询 UART3
- {
- /* USER CODE BEGIN StartTask02 */
- uint8_t i001=0,i002 = 0;
- uint16_t ModbusCRC = 0,xyfaddr_max = 0,hdfaddr_max; //xyfaddr_max:卸油阀最高地址,根据每仓卸油阀之和计算得出
- static uint16_t i = 0,j = 0,receive_error = 0;
- HDF_Inf* phdf = hdf_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- XYF_Inf* pxyf = xyf_inf;
- Cang_Inf* pcang = &cang_inf;
- Angle_Inf* pangle = &angle_inf;
- Pressure_Inf* pPressure = pressure_inf;
- uint8_t pressureaddr_max = 0;
-
- xyfaddr_max=0;
- hdfaddr_max=0;
- for(i = 0;i < pcang->Cang_Num;i++)
- {
- xyfaddr_max += pcang->XYF_Num[i];
- hdfaddr_max += pcang->HDF_Num[i];
-
- pressureaddr_max += pcang->Pressure_Num[i];
- }
- i = 0;
-
- extern uint8_t USART2_RX_BUF002[Uart2_BUF_SIZE];
- extern uint8_t USART1_RX_BUF002[Uart2_BUF_SIZE];
- extern uint8_t USART3_RX_BUF002[Uart2_BUF_SIZE];
- extern int data_lengthU2,data_lengthU1,data_lengthU3;
- extern int flagU1Rx,flagU2Rx,flagU3Rx;
- extern uint8_t USART3_RX_BUF002_print[Uart3_BUF_SIZE];
- extern uint8_t XYF_TxBuf[70];
- extern uint16_t Uart_len_TouChuan;
-
- /* Infinite loop */
- for(;;)
- {
- osDelay(10); //以ms为单位
- //HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0);
- HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
- // continue;
- if(Flash_Change) //如果有对Flash进行改动,则重新计算xyfaddr_max
- {
- xyfaddr_max = 0;
- hdfaddr_max = 0;
- pressureaddr_max = 0;
- for(i = 0;i < pcang->Cang_Num;i++)
- {
- xyfaddr_max += pcang->XYF_Num[i];
- hdfaddr_max += pcang->HDF_Num[i];
- pressureaddr_max += pcang->Pressure_Num[i];
- }
- Flash_Change = 0;
- }
-
- if(pkzq->USE_XYF == 0) //平台未控制卸油阀总线,正常轮询数据
- {
- if(i001==0) //发送卸油阀传感器命令轮询
- {
- //pcang->XYF_Type=2;
- if ((pcang->XYF_INSTALL != 0) && (pcang->XYF_Type != 2))
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_XYF, 6);
- CMD_XYF[6] = ModbusCRC >> 8;
- CMD_XYF[7] = ModbusCRC & 0xff;
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_RESET); //
- delay_sys_us(80);
- HAL_UART_Transmit_IT(&huart3, CMD_XYF, 8);
- while (huart3.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_SET); //
- pxyf[CMD_XYF[0] - 0x10].RTData_Num++; //每个传感器发送帧累加
- if (CMD_XYF[0] - 0x10 < xyfaddr_max)
- CMD_XYF[0]++;
- else
- CMD_XYF[0] = 0x11;
- }
- else
- {
- i001 = 3;
- }
- }
- if (i001 == 3) //发送姿态传感器轮询
- {
- if (pcang->Angle) //发送角度传感器命令轮询
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_Angle_XY, 6);
- CMD_Angle_XY[6] = ModbusCRC >> 8;
- CMD_Angle_XY[7] = ModbusCRC & 0xff;
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_RESET);
- delay_sys_us(80);
- HAL_UART_Transmit(&huart3, CMD_Angle_XY, 8, 100); //只支持单指令读角度取传感器数据
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_SET);
- if (pangle->RTData_NumX > RT_ERRORCNT)
- {
- pangle->RTData_NumX = RT_ERRORCNT;
- pangle->Angle_ErrorCnt = RT_ERRORCNT;
- }
- else
- pangle->RTData_NumX++;
- }
- else
- {
- i001 = 6;
- }
- }
- if(i001==6) //发送壁挂油传感器命令轮询
- {
- if(pcang->BGY_INSTALL)
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_Biguayou,6);
- CMD_Biguayou[6] = ModbusCRC>>8;
- CMD_Biguayou[7] = ModbusCRC&0xff;
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);
- delay_sys_us(80);
- HAL_UART_Transmit(&huart3,CMD_Biguayou,8,100); //只支持单指令读角度取传感器数据
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);
- }
- else
- {
- i001=9;
- }
- }
- if (i001 == 9) //发送智能海底阀传感器命令轮询
- {
- if (pcang->HDF_INSTALL != 0 && pcang->HDF_Type)
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_HDF, 14);
- CMD_HDF[14] = ModbusCRC >> 8;
- CMD_HDF[15] = ModbusCRC & 0xff;
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_RESET);
- delay_sys_us(80);
- HAL_UART_Transmit(&huart3, CMD_HDF, 16, 100); //只支持单指令读角度取传感器数据
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_SET);
- if (phdf[CMD_HDF[0] - 0x20].RTData_Num > 50) //收发数据错误次数RT_ERRORCNT
- {
- // phdf[CMD_HDF[0]-0x20].RTData_Num = RT_ERRORCNT;
- // phdf[CMD_HDF[0]-0x20].HDF_ErrorCnt = RT_ERRORCNT;
- }
- else
- phdf[CMD_HDF[0] - 0x20].RTData_Num++; //每个传感器发送帧累加
- if (CMD_HDF[0] - 0x21 < hdfaddr_max)
- CMD_HDF[0]++;
- else
- CMD_HDF[0] = 0x21;
- }
- else
- {
- i001 = 12;
- }
- }
- if(i001==12) //发送油气回收传感器命令轮询
- {
- if(pcang->YQHS)
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_YQHS,6);
- CMD_YQHS[6] = ModbusCRC>>8;
- CMD_YQHS[7] = ModbusCRC&0xff;
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);
- delay_sys_us(80);
- HAL_UART_Transmit(&huart3,CMD_YQHS,8,100); //只支持单指令读角度取传感器数据
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);
- }
- else
- {
- i001=15;
- }
- }
-
- if(i001 == 15){
-
- if(Pressure_FST800_801 == pcang->Pressure){
-
- ModbusCRC = LIB_CRC_MODBUS(CMD_Pressure, 6);
- CMD_Pressure[6] = ModbusCRC >> 8;
- CMD_Pressure[7] = ModbusCRC & 0xff;
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_RESET);
- delay_sys_us(80);
- HAL_UART_Transmit(&huart3, CMD_Pressure, 8, 200); //只支持单指令读角度取传感器数据
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_SET);
- pPressure[CMD_Pressure[0] - PRESSURE_STARTADDR].RTData_Num++; //每个传感器发送帧累加
- if (CMD_Pressure[0] - PRESSURE_STARTADDR +1 < pressureaddr_max)
- CMD_Pressure[0]++;
- else
- CMD_Pressure[0] = PRESSURE_STARTADDR;
-
-
- }else{
- i001=0;
- continue;
- }
-
- }
- }
- else //平台通过卸油阀总线直接操作传感器
- {
- if(i002 == 3)
- {
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- #if 0
- if((XYF_TxBuf[0] == 0x0D)&&(XYF_TxBuf[0] == 0x0A))
- HAL_UART_Transmit(&huart3,XYF_TxBuf,12,100);
- else
- HAL_UART_Transmit(&huart3,XYF_TxBuf,8,100);
- delay_sys_us(80);
- #else
- HAL_UART_Transmit_IT(&huart3,XYF_TxBuf,Uart_len_TouChuan);
- while (huart3.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- #endif
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET); //
- }
- else if(i002 == 0x06)
- {
- #if 0
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- HAL_UART_Transmit(&huart3,ALL_TxBuf,16,100);
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//
- }
- else if(i002 == 0x09)//slm 0x0c
- {
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- HAL_UART_Transmit(&huart3,ALL_TxBuf,Uart_len_TouChuan,100);
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//
- #endif
- pkzq->USE_XYF = 0;
- i002 = 0;
- }
- i002++;
- if((flagU3Rx==1) && (i002 > 3))
- {
- pkzq->USE_XYF = 0;
- i002 = 0;
- continue;
- }
- }
-
- //来自UART3的命令 电路板上标志位卸油阀
- if(flagU3Rx==1)
- {
- flagU3Rx=0;
- #if 0
- if(USART3_RX_BUF002[0]!=0x11)
- {
- pxyf[1].XYF_ErrorCnt++;
- if(pxyf[1].XYF_ErrorCnt>35)
- {
- pxyf[1].XYF_Error = 1;
- }
- }
-
- if(USART3_RX_BUF002[0]!=0x12)
- {
- pxyf[2].XYF_ErrorCnt++;
- if(pxyf[2].XYF_ErrorCnt>35)
- {
- pxyf[2].XYF_Error = 1;
- }
- }
- #endif
- if(USART3_RX_BUF002[0] >= 0x10 && USART3_RX_BUF002[0] <= 0x1F) //卸油阀数据
- {
- ModbusCRC = USART3_RX_BUF002[5]<<8;
- ModbusCRC |= USART3_RX_BUF002[6];
- //pxyf[USART3_RX_BUF002[0]-0x10].RTData_Num = 1;
- if(USART3_RX_BUF002[1]!=0x03&&USART3_RX_BUF002[1]!=0x06) //校验读写属性
- {
- receive_error = 1;
- }
- else if(USART3_RX_BUF002[2] != 0x02) //校验数据长度
- {
- receive_error = 1;
- }
- else if(ModbusCRC != LIB_CRC_MODBUS(USART3_RX_BUF002,5)) //校验CRC
- {
- receive_error = 1;
- }
-
- if(receive_error == 0)
- {
- pxyf[USART3_RX_BUF002[0]-0x10].XYF_ErrorCnt = 0;
- pxyf[USART3_RX_BUF002[0]-0x10].XYF_Error = 0;
- if(USART3_RX_BUF002[1] == 0x03) //读取数据返回
- {
- #if 0
- if(USART3_RX_BUF002[3]>0x01)//阀门开关状态
- {
- pxyf[i].XYF_ErrorCnt++;
- }
- else if(i < XYF_BUF_DEP)
- {
-
- i++;
- }
- if(i == XYF_BUF_DEP)
- {
- i = 0;
- }
- #else
- pxyf[USART3_RX_BUF002[0] - 0x10].XYF_Data1[0] = USART3_RX_BUF002[3];
- //pxyf[USART3_RX_BUF002[0] - 0x10].XYF_Data2[0] = USART3_RX_BUF002[4];
- pxyf[USART3_RX_BUF002[0] - 0x10].XYF_Data2[0] = 0xFF; //泄尽状态,比IO 输入获取
- #endif
- XYF_state(USART3_RX_BUF002[0] - 0x10);
-
- }
- else if(USART3_RX_BUF002[1] == 0x06) //写入数据返回 判断写入是否成功
- {
- //清除控制器占用标志
- //整理卸油阀协议后添加
- }
- i001=12;
- //continue;
- }
- }
- else if(USART3_RX_BUF002[0] >=0x70 && USART3_RX_BUF002[0] <= 0x7f) //姿态数据,目前最多支持3轴
- {
- ModbusCRC = USART3_RX_BUF002[7]<<8;
- ModbusCRC |= USART3_RX_BUF002[8];
- pangle->RTData_NumX = 1;
- if(USART3_RX_BUF002[1]!=0x03&&USART3_RX_BUF002[1]!=0x06) //校验读写属性
- {
- receive_error = 1;
- }
- else if(USART3_RX_BUF002[2] >= 0x08) //校验数据长度
- {
- receive_error = 1;
- }
- else if(ModbusCRC != LIB_CRC_MODBUS(USART3_RX_BUF002,USART3_RX_BUF002[2]+3)) //校验CRC
- {
- //receive_error = 1;
- }
-
- if(receive_error == 0)
- {
- if(USART3_RX_BUF002[1] ==0x03)
- {
- if(j < ANGLE_BUF_DEP)
- {
- pangle->Angle_ErrorCnt = 0;
- //if(USART3_RX_BUF002[2] == 0x02)
- pangle->Angle_DataX[j] = USART3_RX_BUF002[3]<<8|USART3_RX_BUF002[4];
- //if(USART3_RX_BUF002[2] > 0x02)
- pangle->Angle_DataY[j] = USART3_RX_BUF002[5]<<8|USART3_RX_BUF002[6];
- // if(USART3_RX_BUF002[2] > 0x04)
- pangle->Angle_DataZ[j] = USART3_RX_BUF002[7]<<8|USART3_RX_BUF002[8];
- j++;
- }
- if(j == ANGLE_BUF_DEP)
- {
- j = 0;
- }
- }
- else
- {
-
- //整理卸油阀协议后添加
-
- }
-
- i001=6;
- continue;
- }
- }
- else if(USART3_RX_BUF002[0] >= 0x20 && USART3_RX_BUF002[0] <= 0x2F ) //智能海底阀数据
- {
-
- Get_ZN_hdf_data();
- i001 = 12;
- continue;
-
- }
- else if(USART3_RX_BUF002[0] == 0xe4) //油气回收数据
- {
- Get_Yqhuishou_data();
- i001 = 15;
- continue;
- }
- else if(USART3_RX_BUF002[0] >= 0x81 && USART3_RX_BUF002[0] <= 0x8F) //壁挂油数据
- {
- Get_Biguayou_data();
- i001 = 9;
- continue;
- }else if(USART3_RX_BUF002[0] >= 0x91 && USART3_RX_BUF002[0] <= 0x9F)
- {
- if(0 == Prase_Pressure(USART3_RX_BUF002, 9)){
- //i001 = 0;
- //continue;
- }
- }
- receive_error = 0;
-
- }
- else
- {
- if (i001 == 2)
- {
- if(CMD_XYF[0] == 0x11)
- {
- i = xyfaddr_max;
- }
- else
- {
- i = CMD_XYF[0] - 0x11;
- }
- pxyf[i].XYF_ErrorCnt++;
- if (pxyf[i].XYF_ErrorCnt > pcang->sensorBusMaxReTry)
- {
- pxyf[i].XYF_ErrorCnt = pcang->sensorBusMaxReTry + 1;
- pxyf[i].XYF_Error = 1;
- }
- }
- }
-
-
- if(i001< 18)
- i001++;
- else
- i001 = 0;
- osDelay(40);
- }
- /* USER CODE END StartTask02 */
- }
- /* USER CODE BEGIN Header_StartTask03 */
- /**
- * @brief Function implementing the myTask03 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask03 */
- /*
- //发送华天三点式温度传感器命令轮询
- //发送人控大盖盖命令轮询
- //雷达液位传感器命令
- //发送小盖传感器轮询
- //发送磁致伸缩液位计命令轮询
- ?
- */
- #include "rkg.h"
- void StartTask03(void *argument) //人孔盖总线传感器 UART1
- {
- /* USER CODE BEGIN StartTask03 */
- /* Infinite loop */
- /* USER CODE BEGIN StartTask02 */
- static uint8_t i001=0,i002 = 0,i003 = 0,receive_error = 0;
- uint16_t rkgaddr_max = 0,temaddr_max = 0,leveladdr_max = 0,RKG_angle = 0;
- static uint16_t i = 0,rkdg_cnt = 0,rkxg_cnt = 0,level_cnt = 0,tem_cnt = 0,temp_dot_cnt=0,temp_dot_dex=0,ModbusCRC = 0,ModbusCRC1 = 0;
- uint16_t rx_len,head = 0;
- S_ANGLEDATA* psATsk3 = gs_AngleData;
- KZQ_Inf* pkzq = &kzq_inf;
- RKG_Inf* prkg = rkg_inf;
- Cang_Inf* pcang = &cang_inf;
- Level_Inf* plevel = level_inf;
- Tem_Inf* ptem = tem_inf;
- Pressure_Inf* pPressure = pressure_inf;
- typedef union{
- float QDGH_data_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- static Hex_to_float hex_to_float;
- uint8_t pressureaddr_max = 0;
- leveladdr_max=0;
- if(pcang->Temperture==2)
- pcang->Temperture=3;
- for(i = 0;i < pcang->Cang_Num;i++)
- {
- rkgaddr_max += pcang->RKG_Num[i];
- pressureaddr_max += pcang->Pressure_Num[i]; //人孔盖最大地址
- leveladdr_max++;
- temaddr_max++;
- }
- /*if(pcang->RKG_Type==0)
- {
- rkgaddr_max += 1;
- }*/
- i = 0;
-
-
- extern uint8_t USART1_RX_BUF002[Uart2_BUF_SIZE];
- extern int data_lengthU1;
- extern int flagU1Rx;
- extern uint8_t USART1_RX_BUF002_print[Uart1_BUF_SIZE];
- /* Infinite loop */
- for(;;)
- {
- osDelay(10); //以ms为单位
- //HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0); //已经移至task12 500ms闪烁 邵磊明修改
- HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
- if(Flash_Change)
- {
- rkgaddr_max = 0;
- leveladdr_max=0;
- temaddr_max = 0;
- pressureaddr_max = 0;
- if(pcang->Temperture==2)
- pcang->Temperture=3;
- for(i = 0;i < pcang->Cang_Num;i++)
- {
- rkgaddr_max += pcang->RKG_Num[i];
- pressureaddr_max += pcang->Pressure_Num[i]; //人孔盖最大地址
- leveladdr_max++;
- temaddr_max++;
- }
- /*if(pcang->RKG_Type==0)
- {
- rkgaddr_max += 1;
- }*/
- Flash_Change = 0;
- }
-
-
-
- if(pkzq->USE_RKG == 0) //平台未控制卸油阀总线,正常轮询数据
- {
- if(i001==0) //发送人控大盖盖命令轮询
- {
- if((pcang->RKG_DG != 0) && (pcang->RKG_Type!=2))
- {
- if(pcang->RKG_Type == 0)
- {
- if(CMD_RKG[0] == 0x1)
- {
- if(i003 >= rkgaddr_max)
- i003 = 0;
- ++i003;
- CMD_RKG[0] = 1+i003*2;
- prkg[i003].RTData_Num++;
- }
- else
- {
- CMD_RKG[0] = 0x1;
- prkg[0].RTData_Num++;
- }
- }
- else
- {
- prkg[CMD_RKG[0] - 0x30].RTData_Num++;
- if(CMD_RKG[0] - 0x30 < rkgaddr_max)
- {
- ++i003;
- CMD_RKG[0]=0x30+i003;
- }
- else
- {
- CMD_RKG[0] = 0x31;
- i003 = 1;
- }
- }
- ModbusCRC = LIB_CRC_MODBUS(CMD_RKG,6);
- CMD_RKG[6] = ModbusCRC>>8;
- CMD_RKG[7] = ModbusCRC&0xff;
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- //if(pcang->RKG_Type == 0x01)
- // HAL_UART_Transmit(&huart1,Data_Head,2,10);
- {
- HAL_UART_Transmit_IT(&huart1,CMD_RKG,8);
- while (huart1.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- } //HAL_UART_Transmit(&huart1,CMD_RKG,8,100);
- //if(pcang->RKG_Type == 0x01)
- // HAL_UART_Transmit(&huart1,Data_Head,2,10);
- //delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
- #if 0
- if(prkg[CMD_RKG[0] - 0x30].RTData_Num > RT_ERRORCNT) //每个传感器每发送一帧 基准角度为0x30
- {
- prkg[CMD_RKG[0] - 0x30].RTData_Num = RT_ERRORCNT;
- prkg[CMD_RKG[0] - 0x30].RKDG_ErrorCnt = RT_ERRORCNT;
- }
- else
- #endif
-
-
- }
- else
- i001 = 3;
- }
-
- if(i001==3) //发送小盖传感器轮询
- {
- if(pcang->RKG_XG == 0x01)
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_RKG_XG,6);
- CMD_RKG_XG[6] = ModbusCRC>>8;
- CMD_RKG_XG[7] = ModbusCRC&0xff;
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- if(pcang->RKG_Type == 0x01)
- HAL_UART_Transmit(&huart1,Data_Head,2,10);
- HAL_UART_Transmit(&huart1,CMD_RKG_XG,8,100);
- if(pcang->RKG_Type == 0x01)
- HAL_UART_Transmit(&huart1,Data_Head,2,10);
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
- if(prkg[CMD_RKG_XG[0]-0x40].RTData_Num > RT_ERRORCNT)
- {
- prkg[CMD_RKG_XG[0]-0x40].RTData_Num = RT_ERRORCNT;
- prkg[CMD_RKG_XG[0]-0x40].RKXG_ErrorCnt = RT_ERRORCNT;
- }
- else
- prkg[CMD_RKG_XG[0]-0x40].RTData_Num++; //每个传感器发送帧累加
- if(CMD_RKG_XG[0] - 0x41 < rkgaddr_max -1)
- CMD_RKG_XG[0]++;
- else
- CMD_RKG_XG[0] = 0x41;
- }
- else
- i001 = 6;
- }
-
- if(i001==6) //发送磁致伸缩液位计命令轮询 邵磊明增加
- {
- if(pcang->Level == LEVEL_CZSS) //磁致伸缩传感器轮询 邵磊明增加
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_GetTempAndYewei,6);
- CMD_GetTempAndYewei[6] = ModbusCRC>>8;
- CMD_GetTempAndYewei[7] = ModbusCRC&0xff;
-
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- //HAL_UART_Transmit(&huart1,CMD_GetTempAndYewei,8,100);
- //delay_sys_us(80);
- HAL_UART_Transmit_IT(&huart1,CMD_GetTempAndYewei,8);
- while (huart1.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
-
- /*if(plevel[CMD_GetTempAndYewei[0]-0x50].RTData_Num > RT_ERRORCNT)
- {
- plevel[CMD_GetTempAndYewei[0]-0x50].RTData_Num = RT_ERRORCNT;
- plevel[CMD_GetTempAndYewei[0]-0x50].Level_ErrorCnt = RT_ERRORCNT;
- }
- else*/
- plevel[CMD_GetTempAndYewei[0]-0x50].RTData_Num++; //每个传感器发送帧累加 基准角度为0x30
- if(CMD_GetTempAndYewei[0]-0x50 < leveladdr_max)
- CMD_GetTempAndYewei[0]++;
- else
- CMD_GetTempAndYewei[0] = 0x51;
- }
- else if(pcang->Level == LEVEL_LDYW) //雷达液位传感器命令轮询 20210818邵增加
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_LDYW,6);
- CMD_LDYW[6] = ModbusCRC>>8;
- CMD_LDYW[7] = ModbusCRC&0xff;
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- //HAL_UART_Transmit(&huart1,CMD_LDYW,8,100);
- //delay_sys_us(80);
- HAL_UART_Transmit_IT(&huart1, CMD_LDYW, 8);
- while (huart1.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- HAL_GPIO_WritePin(GPIOB, Con01_uart1_rankonggai_Pin, GPIO_PIN_SET); //
- /*if (prkg[CMD_RKG[0] - 0x50].RTData_Num > RT_ERRORCNT) //每个传感器每发送一帧 基准角度为0x30
- {
- plevel[CMD_RKG[0] - 0x50].RTData_Num = RT_ERRORCNT;
- plevel[CMD_RKG[0] - 0x50].Level_ErrorCnt = RT_ERRORCNT;
- }
- else*/
- plevel[CMD_LDYW[0] - LEVEL_STARTADDR].RTData_Num++;
- if ((CMD_LDYW[0] - LEVEL_STARTADDR+1) < leveladdr_max)
- CMD_LDYW[0]++;
- else
- CMD_LDYW[0] = LEVEL_STARTADDR;
- }
- else
- i001=9;
- }
-
- if(i001==9) //发送华天三点式温度传感器命令轮询 邵磊明增加
- {
- if(Tem_FST100_611 == pcang->Temperture )
- {
- // taskENTER_CRITICAL();
- ModbusCRC = LIB_CRC_MODBUS(CMD_TemAng,6);
- CMD_TemAng[6] = ModbusCRC>>8;
- CMD_TemAng[7] = ModbusCRC&0xff;
-
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- HAL_UART_Transmit_IT(&huart1,CMD_TemAng,8);
- while (huart1.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- //HAL_UART_Transmit(&huart1,CMD_GetTempHuaTian,8,100);
- //delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
- // taskEXIT_CRITICAL();
- ptem[CMD_TemAng[0] - TEM_STARTADDR].RTData_Num++;
- ptem[CMD_TemAng[0] - TEM_STARTADDR+1].RTData_Num++;
- if((CMD_TemAng[0] - TEM_STARTADDR+1)*2 < temaddr_max)
- CMD_TemAng[0] = CMD_TemAng[0]+1;
- else
- CMD_TemAng[0] = TEM_STARTADDR;
- }else if(Tem_FST100_1007 == pcang->Temperture )
- {
- // taskENTER_CRITICAL();
- ModbusCRC = LIB_CRC_MODBUS(CMD_Temperature,6);
- CMD_Temperature[6] = ModbusCRC>>8;
- CMD_Temperature[7] = ModbusCRC&0xff;
-
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- HAL_UART_Transmit_IT(&huart1,CMD_Temperature,8);
- while (huart1.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- //HAL_UART_Transmit(&huart1,CMD_GetTempHuaTian,8,100);
- //delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
- // taskEXIT_CRITICAL();
- ptem[CMD_Temperature[0] - TEM_STARTADDR].RTData_Num++;
- if((CMD_Temperature[0] - TEM_STARTADDR+1) < temaddr_max)
- CMD_Temperature[0] = CMD_Temperature[0]+1;
- else
- CMD_Temperature[0] = TEM_STARTADDR;
- }else
- {
- i001=12;
-
- }
- }
- if(i001==12){
- if(Pressure_FST100_1007 == pcang->Pressure )
- {
- ModbusCRC = LIB_CRC_MODBUS(CMD_Pressure, 6);
- CMD_Pressure[6] = ModbusCRC >> 8;
- CMD_Pressure[7] = ModbusCRC & 0xff;
- HAL_GPIO_WritePin(GPIOB, Con01_uart1_rankonggai_Pin, GPIO_PIN_RESET);
- delay_sys_us(80);
- HAL_UART_Transmit(&huart1, CMD_Pressure, 8, 200);
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOB, Con01_uart1_rankonggai_Pin, GPIO_PIN_SET);
- pPressure[CMD_Pressure[0] - PRESSURE_STARTADDR].RTData_Num++;
- if (CMD_Pressure[0] - PRESSURE_STARTADDR +1 < pressureaddr_max)
- CMD_Pressure[0]++;
- else
- CMD_Pressure[0] = PRESSURE_STARTADDR;
- }else
- {
- i001=0x0;
- continue;
- }
- }
- }
- else //平台通过卸油阀总线直接操作传感器
- {
- if(i002 == 3)
- {
- extern uint16_t Uart_len_TouChuan;
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- #if 0
- if((RKG_TxBuf[0] == 0x0D)&&(RKG_TxBuf[1] == 0x0A))
- HAL_UART_Transmit(&huart1,RKG_TxBuf,12,100);
- else
- HAL_UART_Transmit(&huart1,RKG_TxBuf,8,100);
- delay_sys_us(80);
- #else
- HAL_UART_Transmit_IT(&huart1,RKG_TxBuf,Uart_len_TouChuan);
- while (huart1.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- #endif
- HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
- flagU1Rx=0;
- }
-
- i002++;
- if(((flagU1Rx==1) && (i002 > 3)) || i002>10)
- {
- pkzq->USE_RKG = 0;
- i002 = 0;
- continue;
- }
- }
-
-
-
- //来自UART1,即人孔盖总线的命令 电路板上标志位人孔盖
- if(flagU1Rx==1)
- {
- flagU1Rx = 0;
- receive_error = 0;
- rx_len = USART1_RX_BUF002[2];
- ModbusCRC = USART1_RX_BUF002[(3+rx_len)]<<8;
- ModbusCRC |= USART1_RX_BUF002[(3+rx_len+1)];
-
- if((USART1_RX_BUF002[head+0] >= 0x30 && USART1_RX_BUF002[head+0] <= 0x3F) || (USART1_RX_BUF002[head+0] >= 0x1 && USART1_RX_BUF002[head+0] <= 0x10)) //人孔大盖数据 地址0x30为基准传感器
- {
- if(USART1_RX_BUF002[head+1]!=0x03&&USART1_RX_BUF002[head+1]!=0x06) //校验读写属性
- {
- receive_error = 1;
- }
- else if(USART1_RX_BUF002[head+2] != 0x04) //校验数据长度
- {
- receive_error = 1;
- }
- else if(ModbusCRC != LIB_CRC_MODBUS(USART1_RX_BUF002,7)) //校验CRC
- {
- receive_error = 1;
- }
- // if((pcang->RKG_Type == 0)&&(USART1_RX_BUF002[head]>=0x30)&&(USART1_RX_BUF002[head] <=0x4F))
- RKG_angle = (USART1_RX_BUF002[head+4]<<8)|USART1_RX_BUF002[head+3];
- // else
- // RKG_angle = (USART1_RX_BUF002[head+3]<<8)|USART1_RX_BUF002[head+4];
- if((USART1_RX_BUF002[head+1] == 0x03)&&(receive_error == 0)) //读取数据返回
- {//童赟 磁电编码 磁编码 人孔盖
- if(USART1_RX_BUF002[head]==1)
- {
- prkg[0].RKDG_ErrorCnt = 0;
- prkg[0].RKDG_Error=0;
- }
- else
- {
- prkg[i003].RKDG_ErrorCnt = 0;
- prkg[i003].RKDG_Error=0;
- }
-
- if(USART1_RX_BUF002[head]==1)
- {
- AGL_AddNewData(RKG_angle,0);
- }
- else
- {
- AGL_AddNewData(RKG_angle,i003);
- }
-
- #if 0
- //邵磊明修改 20211027 从rkg.c剪切到此处
- if(psATsk3[i003].uiDG < 0 ||psATsk3[USART1_RX_BUF002[head]-0x30].uiDG >= 27000)//角度
- {
- prkg[USART1_RX_BUF002[head]-0x30].RKDG_ErrorCnt++;
- }
- #endif
-
- // if( - psATsk3[USART1_RX_BUF002[head]-0x30].uiDG > prkg->RKG_Threshold || psATsk3[USART1_RX_BUF002[head]-0x30].uiDG > prkg->RKG_Threshold)
- // prkg[USART1_RX_BUF002[head]-0x30].RKDG_StateCnt++;
- // else
- // prkg[USART1_RX_BUF002[head]-0x30].RKDG_StateCnt = 0;
-
-
-
- if(pcang->RKG_Type == 0)
- {
- AGL_CalcDeltaAll(USART1_RX_BUF002[head],0);
- }
- #if 0 //倾角大盖计算
- if(rkdg_cnt < RKG_BUF_DEP)
- {
- if(USART1_RX_BUF002[head] == 0x30)
- {
- prkg[USART1_RX_BUF002[head] - 0x30].RKG_JZData[rkdg_cnt] = RKG_angle;
- }
- else
- {
- prkg[USART1_RX_BUF002[head] - 0x30].RKG_DGData[rkdg_cnt] = RKG_angle;
- rkdg_cnt++;
- }
- }
- if(rkdg_cnt == RKG_BUF_DEP)
- {
- rkdg_cnt = 0;
- }
- #endif
- //李伟修改 20211027 从rkg.c剪切到此处;开始
- if (USART1_RX_BUF002[head] != 1)
- {
- if (psATsk3[i003].uiDG >= 0 || psATsk3[i003].uiDG <= 27000) //角度
- {
- if (-psATsk3[i003].uiDG > prkg->RKG_Threshold || psATsk3[i003].uiDG > prkg->RKG_Threshold)
- prkg[i003].RKDG_StateCnt++;
- else
- prkg[i003].RKDG_StateCnt = 0;
- if (prkg[i003].RKDG_StateCnt >= prkg[i003].RKG_StateKeepNum)
- {
- // RisingEdge++;
- prkg[i003].RKDG_StateCnt = prkg[i003].RKG_StateKeepNum;
- prkg[i003].RKDG_State = 1;
- }
- else
- {
- prkg[i003].RKDG_State = 0;
- }
- }
- }
- //李伟修改 20211027 从rkg.c剪切到此处;开始
- i001 = 3;
- continue;
- }
- }
- else if(USART1_RX_BUF002[head+0] >= 0x40 && USART1_RX_BUF002[head+0] <= 0x4F) //人孔小盖数据 地址0x30为基准传感器
- {
- prkg[USART1_RX_BUF002[head] - 0x30].RKXG_ErrorCnt = 0;
- prkg[USART1_RX_BUF002[head+0]-0x40].RTData_Num = 1;
- if(USART1_RX_BUF002[head+1]!=0x03&&USART1_RX_BUF002[head+1]!=0x06) //校验读写属性
- {
- receive_error = 1;
- }
- else if(USART1_RX_BUF002[head+2] != 0x04) //校验数据长度
- {
- receive_error = 1;
- }
- else if(ModbusCRC != LIB_CRC_MODBUS(USART1_RX_BUF002,7)) //校验CRC
- {
- receive_error = 1;
- }
- if((USART1_RX_BUF002[head+1] == 0x03)&&(receive_error == 0)) //读取数据返回
- {
- AGL_AddNewData((USART1_RX_BUF002[head+3]<<8)|USART1_RX_BUF002[head+4],USART1_RX_BUF002[head]);
- if(rkxg_cnt < RKG_BUF_DEP)
- {
- prkg[USART1_RX_BUF002[head] - 0x40].RKG_XGData[rkxg_cnt] = USART1_RX_BUF002[head+4]<<8;
- prkg[USART1_RX_BUF002[head] - 0x40].RKG_XGData[rkxg_cnt] |= USART1_RX_BUF002[head+3];
- rkxg_cnt++;
- }
- if(rkxg_cnt == RKG_BUF_DEP)
- {
- rkxg_cnt = 0;
- }
- }
- else if((USART1_RX_BUF002[head+1] == 0x06)&&(receive_error == 0)) //写入数据返回
- {
-
- }
- i001 = 6;
- continue;
- }
- else if(USART1_RX_BUF002[0] >= 0x50 && USART1_RX_BUF002[0] <= 0x5F) //液位计数据 邵磊明增加
- {
- Prase_Level(USART1_RX_BUF002, pcang->Level);
- i001 = 9;
- continue;
- }
- else if(USART1_RX_BUF002[0] >=0x60 && USART1_RX_BUF002[0] <= 0x6f) //华天三点式温度传感器接收数据 邵磊明增加
- {
- Parse_Tem(USART1_RX_BUF002, pcang->Temperture);
-
- i001 = 15;
- continue;
-
- }
- else if(USART1_RX_BUF002[0] >=0xA0 && USART1_RX_BUF002[0] <= 0xAF) //暂未使用
- {
- if (i001 < 9){
- }else if(i001 < 12){
- Parse_Tem(USART1_RX_BUF002, pcang->Temperture);
- i001 = 12;
- continue;
- }else if(i001 < 15){
- Prase_Pressure(USART1_RX_BUF002, pcang->Pressure);
- i001 = 0;
- continue;
- }
- }
- else if(0) //暂未使用
- {
-
- }
- }
- else
- {
- if (i001 == 2)
- {
- if(pcang->RKG_Type == 0)
- {
- if(CMD_RKG[0] == 0x1)
- {
- i = 0;
- }
- else
- {
- i = i003;
- }
- }
- else
- {
- i = i003;
- }
-
- prkg[i].RKDG_ErrorCnt++;
- if (prkg[i].RKDG_ErrorCnt > pcang->sensorBusMaxReTry)
- {
- prkg[i].RKDG_ErrorCnt = pcang->sensorBusMaxReTry + 1;
- prkg[i].RKDG_Error = 1;
- }
- }
- if (i001 == 8) //液位错误
- {
- Level_Error(CMD_LDYW[0]);
- }else if(i001 == 11){
- if(Tem_FST100_611 == pcang->Temperture){
- Tem_Error(CMD_TemAng[0]);
- }else if(Tem_FST100_1007 == pcang->Temperture){
- Tem_Error(CMD_Temperature[0]);
- }
-
- }else if(i001 == 15){
- Pressure_Error(CMD_Pressure[0]);
- }
- }
-
- if(i001<16)
- i001++;
- else
- i001 = 0;
- osDelay(40);
- }
- /* USER CODE END StartTask03 */
- }
- /* USER CODE BEGIN Header_StartTask04 */
- /**
- * @brief Function implementing the myTask04 thread.
- * @param argument: Not used
- * @retval None
- */
- #include "Data_deal.h"
- uint8_t USART2_RX_BUF003[128];
- uint8_t F_STATE[70] = {0};
- uint8_t ptxCang01Temp[150];
- uint32_t KZQ_RTerror = 0;
- /* USER CODE END Header_StartTask04 */
- void StartTask04(void *argument) //控制器数据处理 uart2
- {
- /* USER CODE BEGIN StartTask04 */
- /* Infinite loop */
- uint8_t* ptx = CMD_KZQ;
- uint16_t ModbusCRC_lsb = 0,ModbusCRC = 0,SetSuccess = 0,ModbusCRC1 = 0,SetSuccess1 = 0,SetSuccess2=0,SetSuccess3=0;
- static uint16_t i = 0;
- int i000;
- uint8_t* send_ptr;
- uint16_t send_len;
- uint32_t tmpU32;
-
- KZQ_Inf* pkzq = &kzq_inf;
- extern uint8_t USART2_RX_BUF002[Uart2_BUF_SIZE];
- extern int data_lengthU2;
- extern int flagU2Rx;
- extern uint8_t USART2_RX_BUF002_print[Uart2_BUF_SIZE];
-
- //延时1S 启动
- osDelay(1000);
-
- /* Infinite loop */
- for(;;)
- {
- osDelay(2); //以ms为单位
- // HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0);
- HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
- if (flagU2Rx == 1)
- {
- flagU2Rx = 0;
- if ((rx1_len > 300) || ((USART2_RX_BUF002[0] == 0xa5) && (USART2_RX_BUF002[1] == 0x5a)))
- {
- tmpU32 = (USART2_RX_BUF002[0] << 24) | (USART2_RX_BUF002[1] << 16) | (USART2_RX_BUF002[2] << 8) | (USART2_RX_BUF002[3]);
- if (StartBytes_IAP == tmpU32)
- {
- Process_CMD_IAP_Update();
- continue;
- }
- }
- // KZQ_RTerror = 0;
- // ASC转换为16进制,收到数据为:3901开头的数据总长度131字节
- if ((USART2_RX_BUF002[0] == 0x3A) && (USART2_RX_BUF002[1] == 0x33) && (USART2_RX_BUF002[2] == 0x39) && (USART2_RX_BUF002[3] == 0x30)) //判断帧头
- {
- if (data_lengthU2 != 131)
- {
- ++KZQ_RTerror;
- continue;
- }
- for (i000 = 0; i000 < (data_lengthU2 - 3) / 2; i000++)
- {
- T2C_RemoteCaliDat001.PayLoadData[i000] = MODBUS_ASCII_AsciiToHex(USART2_RX_BUF002 + 1 + 0 + i000 * 2);
- USART2_RX_BUF003[i000] = MODBUS_ASCII_AsciiToHex(USART2_RX_BUF002 + 1 + 0 + i000 * 2);
- }
- //解析后的数据拷贝过来
- memcpy(USART2_RX_BUF002, USART2_RX_BUF003, (data_lengthU2 - 3) / 2);
- data_lengthU2 = (data_lengthU2 - 3) / 2;
- }
- if (data_lengthU2 < 5)
- continue;
- ModbusCRC = USART2_RX_BUF002[data_lengthU2 - 1] << 8;
- ModbusCRC |= USART2_RX_BUF002[data_lengthU2 - 2];
- ModbusCRC_lsb = USART2_RX_BUF002[data_lengthU2 - 2] << 8;
- ModbusCRC_lsb |= USART2_RX_BUF002[data_lengthU2 - 1];
- ModbusCRC1 = LIB_CRC_MODBUS(USART2_RX_BUF002, data_lengthU2 - 2);
- if ((USART2_RX_BUF002[0] != 0x39) && (USART2_RX_BUF002[1] <= 0x01) && (USART2_RX_BUF002[2] <= 0x95) && (USART2_RX_BUF002[3] <= 0x50)) //判断帧头
- {
- pkzq->KZQ_Error++;
- KZQ_RTerror = 1;
- }
- else if (USART2_RX_BUF002[5] != 0x01) //校验地址
- {
- pkzq->KZQ_Error++;
- KZQ_RTerror = 1;
- }
- else if ((USART2_RX_BUF002[7] != 0x03) && (USART2_RX_BUF002[7] != 0x06)) //校验数据长度
- {
- pkzq->KZQ_Error++;
- KZQ_RTerror = 1;
- }
- /*else if(ModbusCRC != ModbusCRC1 && ModbusCRC_lsb != ModbusCRC1) //校验CRC
- {
- pkzq->KZQ_Error++;
- KZQ_RTerror = 1;
- }*/
- else
- {
- pkzq->KZQ_Error = 0;
- KZQ_RTerror = 0;
- for (i = 0; i < 64; i++)
- pkzq->data_buf[i] = USART2_RX_BUF002[i];
- for(i = 0;i < 16;i++)
- ptx[i] = USART2_RX_BUF002[i];
- }
-
-
- if(KZQ_RTerror == 0)
- {
- send_len=0;
- pkzq->sensor_reg = USART2_RX_BUF002[8];
- pkzq->sensor_reg = pkzq->sensor_reg<<8;
- pkzq->sensor_reg |= USART2_RX_BUF002[9];
- switch(pkzq->sensor_reg)
- {
- case 0x10:
- RstCPU(); //复位
- break;
- case 0x13:
- Sen_CangState_old(F_STATE); //老协议 传输阀门状态
- send_ptr = F_STATE;
- send_len = 62;
- break;
- case 0x20:
- SetSuccess = Read_CangState(ptx); //读取仓状态
- break;
- case 0x27:
- SetSuccess = Read_CangSensorData(ptx); //读取仓传感器
- break;
- case 0x40:
- SetSuccess = Angle_SetZero(ptx); //姿态传感器置零
- for(i = 0;i < 64;i++)
- ptx[i] = USART2_RX_BUF002[i];
- break;
-
- case 0x50:
- SetSuccess = XYF_SetOFF(ptx); //远程卸油阀标定关 slm
- for(i = 0;i < 64;i++)
- ptx[i] = USART2_RX_BUF002[i];
- break;
- case 0x51:
- SetSuccess = XYF_SetThreshold(ptx); //设置卸油阀传感器开关门限
- break;
- case 0x52:
- SetSuccess = RKG_SetZero(ptx); //人孔盖传感器置零
- for(i = 0;i < 64;i++)
- ptx[i] = USART2_RX_BUF002[i];
- break;
- case 0x55:
- SetSuccess = Read_Sensor(ptx); // 远程读取传感器数据 slm
- break;
- case 0x70:
- break;
- case 0x71:
- SetSuccess = BGY_SetThreshold(ptx); //设置壁挂油门限
- break;
- case 0x72:
- SetSuccess = RKG_SetThreshold(ptx); //设置人孔盖开关门限
- break;
- case 0x73:
- SetSuccess = Sensor_SetJudgefNum(ptx); //设置开关判断次数
- break;
- case 0x74:
- SetSuccess = CJQ_SetConfig(ptx); //设置采集器参数
- Flash_Change = 1;
- break;
- case 0x75:
- SetSuccess = RKG_SetTypeNum(ptx); //设置人孔盖种类、数量
- Flash_Change = 1;
- break;
- case 0x76:
- SetSuccess = XYF_SetTypeNum(ptx); //设置卸油阀种类、数量
- Flash_Change = 1;
- break;
- case 0x77:
- SetSuccess = HDF_SetTypeNum(ptx); //设置海底阀种类、数量
- Flash_Change = 1;
- break;
- case 0x78:
- SetSuccess = Level_SetType(ptx); //设置液位计种类
- Flash_Change = 1;
- break;
- case 0x79:
- SetSuccess = Angle_SetType(ptx); //设置姿态传感器种类
- Flash_Change = 1;
- break;
- case 0x7a:
- SetSuccess = Tem_SetType(ptx); //设置温度传感器种类
- //Flash_Change = 1;
- break;
- case 0x7b:
- HDF_Set_CloseVal(ptx); //设置智能海底阀放大倍数
- Flash_Change = 1;
- break;
- case 0x7c:
- HDF_Set_Threshold(ptx); //设置智能海底阀放大倍数
- Flash_Change = 1;
- break;
- case 0x7d:
- HDF_Set_Gain(ptx); //设置智能海底阀放大倍数
- Flash_Change = 1;
- break;
- case 0x7e: HDF_Reset(ptx); //设置智能海底阀放大倍数
- Flash_Change = 1;
- break;
- case 0x80:
- SetSuccess = RW_SensorBusMaxRetry(ptx); //传感器总线重试最大值来获取异常
- break;
- case 0x81:
- SetSuccess = RW_PinIoHitSameParam(ptx); //
- break;
- case 0x017e:
- TOUCHUAN_UART_NUM(ptx); //设置智能海底阀放大倍数
- Flash_Change = 1;
- break;
- //case 0x0180:
- // SetSuccess = GRB_SET_Table(ptx); //罐容表配置 邵磊明增加
- // Flash_Change = 1;
- // break;
- case 0x0190:
- SetSuccess = Level_SetCalvalue(ptx); //设置液位计零点 邵磊明增加
- Flash_Change = 1;
- case 0x0121:
- //SetSuccess = Level_SetCalvalue(ptx); //设置液位计种类
- // Flash_Change = 1;
- break;
- case 0x0122:
- //SetSuccess = Level_SetCalvalue(ptx); //设置液位计种类
- // Flash_Change = 1;
- break;
- case 0x0220:
- SetSuccess=Read_SoftVersion(ptx);
- break;
- case 0x1121:
- SetSuccess1 = Read_CangSensorData_1to4(ptx); //读仓1-4传感器
- if(SetSuccess1)
- {
- SetSuccess1=0;
- ptx[232] = 0x00;
- ptx[233] = 0x00;
- send_ptr = ptx;
- send_len = 234;
- }
- break;
- #if 0
- #else
- case 0x1193:
- case 0x1194:
- case 0x1195:
- case 0x1196:
- case 0x1197:
- case 0x1198:
- case 0x1199:
- case 0x119a:
- SetSuccess2 = Read_CangSensorData_V2(ptx, (uint8_t)(pkzq->sensor_reg-0x1193+1));
- if(SetSuccess2){
- send_ptr = ptx;
- send_len = 148;
- SetSuccess2 = 0;
- }
-
- break;
- #endif
- case 0x119b:
- SetSuccess3 = Read_ZhencheSensorData1(ptx); //读仓1-4传感器
- if(SetSuccess3)
- {
- SetSuccess3=0;
- send_ptr = ptx;
- send_len = 96;
- }
- break;
- case 0x1130:
- Read_SensorData_New(ptx, &send_len);
- send_ptr = ptx;
- break;
- default:
- break;
- }
-
- //send_len=0;
- if(0 == send_len){
- if(SetSuccess){
- ptx[60] = 0x00;
- ptx[61] = 0x00;
- }else{
- ptx[60] = 0xFF;
- ptx[61] = 0xFF;
- }
- send_ptr = ptx;
- send_len = 62;
- }
- SetSuccess = 0;
- if(send_len)
- {
- ModbusCRC = LIB_CRC_MODBUS(send_ptr,send_len);
- send_ptr[send_len] = ModbusCRC>>8;
- send_ptr[send_len+1] = ModbusCRC&0xff;
- HAL_GPIO_WritePin(GPIOA,con03_uart2_kongzhiqi_Pin,GPIO_PIN_RESET);//
- delay_sys_us(80);
- HAL_UART_Transmit_IT(&huart2,send_ptr,send_len+2);
- while (huart2.gState == HAL_UART_STATE_BUSY_TX)
- {
- osDelay(1);
- }
- delay_sys_us(80);
- HAL_GPIO_WritePin(GPIOA,con03_uart2_kongzhiqi_Pin,GPIO_PIN_SET);//
- }
- }
- flagU2Rx = 0;
- }
- }
- /* USER CODE END StartTask04 */
- }
- /* USER CODE BEGIN Header_StartTask05 */
- /**
- * @brief Function implementing the myTask05 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask05 */
- //#include"level.h"
- void StartTask05(void *argument)
- {
- /* USER CODE BEGIN StartTask05 */
- /* Infinite loop */
- Level_Inf *plevel = level_inf;
- Cang_Inf *pcang = &cang_inf;
- uint8_t i;
- //float v000;
- //uint16_t *VolArrayTsk05 = Volume_1cang;
- //const uint16_t *HArrayTsk05 = H_1cang;
- for (;;)
- {
- HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
- AGL_JudgeState();
- for (i = 0; i < pcang->Cang_Num; i++)
- {
- // Value_Manage(i);
- // for(uint8_t i = 0;i < 5;i++)
- {
- #if 0
- switch (i)
- {
- case 0:
- VolArrayTsk05 = Volume_1cang;
- HArrayTsk05 = H_1cang;
- break;
- case 1:
- VolArrayTsk05 = Volume_1cang;
- HArrayTsk05 = H_1cang;
- break;
- case 2:
- VolArrayTsk05 = Volume_2cang;
- HArrayTsk05 = H_2cang;
- break;
- case 3:
- VolArrayTsk05 = Volume_3cang;
- HArrayTsk05 = H_3cang;
- break;
- case 4:
- VolArrayTsk05 = Volume_4cang;
- HArrayTsk05 = H_4cang;
- break;
- default:
- VolArrayTsk05 = Volume_4cang;
- HArrayTsk05 = H_4cang;
- break;
- }
- v000 = Calc_Vol(plevel[i].Level_Data, VolArrayTsk05, HArrayTsk05, i);
- plevel[i].Volume_Data = v000;
- #endif
- DF_State(i);
- // BGY_state(i);
- osDelay(100);
- }
- }
- }
- /* USER CODE END StartTask05 */
- }
- /* USER CODE BEGIN Header_StartTask06 */
- /**
- * @brief Function implementing the myTask06 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask06 */
- void StartTask06(void *argument)
- {
- /* USER CODE BEGIN StartTask06 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(1);
- }
- /* USER CODE END StartTask06 */
- }
- /* USER CODE BEGIN Header_StartTask07 */
- /**
- * @brief Function implementing the myTask07 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask07 */
- void StartTask07(void *argument)
- {
- /* USER CODE BEGIN StartTask07 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(1);
- }
- /* USER CODE END StartTask07 */
- }
- /* USER CODE BEGIN Header_StartTask08 */
- /**
- * @brief Function implementing the myTask08 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask08 */
- void StartTask08(void *argument)
- {
- /* USER CODE BEGIN StartTask08 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(1);
- }
- /* USER CODE END StartTask08 */
- }
- /* USER CODE BEGIN Header_StartTask09 */
- /**
- * @brief Function implementing the myTask09 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask09 */
- void StartTask09(void *argument)
- {
- /* USER CODE BEGIN StartTask09 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(1);
- }
- /* USER CODE END StartTask09 */
- }
- /* USER CODE BEGIN Header_StartTask10 */
- /**
- * @brief Function implementing the myTask10 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask10 */
- void StartTask10(void *argument)
- {
- /* USER CODE BEGIN StartTask10 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(1);
- }
- /* USER CODE END StartTask10 */
- }
- /* USER CODE BEGIN Header_StartTask11 */
- /**
- * @brief Function implementing the myTask11 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask11 */
- void StartTask11(void *argument)
- {
- /* USER CODE BEGIN StartTask11 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(1);
- }
- /* USER CODE END StartTask11 */
- }
- /* USER CODE BEGIN Header_StartTask12 */
- /**
- * @brief Function implementing the myTask12 thread.
- * @param argument: Not used
- * @retval None
- */
- /* USER CODE END Header_StartTask12 */
- void StartTask12(void *argument)
- {
- /* USER CODE BEGIN StartTask12 */
- /* Infinite loop */
- for(;;)
- {
- osDelay(500);
- usage_Tsk12++;
- HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0);
- HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
- }
- /* USER CODE END StartTask12 */
- }
- /* Callback01 function */
- void Callback01(void *argument)
- {
- /* USER CODE BEGIN Callback01 */
- /* USER CODE END Callback01 */
- }
- /* Callback02 function */
- void Callback02(void *argument)
- {
- /* USER CODE BEGIN Callback02 */
- /* USER CODE END Callback02 */
- }
- /* Callback03 function */
- void Callback03(void *argument)
- {
- /* USER CODE BEGIN Callback03 */
- /* USER CODE END Callback03 */
- }
- /* Callback04 function */
- void Callback04(void *argument)
- {
- /* USER CODE BEGIN Callback04 */
- /* USER CODE END Callback04 */
- }
- /* Callback05 function */
- void Callback05(void *argument)
- {
- /* USER CODE BEGIN Callback05 */
- /* USER CODE END Callback05 */
- }
- /* Callback06 function */
- void Callback06(void *argument)
- {
- /* USER CODE BEGIN Callback06 */
- /* USER CODE END Callback06 */
- }
- /* Callback07 function */
- void Callback07(void *argument)
- {
- /* USER CODE BEGIN Callback07 */
- /* USER CODE END Callback07 */
- }
- /* Callback08 function */
- void Callback08(void *argument)
- {
- /* USER CODE BEGIN Callback08 */
- /* USER CODE END Callback08 */
- }
- /* Callback09 function */
- void Callback09(void *argument)
- {
- /* USER CODE BEGIN Callback09 */
- /* USER CODE END Callback09 */
- }
- /* Callback010 function */
- void Callback010(void *argument)
- {
- /* USER CODE BEGIN Callback010 */
- /* USER CODE END Callback010 */
- }
- /**
- * @brief Period elapsed callback in non blocking mode
- * @note This function is called when TIM8 interrupt took place, inside
- * HAL_TIM_IRQHandler(). It makes a direct call to HAL_IncTick() to increment
- * a global variable "uwTick" used as application time base.
- * @param htim : TIM handle
- * @retval None
- */
- void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
- {
- /* USER CODE BEGIN Callback 0 */
- /* USER CODE END Callback 0 */
- if (htim->Instance == TIM8) {
- HAL_IncTick();
- }
- /* USER CODE BEGIN Callback 1 */
- /* USER CODE END Callback 1 */
- }
- /**
- * @brief This function is executed in case of error occurrence.
- * @retval None
- */
- void Error_Handler(void)
- {
- /* USER CODE BEGIN Error_Handler_Debug */
- /* User can add his own implementation to report the HAL error return state */
- __disable_irq();
- while (1)
- {
- }
- /* USER CODE END Error_Handler_Debug */
- }
- #ifdef USE_FULL_ASSERT
- /**
- * @brief Reports the name of the source file and the source line number
- * where the assert_param error has occurred.
- * @param file: pointer to the source file name
- * @param line: assert_param error line source number
- * @retval None
- */
- void assert_failed(uint8_t *file, uint32_t line)
- {
- /* USER CODE BEGIN 6 */
- /* User can add his own implementation to report the file name and line number,
- ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
- /* USER CODE END 6 */
- }
- #endif /* USE_FULL_ASSERT */
- /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|