main.c 93 KB

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