main.c 93 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474
  1. /* USER CODE BEGIN Header */
  2. /**
  3. ******************************************************************************
  4. * @file : main.c
  5. * @brief : Main program body
  6. ******************************************************************************
  7. * @attention
  8. *
  9. * <h2><center>&copy; Copyright (c) 2021 STMicroelectronics.
  10. * All rights reserved.</center></h2>
  11. *
  12. * This software component is licensed by ST under Ultimate Liberty license
  13. * SLA0044, the "License"; You may not use this file except in compliance with
  14. * the License. You may obtain a copy of the License at:
  15. * www.st.com/SLA0044
  16. *
  17. ******************************************************************************
  18. */
  19. /* USER CODE END Header */
  20. /* Includes ------------------------------------------------------------------*/
  21. #include "main.h"
  22. #include "cmsis_os.h"
  23. #include "FreeRTOS.h"
  24. #include "task.h"
  25. #include "timers.h"
  26. #include "event_groups.h"
  27. /* Private includes ----------------------------------------------------------*/
  28. /* USER CODE BEGIN Includes */
  29. #include "string.h"
  30. #include "stdio.h"
  31. #include "usart.h"
  32. #include "config.h"
  33. #include "rkg.h"
  34. #include "cang.h"
  35. #include "kzq.h"
  36. #include "level.h"
  37. #include "tem.h"
  38. #include "angle.h"
  39. #include "xyf.h"
  40. #include "hdf.h"
  41. #include "bgy.h"
  42. #include "yqhs.h"
  43. /* USER CODE END Includes */
  44. /* Private typedef -----------------------------------------------------------*/
  45. /* USER CODE BEGIN PTD */
  46. #define ADDR_Is_In_ElecFence 0x05D0 // 1488 车是否在电子围栏内
  47. uint8_t REST = 0;
  48. uint32_t usage_Tsk12=0;
  49. //============================================================
  50. sT2C_RemoteCaliDat T2C_RemoteCaliDat001 =
  51. {
  52. 0x3901,
  53. 0x9551000,
  54. 0x0003,
  55. ADDR_Is_In_ElecFence,//0x0000,
  56. 0x0001, //操作的数据个数
  57. 0x55aa55aa, //保留字4字节
  58. {1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,\
  59. 25,26,27,28,29,30,31,32,33,34,35,36,37,38,39,40,41,42,43,44},
  60. 0x7788,//保留字2字节
  61. 0x99aa //校验2字节
  62. };
  63. sT2C_RemoteCaliDat *pT2C_RemoteCaliData = &T2C_RemoteCaliDat001;
  64. /* USER CODE END PTD */
  65. /* Private define ------------------------------------------------------------*/
  66. /* USER CODE BEGIN PD */
  67. #define RT_ERRORCNT 60 //串口收发数据错误上限
  68. /* USER CODE END PD */
  69. /* Private macro -------------------------------------------------------------*/
  70. /* USER CODE BEGIN PM */
  71. uint8_t CMD_KZQ[256] =
  72. {0x39,0x01,0x95,0x50,0x00,0x01,0x00,0x03,
  73. 0x00,0x00,0x00,0x00,0x95,0x05,0xaa,0xaa,
  74. 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  75. 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  76. 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  77. 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  78. 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  79. 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
  80. };
  81. //卸油阀指令
  82. uint8_t CMD_XYF[8] = {0x11,0x03,0x00,0x00,0x00,0x01,0x00,0x00};
  83. uint8_t Data_Head[2] = {0x0D,0x0A};
  84. //海底阀指令
  85. uint8_t CMD_HDF[16] =
  86. {0x21,0x03,0x2a,0,0,0,0,0,0xaa,0xbb,0xcc,0xdd,0xee,0xdd,0xcc,0xbb};
  87. //人孔盖指令31 03 00 02 00 02
  88. uint8_t CMD_RKG[8] = {0x31,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
  89. uint8_t CMD_RKG_CBM[12] = {0x0D,0x0A,0x31,0x03,0x00,0x02,0x00,0x02,0x00,0x00,0x0D,0x0A};
  90. uint8_t CMD_RKG_XG[12] = {0x41,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
  91. //油气回收
  92. uint8_t CMD_YQHS[8] = {0xE4,0x03,0x00,0x00,0x00,0x01,0x00,0x00};
  93. //倾角传感器读取协议 01 03 00 02 00 02 CRC
  94. uint8_t CMD_Angle_XY[] = {0x71,0x03,0x00,0x3d,0x00,0x03,0x00,0x00};
  95. //卸尽传感器读取协议
  96. uint8_t CMD_Biguayou[] = {0x81,0x03,0x00,0x00,0x00,0x01,0x9B,0xCA};
  97. //uint8_t CMD_Angle_X[] = {0xE0,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
  98. //uint8_t CMD_Angle_Y[] = {0xE1,0x03,0x00,0x02,0x00,0x02,0x00,0x00};
  99. uint8_t CMD_LDYW[8]={0x51,0x04,0x0a,0x0f,0x00,0x02};//设备地址,功能码,地址4字节 反回:设备地址,功能码,数据长度,数据4字节
  100. uint8_t CMD_GetTempAndYewei[8]={0x51, 0x04, 00, 00, 00, 0x10, 0x03 ,0xae};//读取编号为04地址的温度传感器数据
  101. //61-6f 03 00 04 00 01 C6 8A----读取华天传感器的第1个温度点,地址为x10;最接近电子仓的温度点
  102. uint8_t CMD_GetTempHuaTian[8]={0x61, 0x03, 00, 04, 00, 01,0,0};//读取华天传感器的第一个温度点
  103. //磁编码传感器读取协议 。
  104. /* USER CODE END PM */
  105. /* Private variables ---------------------------------------------------------*/
  106. CRC_HandleTypeDef hcrc;
  107. DAC_HandleTypeDef hdac;
  108. DMA_HandleTypeDef hdma_dac_ch2;
  109. TIM_HandleTypeDef htim1;
  110. TIM_HandleTypeDef htim4;
  111. UART_HandleTypeDef huart5;
  112. UART_HandleTypeDef huart1;
  113. UART_HandleTypeDef huart2;
  114. UART_HandleTypeDef huart3;
  115. DMA_HandleTypeDef hdma_usart1_rx;
  116. DMA_HandleTypeDef hdma_usart1_tx;
  117. DMA_HandleTypeDef hdma_usart2_rx;
  118. DMA_HandleTypeDef hdma_usart3_rx;
  119. /* Definitions for defaultTask */
  120. osThreadId_t defaultTaskHandle;
  121. const osThreadAttr_t defaultTask_attributes = {
  122. .name = "defaultTask",
  123. .stack_size = 128 * 4,
  124. .priority = (osPriority_t) osPriorityNormal,
  125. };
  126. /* Definitions for myTask02 */
  127. osThreadId_t myTask02Handle;
  128. const osThreadAttr_t myTask02_attributes = {
  129. .name = "myTask02",
  130. .stack_size = 256 * 4,
  131. .priority = (osPriority_t) osPriorityLow,
  132. };
  133. /* Definitions for myTask03 */
  134. osThreadId_t myTask03Handle;
  135. const osThreadAttr_t myTask03_attributes = {
  136. .name = "myTask03",
  137. .stack_size = 256 * 4,
  138. .priority = (osPriority_t) osPriorityLow,
  139. };
  140. /* Definitions for myTask04 */
  141. osThreadId_t myTask04Handle;
  142. const osThreadAttr_t myTask04_attributes = {
  143. .name = "myTask04",
  144. .stack_size = 256 * 4,
  145. .priority = (osPriority_t) osPriorityLow,
  146. };
  147. /* Definitions for myTask05 */
  148. osThreadId_t myTask05Handle;
  149. const osThreadAttr_t myTask05_attributes = {
  150. .name = "myTask05",
  151. .stack_size = 128 * 4,
  152. .priority = (osPriority_t) osPriorityLow,
  153. };
  154. /* Definitions for myTask06 */
  155. osThreadId_t myTask06Handle;
  156. const osThreadAttr_t myTask06_attributes = {
  157. .name = "myTask06",
  158. .stack_size = 128 * 4,
  159. .priority = (osPriority_t) osPriorityLow,
  160. };
  161. /* Definitions for myTask07 */
  162. osThreadId_t myTask07Handle;
  163. const osThreadAttr_t myTask07_attributes = {
  164. .name = "myTask07",
  165. .stack_size = 128 * 4,
  166. .priority = (osPriority_t) osPriorityLow,
  167. };
  168. /* Definitions for myTask08 */
  169. osThreadId_t myTask08Handle;
  170. const osThreadAttr_t myTask08_attributes = {
  171. .name = "myTask08",
  172. .stack_size = 128 * 4,
  173. .priority = (osPriority_t) osPriorityLow,
  174. };
  175. /* Definitions for myTask09 */
  176. osThreadId_t myTask09Handle;
  177. const osThreadAttr_t myTask09_attributes = {
  178. .name = "myTask09",
  179. .stack_size = 128 * 4,
  180. .priority = (osPriority_t) osPriorityLow,
  181. };
  182. /* Definitions for myTask10 */
  183. osThreadId_t myTask10Handle;
  184. const osThreadAttr_t myTask10_attributes = {
  185. .name = "myTask10",
  186. .stack_size = 128 * 4,
  187. .priority = (osPriority_t) osPriorityLow,
  188. };
  189. /* Definitions for myTask11 */
  190. osThreadId_t myTask11Handle;
  191. const osThreadAttr_t myTask11_attributes = {
  192. .name = "myTask11",
  193. .stack_size = 128 * 4,
  194. .priority = (osPriority_t) osPriorityLow,
  195. };
  196. /* Definitions for myTask12 */
  197. osThreadId_t myTask12Handle;
  198. const osThreadAttr_t myTask12_attributes = {
  199. .name = "myTask12",
  200. .stack_size = 128 * 4,
  201. .priority = (osPriority_t) (osPriorityLow-6),
  202. };
  203. /* Definitions for myQueue01 */
  204. osMessageQueueId_t myQueue01Handle;
  205. const osMessageQueueAttr_t myQueue01_attributes = {
  206. .name = "myQueue01"
  207. };
  208. /* Definitions for myQueue02 */
  209. osMessageQueueId_t myQueue02Handle;
  210. const osMessageQueueAttr_t myQueue02_attributes = {
  211. .name = "myQueue02"
  212. };
  213. /* Definitions for myQueue03 */
  214. osMessageQueueId_t myQueue03Handle;
  215. const osMessageQueueAttr_t myQueue03_attributes = {
  216. .name = "myQueue03"
  217. };
  218. /* Definitions for myQueue04 */
  219. osMessageQueueId_t myQueue04Handle;
  220. const osMessageQueueAttr_t myQueue04_attributes = {
  221. .name = "myQueue04"
  222. };
  223. /* Definitions for myQueue05 */
  224. osMessageQueueId_t myQueue05Handle;
  225. const osMessageQueueAttr_t myQueue05_attributes = {
  226. .name = "myQueue05"
  227. };
  228. /* Definitions for myQueue06 */
  229. osMessageQueueId_t myQueue06Handle;
  230. const osMessageQueueAttr_t myQueue06_attributes = {
  231. .name = "myQueue06"
  232. };
  233. /* Definitions for myTimer01 */
  234. osTimerId_t myTimer01Handle;
  235. const osTimerAttr_t myTimer01_attributes = {
  236. .name = "myTimer01"
  237. };
  238. /* Definitions for myTimer02 */
  239. osTimerId_t myTimer02Handle;
  240. const osTimerAttr_t myTimer02_attributes = {
  241. .name = "myTimer02"
  242. };
  243. /* Definitions for myTimer03 */
  244. osTimerId_t myTimer03Handle;
  245. const osTimerAttr_t myTimer03_attributes = {
  246. .name = "myTimer03"
  247. };
  248. /* Definitions for myTimer04 */
  249. osTimerId_t myTimer04Handle;
  250. const osTimerAttr_t myTimer04_attributes = {
  251. .name = "myTimer04"
  252. };
  253. /* Definitions for myTimer05 */
  254. osTimerId_t myTimer05Handle;
  255. const osTimerAttr_t myTimer05_attributes = {
  256. .name = "myTimer05"
  257. };
  258. /* Definitions for myTimer06 */
  259. osTimerId_t myTimer06Handle;
  260. const osTimerAttr_t myTimer06_attributes = {
  261. .name = "myTimer06"
  262. };
  263. /* Definitions for myTimer07 */
  264. osTimerId_t myTimer07Handle;
  265. const osTimerAttr_t myTimer07_attributes = {
  266. .name = "myTimer07"
  267. };
  268. /* Definitions for myTimer08 */
  269. osTimerId_t myTimer08Handle;
  270. const osTimerAttr_t myTimer08_attributes = {
  271. .name = "myTimer08"
  272. };
  273. /* Definitions for myTimer09 */
  274. osTimerId_t myTimer09Handle;
  275. const osTimerAttr_t myTimer09_attributes = {
  276. .name = "myTimer09"
  277. };
  278. /* Definitions for myTimer10 */
  279. osTimerId_t myTimer10Handle;
  280. const osTimerAttr_t myTimer10_attributes = {
  281. .name = "myTimer10"
  282. };
  283. /* Definitions for myMutex01 */
  284. osMutexId_t myMutex01Handle;
  285. const osMutexAttr_t myMutex01_attributes = {
  286. .name = "myMutex01"
  287. };
  288. /* Definitions for myMutex02 */
  289. osMutexId_t myMutex02Handle;
  290. const osMutexAttr_t myMutex02_attributes = {
  291. .name = "myMutex02"
  292. };
  293. /* Definitions for myMutex03 */
  294. osMutexId_t myMutex03Handle;
  295. const osMutexAttr_t myMutex03_attributes = {
  296. .name = "myMutex03"
  297. };
  298. /* Definitions for myMutex04 */
  299. osMutexId_t myMutex04Handle;
  300. const osMutexAttr_t myMutex04_attributes = {
  301. .name = "myMutex04"
  302. };
  303. /* Definitions for myMutex05 */
  304. osMutexId_t myMutex05Handle;
  305. const osMutexAttr_t myMutex05_attributes = {
  306. .name = "myMutex05"
  307. };
  308. /* Definitions for myMutex06 */
  309. osMutexId_t myMutex06Handle;
  310. const osMutexAttr_t myMutex06_attributes = {
  311. .name = "myMutex06"
  312. };
  313. /* Definitions for myMutex07 */
  314. osMutexId_t myMutex07Handle;
  315. const osMutexAttr_t myMutex07_attributes = {
  316. .name = "myMutex07"
  317. };
  318. /* Definitions for myMutex08 */
  319. osMutexId_t myMutex08Handle;
  320. const osMutexAttr_t myMutex08_attributes = {
  321. .name = "myMutex08"
  322. };
  323. /* Definitions for myRecursiveMutex01 */
  324. osMutexId_t myRecursiveMutex01Handle;
  325. const osMutexAttr_t myRecursiveMutex01_attributes = {
  326. .name = "myRecursiveMutex01",
  327. .attr_bits = osMutexRecursive,
  328. };
  329. /* Definitions for myRecursiveMutex02 */
  330. osMutexId_t myRecursiveMutex02Handle;
  331. const osMutexAttr_t myRecursiveMutex02_attributes = {
  332. .name = "myRecursiveMutex02",
  333. .attr_bits = osMutexRecursive,
  334. };
  335. /* Definitions for myRecursiveMutex03 */
  336. osMutexId_t myRecursiveMutex03Handle;
  337. const osMutexAttr_t myRecursiveMutex03_attributes = {
  338. .name = "myRecursiveMutex03",
  339. .attr_bits = osMutexRecursive,
  340. };
  341. /* Definitions for myRecursiveMutex04 */
  342. osMutexId_t myRecursiveMutex04Handle;
  343. const osMutexAttr_t myRecursiveMutex04_attributes = {
  344. .name = "myRecursiveMutex04",
  345. .attr_bits = osMutexRecursive,
  346. };
  347. /* Definitions for myBinarySem01 */
  348. osSemaphoreId_t myBinarySem01Handle;
  349. const osSemaphoreAttr_t myBinarySem01_attributes = {
  350. .name = "myBinarySem01"
  351. };
  352. /* Definitions for myBinarySem02 */
  353. osSemaphoreId_t myBinarySem02Handle;
  354. const osSemaphoreAttr_t myBinarySem02_attributes = {
  355. .name = "myBinarySem02"
  356. };
  357. /* Definitions for myBinarySem03 */
  358. osSemaphoreId_t myBinarySem03Handle;
  359. const osSemaphoreAttr_t myBinarySem03_attributes = {
  360. .name = "myBinarySem03"
  361. };
  362. /* Definitions for myBinarySem04 */
  363. osSemaphoreId_t myBinarySem04Handle;
  364. const osSemaphoreAttr_t myBinarySem04_attributes = {
  365. .name = "myBinarySem04"
  366. };
  367. /* Definitions for myBinarySem05 */
  368. osSemaphoreId_t myBinarySem05Handle;
  369. const osSemaphoreAttr_t myBinarySem05_attributes = {
  370. .name = "myBinarySem05"
  371. };
  372. /* Definitions for myBinarySem06 */
  373. osSemaphoreId_t myBinarySem06Handle;
  374. const osSemaphoreAttr_t myBinarySem06_attributes = {
  375. .name = "myBinarySem06"
  376. };
  377. /* Definitions for myBinarySem07 */
  378. osSemaphoreId_t myBinarySem07Handle;
  379. const osSemaphoreAttr_t myBinarySem07_attributes = {
  380. .name = "myBinarySem07"
  381. };
  382. /* Definitions for myBinarySem08 */
  383. osSemaphoreId_t myBinarySem08Handle;
  384. const osSemaphoreAttr_t myBinarySem08_attributes = {
  385. .name = "myBinarySem08"
  386. };
  387. /* Definitions for myCountingSem01 */
  388. osSemaphoreId_t myCountingSem01Handle;
  389. const osSemaphoreAttr_t myCountingSem01_attributes = {
  390. .name = "myCountingSem01"
  391. };
  392. /* Definitions for myCountingSem02 */
  393. osSemaphoreId_t myCountingSem02Handle;
  394. const osSemaphoreAttr_t myCountingSem02_attributes = {
  395. .name = "myCountingSem02"
  396. };
  397. /* Definitions for myCountingSem03 */
  398. osSemaphoreId_t myCountingSem03Handle;
  399. const osSemaphoreAttr_t myCountingSem03_attributes = {
  400. .name = "myCountingSem03"
  401. };
  402. /* Definitions for myCountingSem04 */
  403. osSemaphoreId_t myCountingSem04Handle;
  404. const osSemaphoreAttr_t myCountingSem04_attributes = {
  405. .name = "myCountingSem04"
  406. };
  407. /* Definitions for myEvent01 */
  408. osEventFlagsId_t myEvent01Handle;
  409. const osEventFlagsAttr_t myEvent01_attributes = {
  410. .name = "myEvent01"
  411. };
  412. /* Definitions for myEvent02 */
  413. osEventFlagsId_t myEvent02Handle;
  414. const osEventFlagsAttr_t myEvent02_attributes = {
  415. .name = "myEvent02"
  416. };
  417. /* Definitions for myEvent03 */
  418. osEventFlagsId_t myEvent03Handle;
  419. const osEventFlagsAttr_t myEvent03_attributes = {
  420. .name = "myEvent03"
  421. };
  422. /* Definitions for myEvent04 */
  423. osEventFlagsId_t myEvent04Handle;
  424. const osEventFlagsAttr_t myEvent04_attributes = {
  425. .name = "myEvent04"
  426. };
  427. /* Definitions for myEvent05 */
  428. osEventFlagsId_t myEvent05Handle;
  429. const osEventFlagsAttr_t myEvent05_attributes = {
  430. .name = "myEvent05"
  431. };
  432. /* Definitions for myEvent06 */
  433. osEventFlagsId_t myEvent06Handle;
  434. const osEventFlagsAttr_t myEvent06_attributes = {
  435. .name = "myEvent06"
  436. };
  437. /* Definitions for myEvent07 */
  438. osEventFlagsId_t myEvent07Handle;
  439. const osEventFlagsAttr_t myEvent07_attributes = {
  440. .name = "myEvent07"
  441. };
  442. /* Definitions for myEvent08 */
  443. osEventFlagsId_t myEvent08Handle;
  444. const osEventFlagsAttr_t myEvent08_attributes = {
  445. .name = "myEvent08"
  446. };
  447. /* USER CODE BEGIN PV */
  448. /* USER CODE END PV */
  449. /* Private function prototypes -----------------------------------------------*/
  450. void SystemClock_Config(void);
  451. static void MX_GPIO_Init(void);
  452. static void MX_DMA_Init(void);
  453. static void MX_USART1_UART_Init(void);
  454. static void MX_UART5_Init(void);
  455. static void MX_USART2_UART_Init(void);
  456. static void MX_USART3_UART_Init(void);
  457. static void MX_CRC_Init(void);
  458. static void MX_DAC_Init(void);
  459. static void MX_TIM1_Init(void);
  460. static void MX_TIM4_Init(void);
  461. void StartDefaultTask(void *argument);
  462. void StartTask02(void *argument);
  463. void StartTask03(void *argument);
  464. void StartTask04(void *argument);
  465. void StartTask05(void *argument);
  466. void StartTask06(void *argument);
  467. void StartTask07(void *argument);
  468. void StartTask08(void *argument);
  469. void StartTask09(void *argument);
  470. void StartTask10(void *argument);
  471. void StartTask11(void *argument);
  472. void StartTask12(void *argument);
  473. void Callback01(void *argument);
  474. void Callback02(void *argument);
  475. void Callback03(void *argument);
  476. void Callback04(void *argument);
  477. void Callback05(void *argument);
  478. void Callback06(void *argument);
  479. void Callback07(void *argument);
  480. void Callback08(void *argument);
  481. void Callback09(void *argument);
  482. void Callback010(void *argument);
  483. void Cang_Init(void);
  484. static void MX_NVIC_Init(void);
  485. /* USER CODE BEGIN PFP */
  486. void Flash_ReadBytes(uint16_t* sorBuf,uint32_t FlashAddr,uint16_t len)
  487. {
  488. uint16_t* p = sorBuf;
  489. uint8_t i = 0,j = 0;
  490. uint32_t addr = FlashAddr;
  491. while(len--)
  492. {
  493. i = *(uint32_t*)addr++;
  494. j = *(uint32_t*)addr++;
  495. *p++ = j<<8|i;
  496. }
  497. }
  498. uint16_t Flashbuf[2048]__attribute__ ((at(0X20001000)));// {0};
  499. //uint8_t UART_RX_BUF[1024] __attribute__ ((at(0X20001000)));
  500. void Flash_WriteBytes(uint16_t* sorBuf,uint32_t FlashAddr,uint16_t len)
  501. {
  502. uint32_t Offset_ADDR = 0,Page_StartAddr = 0,i = 0;
  503. Offset_ADDR = FlashAddr%0x800;
  504. Page_StartAddr = FlashAddr - Offset_ADDR;
  505. //设置PageError
  506. uint32_t PageError = 0;
  507. FLASH_EraseInitTypeDef f;
  508. f.TypeErase = FLASH_TYPEERASE_PAGES;
  509. __nop();
  510. f.PageAddress =Page_StartAddr;
  511. f.NbPages = 1;
  512. Flash_ReadBytes(Flashbuf,Page_StartAddr,0x400);
  513. for(i = 0;i<len;i++)
  514. Flashbuf[Offset_ADDR/2+i] = sorBuf[i];
  515. //1、解锁FLASH
  516. HAL_FLASH_Unlock();
  517. __nop();
  518. //2、擦除FLASH
  519. //初始化FLASH_EraseInitTypeDef
  520. //调用擦除函数
  521. HAL_FLASHEx_Erase(&f, &PageError);
  522. __nop();
  523. //3、对FLASH烧写
  524. for(uint16_t i = 0;i< 0x400 ;i++)
  525. {
  526. HAL_FLASH_Program(FLASH_TYPEPROGRAM_HALFWORD , Page_StartAddr + (i * 2), Flashbuf[i]);
  527. }
  528. //4、锁住FLASH
  529. HAL_FLASH_Lock();
  530. }
  531. typedef union{
  532. float Ldcal_zero_temp; //青鸟贵和磁致伸缩液位温度一体传感器
  533. uint8_t arr[4];
  534. }Hex_to_float1;
  535. Hex_to_float1 hex_to_float1;
  536. void Cang_Init(void)
  537. {
  538. Cang_Inf* pcang = &cang_inf;
  539. RKG_Inf* prkg = rkg_inf;
  540. XYF_Inf* pxyf = xyf_inf;
  541. HDF_Inf* phdf = hdf_inf;
  542. Angle_Inf* pangle = &angle_inf;
  543. Level_Inf* plevel = level_inf;
  544. TEM_Inf* ptem = tem_inf;
  545. uint16_t Flash_buff[64] = {0};
  546. uint16_t i = 0;
  547. Flash_ReadBytes(Flash_buff,ADDR_CANG_NUM,6);
  548. if(Flash_buff[0] == 0xffff)
  549. {
  550. Flash_WriteBytes(Volume_1cang,ADD_CANG1_TABLE,200);
  551. Flash_WriteBytes(Volume_2cang,ADD_CANG2_TABLE,200);
  552. Flash_WriteBytes(Volume_3cang,ADD_CANG3_TABLE,200);
  553. Flash_WriteBytes(Volume_4cang,ADD_CANG4_TABLE,200);
  554. pcang->Cang_Num = 3; //默认三仓
  555. }
  556. else
  557. pcang->Cang_Num = Flash_buff[0];
  558. if(Flash_buff[1] == 0xffff)
  559. {
  560. i = 0;
  561. while(i < pcang->Cang_Num)
  562. {
  563. pcang->RKG_Num[i] = 1; //默认每仓1人孔大盖
  564. pcang->RKG_DG = 1; //默认有大盖
  565. i++;
  566. }
  567. }
  568. else
  569. {
  570. i = 0;
  571. while(i <pcang->Cang_Num)
  572. {
  573. pcang->RKG_Num[i] = Flash_buff[1]; //默认每仓1人孔盖
  574. pcang->RKG_DG = Flash_buff[1];
  575. i++;
  576. }
  577. }
  578. if(Flash_buff[2] == 0xffff)
  579. pcang->RKG_XG = 0; //默认无人孔小盖
  580. else
  581. pcang->RKG_XG = Flash_buff[2];
  582. if(Flash_buff[3] == 0xffff)
  583. {
  584. i = 0;
  585. while(i <pcang->Cang_Num)
  586. {
  587. pcang->XYF_INSTALL = 1; // 默认有卸油阀SLM
  588. pcang->XYF_Num[i] = 1; //默认每仓1卸油阀
  589. i++;
  590. }
  591. }
  592. else
  593. {
  594. i = 0;
  595. while(i <pcang->Cang_Num)
  596. {
  597. pcang->XYF_INSTALL = 1; // 默认有卸油阀SLM
  598. pcang->XYF_Num[i] = Flash_buff[3]; i++;
  599. }
  600. }
  601. if(Flash_buff[4] == 0xffff)
  602. {
  603. i = 0;
  604. while(i <pcang->Cang_Num)
  605. {
  606. pcang->HDF_INSTALL = 1;
  607. pcang->HDF_Num[i] = 1; //默认每仓1海底阀
  608. i++;
  609. }
  610. }
  611. else
  612. {
  613. i = 0;
  614. while(i <pcang->Cang_Num)
  615. {
  616. pcang->HDF_INSTALL = 1;//slm
  617. pcang->HDF_Num[i] = Flash_buff[4];
  618. i++;
  619. }
  620. }
  621. Flash_ReadBytes(Flash_buff,ADDR_RKGSENSOR_TYPE,1);
  622. if(Flash_buff[0] == 0xffff)
  623. pcang->RKG_Type = 1; //默认人孔盖角度传感器 1磁电编码传感器
  624. else
  625. pcang->RKG_Type = Flash_buff[0];
  626. Flash_ReadBytes(Flash_buff,ADDR_XYFSENSOR_TYPE,1);
  627. if(Flash_buff[0] == 0xffff)
  628. pcang->XYF_Type = 0; //默认卸油阀霍尔二合一
  629. else
  630. pcang->XYF_Type = Flash_buff[0];
  631. Flash_ReadBytes(Flash_buff,ADDR_HDFSENSOR_TYPE,1);
  632. if(Flash_buff[0] == 0xffff)
  633. pcang->HDF_Type = 1; //默认底阀监测器 1智能底阀
  634. else
  635. pcang->HDF_Type = Flash_buff[0];
  636. Flash_ReadBytes(Flash_buff,ADDR_RKG_NUM,8); //检测是否对阀门种类及数量进行配置
  637. for(i = 0;i < 8;i++)
  638. {
  639. if((Flash_buff[i] < 8))
  640. pcang->RKG_Num[i] = Flash_buff[i];
  641. else
  642. pcang->RKG_Num[i] = 1; //默认每仓1人孔阀
  643. }
  644. Flash_ReadBytes(Flash_buff,ADDR_XYF_NUM,8);
  645. for(i = 0;i < 8;i++)
  646. {
  647. if((Flash_buff[i] < 8))
  648. pcang->XYF_Num[i] = Flash_buff[i];
  649. else
  650. pcang->XYF_Num[i] = 1; //默认每仓1卸油阀 slm
  651. }
  652. Flash_ReadBytes(Flash_buff,ADDR_HDF_NUM,8);
  653. for(i = 0;i < 8;i++)
  654. {
  655. if((Flash_buff[i] < 8))
  656. pcang->HDF_Num[i] = Flash_buff[i];
  657. else
  658. pcang->HDF_Num[i] = 1; //默认每仓1海底阀 slm
  659. }
  660. Flash_ReadBytes(Flash_buff,ADDR_YQHS_TYPE,1);
  661. if(Flash_buff[0] == 0xffff)
  662. pcang->YQHS = 0; //默认无油气回收 slm
  663. else
  664. pcang->YQHS = Flash_buff[0];
  665. Flash_ReadBytes(Flash_buff,ADDR_LEVEL_TYPE,1);
  666. if(Flash_buff[0] == 0xffff)
  667. pcang->Level = 2; //默认磁致伸缩液位传感器 slm
  668. else
  669. pcang->Level = Flash_buff[0];
  670. Flash_ReadBytes(Flash_buff,CANG1_LEVEL_CAL,8);
  671. if(Flash_buff[0] == 0xffff)
  672. {
  673. for(i=0;i<pcang->Cang_Num;++i)
  674. {
  675. plevel[i+1].Level_Cal_zero = 0;
  676. }
  677. }
  678. else
  679. {
  680. for (i = 0; i < pcang->Cang_Num; ++i)
  681. {
  682. hex_to_float1.arr[3] = (uint8_t)(Flash_buff[0+2*i] >> 8);
  683. hex_to_float1.arr[2] = (uint8_t)(Flash_buff[0+2*i] & 0xFF); // Flash_buff[3];
  684. hex_to_float1.arr[1] = (uint8_t)(Flash_buff[1+2*i] >> 8);
  685. hex_to_float1.arr[0] = (uint8_t)(Flash_buff[1+2*i] & 0xFF);
  686. plevel[i + 1].Level_Cal_zero = hex_to_float1.Ldcal_zero_temp;
  687. }
  688. }
  689. Flash_ReadBytes(Flash_buff,ADDR_TEM_TYPE,1);
  690. if(Flash_buff[0] == 0xffff)
  691. pcang->Temperture = 1; //默认无温度传感器
  692. else
  693. pcang->Temperture = Flash_buff[0];
  694. Flash_ReadBytes(Flash_buff,ADDR_ANGLE_TYPE,1);
  695. if(Flash_buff[0] == 0xffff)
  696. pcang->Angle = 1; //默认无姿态传感器
  697. else
  698. pcang->Angle = Flash_buff[0];
  699. Flash_ReadBytes(Flash_buff,ADDR_SDATEJUDGE_NUM,1);
  700. if(Flash_buff[0] == 0xffff)
  701. {
  702. for (i = 0; i < 8; i++)
  703. {
  704. prkg[i].RKG_StateKeepNum = 5; //默认人孔盖角度传感器
  705. pxyf[i].XYF_StateKeepNum = 5;
  706. }
  707. phdf->HDF_StateKeepNum = 5;
  708. pangle->Angle_StateKeepNum = 5;
  709. plevel->Level_StateKeepNum = 5;
  710. ptem->TEM_StateKeepNum = 5;
  711. }
  712. else
  713. {
  714. for (i = 0; i < 8; i++)
  715. {
  716. prkg[i].RKG_StateKeepNum = Flash_buff[0];
  717. pxyf[i].XYF_StateKeepNum = Flash_buff[0];
  718. }
  719. pxyf->XYF_StateKeepNum = Flash_buff[0];
  720. phdf->HDF_StateKeepNum = Flash_buff[0];
  721. __NOP();
  722. pangle->Angle_StateKeepNum = Flash_buff[0];
  723. plevel->Level_StateKeepNum = Flash_buff[0];
  724. ptem->TEM_StateKeepNum = Flash_buff[0];
  725. }
  726. }
  727. /* USER CODE END PFP */
  728. /* Private user code ---------------------------------------------------------*/
  729. /* USER CODE BEGIN 0 */
  730. /* USER CODE END 0 */
  731. /**4
  732. * @brief The application entry point.
  733. * @retval int
  734. */
  735. uint8_t bufMain[128];
  736. int main(void)
  737. {
  738. /* USER CODE BEGIN 1 */
  739. GPIO_InitTypeDef GPIO_InitStruct = {0};
  740. int spr000;
  741. /* USER CODE END 1 */
  742. /* MCU Configuration--------------------------------------------------------*/
  743. /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  744. HAL_Init();
  745. /* USER CODE BEGIN Init */
  746. Cang_Init(); //应用程序初始化函数
  747. RKG_Init();
  748. XYF_Init();
  749. BGY_Init();
  750. /* USER CODE END Init */
  751. /* Configure the system clock */
  752. SystemClock_Config();
  753. /* USER CODE BEGIN SysInit */
  754. /* USER CODE END SysInit */
  755. /* Initialize all configured peripherals */
  756. MX_GPIO_Init();
  757. MX_DMA_Init();
  758. MX_USART1_UART_Init();
  759. MX_UART5_Init();
  760. MX_USART2_UART_Init();
  761. MX_USART3_UART_Init();
  762. MX_CRC_Init();
  763. MX_DAC_Init();
  764. MX_TIM1_Init();
  765. MX_TIM4_Init();
  766. /* Initialize interrupts */
  767. MX_NVIC_Init();
  768. /* USER CODE BEGIN 2 */
  769. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//切换为接收模式
  770. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//切换为接收模式
  771. HAL_GPIO_WritePin(con03_uart2_kongzhiqi_GPIO_Port,con03_uart2_kongzhiqi_Pin,GPIO_PIN_SET);//切换为接收模式
  772. //看门狗重新根据宏定义初始化
  773. GPIO_InitStruct.Pin = WDI_sp706_kanmemgou_Pin;
  774. if(WatchDogOn)//打开看门狗sp706
  775. //if(1)//打开看门狗sp706
  776. {
  777. //
  778. GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  779. }
  780. else
  781. {
  782. GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  783. }
  784. GPIO_InitStruct.Pull = GPIO_NOPULL;
  785. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  786. HAL_GPIO_Init(WDI_sp706_kanmemgou_GPIO_Port, &GPIO_InitStruct);
  787. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//切换为发送模式CON=0;//
  788. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//切换为接收模式
  789. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//切换为接收模式
  790. HAL_GPIO_WritePin(con03_uart2_kongzhiqi_GPIO_Port,con03_uart2_kongzhiqi_Pin,GPIO_PIN_RESET);//切换为接收模式
  791. HAL_Delay(2);
  792. memset(bufMain,0,32);
  793. spr000=sprintf((char*)bufMain,"sysytem reset...%5d",5);
  794. //HAL_UART_Transmit(&huart1,bufMain,32,300);
  795. HAL_UART_Transmit(&huart2,bufMain,spr000,300);
  796. //HAL_UART_Transmit(&huart3,bufMain,32,300);
  797. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//切换为接收模式
  798. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//切换为接收模式
  799. HAL_GPIO_WritePin(con03_uart2_kongzhiqi_GPIO_Port,con03_uart2_kongzhiqi_Pin,GPIO_PIN_SET);//切换为接收模式
  800. /* USER CODE END 2 */
  801. /* Init scheduler */
  802. osKernelInitialize();
  803. /* Create the mutex(es) */
  804. /* creation of myMutex01 */
  805. myMutex01Handle = osMutexNew(&myMutex01_attributes);
  806. /* creation of myMutex02 */
  807. myMutex02Handle = osMutexNew(&myMutex02_attributes);
  808. /* creation of myMutex03 */
  809. myMutex03Handle = osMutexNew(&myMutex03_attributes);
  810. /* creation of myMutex04 */
  811. myMutex04Handle = osMutexNew(&myMutex04_attributes);
  812. /* creation of myMutex05 */
  813. myMutex05Handle = osMutexNew(&myMutex05_attributes);
  814. /* creation of myMutex06 */
  815. myMutex06Handle = osMutexNew(&myMutex06_attributes);
  816. /* creation of myMutex07 */
  817. myMutex07Handle = osMutexNew(&myMutex07_attributes);
  818. /* creation of myMutex08 */
  819. myMutex08Handle = osMutexNew(&myMutex08_attributes);
  820. /* Create the recursive mutex(es) */
  821. /* creation of myRecursiveMutex01 */
  822. myRecursiveMutex01Handle = osMutexNew(&myRecursiveMutex01_attributes);
  823. /* creation of myRecursiveMutex02 */
  824. myRecursiveMutex02Handle = osMutexNew(&myRecursiveMutex02_attributes);
  825. /* creation of myRecursiveMutex03 */
  826. myRecursiveMutex03Handle = osMutexNew(&myRecursiveMutex03_attributes);
  827. /* creation of myRecursiveMutex04 */
  828. myRecursiveMutex04Handle = osMutexNew(&myRecursiveMutex04_attributes);
  829. /* USER CODE BEGIN RTOS_MUTEX */
  830. /* add mutexes, ... */
  831. /* USER CODE END RTOS_MUTEX */
  832. /* Create the semaphores(s) */
  833. /* creation of myBinarySem01 */
  834. myBinarySem01Handle = osSemaphoreNew(1, 1, &myBinarySem01_attributes);
  835. /* creation of myBinarySem02 */
  836. myBinarySem02Handle = osSemaphoreNew(1, 1, &myBinarySem02_attributes);
  837. /* creation of myBinarySem03 */
  838. myBinarySem03Handle = osSemaphoreNew(1, 1, &myBinarySem03_attributes);
  839. /* creation of myBinarySem04 */
  840. myBinarySem04Handle = osSemaphoreNew(1, 1, &myBinarySem04_attributes);
  841. /* creation of myBinarySem05 */
  842. myBinarySem05Handle = osSemaphoreNew(1, 1, &myBinarySem05_attributes);
  843. /* creation of myBinarySem06 */
  844. myBinarySem06Handle = osSemaphoreNew(1, 1, &myBinarySem06_attributes);
  845. /* creation of myBinarySem07 */
  846. myBinarySem07Handle = osSemaphoreNew(1, 1, &myBinarySem07_attributes);
  847. /* creation of myBinarySem08 */
  848. myBinarySem08Handle = osSemaphoreNew(1, 1, &myBinarySem08_attributes);
  849. /* creation of myCountingSem01 */
  850. myCountingSem01Handle = osSemaphoreNew(2, 2, &myCountingSem01_attributes);
  851. /* creation of myCountingSem02 */
  852. myCountingSem02Handle = osSemaphoreNew(2, 2, &myCountingSem02_attributes);
  853. /* creation of myCountingSem03 */
  854. myCountingSem03Handle = osSemaphoreNew(2, 2, &myCountingSem03_attributes);
  855. /* creation of myCountingSem04 */
  856. myCountingSem04Handle = osSemaphoreNew(2, 2, &myCountingSem04_attributes);
  857. /* USER CODE BEGIN RTOS_SEMAPHORES */
  858. /* add semaphores, ... */
  859. /* USER CODE END RTOS_SEMAPHORES */
  860. /* Create the timer(s) */
  861. /* creation of myTimer01 */
  862. myTimer01Handle = osTimerNew(Callback01, osTimerPeriodic, NULL, &myTimer01_attributes);
  863. /* creation of myTimer02 */
  864. myTimer02Handle = osTimerNew(Callback02, osTimerPeriodic, NULL, &myTimer02_attributes);
  865. /* creation of myTimer03 */
  866. myTimer03Handle = osTimerNew(Callback03, osTimerPeriodic, NULL, &myTimer03_attributes);
  867. /* creation of myTimer04 */
  868. myTimer04Handle = osTimerNew(Callback04, osTimerPeriodic, NULL, &myTimer04_attributes);
  869. /* creation of myTimer05 */
  870. myTimer05Handle = osTimerNew(Callback05, osTimerPeriodic, NULL, &myTimer05_attributes);
  871. /* creation of myTimer06 */
  872. myTimer06Handle = osTimerNew(Callback06, osTimerPeriodic, NULL, &myTimer06_attributes);
  873. /* creation of myTimer07 */
  874. myTimer07Handle = osTimerNew(Callback07, osTimerPeriodic, NULL, &myTimer07_attributes);
  875. /* creation of myTimer08 */
  876. myTimer08Handle = osTimerNew(Callback08, osTimerPeriodic, NULL, &myTimer08_attributes);
  877. /* creation of myTimer09 */
  878. myTimer09Handle = osTimerNew(Callback09, osTimerPeriodic, NULL, &myTimer09_attributes);
  879. /* creation of myTimer10 */
  880. myTimer10Handle = osTimerNew(Callback010, osTimerPeriodic, NULL, &myTimer10_attributes);
  881. /* USER CODE BEGIN RTOS_TIMERS */
  882. /* start timers, add new ones, ... */
  883. /* USER CODE END RTOS_TIMERS */
  884. /* Create the queue(s) */
  885. /* creation of myQueue01 */
  886. myQueue01Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue01_attributes);
  887. /* creation of myQueue02 */
  888. myQueue02Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue02_attributes);
  889. /* creation of myQueue03 */
  890. myQueue03Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue03_attributes);
  891. /* creation of myQueue04 */
  892. myQueue04Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue04_attributes);
  893. /* creation of myQueue05 */
  894. myQueue05Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue05_attributes);
  895. /* creation of myQueue06 */
  896. myQueue06Handle = osMessageQueueNew (16, sizeof(uint16_t), &myQueue06_attributes);
  897. /* USER CODE BEGIN RTOS_QUEUES */
  898. /* add queues, ... */
  899. /* USER CODE END RTOS_QUEUES */
  900. /* Create the thread(s) */
  901. /* creation of defaultTask */
  902. defaultTaskHandle = osThreadNew(StartDefaultTask, NULL, &defaultTask_attributes);
  903. /* creation of myTask02 */
  904. myTask02Handle = osThreadNew(StartTask02, NULL, &myTask02_attributes);
  905. /* creation of myTask03 */
  906. myTask03Handle = osThreadNew(StartTask03, NULL, &myTask03_attributes);
  907. /* creation of myTask04 */
  908. myTask04Handle = osThreadNew(StartTask04, NULL, &myTask04_attributes);
  909. /* creation of myTask05 */
  910. myTask05Handle = osThreadNew(StartTask05, NULL, &myTask05_attributes);
  911. /* creation of myTask06 */
  912. myTask06Handle = osThreadNew(StartTask06, NULL, &myTask06_attributes);
  913. /* creation of myTask07 */
  914. myTask07Handle = osThreadNew(StartTask07, NULL, &myTask07_attributes);
  915. /* creation of myTask08 */
  916. myTask08Handle = osThreadNew(StartTask08, NULL, &myTask08_attributes);
  917. /* creation of myTask09 */
  918. myTask09Handle = osThreadNew(StartTask09, NULL, &myTask09_attributes);
  919. /* creation of myTask10 */
  920. myTask10Handle = osThreadNew(StartTask10, NULL, &myTask10_attributes);
  921. /* creation of myTask11 */
  922. myTask11Handle = osThreadNew(StartTask11, NULL, &myTask11_attributes);
  923. /* creation of myTask12 */
  924. myTask12Handle = osThreadNew(StartTask12, NULL, &myTask12_attributes);
  925. /* USER CODE BEGIN RTOS_THREADS */
  926. /* add threads, ... */
  927. /* USER CODE END RTOS_THREADS */
  928. /* creation of myEvent01 */
  929. myEvent01Handle = osEventFlagsNew(&myEvent01_attributes);
  930. /* creation of myEvent02 */
  931. myEvent02Handle = osEventFlagsNew(&myEvent02_attributes);
  932. /* creation of myEvent03 */
  933. myEvent03Handle = osEventFlagsNew(&myEvent03_attributes);
  934. /* creation of myEvent04 */
  935. myEvent04Handle = osEventFlagsNew(&myEvent04_attributes);
  936. /* creation of myEvent05 */
  937. myEvent05Handle = osEventFlagsNew(&myEvent05_attributes);
  938. /* creation of myEvent06 */
  939. myEvent06Handle = osEventFlagsNew(&myEvent06_attributes);
  940. /* creation of myEvent07 */
  941. myEvent07Handle = osEventFlagsNew(&myEvent07_attributes);
  942. /* creation of myEvent08 */
  943. myEvent08Handle = osEventFlagsNew(&myEvent08_attributes);
  944. /* USER CODE BEGIN RTOS_EVENTS */
  945. /* add events, ... */
  946. /* USER CODE END RTOS_EVENTS */
  947. /* Start scheduler */
  948. osKernelStart();
  949. /* We should never get here as control is now taken by the scheduler */
  950. /* Infinite loop */
  951. /* USER CODE BEGIN WHILE */
  952. while (1)
  953. {
  954. }
  955. /* USER CODE END WHILE */
  956. /* USER CODE BEGIN 3 */
  957. /* USER CODE END 3 */
  958. }
  959. /**
  960. * @brief System Clock Configuration
  961. * @retval None
  962. */
  963. void SystemClock_Config(void)
  964. {
  965. RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  966. RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
  967. /** Initializes the RCC Oscillators according to the specified parameters
  968. * in the RCC_OscInitTypeDef structure.
  969. */
  970. RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
  971. RCC_OscInitStruct.HSEState = RCC_HSE_ON;
  972. RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
  973. RCC_OscInitStruct.HSIState = RCC_HSI_ON;
  974. RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
  975. RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
  976. RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
  977. if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  978. {
  979. Error_Handler();
  980. }
  981. /** Initializes the CPU, AHB and APB buses clocks
  982. */
  983. RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
  984. |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  985. RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
  986. RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  987. RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
  988. RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
  989. if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
  990. {
  991. Error_Handler();
  992. }
  993. }
  994. /**
  995. * @brief NVIC Configuration.
  996. * @retval None
  997. */
  998. static void MX_NVIC_Init(void)
  999. {
  1000. /* USART3_IRQn interrupt configuration */
  1001. HAL_NVIC_SetPriority(USART3_IRQn, 5, 0);
  1002. HAL_NVIC_EnableIRQ(USART3_IRQn);
  1003. /* USART1_IRQn interrupt configuration */
  1004. HAL_NVIC_SetPriority(USART1_IRQn, 5, 0);
  1005. HAL_NVIC_EnableIRQ(USART1_IRQn);
  1006. /* USART2_IRQn interrupt configuration */
  1007. HAL_NVIC_SetPriority(USART2_IRQn, 5, 0);
  1008. HAL_NVIC_EnableIRQ(USART2_IRQn);
  1009. /* TIM4_IRQn interrupt configuration */
  1010. HAL_NVIC_SetPriority(TIM4_IRQn, 5, 0);
  1011. HAL_NVIC_EnableIRQ(TIM4_IRQn);
  1012. /* TIM1_UP_IRQn interrupt configuration */
  1013. HAL_NVIC_SetPriority(TIM1_UP_IRQn, 5, 0);
  1014. HAL_NVIC_EnableIRQ(TIM1_UP_IRQn);
  1015. /* DMA1_Channel6_IRQn interrupt configuration */
  1016. HAL_NVIC_SetPriority(DMA1_Channel6_IRQn, 5, 0);
  1017. HAL_NVIC_EnableIRQ(DMA1_Channel6_IRQn);
  1018. /* DMA1_Channel5_IRQn interrupt configuration */
  1019. HAL_NVIC_SetPriority(DMA1_Channel5_IRQn, 5, 0);
  1020. HAL_NVIC_EnableIRQ(DMA1_Channel5_IRQn);
  1021. /* DMA1_Channel3_IRQn interrupt configuration */
  1022. HAL_NVIC_SetPriority(DMA1_Channel3_IRQn, 5, 0);
  1023. HAL_NVIC_EnableIRQ(DMA1_Channel3_IRQn);
  1024. }
  1025. /**
  1026. * @brief CRC Initialization Function
  1027. * @param None
  1028. * @retval None
  1029. */
  1030. static void MX_CRC_Init(void)
  1031. {
  1032. /* USER CODE BEGIN CRC_Init 0 */
  1033. /* USER CODE END CRC_Init 0 */
  1034. /* USER CODE BEGIN CRC_Init 1 */
  1035. /* USER CODE END CRC_Init 1 */
  1036. hcrc.Instance = CRC;
  1037. if (HAL_CRC_Init(&hcrc) != HAL_OK)
  1038. {
  1039. Error_Handler();
  1040. }
  1041. /* USER CODE BEGIN CRC_Init 2 */
  1042. /* USER CODE END CRC_Init 2 */
  1043. }
  1044. /**
  1045. * @brief DAC Initialization Function
  1046. * @param None
  1047. * @retval None
  1048. */
  1049. static void MX_DAC_Init(void)
  1050. {
  1051. /* USER CODE BEGIN DAC_Init 0 */
  1052. /* USER CODE END DAC_Init 0 */
  1053. DAC_ChannelConfTypeDef sConfig = {0};
  1054. /* USER CODE BEGIN DAC_Init 1 */
  1055. /* USER CODE END DAC_Init 1 */
  1056. /** DAC Initialization
  1057. */
  1058. hdac.Instance = DAC;
  1059. if (HAL_DAC_Init(&hdac) != HAL_OK)
  1060. {
  1061. Error_Handler();
  1062. }
  1063. /** DAC channel OUT2 config
  1064. */
  1065. sConfig.DAC_Trigger = DAC_TRIGGER_SOFTWARE;
  1066. sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
  1067. if (HAL_DAC_ConfigChannel(&hdac, &sConfig, DAC_CHANNEL_2) != HAL_OK)
  1068. {
  1069. Error_Handler();
  1070. }
  1071. /* USER CODE BEGIN DAC_Init 2 */
  1072. /* USER CODE END DAC_Init 2 */
  1073. }
  1074. /**
  1075. * @brief TIM1 Initialization Function
  1076. * @param None
  1077. * @retval None
  1078. */
  1079. static void MX_TIM1_Init(void)
  1080. {
  1081. /* USER CODE BEGIN TIM1_Init 0 */
  1082. /* USER CODE END TIM1_Init 0 */
  1083. TIM_ClockConfigTypeDef sClockSourceConfig = {0};
  1084. TIM_MasterConfigTypeDef sMasterConfig = {0};
  1085. /* USER CODE BEGIN TIM1_Init 1 */
  1086. /* USER CODE END TIM1_Init 1 */
  1087. htim1.Instance = TIM1;
  1088. htim1.Init.Prescaler = 0;
  1089. htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
  1090. htim1.Init.Period = 65535;
  1091. htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV4;
  1092. htim1.Init.RepetitionCounter = 0;
  1093. htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  1094. if (HAL_TIM_Base_Init(&htim1) != HAL_OK)
  1095. {
  1096. Error_Handler();
  1097. }
  1098. sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
  1099. if (HAL_TIM_ConfigClockSource(&htim1, &sClockSourceConfig) != HAL_OK)
  1100. {
  1101. Error_Handler();
  1102. }
  1103. sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  1104. sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  1105. if (HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig) != HAL_OK)
  1106. {
  1107. Error_Handler();
  1108. }
  1109. /* USER CODE BEGIN TIM1_Init 2 */
  1110. /* USER CODE END TIM1_Init 2 */
  1111. }
  1112. /**
  1113. * @brief TIM4 Initialization Function
  1114. * @param None
  1115. * @retval None
  1116. */
  1117. static void MX_TIM4_Init(void)
  1118. {
  1119. /* USER CODE BEGIN TIM4_Init 0 */
  1120. /* USER CODE END TIM4_Init 0 */
  1121. TIM_ClockConfigTypeDef sClockSourceConfig = {0};
  1122. TIM_MasterConfigTypeDef sMasterConfig = {0};
  1123. /* USER CODE BEGIN TIM4_Init 1 */
  1124. /* USER CODE END TIM4_Init 1 */
  1125. htim4.Instance = TIM4;
  1126. htim4.Init.Prescaler = 0;
  1127. htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
  1128. htim4.Init.Period = 65535;
  1129. htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  1130. htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  1131. if (HAL_TIM_Base_Init(&htim4) != HAL_OK)
  1132. {
  1133. Error_Handler();
  1134. }
  1135. sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL;
  1136. if (HAL_TIM_ConfigClockSource(&htim4, &sClockSourceConfig) != HAL_OK)
  1137. {
  1138. Error_Handler();
  1139. }
  1140. sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  1141. sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  1142. if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
  1143. {
  1144. Error_Handler();
  1145. }
  1146. /* USER CODE BEGIN TIM4_Init 2 */
  1147. /* USER CODE END TIM4_Init 2 */
  1148. }
  1149. /**
  1150. * @brief UART5 Initialization Function
  1151. * @param None
  1152. * @retval None
  1153. */
  1154. static void MX_UART5_Init(void)
  1155. {
  1156. /* USER CODE BEGIN UART5_Init 0 */
  1157. /* USER CODE END UART5_Init 0 */
  1158. /* USER CODE BEGIN UART5_Init 1 */
  1159. /* USER CODE END UART5_Init 1 */
  1160. huart5.Instance = UART5;
  1161. huart5.Init.BaudRate = 115200;
  1162. huart5.Init.WordLength = UART_WORDLENGTH_8B;
  1163. huart5.Init.StopBits = UART_STOPBITS_1;
  1164. huart5.Init.Parity = UART_PARITY_NONE;
  1165. huart5.Init.Mode = UART_MODE_TX_RX;
  1166. huart5.Init.HwFlowCtl = UART_HWCONTROL_NONE;
  1167. huart5.Init.OverSampling = UART_OVERSAMPLING_16;
  1168. if (HAL_UART_Init(&huart5) != HAL_OK)
  1169. {
  1170. Error_Handler();
  1171. }
  1172. /* USER CODE BEGIN UART5_Init 2 */
  1173. /* USER CODE END UART5_Init 2 */
  1174. }
  1175. /**
  1176. * @brief USART1 Initialization Function
  1177. * @param None
  1178. * @retval None
  1179. */
  1180. static void MX_USART1_UART_Init(void)
  1181. {
  1182. /* USER CODE BEGIN USART1_Init 0 */
  1183. extern uint8_t USART1_RX_BUF[Uart1_BUF_SIZE];
  1184. /* USER CODE END USART1_Init 0 */
  1185. /* USER CODE BEGIN USART1_Init 1 */
  1186. /* USER CODE END USART1_Init 1 */
  1187. huart1.Instance = USART1;
  1188. huart1.Init.BaudRate = 9600;
  1189. huart1.Init.WordLength = UART_WORDLENGTH_8B;
  1190. huart1.Init.StopBits = UART_STOPBITS_1;
  1191. huart1.Init.Parity = UART_PARITY_NONE;
  1192. huart1.Init.Mode = UART_MODE_TX_RX;
  1193. huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
  1194. huart1.Init.OverSampling = UART_OVERSAMPLING_16;
  1195. if (HAL_UART_Init(&huart1) != HAL_OK)
  1196. {
  1197. Error_Handler();
  1198. }
  1199. /* USER CODE BEGIN USART1_Init 2 */
  1200. __HAL_UART_ENABLE_IT(&huart1, UART_IT_IDLE);
  1201. HAL_UART_Receive_DMA(&huart1,USART1_RX_BUF,Uart1_BUF_SIZE);
  1202. /* USER CODE END USART1_Init 2 */
  1203. }
  1204. /**
  1205. * @brief USART2 Initialization Function
  1206. * @param None
  1207. * @retval None
  1208. */
  1209. static void MX_USART2_UART_Init(void)
  1210. {
  1211. /* USER CODE BEGIN USART2_Init 0 */
  1212. /* USER CODE END USART2_Init 0 */
  1213. /* USER CODE BEGIN USART2_Init 1 */
  1214. /* USER CODE END USART2_Init 1 */
  1215. huart2.Instance = USART2;
  1216. huart2.Init.BaudRate = 38400;//19200
  1217. huart2.Init.WordLength = UART_WORDLENGTH_8B;
  1218. huart2.Init.StopBits = UART_STOPBITS_1;
  1219. huart2.Init.Parity = UART_PARITY_NONE;
  1220. huart2.Init.Mode = UART_MODE_TX_RX;
  1221. huart2.Init.HwFlowCtl = UART_HWCONTROL_NONE;
  1222. huart2.Init.OverSampling = UART_OVERSAMPLING_16;
  1223. if (HAL_UART_Init(&huart2) != HAL_OK)
  1224. {
  1225. Error_Handler();
  1226. }
  1227. /* USER CODE BEGIN USART2_Init 2 */
  1228. __HAL_UART_ENABLE_IT(&huart2, UART_IT_IDLE);
  1229. HAL_UART_Receive_DMA(&huart2,USART2_RX_BUF,Uart2_BUF_SIZE);
  1230. /* USER CODE END USART2_Init 2 */
  1231. }
  1232. /**
  1233. * @brief USART3 Initialization Function
  1234. * @param None
  1235. * @retval None
  1236. */
  1237. static void MX_USART3_UART_Init(void)
  1238. {
  1239. /* USER CODE BEGIN USART3_Init 0 */
  1240. /* USER CODE END USART3_Init 0 */
  1241. /* USER CODE BEGIN USART3_Init 1 */
  1242. /* USER CODE END USART3_Init 1 */
  1243. huart3.Instance = USART3;
  1244. huart3.Init.BaudRate = 9600;
  1245. huart3.Init.WordLength = UART_WORDLENGTH_8B;
  1246. huart3.Init.StopBits = UART_STOPBITS_1;
  1247. huart3.Init.Parity = UART_PARITY_NONE;
  1248. huart3.Init.Mode = UART_MODE_TX_RX;
  1249. huart3.Init.HwFlowCtl = UART_HWCONTROL_NONE;
  1250. huart3.Init.OverSampling = UART_OVERSAMPLING_16;
  1251. if (HAL_UART_Init(&huart3) != HAL_OK)
  1252. {
  1253. Error_Handler();
  1254. }
  1255. /* USER CODE BEGIN USART3_Init 2 */
  1256. __HAL_UART_ENABLE_IT(&huart3, UART_IT_IDLE);
  1257. HAL_UART_Receive_DMA(&huart3,USART3_RX_BUF,Uart2_BUF_SIZE);
  1258. /* USER CODE END USART3_Init 2 */
  1259. }
  1260. /**
  1261. * Enable DMA controller clock
  1262. */
  1263. static void MX_DMA_Init(void)
  1264. {
  1265. /* DMA controller clock enable */
  1266. __HAL_RCC_DMA1_CLK_ENABLE();
  1267. __HAL_RCC_DMA2_CLK_ENABLE();
  1268. /* DMA interrupt init */
  1269. /* DMA1_Channel4_IRQn interrupt configuration */
  1270. HAL_NVIC_SetPriority(DMA1_Channel4_IRQn, 5, 0);
  1271. HAL_NVIC_EnableIRQ(DMA1_Channel4_IRQn);
  1272. /* DMA2_Channel4_5_IRQn interrupt configuration */
  1273. HAL_NVIC_SetPriority(DMA2_Channel4_5_IRQn, 5, 0);
  1274. HAL_NVIC_EnableIRQ(DMA2_Channel4_5_IRQn);
  1275. }
  1276. /**
  1277. * @brief GPIO Initialization Function
  1278. * @param None
  1279. * @retval None
  1280. */
  1281. static void MX_GPIO_Init(void)
  1282. {
  1283. GPIO_InitTypeDef GPIO_InitStruct = {0};
  1284. /* GPIO Ports Clock Enable */
  1285. __HAL_RCC_GPIOD_CLK_ENABLE();
  1286. __HAL_RCC_GPIOA_CLK_ENABLE();
  1287. __HAL_RCC_GPIOB_CLK_ENABLE();
  1288. __HAL_RCC_GPIOC_CLK_ENABLE();
  1289. /*Configure GPIO pin Output Level */
  1290. HAL_GPIO_WritePin(GPIOA, LED1_Pin|LED2_Pin|con03_uart2_kongzhiqi_Pin, GPIO_PIN_RESET);
  1291. /*Configure GPIO pin Output Level */
  1292. HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin|Con01_uart1_rankonggai_Pin, GPIO_PIN_RESET);
  1293. /*Configure GPIO pin Output Level */
  1294. HAL_GPIO_WritePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin, GPIO_PIN_RESET);
  1295. /*Configure GPIO pins : LED1_Pin LED2_Pin con03_uart2_kongzhiqi_Pin */
  1296. GPIO_InitStruct.Pin = LED1_Pin|LED2_Pin|con03_uart2_kongzhiqi_Pin;
  1297. GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  1298. GPIO_InitStruct.Pull = GPIO_NOPULL;
  1299. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  1300. HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
  1301. /*Configure GPIO pins : con02_uart3_xieyoufa_Pin Con01_uart1_rankonggai_Pin */
  1302. GPIO_InitStruct.Pin = con02_uart3_xieyoufa_Pin|Con01_uart1_rankonggai_Pin;
  1303. GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  1304. GPIO_InitStruct.Pull = GPIO_NOPULL;
  1305. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  1306. HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
  1307. /*Configure GPIO pins : IN01_Pin PB15 */
  1308. GPIO_InitStruct.Pin = GPIO_PIN_14|GPIO_PIN_15;
  1309. GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  1310. GPIO_InitStruct.Pull = GPIO_NOPULL;
  1311. HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
  1312. /*Configure GPIO pins : PC6 PC7 PC8 PC9 */
  1313. GPIO_InitStruct.Pin = GPIO_PIN_6|GPIO_PIN_7|GPIO_PIN_8|GPIO_PIN_9;
  1314. GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  1315. GPIO_InitStruct.Pull = GPIO_NOPULL;
  1316. HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
  1317. /*Configure GPIO pins : PA8 PA11 */
  1318. GPIO_InitStruct.Pin = GPIO_PIN_8|GPIO_PIN_11;
  1319. GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  1320. GPIO_InitStruct.Pull = GPIO_NOPULL;
  1321. HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
  1322. /*Configure GPIO pin : WDI_sp706_kanmemgou_Pin */
  1323. GPIO_InitStruct.Pin = WDI_sp706_kanmemgou_Pin;
  1324. if(WatchDogOn)//打开看门狗sp706
  1325. //if(1)//打开看门狗sp706
  1326. {
  1327. //
  1328. GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  1329. }
  1330. else
  1331. {
  1332. GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  1333. }
  1334. GPIO_InitStruct.Pull = GPIO_NOPULL;
  1335. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  1336. HAL_GPIO_Init(WDI_sp706_kanmemgou_GPIO_Port, &GPIO_InitStruct);
  1337. }
  1338. /* USER CODE BEGIN 4 */
  1339. /**
  1340. * @funNm : delay_sys_us
  1341. * @brief : 延时nus
  1342. * @param : nus:要延时的us数. 0~204522252(最大值即2^32/fac_us@fac_us=168)
  1343. * @retval: void
  1344. */
  1345. void delay_sys_us(uint32_t Delay)//1个delay,大概1.5us
  1346. {
  1347. uint32_t cnt = Delay * 8;
  1348. uint32_t i = 0;
  1349. for(i = 0; i < cnt; i++)__NOP();
  1350. }
  1351. /* USER CODE END 4 */
  1352. /* USER CODE BEGIN Header_StartDefaultTask */
  1353. /**
  1354. * @brief Function implementing the defaultTask thread.
  1355. * @param argument: Not used
  1356. * @retval None
  1357. */
  1358. /* USER CODE END Header_StartDefaultTask */
  1359. void StartDefaultTask(void *argument)
  1360. {
  1361. /* USER CODE BEGIN 5 */
  1362. /* Infinite loop */
  1363. for(;;)
  1364. {
  1365. osDelay(1);
  1366. }
  1367. /* USER CODE END 5 */
  1368. }
  1369. /* USER CODE BEGIN Header_StartTask02 */
  1370. /**
  1371. * @brief Function implementing the myTask02 thread.
  1372. * @param argument: Not used
  1373. * @retval None
  1374. */
  1375. uint8_t Flash_Change = 0; //定义接收数组
  1376. uni_float tprture001,tprture002,tprture003,Yewei001,tprtureAver;
  1377. /* USER CODE END Header_StartTask02 */
  1378. /*
  1379. //发送卸油阀传感器命令轮询
  1380. //发送角度传感器命令轮询
  1381. //发送壁挂油传感器命令轮询
  1382. //发送智能海底阀传感器命令轮询
  1383. //发送油气回收传感器命令轮询
  1384. */
  1385. void StartTask02(void *argument) //卸油阀总线传感器命令轮询 UART3
  1386. {
  1387. /* USER CODE BEGIN StartTask02 */
  1388. uint8_t i001=0,i002 = 0,rx_len = 0;
  1389. uint16_t ModbusCRC = 0,xyfaddr_max = 0,hdfaddr_max; //xyfaddr_max:卸油阀最高地址,根据每仓卸油阀之和计算得出
  1390. static uint16_t i = 0,j = 0,receive_error = 0;
  1391. HDF_Inf* phdf = hdf_inf;
  1392. KZQ_Inf* pkzq = &kzq_inf;
  1393. XYF_Inf* pxyf = xyf_inf;
  1394. Cang_Inf* pcang = &cang_inf;
  1395. Angle_Inf* pangle = &angle_inf;
  1396. xyfaddr_max=0;
  1397. hdfaddr_max=0;
  1398. for(i = 0;i < pcang->Cang_Num;i++)
  1399. {
  1400. xyfaddr_max += pcang->XYF_Num[i];
  1401. hdfaddr_max += pcang->HDF_Num[i];
  1402. }
  1403. i = 0;
  1404. extern uint8_t USART2_RX_BUF002[Uart2_BUF_SIZE];
  1405. extern uint8_t USART1_RX_BUF002[Uart2_BUF_SIZE];
  1406. extern uint8_t USART3_RX_BUF002[Uart2_BUF_SIZE];
  1407. extern int data_lengthU2,data_lengthU1,data_lengthU3;
  1408. extern int flagU1Rx,flagU2Rx,flagU3Rx;
  1409. extern uint8_t USART3_RX_BUF002_print[Uart3_BUF_SIZE];
  1410. extern uint8_t XYF_TxBuf[70];
  1411. extern uint16_t Uart_len_TouChuan;
  1412. /* Infinite loop */
  1413. for(;;)
  1414. {
  1415. osDelay(10); //以ms为单位
  1416. //HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0);
  1417. HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
  1418. if(Flash_Change) //如果有对Flash进行改动,则重新计算xyfaddr_max
  1419. {
  1420. xyfaddr_max = 0;
  1421. hdfaddr_max = 0;
  1422. for(i = 0;i < pcang->Cang_Num;i++)
  1423. {
  1424. xyfaddr_max += pcang->XYF_Num[i];
  1425. hdfaddr_max += pcang->HDF_Num[i];
  1426. }
  1427. Flash_Change = 0;
  1428. }
  1429. if(pkzq->USE_XYF == 0) //平台未控制卸油阀总线,正常轮询数据
  1430. {
  1431. if(i001==0) //发送卸油阀传感器命令轮询
  1432. {
  1433. if ((pcang->XYF_INSTALL != 0) && (pcang->XYF_Type != 2))
  1434. {
  1435. ModbusCRC = LIB_CRC_MODBUS(CMD_XYF, 6);
  1436. CMD_XYF[6] = ModbusCRC >> 8;
  1437. CMD_XYF[7] = ModbusCRC & 0xff;
  1438. HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_RESET); //
  1439. delay_sys_us(80);
  1440. HAL_UART_Transmit_IT(&huart3, CMD_XYF, 8);
  1441. while (huart3.gState == HAL_UART_STATE_BUSY_TX)
  1442. {
  1443. osDelay(1);
  1444. }
  1445. HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_SET); //
  1446. pxyf[CMD_XYF[0] - 0x10].RTData_Num++; //每个传感器发送帧累加
  1447. if (CMD_XYF[0] - 0x10 < xyfaddr_max)
  1448. CMD_XYF[0]++;
  1449. else
  1450. CMD_XYF[0] = 0x11;
  1451. }
  1452. else
  1453. {
  1454. i001 = 3;
  1455. }
  1456. }
  1457. if (i001 == 3) //发送姿态传感器轮询
  1458. {
  1459. if (pcang->Angle) //发送角度传感器命令轮询
  1460. {
  1461. ModbusCRC = LIB_CRC_MODBUS(CMD_Angle_XY, 6);
  1462. CMD_Angle_XY[6] = ModbusCRC >> 8;
  1463. CMD_Angle_XY[7] = ModbusCRC & 0xff;
  1464. HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_RESET);
  1465. delay_sys_us(80);
  1466. HAL_UART_Transmit(&huart3, CMD_Angle_XY, 8, 100); //只支持单指令读角度取传感器数据
  1467. delay_sys_us(80);
  1468. HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_SET);
  1469. if (pangle->RTData_NumX > RT_ERRORCNT)
  1470. {
  1471. pangle->RTData_NumX = RT_ERRORCNT;
  1472. pangle->Angle_ErrorCnt = RT_ERRORCNT;
  1473. }
  1474. else
  1475. pangle->RTData_NumX++;
  1476. }
  1477. else
  1478. {
  1479. i001 = 6;
  1480. }
  1481. }
  1482. if(i001==6) //发送壁挂油传感器命令轮询
  1483. {
  1484. if(pcang->BGY_INSTALL)
  1485. {
  1486. ModbusCRC = LIB_CRC_MODBUS(CMD_Biguayou,6);
  1487. CMD_Biguayou[6] = ModbusCRC>>8;
  1488. CMD_Biguayou[7] = ModbusCRC&0xff;
  1489. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);
  1490. delay_sys_us(80);
  1491. HAL_UART_Transmit(&huart3,CMD_Biguayou,8,100); //只支持单指令读角度取传感器数据
  1492. delay_sys_us(80);
  1493. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);
  1494. }
  1495. else
  1496. {
  1497. i001=9;
  1498. }
  1499. }
  1500. if (i001 == 9) //发送智能海底阀传感器命令轮询
  1501. {
  1502. if (pcang->HDF_INSTALL != 0 && pcang->HDF_Type)
  1503. {
  1504. ModbusCRC = LIB_CRC_MODBUS(CMD_HDF, 14);
  1505. CMD_HDF[14] = ModbusCRC >> 8;
  1506. CMD_HDF[15] = ModbusCRC & 0xff;
  1507. HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_RESET);
  1508. delay_sys_us(80);
  1509. HAL_UART_Transmit(&huart3, CMD_HDF, 16, 100); //只支持单指令读角度取传感器数据
  1510. delay_sys_us(80);
  1511. HAL_GPIO_WritePin(GPIOB, con02_uart3_xieyoufa_Pin, GPIO_PIN_SET);
  1512. if (phdf[CMD_HDF[0] - 0x20].RTData_Num > 50) //收发数据错误次数RT_ERRORCNT
  1513. {
  1514. // phdf[CMD_HDF[0]-0x20].RTData_Num = RT_ERRORCNT;
  1515. // phdf[CMD_HDF[0]-0x20].HDF_ErrorCnt = RT_ERRORCNT;
  1516. }
  1517. else
  1518. phdf[CMD_HDF[0] - 0x20].RTData_Num++; //每个传感器发送帧累加
  1519. if (CMD_HDF[0] - 0x21 < hdfaddr_max)
  1520. CMD_HDF[0]++;
  1521. else
  1522. CMD_HDF[0] = 0x21;
  1523. }
  1524. else
  1525. {
  1526. i001 = 12;
  1527. }
  1528. }
  1529. if(i001==12) //发送油气回收传感器命令轮询
  1530. {
  1531. if(pcang->YQHS)
  1532. {
  1533. ModbusCRC = LIB_CRC_MODBUS(CMD_YQHS,6);
  1534. CMD_YQHS[6] = ModbusCRC>>8;
  1535. CMD_YQHS[7] = ModbusCRC&0xff;
  1536. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);
  1537. delay_sys_us(80);
  1538. HAL_UART_Transmit(&huart3,CMD_YQHS,8,100); //只支持单指令读角度取传感器数据
  1539. delay_sys_us(80);
  1540. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);
  1541. }
  1542. else
  1543. {
  1544. i001=0;
  1545. continue;
  1546. }
  1547. }
  1548. }
  1549. else //平台通过卸油阀总线直接操作传感器
  1550. {
  1551. if(i002 == 3)
  1552. {
  1553. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//
  1554. delay_sys_us(80);
  1555. #if 0
  1556. if((XYF_TxBuf[0] == 0x0D)&&(XYF_TxBuf[0] == 0x0A))
  1557. HAL_UART_Transmit(&huart3,XYF_TxBuf,12,100);
  1558. else
  1559. HAL_UART_Transmit(&huart3,XYF_TxBuf,8,100);
  1560. delay_sys_us(80);
  1561. #else
  1562. HAL_UART_Transmit_IT(&huart3,XYF_TxBuf,Uart_len_TouChuan);
  1563. while (huart3.gState == HAL_UART_STATE_BUSY_TX)
  1564. {
  1565. osDelay(1);
  1566. }
  1567. #endif
  1568. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET); //
  1569. }
  1570. else if(i002 == 0x06)
  1571. {
  1572. #if 0
  1573. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//
  1574. delay_sys_us(80);
  1575. HAL_UART_Transmit(&huart3,ALL_TxBuf,16,100);
  1576. delay_sys_us(80);
  1577. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//
  1578. }
  1579. else if(i002 == 0x09)//slm 0x0c
  1580. {
  1581. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_RESET);//
  1582. delay_sys_us(80);
  1583. HAL_UART_Transmit(&huart3,ALL_TxBuf,Uart_len_TouChuan,100);
  1584. delay_sys_us(80);
  1585. HAL_GPIO_WritePin(GPIOB,con02_uart3_xieyoufa_Pin,GPIO_PIN_SET);//
  1586. #endif
  1587. pkzq->USE_XYF = 0;
  1588. i002 = 0;
  1589. }
  1590. i002++;
  1591. if((flagU3Rx==1) && (i002 > 3))
  1592. {
  1593. pkzq->USE_XYF = 0;
  1594. i002 = 0;
  1595. continue;
  1596. }
  1597. }
  1598. //来自UART3的命令 电路板上标志位卸油阀
  1599. if(flagU3Rx==1)
  1600. {
  1601. flagU3Rx=0;
  1602. #if 0
  1603. if(USART3_RX_BUF002[0]!=0x11)
  1604. {
  1605. pxyf[1].XYF_ErrorCnt++;
  1606. if(pxyf[1].XYF_ErrorCnt>35)
  1607. {
  1608. pxyf[1].XYF_Error = 1;
  1609. }
  1610. }
  1611. if(USART3_RX_BUF002[0]!=0x12)
  1612. {
  1613. pxyf[2].XYF_ErrorCnt++;
  1614. if(pxyf[2].XYF_ErrorCnt>35)
  1615. {
  1616. pxyf[2].XYF_Error = 1;
  1617. }
  1618. }
  1619. #endif
  1620. if(USART3_RX_BUF002[0] >= 0x10 && USART3_RX_BUF002[0] <= 0x1F) //卸油阀数据
  1621. {
  1622. ModbusCRC = USART3_RX_BUF002[5]<<8;
  1623. ModbusCRC |= USART3_RX_BUF002[6];
  1624. //pxyf[USART3_RX_BUF002[0]-0x10].RTData_Num = 1;
  1625. if(USART3_RX_BUF002[1]!=0x03&&USART3_RX_BUF002[1]!=0x06) //校验读写属性
  1626. {
  1627. receive_error = 1;
  1628. }
  1629. else if(USART3_RX_BUF002[2] != 0x02) //校验数据长度
  1630. {
  1631. receive_error = 1;
  1632. }
  1633. else if(ModbusCRC != LIB_CRC_MODBUS(USART3_RX_BUF002,5)) //校验CRC
  1634. {
  1635. receive_error = 1;
  1636. }
  1637. if(receive_error == 0)
  1638. {
  1639. pxyf[USART3_RX_BUF002[0]-0x10].XYF_ErrorCnt = 0;
  1640. pxyf[USART3_RX_BUF002[0]-0x10].XYF_Error = 0;
  1641. if(USART3_RX_BUF002[1] == 0x03) //读取数据返回
  1642. {
  1643. #if 0
  1644. if(USART3_RX_BUF002[3]>0x01)//阀门开关状态
  1645. {
  1646. pxyf[i].XYF_ErrorCnt++;
  1647. }
  1648. else if(i < XYF_BUF_DEP)
  1649. {
  1650. i++;
  1651. }
  1652. if(i == XYF_BUF_DEP)
  1653. {
  1654. i = 0;
  1655. }
  1656. #else
  1657. pxyf[USART3_RX_BUF002[0] - 0x10].XYF_Data1[0] = USART3_RX_BUF002[3];
  1658. pxyf[USART3_RX_BUF002[0] - 0x10].XYF_Data2[0] = USART3_RX_BUF002[4];
  1659. #endif
  1660. XYF_state(USART3_RX_BUF002[0] - 0x10);
  1661. }
  1662. else if(USART3_RX_BUF002[1] == 0x06) //写入数据返回 判断写入是否成功
  1663. {
  1664. //清除控制器占用标志
  1665. //整理卸油阀协议后添加
  1666. }
  1667. i001=3;
  1668. continue;
  1669. }
  1670. }
  1671. else if(USART3_RX_BUF002[0] >=0x70 && USART3_RX_BUF002[0] <= 0x7f) //姿态数据,目前最多支持3轴
  1672. {
  1673. ModbusCRC = USART3_RX_BUF002[7]<<8;
  1674. ModbusCRC |= USART3_RX_BUF002[8];
  1675. pangle->RTData_NumX = 1;
  1676. if(USART3_RX_BUF002[1]!=0x03&&USART3_RX_BUF002[1]!=0x06) //校验读写属性
  1677. {
  1678. receive_error = 1;
  1679. }
  1680. else if(USART3_RX_BUF002[2] >= 0x08) //校验数据长度
  1681. {
  1682. receive_error = 1;
  1683. }
  1684. else if(ModbusCRC != LIB_CRC_MODBUS(USART3_RX_BUF002,USART3_RX_BUF002[2]+3)) //校验CRC
  1685. {
  1686. //receive_error = 1;
  1687. }
  1688. if(receive_error == 0)
  1689. {
  1690. if(USART3_RX_BUF002[1] ==0x03)
  1691. {
  1692. if(j < ANGLE_BUF_DEP)
  1693. {
  1694. pangle->Angle_ErrorCnt = 0;
  1695. //if(USART3_RX_BUF002[2] == 0x02)
  1696. pangle->Angle_DataX[j] = USART3_RX_BUF002[3]<<8|USART3_RX_BUF002[4];
  1697. //if(USART3_RX_BUF002[2] > 0x02)
  1698. pangle->Angle_DataY[j] = USART3_RX_BUF002[5]<<8|USART3_RX_BUF002[6];
  1699. // if(USART3_RX_BUF002[2] > 0x04)
  1700. pangle->Angle_DataZ[j] = USART3_RX_BUF002[7]<<8|USART3_RX_BUF002[8];
  1701. j++;
  1702. }
  1703. if(j == ANGLE_BUF_DEP)
  1704. {
  1705. j = 0;
  1706. }
  1707. }
  1708. else
  1709. {
  1710. //整理卸油阀协议后添加
  1711. }
  1712. }
  1713. }
  1714. else if(USART3_RX_BUF002[0] >= 0x20 && USART3_RX_BUF002[0] <= 0x2F ) //智能海底阀数据
  1715. {
  1716. Get_ZN_hdf_data();
  1717. }
  1718. else if(USART3_RX_BUF002[0] == 0xe4) //油气回收数据
  1719. {
  1720. Get_Yqhuishou_data();
  1721. }
  1722. else if(USART3_RX_BUF002[0] >= 0x81 && USART3_RX_BUF002[0] <= 0x8F) //壁挂油数据
  1723. {
  1724. Get_Biguayou_data();
  1725. }
  1726. receive_error = 0;
  1727. }
  1728. else
  1729. {
  1730. if (i001 == 2)
  1731. {
  1732. if(CMD_XYF[0] == 0x11)
  1733. {
  1734. i = xyfaddr_max;
  1735. }
  1736. else
  1737. {
  1738. i = CMD_XYF[0] - 0x11;
  1739. }
  1740. pxyf[i].XYF_ErrorCnt++;
  1741. if (pxyf[i].XYF_ErrorCnt > 3)
  1742. {
  1743. pxyf[i].XYF_ErrorCnt = 11;
  1744. pxyf[i].XYF_Error = 1;
  1745. }
  1746. }
  1747. }
  1748. if(i001<15)
  1749. i001++;
  1750. else
  1751. i001 = 0;
  1752. osDelay(40);
  1753. }
  1754. /* USER CODE END StartTask02 */
  1755. }
  1756. /* USER CODE BEGIN Header_StartTask03 */
  1757. /**
  1758. * @brief Function implementing the myTask03 thread.
  1759. * @param argument: Not used
  1760. * @retval None
  1761. */
  1762. /* USER CODE END Header_StartTask03 */
  1763. /*
  1764. //发送华天三点式温度传感器命令轮询
  1765. //发送人控大盖盖命令轮询
  1766. //雷达液位传感器命令
  1767. //发送小盖传感器轮询
  1768. //发送磁致伸缩液位计命令轮询
  1769. ?
  1770. */
  1771. #include "rkg.h"
  1772. void StartTask03(void *argument) //人孔盖总线传感器 UART1
  1773. {
  1774. /* USER CODE BEGIN StartTask03 */
  1775. /* Infinite loop */
  1776. /* USER CODE BEGIN StartTask02 */
  1777. static uint8_t i001=0,i002 = 0,i003 = 0,receive_error = 0;
  1778. uint16_t rkgaddr_max = 0,temaddr_max = 0,leveladdr_max = 0,RKG_angle = 0;
  1779. 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;
  1780. uint16_t rx_len,head = 0;
  1781. S_ANGLEDATA* psATsk3 = gs_AngleData;
  1782. KZQ_Inf* pkzq = &kzq_inf;
  1783. RKG_Inf* prkg = rkg_inf;
  1784. Cang_Inf* pcang = &cang_inf;
  1785. Level_Inf* plevel = level_inf;
  1786. TEM_Inf* ptem = tem_inf;
  1787. typedef union{
  1788. float QDGH_data_temp; //青鸟贵和磁致伸缩液位温度一体传感器
  1789. uint8_t arr[4];
  1790. }Hex_to_float;
  1791. static Hex_to_float hex_to_float;
  1792. leveladdr_max=0;
  1793. if(pcang->Temperture==2)
  1794. pcang->Temperture=3;
  1795. for(i = 0;i < pcang->Cang_Num;i++)
  1796. {
  1797. rkgaddr_max += pcang->RKG_Num[i]; //人孔盖最大地址
  1798. leveladdr_max++;
  1799. }
  1800. /*if(pcang->RKG_Type==0)
  1801. {
  1802. rkgaddr_max += 1;
  1803. }*/
  1804. //if(((pcang->Level)|0xff) == 0)
  1805. {
  1806. if(((pcang->Temperture)&0xff) == 0)
  1807. {
  1808. temaddr_max = leveladdr_max; //温度最大集成地址
  1809. }
  1810. else
  1811. {
  1812. temaddr_max = leveladdr_max*(pcang->Temperture&0xff); //温度最大离散地址
  1813. }
  1814. }
  1815. i = 0;
  1816. extern uint8_t USART1_RX_BUF002[Uart2_BUF_SIZE];
  1817. extern int data_lengthU1;
  1818. extern int flagU1Rx;
  1819. extern uint8_t USART1_RX_BUF002_print[Uart1_BUF_SIZE];
  1820. /* Infinite loop */
  1821. for(;;)
  1822. {
  1823. osDelay(10); //以ms为单位
  1824. //HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0); //已经移至task12 500ms闪烁 邵磊明修改
  1825. HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
  1826. if(Flash_Change)
  1827. {
  1828. rkgaddr_max = 0;
  1829. leveladdr_max=0;
  1830. if(pcang->Temperture==2)
  1831. pcang->Temperture=3;
  1832. for(i = 0;i < pcang->Cang_Num;i++)
  1833. {
  1834. rkgaddr_max += pcang->RKG_Num[i]; //人孔盖最大地址
  1835. leveladdr_max++;
  1836. }
  1837. /*if(pcang->RKG_Type==0)
  1838. {
  1839. rkgaddr_max += 1;
  1840. }*/
  1841. //if(((pcang->Level>)|0xff) == 0)
  1842. {
  1843. if(((pcang->Temperture)&0xff) == 0)
  1844. {
  1845. temaddr_max = leveladdr_max; //温度最大集成地址
  1846. }
  1847. else
  1848. {
  1849. temaddr_max = leveladdr_max*(pcang->Temperture&0xff); //温度最大离散地址
  1850. }
  1851. }
  1852. Flash_Change = 0;
  1853. }
  1854. if(pkzq->USE_RKG == 0) //平台未控制卸油阀总线,正常轮询数据
  1855. {
  1856. if(i001==0) //发送人控大盖盖命令轮询
  1857. {
  1858. if((pcang->RKG_DG != 0) && (pcang->RKG_Type!=2))
  1859. {
  1860. ModbusCRC = LIB_CRC_MODBUS(CMD_RKG,6);
  1861. CMD_RKG[6] = ModbusCRC>>8;
  1862. CMD_RKG[7] = ModbusCRC&0xff;
  1863. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
  1864. delay_sys_us(80);
  1865. //if(pcang->RKG_Type == 0x01)
  1866. // HAL_UART_Transmit(&huart1,Data_Head,2,10);
  1867. {
  1868. HAL_UART_Transmit_IT(&huart1,CMD_RKG,8);
  1869. while (huart1.gState == HAL_UART_STATE_BUSY_TX)
  1870. {
  1871. osDelay(1);
  1872. }
  1873. } //HAL_UART_Transmit(&huart1,CMD_RKG,8,100);
  1874. //if(pcang->RKG_Type == 0x01)
  1875. // HAL_UART_Transmit(&huart1,Data_Head,2,10);
  1876. //delay_sys_us(80);
  1877. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
  1878. #if 0
  1879. if(prkg[CMD_RKG[0] - 0x30].RTData_Num > RT_ERRORCNT) //每个传感器每发送一帧 基准角度为0x30
  1880. {
  1881. prkg[CMD_RKG[0] - 0x30].RTData_Num = RT_ERRORCNT;
  1882. prkg[CMD_RKG[0] - 0x30].RKDG_ErrorCnt = RT_ERRORCNT;
  1883. }
  1884. else
  1885. #endif
  1886. prkg[CMD_RKG[0] - 0x30].RTData_Num++;
  1887. if(pcang->RKG_Type == 0)
  1888. {
  1889. if(CMD_RKG[0] == 0x30)
  1890. {
  1891. CMD_RKG[0] += i003++;
  1892. if(CMD_RKG[0] - 0x30 >= rkgaddr_max)//rkgaddr_max
  1893. i003 = 1;
  1894. }
  1895. else
  1896. CMD_RKG[0] = 0x30;
  1897. }
  1898. else
  1899. {
  1900. if(CMD_RKG[0] - 0x30 < rkgaddr_max)//rkgaddr_max
  1901. CMD_RKG[0]++;
  1902. else
  1903. CMD_RKG[0] = 0x31;
  1904. }
  1905. }
  1906. else
  1907. i001 = 3;
  1908. }
  1909. if(i001==3) //发送小盖传感器轮询
  1910. {
  1911. if(pcang->RKG_XG == 0x01)
  1912. {
  1913. ModbusCRC = LIB_CRC_MODBUS(CMD_RKG_XG,6);
  1914. CMD_RKG_XG[6] = ModbusCRC>>8;
  1915. CMD_RKG_XG[7] = ModbusCRC&0xff;
  1916. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
  1917. delay_sys_us(80);
  1918. if(pcang->RKG_Type == 0x01)
  1919. HAL_UART_Transmit(&huart1,Data_Head,2,10);
  1920. HAL_UART_Transmit(&huart1,CMD_RKG_XG,8,100);
  1921. if(pcang->RKG_Type == 0x01)
  1922. HAL_UART_Transmit(&huart1,Data_Head,2,10);
  1923. delay_sys_us(80);
  1924. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
  1925. if(prkg[CMD_RKG_XG[0]-0x40].RTData_Num > RT_ERRORCNT)
  1926. {
  1927. prkg[CMD_RKG_XG[0]-0x40].RTData_Num = RT_ERRORCNT;
  1928. prkg[CMD_RKG_XG[0]-0x40].RKXG_ErrorCnt = RT_ERRORCNT;
  1929. }
  1930. else
  1931. prkg[CMD_RKG_XG[0]-0x40].RTData_Num++; //每个传感器发送帧累加
  1932. if(CMD_RKG_XG[0] - 0x41 < rkgaddr_max -1)
  1933. CMD_RKG_XG[0]++;
  1934. else
  1935. CMD_RKG_XG[0] = 0x41;
  1936. }
  1937. else
  1938. i001 = 6;
  1939. }
  1940. if(i001==6) //发送磁致伸缩液位计命令轮询 邵磊明增加
  1941. {
  1942. if(pcang->Level == 0) //没有液位传感器
  1943. {
  1944. i001=9;
  1945. }
  1946. else if(pcang->Level == 1) //磁致伸缩传感器轮询 邵磊明增加
  1947. {
  1948. ModbusCRC = LIB_CRC_MODBUS(CMD_GetTempAndYewei,6);
  1949. CMD_GetTempAndYewei[6] = ModbusCRC>>8;
  1950. CMD_GetTempAndYewei[7] = ModbusCRC&0xff;
  1951. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
  1952. delay_sys_us(80);
  1953. //HAL_UART_Transmit(&huart1,CMD_GetTempAndYewei,8,100);
  1954. //delay_sys_us(80);
  1955. HAL_UART_Transmit_IT(&huart1,CMD_GetTempAndYewei,8);
  1956. while (huart1.gState == HAL_UART_STATE_BUSY_TX)
  1957. {
  1958. osDelay(1);
  1959. }
  1960. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
  1961. /*if(plevel[CMD_GetTempAndYewei[0]-0x50].RTData_Num > RT_ERRORCNT)
  1962. {
  1963. plevel[CMD_GetTempAndYewei[0]-0x50].RTData_Num = RT_ERRORCNT;
  1964. plevel[CMD_GetTempAndYewei[0]-0x50].Level_ErrorCnt = RT_ERRORCNT;
  1965. }
  1966. else*/
  1967. plevel[CMD_GetTempAndYewei[0]-0x50].RTData_Num++; //每个传感器发送帧累加 基准角度为0x30
  1968. if(CMD_GetTempAndYewei[0]-0x51 < leveladdr_max -1)
  1969. CMD_GetTempAndYewei[0]++;
  1970. else
  1971. CMD_GetTempAndYewei[0] = 0x51;
  1972. }
  1973. else if(pcang->Level == 2) //雷达液位传感器命令轮询 20210818邵增加
  1974. {
  1975. ModbusCRC = LIB_CRC_MODBUS(CMD_LDYW,6);
  1976. CMD_LDYW[6] = ModbusCRC>>8;
  1977. CMD_LDYW[7] = ModbusCRC&0xff;
  1978. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
  1979. delay_sys_us(80);
  1980. //HAL_UART_Transmit(&huart1,CMD_LDYW,8,100);
  1981. //delay_sys_us(80);
  1982. HAL_UART_Transmit_IT(&huart1, CMD_LDYW, 8);
  1983. while (huart1.gState == HAL_UART_STATE_BUSY_TX)
  1984. {
  1985. osDelay(1);
  1986. }
  1987. HAL_GPIO_WritePin(GPIOB, Con01_uart1_rankonggai_Pin, GPIO_PIN_SET); //
  1988. /*if (prkg[CMD_RKG[0] - 0x50].RTData_Num > RT_ERRORCNT) //每个传感器每发送一帧 基准角度为0x30
  1989. {
  1990. plevel[CMD_RKG[0] - 0x50].RTData_Num = RT_ERRORCNT;
  1991. plevel[CMD_RKG[0] - 0x50].Level_ErrorCnt = RT_ERRORCNT;
  1992. }
  1993. else*/
  1994. plevel[CMD_LDYW[0] - 0x50].RTData_Num++;
  1995. if (CMD_LDYW[0] - 0x50 < leveladdr_max - 1)
  1996. CMD_LDYW[0]++;
  1997. else
  1998. CMD_LDYW[0] = 0x51;
  1999. }
  2000. else
  2001. i001=9;
  2002. }
  2003. if(i001==9) //发送华天三点式温度传感器命令轮询 邵磊明增加
  2004. {
  2005. if(pcang->Temperture != 0)
  2006. {
  2007. // taskENTER_CRITICAL();
  2008. ModbusCRC = LIB_CRC_MODBUS(CMD_GetTempHuaTian,6);
  2009. CMD_GetTempHuaTian[6] = ModbusCRC>>8;
  2010. CMD_GetTempHuaTian[7] = ModbusCRC&0xff;
  2011. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
  2012. delay_sys_us(80);
  2013. HAL_UART_Transmit_IT(&huart1,CMD_GetTempHuaTian,8);
  2014. while (huart1.gState == HAL_UART_STATE_BUSY_TX)
  2015. {
  2016. osDelay(1);
  2017. }
  2018. //HAL_UART_Transmit(&huart1,CMD_GetTempHuaTian,8,100);
  2019. //delay_sys_us(80);
  2020. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
  2021. // taskEXIT_CRITICAL();
  2022. #if 0
  2023. if(ptem[CMD_GetTempHuaTian[0] - 0x60].RTData_Num > RT_ERRORCNT) //每个传感器每发送一帧 基准角度为0x30
  2024. {
  2025. ptem[CMD_GetTempHuaTian[0] - 0x60].RTData_Num = RT_ERRORCNT;
  2026. ptem[CMD_GetTempHuaTian[0] - 0x60].TEM_ErrorCnt = RT_ERRORCNT;
  2027. }
  2028. else
  2029. #endif
  2030. {
  2031. ptem[CMD_GetTempHuaTian[0] - 0x60].RTData_Num++;
  2032. }
  2033. if(CMD_GetTempHuaTian[0] - 0x60 < temaddr_max)
  2034. CMD_GetTempHuaTian[0] = CMD_GetTempHuaTian[0]+1;
  2035. else
  2036. CMD_GetTempHuaTian[0] = 0x61;
  2037. }
  2038. else
  2039. {
  2040. i001=0x0;
  2041. continue;
  2042. }
  2043. }
  2044. }
  2045. else //平台通过卸油阀总线直接操作传感器
  2046. {
  2047. if(i002 == 3)
  2048. {
  2049. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_RESET);//
  2050. delay_sys_us(80);
  2051. #if 0
  2052. if((RKG_TxBuf[0] == 0x0D)&&(RKG_TxBuf[1] == 0x0A))
  2053. HAL_UART_Transmit(&huart1,RKG_TxBuf,12,100);
  2054. else
  2055. HAL_UART_Transmit(&huart1,RKG_TxBuf,8,100);
  2056. delay_sys_us(80);
  2057. #else
  2058. HAL_UART_Transmit_IT(&huart1,RKG_TxBuf,Uart_len_TouChuan);
  2059. while (huart1.gState == HAL_UART_STATE_BUSY_TX)
  2060. {
  2061. osDelay(1);
  2062. }
  2063. #endif
  2064. HAL_GPIO_WritePin(GPIOB,Con01_uart1_rankonggai_Pin,GPIO_PIN_SET);//
  2065. }
  2066. i002++;
  2067. if((flagU1Rx==1) && (i002 > 3))
  2068. {
  2069. pkzq->USE_RKG = 0;
  2070. i002 = 0;
  2071. continue;
  2072. }
  2073. }
  2074. //来自UART1,即人孔盖总线的命令 电路板上标志位人孔盖
  2075. if(flagU1Rx==1)
  2076. {
  2077. flagU1Rx = 0;
  2078. receive_error = 0;
  2079. rx_len = USART1_RX_BUF002[2];
  2080. ModbusCRC = USART1_RX_BUF002[(3+rx_len)]<<8;
  2081. ModbusCRC |= USART1_RX_BUF002[(3+rx_len+1)];
  2082. //if((USART1_RX_BUF002[0] == 0x0D)&&(USART1_RX_BUF002[1] == 0x0A)) //slm
  2083. ////head = 2;
  2084. // else
  2085. // head = 0;
  2086. #if 0
  2087. if(USART1_RX_BUF002[0]!=0x31)
  2088. {
  2089. prkg[1].RKDG_ErrorCnt++;
  2090. if(prkg[1].RKDG_ErrorCnt>200)
  2091. {
  2092. prkg[1].RKDG_ErrorCnt = 201;
  2093. prkg[1].RKDG_Error = 1;
  2094. }
  2095. }
  2096. if(USART1_RX_BUF002[0]!=0x32)
  2097. {
  2098. prkg[2].RKDG_ErrorCnt++;
  2099. if(prkg[2].RKDG_ErrorCnt>200)
  2100. {
  2101. prkg[2].RKDG_ErrorCnt = 201;
  2102. prkg[2].RKDG_Error = 1;
  2103. }
  2104. }
  2105. #endif
  2106. if(USART1_RX_BUF002[head+0] >= 0x30 && USART1_RX_BUF002[head+0] <= 0x3F) //人孔大盖数据 地址0x30为基准传感器
  2107. {
  2108. // rx_len = USART1_RX_BUF002[2];
  2109. // ModbusCRC1 = USART1_RX_BUF002[(3+rx_len)+1]<<8;
  2110. // ModbusCRC1 |= USART1_RX_BUF002[(3+rx_len)];
  2111. //prkg[USART1_RX_BUF002[head+0]-0x30].RTData_Num = 1;
  2112. if(USART1_RX_BUF002[head+1]!=0x03&&USART1_RX_BUF002[head+1]!=0x06) //校验读写属性
  2113. {
  2114. receive_error = 1;
  2115. }
  2116. else if(USART1_RX_BUF002[head+2] != 0x04) //校验数据长度
  2117. {
  2118. receive_error = 1;
  2119. }
  2120. else if(ModbusCRC != LIB_CRC_MODBUS(USART1_RX_BUF002,7)) //校验CRC
  2121. {
  2122. // pcang->CRC2 = LIB_CRC_MODBUS(USART1_RX_BUF002,7);
  2123. receive_error = 1;
  2124. }
  2125. // if((pcang->RKG_Type == 0)&&(USART1_RX_BUF002[head]>=0x30)&&(USART1_RX_BUF002[head] <=0x4F))
  2126. RKG_angle = (USART1_RX_BUF002[head+4]<<8)|USART1_RX_BUF002[head+3];
  2127. // else
  2128. // RKG_angle = (USART1_RX_BUF002[head+3]<<8)|USART1_RX_BUF002[head+4];
  2129. if((USART1_RX_BUF002[head+1] == 0x03)&&(receive_error == 0)) //读取数据返回
  2130. {//童赟 磁电编码 磁编码 人孔盖
  2131. prkg[USART1_RX_BUF002[head]-0x30].RKDG_ErrorCnt = 0;
  2132. prkg[USART1_RX_BUF002[head]-0x30].RKDG_Error=0;
  2133. //prkg[USART1_RX_BUF002[head]-0x30].RTData_Num = 1;
  2134. AGL_AddNewData(RKG_angle,USART1_RX_BUF002[head]);
  2135. //邵磊明修改 20211027 从rkg.c剪切到此处
  2136. if(psATsk3[USART1_RX_BUF002[head]-0x30].uiDG < 0 ||psATsk3[USART1_RX_BUF002[head]-0x30].uiDG >= 27000)//角度
  2137. {
  2138. prkg[USART1_RX_BUF002[head]-0x30].RKDG_ErrorCnt++;
  2139. }
  2140. // if( - psATsk3[USART1_RX_BUF002[head]-0x30].uiDG > prkg->RKG_Threshold || psATsk3[USART1_RX_BUF002[head]-0x30].uiDG > prkg->RKG_Threshold)
  2141. // prkg[USART1_RX_BUF002[head]-0x30].RKDG_StateCnt++;
  2142. // else
  2143. // prkg[USART1_RX_BUF002[head]-0x30].RKDG_StateCnt = 0;
  2144. if(pcang->RKG_Type == 0)
  2145. AGL_CalcDeltaAll(USART1_RX_BUF002[head],0);
  2146. #if 0 //倾角大盖计算
  2147. if(rkdg_cnt < RKG_BUF_DEP)
  2148. {
  2149. if(USART1_RX_BUF002[head] == 0x30)
  2150. {
  2151. prkg[USART1_RX_BUF002[head] - 0x30].RKG_JZData[rkdg_cnt] = RKG_angle;
  2152. }
  2153. else
  2154. {
  2155. prkg[USART1_RX_BUF002[head] - 0x30].RKG_DGData[rkdg_cnt] = RKG_angle;
  2156. rkdg_cnt++;
  2157. }
  2158. }
  2159. if(rkdg_cnt == RKG_BUF_DEP)
  2160. {
  2161. rkdg_cnt = 0;
  2162. }
  2163. #endif
  2164. //李伟修改 20211027 从rkg.c剪切到此处;开始
  2165. if (psATsk3[USART1_RX_BUF002[head] - 0x30].uiDG >= 0 || psATsk3[USART1_RX_BUF002[head] - 0x30].uiDG <= 27000) //角度
  2166. {
  2167. if (-psATsk3[USART1_RX_BUF002[head] - 0x30].uiDG > prkg->RKG_Threshold || psATsk3[USART1_RX_BUF002[head] - 0x30].uiDG > prkg->RKG_Threshold)
  2168. prkg[USART1_RX_BUF002[head] - 0x30].RKDG_StateCnt++;
  2169. else
  2170. prkg[USART1_RX_BUF002[head] - 0x30].RKDG_StateCnt = 0;
  2171. if (prkg[USART1_RX_BUF002[head] - 0x30].RKDG_StateCnt >= prkg[USART1_RX_BUF002[head] - 0x30].RKG_StateKeepNum)
  2172. {
  2173. // RisingEdge++;
  2174. prkg[USART1_RX_BUF002[head] - 0x30].RKDG_StateCnt = prkg[USART1_RX_BUF002[head] - 0x30].RKG_StateKeepNum;
  2175. prkg[USART1_RX_BUF002[head] - 0x30].RKDG_State = 1;
  2176. }
  2177. else
  2178. {
  2179. prkg[USART1_RX_BUF002[head] - 0x30].RKDG_State = 0;
  2180. }
  2181. }
  2182. //李伟修改 20211027 从rkg.c剪切到此处;开始
  2183. i001 = 3;
  2184. continue;
  2185. }
  2186. }
  2187. else if(USART1_RX_BUF002[head+0] >= 0x40 && USART1_RX_BUF002[head+0] <= 0x4F) //人孔小盖数据 地址0x30为基准传感器
  2188. {
  2189. prkg[USART1_RX_BUF002[head] - 0x30].RKXG_ErrorCnt = 0;
  2190. prkg[USART1_RX_BUF002[head+0]-0x40].RTData_Num = 1;
  2191. if(USART1_RX_BUF002[head+1]!=0x03&&USART1_RX_BUF002[head+1]!=0x06) //校验读写属性
  2192. {
  2193. receive_error = 1;
  2194. }
  2195. else if(USART1_RX_BUF002[head+2] != 0x04) //校验数据长度
  2196. {
  2197. receive_error = 1;
  2198. }
  2199. else if(ModbusCRC != LIB_CRC_MODBUS(USART1_RX_BUF002,7)) //校验CRC
  2200. {
  2201. receive_error = 1;
  2202. }
  2203. if((USART1_RX_BUF002[head+1] == 0x03)&&(receive_error == 0)) //读取数据返回
  2204. {
  2205. AGL_AddNewData((USART1_RX_BUF002[head+3]<<8)|USART1_RX_BUF002[head+4],USART1_RX_BUF002[head]);
  2206. if(rkxg_cnt < RKG_BUF_DEP)
  2207. {
  2208. prkg[USART1_RX_BUF002[head] - 0x40].RKG_XGData[rkxg_cnt] = USART1_RX_BUF002[head+4]<<8;
  2209. prkg[USART1_RX_BUF002[head] - 0x40].RKG_XGData[rkxg_cnt] |= USART1_RX_BUF002[head+3];
  2210. rkxg_cnt++;
  2211. }
  2212. if(rkxg_cnt == RKG_BUF_DEP)
  2213. {
  2214. rkxg_cnt = 0;
  2215. }
  2216. }
  2217. else if((USART1_RX_BUF002[head+1] == 0x06)&&(receive_error == 0)) //写入数据返回
  2218. {
  2219. }
  2220. i001 = 6;
  2221. continue;
  2222. }
  2223. else if(USART1_RX_BUF002[0] >= 0x50 && USART1_RX_BUF002[0] <= 0x5F) //液位计数据 邵磊明增加
  2224. {
  2225. if(pcang->Level == 1) //磁致伸缩传感器接收数据 邵磊明增加
  2226. {
  2227. plevel[USART1_RX_BUF002[0]-0x50].RTData_Num = 1;//液位计信息数量
  2228. plevel[USART1_RX_BUF002[0]-0x50].Level_ErrorCnt = 0;
  2229. if(USART1_RX_BUF002[1]!=0x04) //校验功能码USART1_RX_BUF002[1]!=0x04&&..
  2230. {
  2231. receive_error = 1;
  2232. }
  2233. else if(USART1_RX_BUF002[2] != 0x20) //校验数据长度
  2234. {
  2235. receive_error = 1;
  2236. }
  2237. else if(ModbusCRC != LIB_CRC_MODBUS(USART1_RX_BUF002,35)) //校验CRC
  2238. {
  2239. receive_error = 1;
  2240. }
  2241. if((USART1_RX_BUF002[head+1] == 0x04)&&(receive_error == 0)) //读取返回雷达数据 slm
  2242. {
  2243. hex_to_float.arr[0] = USART1_RX_BUF002[5];
  2244. hex_to_float.arr[1] = USART1_RX_BUF002[6];
  2245. hex_to_float.arr[2] = USART1_RX_BUF002[3];
  2246. hex_to_float.arr[3] = USART1_RX_BUF002[4];
  2247. plevel[USART1_RX_BUF002[head]-0x50].Level_Data = hex_to_float.QDGH_data_temp;
  2248. hex_to_float.arr[0] = USART1_RX_BUF002[13];
  2249. hex_to_float.arr[1] = USART1_RX_BUF002[14];
  2250. hex_to_float.arr[2] = USART1_RX_BUF002[11];
  2251. hex_to_float.arr[3] = USART1_RX_BUF002[12];
  2252. plevel[USART1_RX_BUF002[head]-0x50].Avr_temp = hex_to_float.QDGH_data_temp;
  2253. hex_to_float.arr[0] = USART1_RX_BUF002[17];
  2254. hex_to_float.arr[1] = USART1_RX_BUF002[18];
  2255. hex_to_float.arr[2] = USART1_RX_BUF002[15];
  2256. hex_to_float.arr[3] = USART1_RX_BUF002[16];
  2257. plevel[USART1_RX_BUF002[head]-0x50].Avr_temp = hex_to_float.QDGH_data_temp;
  2258. hex_to_float.arr[0] = USART1_RX_BUF002[21];
  2259. hex_to_float.arr[1] = USART1_RX_BUF002[22];
  2260. hex_to_float.arr[2] = USART1_RX_BUF002[19];
  2261. hex_to_float.arr[3] = USART1_RX_BUF002[20];
  2262. plevel[USART1_RX_BUF002[head]-0x50].Bdot_temp = hex_to_float.QDGH_data_temp;
  2263. hex_to_float.arr[0] = USART1_RX_BUF002[25];
  2264. hex_to_float.arr[1] = USART1_RX_BUF002[26];
  2265. hex_to_float.arr[2] = USART1_RX_BUF002[23];
  2266. hex_to_float.arr[3] = USART1_RX_BUF002[24];
  2267. plevel[USART1_RX_BUF002[head]-0x50].Cdot_temp = hex_to_float.QDGH_data_temp;
  2268. }
  2269. else if((USART1_RX_BUF002[head+1] == 0x06)&&(receive_error == 0)) //写入数据返回
  2270. {
  2271. }
  2272. }
  2273. else if(pcang->Level == 2) //雷达液位传感器接收数据 邵磊明增加
  2274. {
  2275. plevel[USART1_RX_BUF002[0]-0x50].RTData_Num = 1;//液位计信息数量
  2276. plevel[USART1_RX_BUF002[0]-0x50].Level_ErrorCnt = 0;
  2277. if(USART1_RX_BUF002[1]!=0x04) //校验功能码USART1_RX_BUF002[1]!=0x04&&..
  2278. {
  2279. receive_error = 1;
  2280. }
  2281. else if(USART1_RX_BUF002[2] != 0x04) //校验数据长度
  2282. {
  2283. receive_error = 1;
  2284. }
  2285. else if(ModbusCRC != LIB_CRC_MODBUS(USART1_RX_BUF002,7)) //校验CRC
  2286. {
  2287. receive_error = 1;
  2288. }
  2289. pcang->CRC1 = LIB_CRC_MODBUS(USART1_RX_BUF002,7);
  2290. if((USART1_RX_BUF002[head+1] == 0x04)&&(receive_error == 0)) //读取返回雷达数据 slm
  2291. {//液位计数据 液位仪数据
  2292. hex_to_float.arr[0] = USART1_RX_BUF002[4];
  2293. hex_to_float.arr[1] = USART1_RX_BUF002[3];
  2294. hex_to_float.arr[2] = USART1_RX_BUF002[6];
  2295. hex_to_float.arr[3] = USART1_RX_BUF002[5];
  2296. plevel[USART1_RX_BUF002[head]-0x50].Level_Data = hex_to_float.QDGH_data_temp;
  2297. }
  2298. else if((USART1_RX_BUF002[head+1] == 0x06)&&(receive_error == 0)) //写入数据返回
  2299. {
  2300. }
  2301. }
  2302. i001 = 9;
  2303. continue;
  2304. }
  2305. else if(USART1_RX_BUF002[0] >=0x60 && USART1_RX_BUF002[0] <= 0x6f) //华天三点式温度传感器接收数据 邵磊明增加
  2306. {
  2307. ptem[CMD_GetTempHuaTian[0] - 0x60].RTData_Num = 1;//三点测温
  2308. ptem[CMD_GetTempHuaTian[0] - 0x60].TEM_ErrorCnt = 0;
  2309. if(USART1_RX_BUF002[1]!=0x03&&USART1_RX_BUF002[1]!=0x06) //校验读写属性
  2310. {
  2311. receive_error = 1;
  2312. }
  2313. else if(USART1_RX_BUF002[2] != 0x02) //校验数据长度
  2314. {
  2315. receive_error = 1;
  2316. }
  2317. else if(ModbusCRC != LIB_CRC_MODBUS(USART1_RX_BUF002,5)) //校验CRC
  2318. {
  2319. receive_error = 1;
  2320. }
  2321. else if((USART1_RX_BUF002[head+1] == 0x03)&&(receive_error == 0))
  2322. {
  2323. if(pcang->Temperture==1) //1点
  2324. {
  2325. ptem[USART1_RX_BUF002[head]-0x60].TEM_HData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2326. ptem[USART1_RX_BUF002[head]-0x60].TEM_MData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2327. ptem[USART1_RX_BUF002[head]-0x60].TEM_LData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2328. }
  2329. else if(pcang->Temperture==3) //1点
  2330. {
  2331. i = USART1_RX_BUF002[head]-0x61;
  2332. switch (i%3)
  2333. {
  2334. case 0:
  2335. ptem[(i/3)+1].TEM_HData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2336. break;
  2337. case 1:
  2338. ptem[(i/3)+1].TEM_MData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2339. break;
  2340. case 2:
  2341. ptem[(i/3)+1].TEM_LData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2342. break;
  2343. default:
  2344. break;
  2345. }
  2346. }
  2347. #if 0
  2348. switch(USART1_RX_BUF002[head])//pcang->Temperture&0xFF
  2349. {
  2350. case 0x61:
  2351. ptem[USART1_RX_BUF002[head]-0x60].TEM_HData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2352. break;
  2353. case 0x62:
  2354. ptem[USART1_RX_BUF002[head]-0x61].TEM_MData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2355. break;
  2356. case 0x63:
  2357. ptem[USART1_RX_BUF002[head]-0x62].TEM_LData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2358. break;
  2359. case 0x64:
  2360. ptem[USART1_RX_BUF002[head]-0x62].TEM_HData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2361. break;
  2362. case 0x65:
  2363. ptem[USART1_RX_BUF002[head]-0x63].TEM_MData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2364. break;
  2365. case 0x66:
  2366. ptem[USART1_RX_BUF002[head]-0x64].TEM_LData[1] = USART1_RX_BUF002[3]<<8|USART1_RX_BUF002[4];
  2367. break;
  2368. default:
  2369. break;
  2370. }
  2371. #endif
  2372. }
  2373. i001 = 0;
  2374. continue;
  2375. }
  2376. else if(0) //暂未使用
  2377. {
  2378. }
  2379. else if(0) //暂未使用
  2380. {
  2381. }
  2382. }
  2383. else
  2384. {
  2385. if (i001 == 2)
  2386. {
  2387. if(pcang->RKG_Type == 0)
  2388. {
  2389. if(CMD_RKG[0] == 0x30)
  2390. {
  2391. if(i003==1)
  2392. i = rkgaddr_max;
  2393. else if(i003)
  2394. i = i003-1;
  2395. else
  2396. i = 1;
  2397. }
  2398. else
  2399. {
  2400. i = 0;
  2401. }
  2402. }
  2403. else
  2404. {
  2405. if(CMD_RKG[0] == 0x31)
  2406. {
  2407. i = rkgaddr_max;
  2408. }
  2409. else
  2410. {
  2411. i = CMD_RKG[0] - 0x31;
  2412. }
  2413. }
  2414. prkg[i].RKDG_ErrorCnt++;
  2415. if (prkg[i].RKDG_ErrorCnt > 3)
  2416. {
  2417. prkg[i].RKDG_ErrorCnt = 11;
  2418. prkg[i].RKDG_Error = 1;
  2419. }
  2420. }
  2421. if (i001 == 8) //液位错误
  2422. {
  2423. if(pcang->Level == 1)
  2424. {
  2425. i = CMD_GetTempAndYewei[0];
  2426. }
  2427. else if(pcang->Level == 2)
  2428. {
  2429. i = CMD_LDYW[0];
  2430. }
  2431. if(pcang->Level)
  2432. {
  2433. if(i==0x51)
  2434. {
  2435. i = leveladdr_max;
  2436. }
  2437. else
  2438. {
  2439. i = i - 0x51;
  2440. }
  2441. plevel[i].Level_ErrorCnt++;
  2442. }
  2443. }
  2444. }
  2445. if(i001<0x0c)
  2446. i001++;
  2447. else
  2448. i001 = 0;
  2449. osDelay(40);
  2450. }
  2451. /* USER CODE END StartTask03 */
  2452. }
  2453. /* USER CODE BEGIN Header_StartTask04 */
  2454. /**
  2455. * @brief Function implementing the myTask04 thread.
  2456. * @param argument: Not used
  2457. * @retval None
  2458. */
  2459. #include "Data_deal.h"
  2460. uint8_t USART2_RX_BUF003[128];
  2461. uint8_t F_STATE[70] = {0};
  2462. uint8_t ptxCang01Temp[150];
  2463. uint32_t KZQ_RTerror = 0;
  2464. /* USER CODE END Header_StartTask04 */
  2465. void StartTask04(void *argument) //控制器数据处理 uart2
  2466. {
  2467. /* USER CODE BEGIN StartTask04 */
  2468. /* Infinite loop */
  2469. uint8_t* ptx = CMD_KZQ;
  2470. uint16_t ModbusCRC = 0,SetSuccess = 0,ModbusCRC1 = 0,SetSuccess1 = 0,SetSuccess2=0,SetSuccess3=0;
  2471. static uint16_t i = 0;
  2472. int i000;
  2473. uint8_t* send_ptr;
  2474. uint16_t send_len;
  2475. KZQ_Inf* pkzq = &kzq_inf;
  2476. extern uint8_t USART2_RX_BUF002[Uart2_BUF_SIZE];
  2477. extern int data_lengthU2;
  2478. extern int flagU2Rx;
  2479. extern uint8_t USART2_RX_BUF002_print[Uart2_BUF_SIZE];
  2480. /* Infinite loop */
  2481. for(;;)
  2482. {
  2483. osDelay(50); //以ms为单位
  2484. // HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0);
  2485. HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
  2486. if(flagU2Rx==1)
  2487. {
  2488. flagU2Rx=0;
  2489. //KZQ_RTerror = 0;
  2490. //ASC转换为16进制,收到数据为:3901开头的数据总长度131字节
  2491. if((USART2_RX_BUF002[0] == 0x3A) && (USART2_RX_BUF002[1] == 0x33)&& (USART2_RX_BUF002[2] == 0x39)&& (USART2_RX_BUF002[3] == 0x30)) //判断帧头
  2492. {
  2493. if(data_lengthU2!=131)
  2494. {
  2495. ++KZQ_RTerror;
  2496. continue;
  2497. }
  2498. for(i000=0;i000<(data_lengthU2-3)/2;i000++)
  2499. {
  2500. T2C_RemoteCaliDat001.PayLoadData[i000]=MODBUS_ASCII_AsciiToHex(USART2_RX_BUF002+1+0+i000*2);
  2501. USART2_RX_BUF003[i000]=MODBUS_ASCII_AsciiToHex(USART2_RX_BUF002+1+0+i000*2);
  2502. }
  2503. //解析后的数据拷贝过来
  2504. memcpy(USART2_RX_BUF002,USART2_RX_BUF003,(data_lengthU2-3)/2);
  2505. data_lengthU2=(data_lengthU2-3)/2;
  2506. }
  2507. if(data_lengthU2<5)
  2508. continue;
  2509. ModbusCRC = USART2_RX_BUF002[data_lengthU2-1]<<8;
  2510. ModbusCRC |= USART2_RX_BUF002[data_lengthU2-2];
  2511. ModbusCRC1 = LIB_CRC_MODBUS(USART2_RX_BUF002,data_lengthU2-2);
  2512. if((USART2_RX_BUF002[0] != 0x39) && (USART2_RX_BUF002[1] <= 0x01)&& (USART2_RX_BUF002[2] <= 0x95)&& (USART2_RX_BUF002[3] <= 0x50)) //判断帧头
  2513. {
  2514. pkzq->KZQ_Error++;
  2515. KZQ_RTerror = 1;
  2516. }
  2517. else if(USART2_RX_BUF002[5]!=0x01) //校验地址
  2518. {
  2519. pkzq->KZQ_Error++;
  2520. KZQ_RTerror = 1;
  2521. }
  2522. else if((USART2_RX_BUF002[7] != 0x03)&&(USART2_RX_BUF002[7] != 0x06)) //校验数据长度
  2523. {
  2524. pkzq->KZQ_Error++;
  2525. KZQ_RTerror = 1;
  2526. }
  2527. /*else if(ModbusCRC != ModbusCRC1) //校验CRC
  2528. {
  2529. pkzq->KZQ_Error++;
  2530. KZQ_RTerror = 1;
  2531. }*/
  2532. else
  2533. {
  2534. pkzq->KZQ_Error = 0;
  2535. KZQ_RTerror=0;
  2536. for(i = 0;i < 64;i++)
  2537. pkzq->data_buf[i] = USART2_RX_BUF002[i];
  2538. for(i = 0;i < 16;i++)
  2539. ptx[i] = USART2_RX_BUF002[i];
  2540. }
  2541. if(KZQ_RTerror == 0)
  2542. {
  2543. pkzq->sensor_reg = USART2_RX_BUF002[8];
  2544. pkzq->sensor_reg = pkzq->sensor_reg<<8;
  2545. pkzq->sensor_reg |= USART2_RX_BUF002[9];
  2546. switch(pkzq->sensor_reg)
  2547. {
  2548. case 0x10: RstCPU(); //复位
  2549. break;
  2550. case 0x11:
  2551. break;
  2552. case 0x12:
  2553. break;
  2554. case 0x13: Sen_CangState_old(F_STATE); //老协议 传输阀门状态
  2555. break;
  2556. case 0x20: SetSuccess = Read_CangState(ptx); //读取仓状态
  2557. break;
  2558. case 0x21:
  2559. break;
  2560. case 0x22:
  2561. break;
  2562. case 0x23:
  2563. break;
  2564. case 0x24:
  2565. break;
  2566. case 0x25:
  2567. break;
  2568. case 0x26:
  2569. break;
  2570. case 0x27: SetSuccess = Read_CangSensorData(ptx); //读取仓传感器
  2571. break;
  2572. case 0x28:
  2573. break;
  2574. case 0x29:
  2575. break;
  2576. case 0x40: SetSuccess = Angle_SetZero(ptx); //姿态传感器置零
  2577. for(i = 0;i < 64;i++)
  2578. ptx[i] = USART2_RX_BUF002[i];
  2579. break;
  2580. case 0x41:
  2581. break;
  2582. case 0x42:
  2583. break;
  2584. case 0x43:
  2585. break;
  2586. case 0x50: SetSuccess = XYF_SetOFF(ptx); //远程卸油阀标定关 slm
  2587. for(i = 0;i < 64;i++)
  2588. ptx[i] = USART2_RX_BUF002[i];
  2589. break;
  2590. case 0x51: SetSuccess = XYF_SetThreshold(ptx); //设置卸油阀传感器开关门限
  2591. break;
  2592. case 0x52: SetSuccess = RKG_SetZero(ptx); //人孔盖传感器置零
  2593. for(i = 0;i < 64;i++)
  2594. ptx[i] = USART2_RX_BUF002[i];
  2595. break;
  2596. case 0x53:
  2597. break;
  2598. case 0x54:
  2599. break;
  2600. case 0x55: SetSuccess = Read_Sensor(ptx); // 远程读取传感器数据 slm
  2601. break;
  2602. case 0x70:
  2603. break;
  2604. case 0x71: SetSuccess = BGY_SetThreshold(ptx); //设置壁挂油门限
  2605. break;
  2606. case 0x72: SetSuccess = RKG_SetThreshold(ptx); //设置人孔盖开关门限
  2607. break;
  2608. case 0x73: SetSuccess = Sensor_SetJudgefNum(ptx); //设置开关判断次数
  2609. break;
  2610. case 0x74: SetSuccess = CJQ_SetConfig(ptx); //设置采集器参数
  2611. Flash_Change = 1;
  2612. break;
  2613. case 0x75: SetSuccess = RKG_SetTypeNum(ptx); //设置人孔盖种类、数量
  2614. Flash_Change = 1;
  2615. break;
  2616. case 0x76: SetSuccess = XYF_SetTypeNum(ptx); //设置卸油阀种类、数量
  2617. Flash_Change = 1;
  2618. break;
  2619. case 0x77: SetSuccess = HDF_SetTypeNum(ptx); //设置海底阀种类、数量
  2620. Flash_Change = 1;
  2621. break;
  2622. case 0x78: SetSuccess = Level_SetType(ptx); //设置液位计种类
  2623. Flash_Change = 1;
  2624. break;
  2625. case 0x79: SetSuccess = Angle_SetType(ptx); //设置姿态传感器种类
  2626. Flash_Change = 1;
  2627. break;
  2628. case 0x7a: SetSuccess = Tem_SetType(ptx); //设置温度传感器种类
  2629. // Flash_Change = 1;
  2630. break;
  2631. case 0x7b: HDF_Set_CloseVal(ptx); //设置智能海底阀放大倍数
  2632. Flash_Change = 1;
  2633. break;
  2634. case 0x7c: HDF_Set_Threshold(ptx); //设置智能海底阀放大倍数
  2635. Flash_Change = 1;
  2636. break;
  2637. case 0x7d: HDF_Set_Gain(ptx); //设置智能海底阀放大倍数
  2638. Flash_Change = 1;
  2639. break;
  2640. case 0x7e: HDF_Reset(ptx); //设置智能海底阀放大倍数
  2641. Flash_Change = 1;
  2642. break;
  2643. case 0x017e: TOUCHUAN_UART_NUM(ptx); //设置智能海底阀放大倍数
  2644. Flash_Change = 1;
  2645. break;
  2646. case 0x0180: SetSuccess = GRB_SET_Table(ptx); //罐容表配置 邵磊明增加
  2647. Flash_Change = 1;
  2648. break;
  2649. case 0x0190: SetSuccess = Level_SetCalvalue(ptx); //设置液位计零点 邵磊明增加
  2650. Flash_Change = 1;
  2651. case 0x0121: //SetSuccess = Level_SetCalvalue(ptx); //设置液位计种类
  2652. // Flash_Change = 1;
  2653. break;
  2654. case 0x0122://SetSuccess = Level_SetCalvalue(ptx); //设置液位计种类
  2655. // Flash_Change = 1;
  2656. break;
  2657. case 0x0220:
  2658. SetSuccess=Read_SoftVersion(ptx);
  2659. break;
  2660. case 0x1121:
  2661. SetSuccess1 = Read_CangSensorData_1to4(ptx); //读仓1-4传感器
  2662. break;
  2663. case 0x1193:
  2664. SetSuccess2 = Read_CangSensorData_1(ptx); //读仓1传感器
  2665. break;
  2666. case 0x1194:
  2667. SetSuccess2 = Read_CangSensorData_2(ptx); //读仓2传感器
  2668. break;
  2669. case 0x1195:
  2670. SetSuccess2 = Read_CangSensorData_3(ptx); //读仓3传感器
  2671. break;
  2672. case 0x1196:
  2673. SetSuccess2 = Read_CangSensorData_4(ptx); //读仓4传感器
  2674. break;
  2675. case 0x1197:
  2676. SetSuccess2 = Read_CangSensorData_5(ptx); //读仓5传感器
  2677. break;
  2678. case 0x1198:
  2679. SetSuccess2 = Read_CangSensorData_6(ptx); //读仓6传感器
  2680. break;
  2681. case 0x1199:
  2682. SetSuccess2 = Read_CangSensorData_7(ptx); //读仓7传感器
  2683. break;
  2684. case 0x119a:
  2685. SetSuccess2 = Read_CangSensorData_8(ptx); //读仓8传感器
  2686. break;
  2687. case 0x119b:
  2688. SetSuccess3 = Read_ZhencheSensorData1(ptx); //读仓1-4传感器
  2689. break;
  2690. default:
  2691. break;
  2692. }
  2693. send_len=0;
  2694. if(pkzq->sensor_reg == 0x13)
  2695. {
  2696. send_ptr = F_STATE;
  2697. send_len = 62;
  2698. }
  2699. else if(SetSuccess2)
  2700. {
  2701. SetSuccess2=0;
  2702. send_ptr = ptx;
  2703. send_len = 148;
  2704. }
  2705. else if(SetSuccess3)
  2706. {
  2707. SetSuccess3=0;
  2708. send_ptr = ptx;
  2709. send_len = 96;
  2710. }
  2711. else if(SetSuccess1)
  2712. {
  2713. SetSuccess1=0;
  2714. ptx[232] = 0x00;
  2715. ptx[233] = 0x00;
  2716. send_ptr = ptx;
  2717. send_len = 234;
  2718. }
  2719. else if(SetSuccess)
  2720. {
  2721. ptx[60] = 0x00;
  2722. ptx[61] = 0x00;
  2723. send_ptr = ptx;
  2724. send_len = 62;
  2725. }
  2726. else
  2727. {
  2728. ptx[60] = 0xFF;
  2729. ptx[61] = 0xFF;
  2730. send_ptr = ptx;
  2731. send_len = 62;
  2732. }
  2733. SetSuccess = 0;
  2734. if(send_len)
  2735. {
  2736. ModbusCRC = LIB_CRC_MODBUS(send_ptr,send_len);
  2737. send_ptr[send_len] = ModbusCRC>>8;
  2738. send_ptr[send_len+1] = ModbusCRC&0xff;
  2739. HAL_GPIO_WritePin(GPIOA,con03_uart2_kongzhiqi_Pin,GPIO_PIN_RESET);//
  2740. delay_sys_us(80);
  2741. HAL_UART_Transmit_IT(&huart2,send_ptr,send_len+2);
  2742. while (huart2.gState == HAL_UART_STATE_BUSY_TX)
  2743. {
  2744. osDelay(1);
  2745. }
  2746. delay_sys_us(80);
  2747. HAL_GPIO_WritePin(GPIOA,con03_uart2_kongzhiqi_Pin,GPIO_PIN_SET);//
  2748. }
  2749. }
  2750. flagU2Rx = 0;
  2751. }
  2752. }
  2753. /* USER CODE END StartTask04 */
  2754. }
  2755. /* USER CODE BEGIN Header_StartTask05 */
  2756. /**
  2757. * @brief Function implementing the myTask05 thread.
  2758. * @param argument: Not used
  2759. * @retval None
  2760. */
  2761. /* USER CODE END Header_StartTask05 */
  2762. #include"level.h"
  2763. void StartTask05(void *argument)
  2764. {
  2765. /* USER CODE BEGIN StartTask05 */
  2766. /* Infinite loop */
  2767. Level_Inf* plevel = level_inf;
  2768. Cang_Inf* pcang = &cang_inf;
  2769. uint8_t i;
  2770. float v000;
  2771. uint16_t* VolArrayTsk05=Volume_1cang;
  2772. const uint16_t* HArrayTsk05=H_1cang;
  2773. for(;;)
  2774. {
  2775. HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
  2776. AGL_JudgeState();
  2777. for(i = 0;i < pcang->Cang_Num;i++)
  2778. {
  2779. //Value_Manage(i);
  2780. //for(uint8_t i = 0;i < 5;i++)
  2781. {
  2782. switch (i)
  2783. {
  2784. case 0:
  2785. //VolArrayTsk05=Volume_1cang;
  2786. // HArrayTsk05=H_1cang;
  2787. break;
  2788. case 1:
  2789. VolArrayTsk05=Volume_1cang;
  2790. HArrayTsk05=H_1cang;
  2791. break;
  2792. case 2:
  2793. VolArrayTsk05=Volume_2cang;
  2794. HArrayTsk05=H_2cang;
  2795. break;
  2796. case 3:
  2797. VolArrayTsk05=Volume_3cang;
  2798. HArrayTsk05=H_3cang;
  2799. break;
  2800. case 4:
  2801. VolArrayTsk05=Volume_4cang;
  2802. HArrayTsk05=H_4cang;
  2803. break;
  2804. default:
  2805. //VolArrayTsk05=Volume_1cang;
  2806. // HArrayTsk05=H_1cang;
  2807. break;
  2808. }
  2809. v000=Calc_Vol(plevel[i].Level_Data,VolArrayTsk05,HArrayTsk05,i);
  2810. plevel[i].Volume_Data=v000;
  2811. DF_State(i);
  2812. //BGY_state(i);
  2813. osDelay(100);
  2814. }
  2815. }
  2816. }
  2817. /* USER CODE END StartTask05 */
  2818. }
  2819. /* USER CODE BEGIN Header_StartTask06 */
  2820. /**
  2821. * @brief Function implementing the myTask06 thread.
  2822. * @param argument: Not used
  2823. * @retval None
  2824. */
  2825. /* USER CODE END Header_StartTask06 */
  2826. void StartTask06(void *argument)
  2827. {
  2828. /* USER CODE BEGIN StartTask06 */
  2829. /* Infinite loop */
  2830. for(;;)
  2831. {
  2832. osDelay(1);
  2833. }
  2834. /* USER CODE END StartTask06 */
  2835. }
  2836. /* USER CODE BEGIN Header_StartTask07 */
  2837. /**
  2838. * @brief Function implementing the myTask07 thread.
  2839. * @param argument: Not used
  2840. * @retval None
  2841. */
  2842. /* USER CODE END Header_StartTask07 */
  2843. void StartTask07(void *argument)
  2844. {
  2845. /* USER CODE BEGIN StartTask07 */
  2846. /* Infinite loop */
  2847. for(;;)
  2848. {
  2849. osDelay(1);
  2850. }
  2851. /* USER CODE END StartTask07 */
  2852. }
  2853. /* USER CODE BEGIN Header_StartTask08 */
  2854. /**
  2855. * @brief Function implementing the myTask08 thread.
  2856. * @param argument: Not used
  2857. * @retval None
  2858. */
  2859. /* USER CODE END Header_StartTask08 */
  2860. void StartTask08(void *argument)
  2861. {
  2862. /* USER CODE BEGIN StartTask08 */
  2863. /* Infinite loop */
  2864. for(;;)
  2865. {
  2866. osDelay(1);
  2867. }
  2868. /* USER CODE END StartTask08 */
  2869. }
  2870. /* USER CODE BEGIN Header_StartTask09 */
  2871. /**
  2872. * @brief Function implementing the myTask09 thread.
  2873. * @param argument: Not used
  2874. * @retval None
  2875. */
  2876. /* USER CODE END Header_StartTask09 */
  2877. void StartTask09(void *argument)
  2878. {
  2879. /* USER CODE BEGIN StartTask09 */
  2880. /* Infinite loop */
  2881. for(;;)
  2882. {
  2883. osDelay(1);
  2884. }
  2885. /* USER CODE END StartTask09 */
  2886. }
  2887. /* USER CODE BEGIN Header_StartTask10 */
  2888. /**
  2889. * @brief Function implementing the myTask10 thread.
  2890. * @param argument: Not used
  2891. * @retval None
  2892. */
  2893. /* USER CODE END Header_StartTask10 */
  2894. void StartTask10(void *argument)
  2895. {
  2896. /* USER CODE BEGIN StartTask10 */
  2897. /* Infinite loop */
  2898. for(;;)
  2899. {
  2900. osDelay(1);
  2901. }
  2902. /* USER CODE END StartTask10 */
  2903. }
  2904. /* USER CODE BEGIN Header_StartTask11 */
  2905. /**
  2906. * @brief Function implementing the myTask11 thread.
  2907. * @param argument: Not used
  2908. * @retval None
  2909. */
  2910. /* USER CODE END Header_StartTask11 */
  2911. void StartTask11(void *argument)
  2912. {
  2913. /* USER CODE BEGIN StartTask11 */
  2914. /* Infinite loop */
  2915. for(;;)
  2916. {
  2917. osDelay(1);
  2918. }
  2919. /* USER CODE END StartTask11 */
  2920. }
  2921. /* USER CODE BEGIN Header_StartTask12 */
  2922. /**
  2923. * @brief Function implementing the myTask12 thread.
  2924. * @param argument: Not used
  2925. * @retval None
  2926. */
  2927. /* USER CODE END Header_StartTask12 */
  2928. void StartTask12(void *argument)
  2929. {
  2930. /* USER CODE BEGIN StartTask12 */
  2931. /* Infinite loop */
  2932. for(;;)
  2933. {
  2934. osDelay(500);
  2935. usage_Tsk12++;
  2936. HAL_GPIO_TogglePin(GPIOA,GPIO_PIN_0);
  2937. HAL_GPIO_TogglePin(WDI_sp706_kanmemgou_GPIO_Port, WDI_sp706_kanmemgou_Pin);
  2938. }
  2939. /* USER CODE END StartTask12 */
  2940. }
  2941. /* Callback01 function */
  2942. void Callback01(void *argument)
  2943. {
  2944. /* USER CODE BEGIN Callback01 */
  2945. /* USER CODE END Callback01 */
  2946. }
  2947. /* Callback02 function */
  2948. void Callback02(void *argument)
  2949. {
  2950. /* USER CODE BEGIN Callback02 */
  2951. /* USER CODE END Callback02 */
  2952. }
  2953. /* Callback03 function */
  2954. void Callback03(void *argument)
  2955. {
  2956. /* USER CODE BEGIN Callback03 */
  2957. /* USER CODE END Callback03 */
  2958. }
  2959. /* Callback04 function */
  2960. void Callback04(void *argument)
  2961. {
  2962. /* USER CODE BEGIN Callback04 */
  2963. /* USER CODE END Callback04 */
  2964. }
  2965. /* Callback05 function */
  2966. void Callback05(void *argument)
  2967. {
  2968. /* USER CODE BEGIN Callback05 */
  2969. /* USER CODE END Callback05 */
  2970. }
  2971. /* Callback06 function */
  2972. void Callback06(void *argument)
  2973. {
  2974. /* USER CODE BEGIN Callback06 */
  2975. /* USER CODE END Callback06 */
  2976. }
  2977. /* Callback07 function */
  2978. void Callback07(void *argument)
  2979. {
  2980. /* USER CODE BEGIN Callback07 */
  2981. /* USER CODE END Callback07 */
  2982. }
  2983. /* Callback08 function */
  2984. void Callback08(void *argument)
  2985. {
  2986. /* USER CODE BEGIN Callback08 */
  2987. /* USER CODE END Callback08 */
  2988. }
  2989. /* Callback09 function */
  2990. void Callback09(void *argument)
  2991. {
  2992. /* USER CODE BEGIN Callback09 */
  2993. /* USER CODE END Callback09 */
  2994. }
  2995. /* Callback010 function */
  2996. void Callback010(void *argument)
  2997. {
  2998. /* USER CODE BEGIN Callback010 */
  2999. /* USER CODE END Callback010 */
  3000. }
  3001. /**
  3002. * @brief Period elapsed callback in non blocking mode
  3003. * @note This function is called when TIM8 interrupt took place, inside
  3004. * HAL_TIM_IRQHandler(). It makes a direct call to HAL_IncTick() to increment
  3005. * a global variable "uwTick" used as application time base.
  3006. * @param htim : TIM handle
  3007. * @retval None
  3008. */
  3009. void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
  3010. {
  3011. /* USER CODE BEGIN Callback 0 */
  3012. /* USER CODE END Callback 0 */
  3013. if (htim->Instance == TIM8) {
  3014. HAL_IncTick();
  3015. }
  3016. /* USER CODE BEGIN Callback 1 */
  3017. /* USER CODE END Callback 1 */
  3018. }
  3019. /**
  3020. * @brief This function is executed in case of error occurrence.
  3021. * @retval None
  3022. */
  3023. void Error_Handler(void)
  3024. {
  3025. /* USER CODE BEGIN Error_Handler_Debug */
  3026. /* User can add his own implementation to report the HAL error return state */
  3027. __disable_irq();
  3028. while (1)
  3029. {
  3030. }
  3031. /* USER CODE END Error_Handler_Debug */
  3032. }
  3033. #ifdef USE_FULL_ASSERT
  3034. /**
  3035. * @brief Reports the name of the source file and the source line number
  3036. * where the assert_param error has occurred.
  3037. * @param file: pointer to the source file name
  3038. * @param line: assert_param error line source number
  3039. * @retval None
  3040. */
  3041. void assert_failed(uint8_t *file, uint32_t line)
  3042. {
  3043. /* USER CODE BEGIN 6 */
  3044. /* User can add his own implementation to report the file name and line number,
  3045. ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
  3046. /* USER CODE END 6 */
  3047. }
  3048. #endif /* USE_FULL_ASSERT */
  3049. /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/