1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591 |
- #include "config.h"
- #include "rkg.h"
- #include "cang.h"
- #include "kzq.h"
- #include "level.h"
- #include "tem.h"
- #include "angle.h"
- #include "xyf.h"
- #include "kzq.h"
- #include "hdf.h"
- #include "cmsis_armcc.h"
- #include "usart.h"
- #include "yqhs.h"
- #include "bgy.h"
- uint8_t RKG_TxBuf[70] = {0};
- uint8_t XYF_TxBuf[70] = {0};
- uint8_t ALL_TxBuf[70] = {0};
- #define State_Error 3
- #define State_Off 0
- #define State_On 1
- #define PowerOnTime_Delay 0x00002000
- KZQ_Inf kzq_inf;
- extern uint16_t Uart_len_TouChuan;
- #include "stm32f1xx_hal.h"
- extern uint32_t HAL_GetTick(void);
- uint32_t tickMain=0;
-
- uint16_t Read_CangState(uint8_t* pTx)
- {
- Biguayou_Inf* pBGY = biguayou_inf;
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- RKG_Inf* prkg = rkg_inf;
- XYF_Inf* pxyf = xyf_inf;
- HDF_Inf* phdf = hdf_inf;
- Yqhuishou_Inf* pYqhuishou = &yqhuishou_inf;
- uint8_t HDF_Start = 0,XYF_Start = 0,RKG_Start = 0,BGY_Start = 0,Cang_Num = 0,i = 0;
-
-
- Cang_Num = pkzq->data_buf[17]; //slm
- if(Cang_Num < 1 ||Cang_Num > 8)
- return 0;
- for(i = 0;i < Cang_Num - 1;i++)
- {
- HDF_Start += pcang->HDF_Num[i];
- XYF_Start += pcang->XYF_Num[i];
- RKG_Start += pcang->RKG_Num[i];
- BGY_Start += pcang->BGY_Num[i];
- }
- pTx[11] = 40;
- pTx[17] = pkzq->data_buf[17];
- //阀门状态
- /*************第一组阀门状态***************/
-
- if(phdf[HDF_Start+1].HDF_Error)
- pTx[18] = State_Error;
- else
- pTx[18] = Get_DFState(HDF_Start+1); //获取罐仓1号底阀状态
-
- if(pxyf[XYF_Start+1].XYF_Error)
- pTx[19] = State_Error;
- else
- pTx[19] = pxyf[XYF_Start+1].XYF_State1; //获取罐仓1号卸油阀状态 pxyf[XYF_Start+1].XYF_Data1[0] ;
- tickMain=HAL_GetTick();
- if(prkg[RKG_Start+1].RKDG_Error)
- {
- pTx[20] = State_Error;
- pTx[21] = State_Error;
-
- }
- else
- {
- pTx[20] = prkg[RKG_Start+1].RKDG_State; //获取罐仓1号人孔大盖状态
- pTx[21] = prkg[RKG_Start+1].RKXG_State; //获取罐仓1号人孔小盖状态
-
- }
-
- if(pxyf[XYF_Start+1].XYF_Error)
- pTx[22] = State_Error;
- else
- pTx[22] = pxyf[XYF_Start+1].XYF_State2; //获取罐仓1号卸尽状态
-
-
- //新增壁挂油传感器状态 邵磊明20210916
- if(pBGY[BGY_Start+1].BGY_Error)
- {
- pTx[23] = State_Error;
- }
- else
- {
- pTx[23] = pBGY[BGY_Start+1].BGY_State;
- }
- //新增油气回收传感器状态 邵磊明20210918
- pTx[24] = pYqhuishou[1].Yqhuishou_SSWD[0];
- //新增智能海底阀传感器状态 邵磊明20210919
- if(phdf[HDF_Start+1].HDF_Error)
- pTx[25] = (phdf[HDF_Start+1].HDF_Data[1]);
- else
- pTx[25] = (phdf[HDF_Start+1].HDF_Data[1]); //获取罐仓1号底阀状态
-
- pTx[26] = 0xA5;
- pTx[27] = 0xA5;
- /*************第二组阀门状态***************/
- if(pcang->HDF_Num[Cang_Num - 1] > 1)
- {
- if(phdf[HDF_Start+2].HDF_Error)
- pTx[28] = State_Error;
- else
- pTx[28] = Get_DFState(HDF_Start+2); //获取罐仓2号底阀状态
- }
- else
- pTx[28] = 0xA5;
- if(pcang->XYF_Num[Cang_Num - 1] > 1)
- {
- if( pxyf[XYF_Start+2].XYF_Error)
- {
- pTx[29] = State_Error;
- pTx[32] = State_Error;
- }
- else
- {
- pTx[29] = pxyf[XYF_Start+2].XYF_State1; //获取罐仓2号卸油阀状态
- pTx[32] = pxyf[XYF_Start+2].XYF_State2; //获取罐仓2号卸尽状态
- }
- }
- else
- {
- pTx[29] = 0xA5;
- pTx[32] = 0xA5;
- }
- if(pcang->RKG_Num[Cang_Num - 1] > 1)
- {
- if(prkg[RKG_Start+2].RKDG_Error)
- {
- pTx[30] = State_Error;
- pTx[31] = State_Error;
- }
- else
- {
- pTx[30] = prkg[RKG_Start+2].RKDG_State; //获取罐仓2号人孔大盖状态
- pTx[31] = prkg[RKG_Start+2].RKXG_State; //获取罐仓2号人孔小盖状态
- }
- }
- else
- {
- pTx[30] = 0xA5;
- pTx[31] = 0xA5;
- }
- pTx[33] = 0xA5;
- pTx[34] = 0xA5;
- pTx[35] = 0xA5;
- pTx[36] = 0xA5;
- pTx[37] = 0xA5;
- /***********第三组阀门状态***************/
- if(pcang->HDF_Num[Cang_Num - 1] > 2)
- {
- if(phdf[HDF_Start+3].HDF_Error)
- pTx[38] = State_Error;
- else
- pTx[38] = Get_DFState(HDF_Start+3); //获取罐仓3号底阀状态
- }
- else
- pTx[38] = 0xA5;
-
- if(pcang->XYF_Num[Cang_Num - 1] > 2)
- {
- if(pxyf[XYF_Start+3].XYF_Error)
- {
- pTx[39] = State_Error;
- pTx[42] = State_Error;
- }
- else
- {
- pTx[39] = pxyf[XYF_Start+3].XYF_State1; //获取罐仓3号卸油阀状态
- pTx[42] = pxyf[XYF_Start+3].XYF_State2; //获取罐仓3号卸尽状态
-
- }
- }
- else
- {
- pTx[39] = 0xA5;
- pTx[42] = 0xA5;
- }
-
- if(pcang->RKG_Num[Cang_Num - 1] > 2)
- {
- if(prkg[RKG_Start+3].RKDG_Error)
- {
- pTx[40] = State_Error;
- pTx[41] = State_Error;
- }
- else
- {
- pTx[40] = prkg[RKG_Start+3].RKDG_State; //获取罐仓3号人孔大盖状态
- pTx[41] = prkg[RKG_Start+3].RKXG_State; //获取罐仓3号人孔小盖状态
- }
- }
- else
- {
- pTx[40] = 0xA5;
- pTx[41] = 0xA5;
- }
- pTx[43] = 0xA5;
- pTx[44] = 0xA5;
- pTx[45] = 0xA5;
- pTx[46] = 0xA5;
- pTx[47] = 0xA5;
- /***********第四组阀门状态***************/
- if(pcang->HDF_Num[Cang_Num - 1] > 3)
- {
- if(phdf[HDF_Start+4].HDF_Error)
- pTx[48] = State_Error;
- else
- pTx[48] = Get_DFState(HDF_Start+4); //获取罐仓4号底阀状态
- }
- else
- pTx[48] = 0xA5;
-
- if(pcang->XYF_Num[Cang_Num - 1] > 3)
- {
- if(pxyf[XYF_Start+4].XYF_Error)
- {
- pTx[49] = State_Error;
- pTx[52] = State_Error;
- }
- pTx[49] = pxyf[XYF_Start+4].XYF_State1; //获取罐仓4号卸油阀状态
- pTx[52] = pxyf[XYF_Start+4].XYF_State2; //获取罐仓4号卸尽状态
- }
- else
- {
- pTx[49] = 0xA5;
- pTx[52] = 0xA5;
- }
- if(pcang->RKG_Num[Cang_Num - 1] > 4)
- {
- if(prkg[RKG_Start+4].RKDG_Error)
- {
- pTx[50] = State_Error;
- pTx[51] = State_Error;
- }
- else
- {
- pTx[50] = prkg[RKG_Start+4].RKDG_State; //获取罐仓4号人孔大盖状态
- pTx[51] = prkg[RKG_Start+4].RKXG_State; //获取罐仓4号人孔小盖状态
- }
- }
- else
- {
- pTx[50] = 0xA5;
- pTx[51] = 0xA5;
- }
-
- pTx[53] = 0xA5;
- pTx[54] = 0xA5;
- pTx[55] = 0xA5;
- pTx[56] = 0xA5;
- pTx[57] = 0xA5;
-
-
- //李伟添加 20211027 上电的10s之内 强制输出状态是受控的 全部是关闭状态
- if(tickMain<PowerOnTime_Delay)
- {
- pTx[20] = State_Off;//大盖
- pTx[21] = State_Off;//小盖
- pTx[22] = State_Off; //卸尽
- pTx[22] = State_Off; ///////李伟增加 壁挂油
- pTx[23] = State_Off;
-
- pTx[20+10*1] = State_Off;//大盖
- pTx[21+10*1] = State_Off;//小盖
- pTx[22+10*1] = State_Off; //卸尽
- pTx[22+10*1] = State_Off; ///////李伟增加 壁挂油
- pTx[23+10*1] = State_Off;
-
- pTx[20+10*2] = State_Off;//大盖
- pTx[21+10*2] = State_Off;//小盖
- pTx[22+10*2] = State_Off; //卸尽
- pTx[22+10*2] = State_Off; ///////李伟增加 壁挂油
- pTx[23+10*2] = State_Off;
-
- pTx[20+10*3] = State_Off;//大盖
- pTx[21+10*3] = State_Off;//小盖
- pTx[22+10*3] = State_Off; //卸尽
- pTx[22+10*3] = State_Off; ///////李伟增加 壁挂油
- pTx[23+10*3] = State_Off;
- }
-
-
- return 1;
- }
- void Sen_CangState_old(uint8_t* F_STATE)
- {
- Cang_Inf* pcang = &cang_inf;
- RKG_Inf* prkg = rkg_inf;
- XYF_Inf* pxyf = xyf_inf;
- uint8_t HDF_Num = 0,XYF_Num = 0,RKG_Num = 0,i = 0,j = 0,k = 0;
-
- F_STATE[0] = 0xAA;
- F_STATE[1] = 0x00;
- F_STATE[2] = 0xA1;
- F_STATE[3] = 0x11;
- F_STATE[4] = 0x00;
-
- for(k = 0;k < 8;k++) //查询1-8仓状态
- {//for(k = 0;k < 8;k++) //查询1-8仓 状态 开始
- i = k*2;
- F_STATE[5+i] = 0x00;
- F_STATE[6+i] = 0x00;
- j = 0;
- while(j < pcang->RKG_Num[k]) //查询1-8仓所有人孔盖数据
- {
- if(prkg[j+1+RKG_Num].RKDG_Error)
- F_STATE[5+i] |= BIT5;
- else if(prkg[j+1+RKG_Num].RKDG_State)
- F_STATE[5+i] |= BIT1;
-
- if(pcang->RKG_XG)//小盖状态或运算
- {
- if(prkg[j+1+RKG_Num].RKXG_Error)
- F_STATE[5+i] |= BIT6;
- else if(prkg[j+1+RKG_Num].RKXG_State)
- F_STATE[5+i] |= BIT2;
- }
- j++;
- //RKG_Num++;
- }
- RKG_Num+=j;
- j = 0;
- while(j < pcang->XYF_Num[k])////卸油阀状态或运算
- {
- if(pxyf[j+1+XYF_Num].XYF_Error)
- {
- F_STATE[5+i] |= BIT8;
- F_STATE[6+i] |= 0x55;
- }
- else
- {
- if(pxyf[j+1+XYF_Num].XYF_State1)
- F_STATE[5+i] |= BIT4;
- if(pxyf[j+1+XYF_Num].XYF_State2)
- F_STATE[6+i] = BIT1;//1;
- }
- j++;
- // XYF_Num++;
- }
- XYF_Num+=j;
- j = 0;
-
- while(j < pcang->HDF_Num[k])
- {
- if(Get_DFState(j+1+HDF_Num) == 1)
- F_STATE[5+i] |= BIT3;
- else if(Get_DFState(j+1+HDF_Num) == 0)
- {
- ;//F_STATE[5+i] &= ~BIT3;
- }
- else
- F_STATE[5+i] &= BIT7;
- j++;
-
- }
- HDF_Num+=j;
-
- j = 0;
- }////for(k = 0;k < 8;k++) //查询1-8仓 状态 结束
-
-
- }
- #define Angle_cs (180.0f/32768.0f)
- uint16_t Read_ZhencheSensorData1(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- // Level_Inf* plevel = level_inf;
- // HDF_Inf* phdf = hdf_inf;
- // Biguayou_Inf* pBGY = biguayou_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t i = 0;
- hex_to_float.float_temp = (float)pangle->Angle_DataX[0]*Angle_cs;
- pTx[16] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[17] = hex_to_float.arr[1];
- pTx[18] = hex_to_float.arr[2];
- pTx[19] = hex_to_float.arr[3];
- hex_to_float.float_temp = (float)pangle->Angle_DataY[0]*Angle_cs;
- pTx[20] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[21] = hex_to_float.arr[1];
- pTx[22] = hex_to_float.arr[2];
- pTx[23] = hex_to_float.arr[3];
- hex_to_float.float_temp = (float)pangle->Angle_DataZ[0]*Angle_cs;
- pTx[24] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[25] = hex_to_float.arr[1];
- pTx[26] = hex_to_float.arr[2];
- pTx[27] = hex_to_float.arr[3];
-
- for(i = 0;i < 228;i++) //铅封
- {
- pTx[28+i] = 0xa5;
- }
-
- return 1;
- }
- #if 0
- /*
- 8仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_8(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 8,i = 0;
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Avr_temp;
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Adot_temp;
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Bdot_temp;
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Cdot_temp;
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- return 1;
- }
- /*
- 7仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_7(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 7,i = 0;
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Avr_temp;
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Adot_temp;
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Bdot_temp;
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Cdot_temp;
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- return 1;
- }
- /*
- 6仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_6(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 6,i = 0;
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Avr_temp;
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Adot_temp;
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Bdot_temp;
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Cdot_temp;
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- return 1;
- }
- /*
- 5仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_5(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 5,i = 0;
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Avr_temp;
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Adot_temp;
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Bdot_temp;
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Cdot_temp;
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- return 1;
-
- }
- /*
- 4仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_4(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 4,i = 0;
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Avr_temp;
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Adot_temp;
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Bdot_temp;
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Cdot_temp;
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- return 1;
- }
- /*
- 3仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_3(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 3,i = 0;
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Avr_temp;
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Adot_temp;
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Bdot_temp;
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Cdot_temp;
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- return 1;
- }
- /*
- 2仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_2(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- RKG_Inf* prkg = rkg_inf;
- XYF_Inf* pxyf = xyf_inf;
- Yqhuishou_Inf* pYqhuishou = &yqhuishou_inf;
-
- // static float test_val=100;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 2,i = 0,HDF_Start = 0,XYF_Start = 0,RKG_Start = 0,BGY_Start = 0;
- if(Cang_Num < 1 ||Cang_Num > 8)
- return 0;
- for(i = 0;i < Cang_Num - 1;i++)
- {
- HDF_Start += pcang->HDF_Num[i];
- XYF_Start += pcang->XYF_Num[i];
- RKG_Start += pcang->RKG_Num[i];
- BGY_Start += pcang->BGY_Num[i];
- }
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- if(phdf[HDF_Start+1].HDF_Error)
- pTx[36+8] = State_Error;
- else
- pTx[36+8] = Get_DFState(HDF_Start+1); //获取罐仓1号底阀状态
-
- if(pxyf[XYF_Start+1].XYF_Error)
- pTx[40+8] = State_Error;
- else
- pTx[40+8] = pxyf[XYF_Start+1].XYF_State1; //获取罐仓1号卸油阀状态 pxyf[XYF_Start+1].XYF_Data1[0] ;
-
- if(prkg[RKG_Start+1].RKDG_Error)
- {
- pTx[44+8] = State_Error;
- pTx[48+8] = State_Error;
- }
- else
- {
- pTx[44+8] = prkg[RKG_Start+1].RKDG_State; //获取罐仓1号人孔大盖状态
- pTx[48+8] = prkg[RKG_Start+1].RKXG_State; //获取罐仓1号人孔小盖状态
- }
-
- if(pxyf[XYF_Start+1].XYF_Error)
- pTx[52+8] = State_Error;
- else
- pTx[52+8] = pxyf[XYF_Start+1].XYF_State2; //获取罐仓1号卸尽状态
- // pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- // pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- // pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- // pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- // pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data1;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_MData[1]*(0.1f));
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_HData[1]*(0.1f));
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_MData[1]*(0.1f));
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_LData[1]*(0.1f));
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[(Cang_Num-0)].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- return 1;
- }
- /*
- 1仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_1(uint8_t* pTx)//邵磊明增加
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- RKG_Inf* prkg = rkg_inf;
- XYF_Inf* pxyf = xyf_inf;
- Yqhuishou_Inf* pYqhuishou = &yqhuishou_inf;
- //static float test_val=100;
- extern uint8_t ptxCang01Temp[150];
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 1,i = 0,HDF_Start = 0,XYF_Start = 0,RKG_Start = 0,BGY_Start = 0;
- if(Cang_Num < 1 ||Cang_Num > 8)
- return 0;
- for(i = 0;i < Cang_Num - 1;i++)
- {
- HDF_Start += pcang->HDF_Num[i];
- XYF_Start += pcang->XYF_Num[i];
- RKG_Start += pcang->RKG_Num[i];
- BGY_Start += pcang->BGY_Num[i];
- }
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- if(phdf[HDF_Start+1].HDF_Error)
- pTx[36+8] = State_Error;
- else
- pTx[36+8] = Get_DFState(HDF_Start+1); //获取罐仓1号底阀状态
-
- if(pxyf[XYF_Start+1].XYF_Error)
- pTx[40+8] = State_Error;
- else
- pTx[40+8] = pxyf[XYF_Start+1].XYF_State1; //获取罐仓1号卸油阀状态 pxyf[XYF_Start+1].XYF_Data1[0] ;
-
- if(prkg[RKG_Start+1].RKDG_Error)
- {
- pTx[44+8] = State_Error;
- pTx[48+8] = State_Error;
- }
- else
- {
- pTx[44+8] = prkg[RKG_Start+1].RKDG_State; //获取罐仓1号人孔大盖状态
- pTx[48+8] = prkg[RKG_Start+1].RKXG_State; //获取罐仓1号人孔小盖状态
- }
-
- if(pxyf[XYF_Start+1].XYF_Error)
- pTx[52+8] = State_Error;
- else
- pTx[52+8] = pxyf[XYF_Start+1].XYF_State2; //获取罐仓1号卸尽状态
- // pTx[36+8] = pBGY[Cang_Num].BGY_SSWD[0]; //底
- pTx[37+8] = 0;
- pTx[38+8] = 0;
- pTx[39+8] = 0;
- // pTx[40+8] = pBGY[Cang_Num].BGY_SVAL[0]; //卸
- pTx[41+8] = 0;
- pTx[42+8] = 0;
- pTx[43+8] = 0;
- // pTx[44+8] = pBGY[Cang_Num].BGY_SSWD[0]; //大倾角
- pTx[45+8] = 0;
- pTx[46+8] = 0;
- pTx[47+8] = 0;
- // pTx[48+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小倾角
- pTx[49+8] = 0;
- pTx[50+8] = 0;
- pTx[51+8] = 0;
- // pTx[52+8] = pBGY[Cang_Num].BGY_SVAL[0]; //尽
- pTx[53+8] = 0;
- pTx[54+8] = 0;
- pTx[55+8] = 0;
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data1;
- pTx[95+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_MData[1]*(0.1f));
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_HData[1]*(0.1f));
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_MData[1]*(0.1f));
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_LData[1]*(0.1f));
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- // test_val++;
- // for(i=0;i<4;i++) //for test
- // {
- // hex_to_float.float_temp = test_val;//plevel[Cang_Num].Level_Data;//(10.56+test_val);
- // pTx[108+i*4] = hex_to_float.arr[0];
- // pTx[109+i*4] = hex_to_float.arr[1];
- // pTx[110+i*4] = hex_to_float.arr[2];
- // pTx[111+i*4] = hex_to_float.arr[3];
- // }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[(Cang_Num-0)].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = hex_to_float.arr[0];
- pTx[132+9] = hex_to_float.arr[1];
- pTx[133+9] = hex_to_float.arr[2];
- pTx[134+9] = hex_to_float.arr[3];
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
-
- // memcpy(ptxCang01Temp,&pTx[0],150);
-
- return 1;
- }
- #endif
- /*
- 1仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_V2(uint8_t* pTx, uint8_t Cang_Num) // add by guoqiang
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- HDF_Inf* phdf = hdf_inf;
- Biguayou_Inf* pBGY = biguayou_inf;
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- RKG_Inf* prkg = rkg_inf;
- XYF_Inf* pxyf = xyf_inf;
- Yqhuishou_Inf* pYqhuishou = &yqhuishou_inf;
- //static float test_val=100;
- extern uint8_t ptxCang01Temp[150];
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t i = 0,HDF_Start = 0,XYF_Start = 0,RKG_Start = 0,BGY_Start = 0;
- if(Cang_Num < 1 ||Cang_Num > 8)
- return 0;
- for(i = 0;i < Cang_Num - 1;i++)
- {
- HDF_Start += pcang->HDF_Num[i];
- XYF_Start += pcang->XYF_Num[i];
- RKG_Start += pcang->RKG_Num[i];
- BGY_Start += pcang->BGY_Num[i];
- }
- for(i = 0;i < 4;i++) //铅封
- {
- pTx[16+i] = 0;
- }
- pTx[20] = phdf[Cang_Num].HDF_OFData[1]; //浮球
- pTx[21] = 0;
- pTx[22] = 0;
- pTx[23] = 0;
- pTx[24] = phdf[Cang_Num].HDF_OFState; //活塞杆
- pTx[25] = 0;
- pTx[26] = 0;
- pTx[27] = 0;
- pTx[28] = pBGY[Cang_Num].BGY_SSWD[0]; //壁挂油光电
- pTx[29] = 0;
- pTx[30] = 0;
- pTx[31] = 0;
- pTx[32] = pBGY[Cang_Num].BGY_SVAL[0]; //壁挂油霍尔
- pTx[33] = 0;
- pTx[34] = 0;
- pTx[35] = 0;
-
- pTx[36] = pBGY[Cang_Num].BGY_SSWD[0]; //油气回收光电
- pTx[37] = 0;
- pTx[38] = 0;
- pTx[39] = 0;
- pTx[40] = pBGY[Cang_Num].BGY_SVAL[0]; //油气回收霍尔
- pTx[41] = 0;
- pTx[42] = 0;
- pTx[43] = 0;
- // hdf
- if(pcang->HDF_Num[Cang_Num - 1] > 0)
- {
- for(i = 0;i < 4;i++){ //the max is 4
- if(i<pcang->HDF_Num[Cang_Num - 1])
- pTx[44+i]= phdf[HDF_Start+i+1].HDF_Error? State_Error:Get_DFState(HDF_Start+i+1);
- else
- pTx[44+i]=0xA5;
- }
- }else{
- for(i = 0;i < 4;i++){
- pTx[44+i]=0xA5;
- }
- }
-
- // xyf
- if(pcang->XYF_Num[Cang_Num - 1] > 0)
- {
- for(i = 0;i < 4;i++){ //the max is 4
- if(i<pcang->XYF_Num[Cang_Num - 1])
- pTx[48+i]= pxyf[XYF_Start+i+1].XYF_Error? State_Error:pxyf[XYF_Start+i+1].XYF_State1;
- else
- pTx[48+i]=0xA5;
- }
- }else{
- for(i = 0;i < 4;i++){
- pTx[48+i]=0xA5;
- }
- }
-
- //rkdg & rkxg
- if(pcang->RKG_Num[Cang_Num - 1] > 0)
- {
- for(i = 0;i < 4;i++){ //the max is 4
- if(i < pcang->RKG_Num[Cang_Num - 1]){
- pTx[52+i]= prkg[RKG_Start+i+1].RKDG_Error? State_Error:prkg[RKG_Start+i+1].RKDG_State;
- pTx[56+i]= prkg[RKG_Start+i+1].RKDG_Error? State_Error:prkg[RKG_Start+i+1].RKXG_State;
- }
- else{
- pTx[52+i]=0xA5;
- pTx[56+i]=0xA5;
- }
- }
-
- }else{
- for(i = 0;i < 4;i++){
- pTx[52+i]=0xA5;
- pTx[56+i]=0xA5;
- }
- }
-
-
- // xj status
- if(pcang->XYF_Num[Cang_Num - 1] > 0)
- {
- for(i = 0;i < 4;i++){ //the max is 4
- if(i<pcang->XYF_Num[Cang_Num - 1])
- pTx[60+i]= pxyf[XYF_Start+i+1].XYF_Error? State_Error:pxyf[XYF_Start+i+1].XYF_State2;
- else
- pTx[60+i]=0xA5;
- }
- }else{
- for(i = 0;i < 4;i++){
- pTx[60+i]=0xA5;
- }
- }
-
- pTx[56+8] = pBGY[Cang_Num].BGY_SVAL[0]; //大磁电
- pTx[57+8] = 0;
- pTx[58+8] = 0;
- pTx[59+8] = 0;
- pTx[60+8] = pBGY[Cang_Num].BGY_SVAL[0]; //小磁电
- pTx[61+8] = 0;
- pTx[62+8] = 0;
- pTx[63+8] = 0;
-
- for(i = 0;i < 32;i++) //保留32Byte
- {
- pTx[72+i] = 0;
- }
-
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[95+9] = 0;
- pTx[96+9] = 0;
- pTx[97+9] = 0;
- pTx[98+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data1;
- pTx[95+9] = hex_to_float.arr[0];
- pTx[96+9] = hex_to_float.arr[1];
- pTx[97+9] = hex_to_float.arr[2];
- pTx[98+9] = hex_to_float.arr[3];
-
- }
-
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[99+9] = 0;
- pTx[100+9] = 0;
- pTx[101+9] = 0;
- pTx[102+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_MData[1]*(0.1f));
- pTx[99+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[100+9] = hex_to_float.arr[1];
- pTx[101+9] = hex_to_float.arr[2];
- pTx[102+9] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[103+9] = 0;
- pTx[104+9] = 0;
- pTx[105+9] = 0;
- pTx[106+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_HData[1]*(0.1f));
- pTx[103+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[104+9] = hex_to_float.arr[1];
- pTx[105+9] = hex_to_float.arr[2];
- pTx[106+9] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[107+9] = 0;
- pTx[108+9] = 0;
- pTx[109+9] = 0;
- pTx[110+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_MData[1]*(0.1f));
- pTx[107+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[108+9] = hex_to_float.arr[1];
- pTx[109+9] = hex_to_float.arr[2];
- pTx[110+9] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[111+9] = 0;
- pTx[112+9] = 0;
- pTx[113+9] = 0;
- pTx[114+9] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = ((float)ptem[Cang_Num].TEM_LData[1]*(0.1f));
- pTx[111+9] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[112+9] = hex_to_float.arr[1];
- pTx[113+9] = hex_to_float.arr[2];
- pTx[114+9] = hex_to_float.arr[3];
-
- }
- // test_val++;
- // for(i=0;i<4;i++) //for test
- // {
- // hex_to_float.float_temp = test_val;//plevel[Cang_Num].Level_Data;//(10.56+test_val);
- // pTx[108+i*4] = hex_to_float.arr[0];
- // pTx[109+i*4] = hex_to_float.arr[1];
- // pTx[110+i*4] = hex_to_float.arr[2];
- // pTx[111+i*4] = hex_to_float.arr[3];
- // }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[115+9] = 0x76;
- pTx[116+9] = 0x7F;
- pTx[117+9] = 0xFF;
- pTx[118+9] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[(Cang_Num-0)].Volume_Data;
- pTx[115+9] = hex_to_float.arr[0];
- pTx[116+9] = hex_to_float.arr[1];
- pTx[117+9] = hex_to_float.arr[2];
- pTx[118+9] = hex_to_float.arr[3];
- }
- /**************************压力*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[119+9] = 0;
- pTx[120+9] = 0;
- pTx[121+9] = 0;
- pTx[122+9] = 0;
- }
- /**************************含水量*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[123+9] = 0;
- pTx[124+9] = 0;
- pTx[125+9] = 0;
- pTx[126+9] = 0;
- }
- /**************************水活性*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[127+9] = 0;
- pTx[128+9] = 0;
- pTx[129+9] = 0;
- pTx[130+9] = 0;
- }
- /**************************新增*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[131+9] = 0;
- pTx[132+9] = 0;
- pTx[133+9] = 0;
- pTx[134+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[131+9] = hex_to_float.arr[0];
- pTx[132+9] = hex_to_float.arr[1];
- pTx[133+9] = hex_to_float.arr[2];
- pTx[134+9] = hex_to_float.arr[3];
- }
- /**************************新增********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[135+9] = 0;
- pTx[136+9] = 0;
- pTx[137+9] = 0;
- pTx[138+9] = 0;
- }
-
- // memcpy(ptxCang01Temp,&pTx[0],150);
-
- return 1;
- }
- /*
- 1-4仓数据读
- 功能增加: 邵磊明
- */
- uint16_t Read_CangSensorData_1to4(uint8_t* pTx)//邵磊明增加
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- // Angle_Inf* pangle = &angle_inf;
- // TEM_Inf* ptem = tem_inf;
- // KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t Cang_Num = 1,i = 0;
- /**********************8byte beiyong**********************************/
- for(i = 0;i <= 8;i++)//读取第几仓传感器数据
- {
- pTx[16+i] = 0xa5;
-
- }
- for(i = 0;i <= 8;i++)//读取第几仓传感器数据
- {
- pTx[24+i*4] = 0;
- pTx[25+i*4] = 0;
- pTx[26+i*4] = 0;
- pTx[27+i*4] = 0;
-
- }
-
- for(Cang_Num = 1;Cang_Num <= 4;Cang_Num++)//读取第几仓传感器数据
- {
- /*********************液位传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[56+(Cang_Num-1)*44] = 0;
- pTx[57+(Cang_Num-1)*44] = 0;
- pTx[58+(Cang_Num-1)*44] = 0;
- pTx[59+(Cang_Num-1)*44] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Level_Data;
- pTx[56+(Cang_Num-1)*44] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[57+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[58+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[59+(Cang_Num-1)*44] = hex_to_float.arr[3];
-
- }
- /**********************平均温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[60+(Cang_Num-1)*44] = 0;
- pTx[61+(Cang_Num-1)*44] = 0;
- pTx[62+(Cang_Num-1)*44] = 0;
- pTx[63+(Cang_Num-1)*44] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Avr_temp;
- pTx[60+(Cang_Num-1)*44] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[61+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[62+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[63+(Cang_Num-1)*44] = hex_to_float.arr[3];
-
- }
- /**********************高温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[64+(Cang_Num-1)*44] = 0;
- pTx[65+(Cang_Num-1)*44] = 0;
- pTx[66+(Cang_Num-1)*44] = 0;
- pTx[67+(Cang_Num-1)*44] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Adot_temp;
- pTx[64+(Cang_Num-1)*44] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[65+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[66+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[67+(Cang_Num-1)*44] = hex_to_float.arr[3];
-
- }
- /*********************中温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[68+(Cang_Num-1)*44] = 0;
- pTx[69+(Cang_Num-1)*44] = 0;
- pTx[70+(Cang_Num-1)*44] = 0;
- pTx[71+(Cang_Num-1)*44] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Bdot_temp;
- pTx[68+(Cang_Num-1)*44] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[69+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[70+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[71+(Cang_Num-1)*44] = hex_to_float.arr[3];
-
- }
- /**********************低温度传感器数据**********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[72+(Cang_Num-1)*44] = 0;
- pTx[73+(Cang_Num-1)*44] = 0;
- pTx[74+(Cang_Num-1)*44] = 0;
- pTx[75+(Cang_Num-1)*44] = 0;
-
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Cdot_temp;
- pTx[72+(Cang_Num-1)*44] = hex_to_float.arr[0]; //读取高位温度传感器数据
- pTx[73+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[74+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[75+(Cang_Num-1)*44] = hex_to_float.arr[3];
-
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[76+(Cang_Num-1)*44] = 0x76;
- pTx[77+(Cang_Num-1)*44] = 0x7F;
- pTx[78+(Cang_Num-1)*44] = 0xFF;
- pTx[79+(Cang_Num-1)*44] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[76+(Cang_Num-1)*44] = hex_to_float.arr[0];
- pTx[77+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[78+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[79+(Cang_Num-1)*44] = hex_to_float.arr[3];
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[80+(Cang_Num-1)*44] = 0x76;
- pTx[81+(Cang_Num-1)*44] = 0x7F;
- pTx[82+(Cang_Num-1)*44] = 0xFF;
- pTx[83+(Cang_Num-1)*44] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[80+(Cang_Num-1)*44] = hex_to_float.arr[0];
- pTx[81+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[82+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[83+(Cang_Num-1)*44] = hex_to_float.arr[3];
- }
-
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[84+(Cang_Num-1)*44] = 0x76;
- pTx[85+(Cang_Num-1)*44] = 0x7F;
- pTx[86+(Cang_Num-1)*44] = 0xFF;
- pTx[87+(Cang_Num-1)*44] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[84+(Cang_Num-1)*44] = hex_to_float.arr[0];
- pTx[85+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[86+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[87+(Cang_Num-1)*44] = hex_to_float.arr[3];
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[88+(Cang_Num-1)*44] = 0x76;
- pTx[89+(Cang_Num-1)*44] = 0x7F;
- pTx[90+(Cang_Num-1)*44] = 0xFF;
- pTx[91+(Cang_Num-1)*44] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[88+(Cang_Num-1)*44] = hex_to_float.arr[0];
- pTx[89+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[90+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[91+(Cang_Num-1)*44] = hex_to_float.arr[3];
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[92+(Cang_Num-1)*44] = 0x76;
- pTx[93+(Cang_Num-1)*44] = 0x7F;
- pTx[94+(Cang_Num-1)*44] = 0xFF;
- pTx[95+(Cang_Num-1)*44] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[92+(Cang_Num-1)*44] = hex_to_float.arr[0];
- pTx[93+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[94+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[95+(Cang_Num-1)*44] = hex_to_float.arr[3];
- }
- /**************************读取容积数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[96+(Cang_Num-1)*44] = 0x76;
- pTx[97+(Cang_Num-1)*44] = 0x7F;
- pTx[98+(Cang_Num-1)*44] = 0xFF;
- pTx[99+(Cang_Num-1)*44] = 0x00;
- }
- else
- {
- hex_to_float.float_temp = plevel[Cang_Num].Volume_Data;
- pTx[96+(Cang_Num-1)*44] = hex_to_float.arr[0];
- pTx[97+(Cang_Num-1)*44] = hex_to_float.arr[1];
- pTx[98+(Cang_Num-1)*44] = hex_to_float.arr[2];
- pTx[99+(Cang_Num-1)*44] = hex_to_float.arr[3];
- }
- }
- return 1;
- }
- //单仓数据
- uint16_t Get_CangData(uint8_t* buffer, uint16_t buffer_size, uint8_t CangNo) // add by guoqiang
- {
- Cang_Inf* pcang = &cang_inf;
- HDF_Inf* phdf = hdf_inf;
- XYF_Inf* pxyf = xyf_inf;
- Level_Inf* plevel = level_inf;
- TEM_Inf* ptem = tem_inf;
- RKG_Inf* prkg = rkg_inf;
- typedef union{
- float float_temp; //青鸟贵和磁致伸缩液位温度一体传感器
- uint8_t arr[4];
- }Hex_to_float;
- Hex_to_float hex_to_float;
- uint8_t i = 0,HDF_Start = 0,XYF_Start = 0,RKG_Start = 0,BGY_Start = 0;
- uint16_t offset = 0;
- if(CangNo < 1 ||CangNo > 8)
- return offset;
- if(CangNo > pcang->Cang_Num){
- return offset;
- }
-
- for(i = 0;i < CangNo - 1;i++)
- {
- HDF_Start += pcang->HDF_Num[i];
- XYF_Start += pcang->XYF_Num[i];
- RKG_Start += pcang->RKG_Num[i];
- BGY_Start += pcang->BGY_Num[i];
- }
-
- // hdf
- if(pcang->HDF_Num[CangNo - 1] > 0){
- for(i = 0; i<pcang->HDF_Num[CangNo - 1]; i++){
- if((offset + IO_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_SEAVALVE;
- buffer[offset+1] = ((CangNo << 4)|i); //cang & id
- buffer[offset+2] = 0x00; //IO type
- buffer[offset+3] = phdf[HDF_Start+i+1].HDF_Error? State_Error:Get_DFState(HDF_Start+i+1);
- offset += IO_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- }
-
- // xyf
- if(pcang->XYF_Num[CangNo - 1] > 0){
- for(i = 0; i<pcang->XYF_Num[CangNo - 1]; i++){
- if((offset + IO_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_UNLOADVALVE;
- buffer[offset+1] = ((CangNo << 4)|i); //cang & id
- buffer[offset+2] = 0x00; //IO type
- buffer[offset+3] = pxyf[XYF_Start+i+1].XYF_Error? State_Error:pxyf[XYF_Start+i+1].XYF_State1;
- offset += IO_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- }
-
- //rkdg & rkxg
- if(pcang->RKG_Num[CangNo - 1] > 0){
-
- for(i = 0;i < pcang->RKG_Num[CangNo - 1];i++){
- if((offset + IO_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_BIGCOVER;
- buffer[offset+1] = ((CangNo << 4)|i); //cang & id
- buffer[offset+2] = 0x00; //IO type
- buffer[offset+3] = prkg[RKG_Start+i+1].RKDG_Error? State_Error:prkg[RKG_Start+i+1].RKDG_State;
- offset += IO_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- if(pcang->RKG_XG > 0){ //rkxg
- for(i = 0;i < pcang->RKG_Num[CangNo - 1];i++){
- if((offset + IO_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_SMALLCOVER;
- buffer[offset+1] = ((CangNo << 4)|i); //cang & id
- buffer[offset+2] = 0x00; //IO type
- buffer[offset+3] = prkg[RKG_Start+i+1].RKDG_Error? State_Error:prkg[RKG_Start+i+1].RKXG_State;
- offset += IO_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- }
-
- }
-
-
- // xj status , just one per cang
- if((2 != pcang->XYF_Type )&& (pcang->XYF_Num[CangNo - 1] > 0)){
- for(i = 0; i < pcang->XYF_Num[CangNo - 1]; i++){
-
- if((offset + IO_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_UNLOADSTATUS;
- buffer[offset+1] = ((CangNo << 4)|i); //cang & id
- buffer[offset+2] = 0x00; //IO type
- buffer[offset+3] = (pxyf[XYF_Start+i+1].XYF_Error? State_Error:pxyf[XYF_Start+i+1].XYF_State2);
- offset += IO_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- }
-
- //level
- if(0 != pcang->Level){
- if((1 == pcang->Level) || (2 == pcang->Level)){
- if((offset + ANALOG_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_LIQUID_LEVEL;
- buffer[offset+1] = ((CangNo << 4)|0x00); //cang & id
- buffer[offset+2] = 0x01; //analog type
- buffer[offset+3] = plevel[CangNo].Level_Error? State_Error:0x00;
- hex_to_float.float_temp = plevel[CangNo].Level_Data1;
- buffer[offset+4] = hex_to_float.arr[0];
- buffer[offset+5] = hex_to_float.arr[1];
- buffer[offset+6] = hex_to_float.arr[2];
- buffer[offset+7] = hex_to_float.arr[3];
- offset += ANALOG_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- }
- //temperture
- if(0 != pcang->Temperture){
- if(1 == pcang->Temperture || 3 == pcang->Temperture){
- if((offset + ANALOG_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_TEMPERATURE1;
- buffer[offset+1] = 0;
- buffer[offset+2] = 0x01; //analog type
- buffer[offset+3] = ptem[CangNo].TEM_Error? State_Error:0x00;
- hex_to_float.float_temp = ((float)ptem[CangNo].TEM_HData[1]*(0.1f));
- buffer[offset+4] = hex_to_float.arr[0];
- buffer[offset+5] = hex_to_float.arr[1];
- buffer[offset+6] = hex_to_float.arr[2];
- buffer[offset+7] = hex_to_float.arr[3];
- offset += ANALOG_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- if(3 == pcang->Temperture){
- if((offset + ANALOG_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_TEMPERATURE2;
- buffer[offset+1] = ((CangNo << 4)|0x00); //cang & id
- buffer[offset+2] = 0x01; //analog type
- buffer[offset+3] = ptem[CangNo].TEM_Error? State_Error:0x00;
- hex_to_float.float_temp = ((float)ptem[CangNo].TEM_MData[1]*(0.1f));
- buffer[offset+4] = hex_to_float.arr[0];
- buffer[offset+5] = hex_to_float.arr[1];
- buffer[offset+6] = hex_to_float.arr[2];
- buffer[offset+7] = hex_to_float.arr[3];
- offset += ANALOG_VALUE_SIZE;
- }else{
- return offset;
- }
- if((offset + ANALOG_VALUE_SIZE) <= buffer_size){
- buffer[offset] = SENSOR_TYPE_TEMPERATURE3;
- buffer[offset+1] = ((CangNo << 4)|0x00); //cang & id
- buffer[offset+2] = 0x01; //analog type
- buffer[offset+3] = ptem[CangNo].TEM_Error? State_Error:0x00;
- hex_to_float.float_temp = ((float)ptem[CangNo].TEM_LData[1]*(0.1f));
- buffer[offset+4] = hex_to_float.arr[0];
- buffer[offset+5] = hex_to_float.arr[1];
- buffer[offset+6] = hex_to_float.arr[2];
- buffer[offset+7] = hex_to_float.arr[3];
- offset += ANALOG_VALUE_SIZE;
- }else{
- return offset;
- }
- }
- }
-
- return offset;
- }
- //车身数据
- uint16_t Get_BodyData(uint8_t* buffer, uint16_t buffer_size) // add by guoqiang
- {
- uint16_t offset=0;
-
- return offset;
- }
- uint16_t Get_AllData(uint8_t* buffer, uint16_t buffer_size) // add by guoqiang
- {
- Cang_Inf* pcang = &cang_inf;
- uint16_t offset = 0;
- uint8_t i=0;
- offset += Get_BodyData(buffer+offset, buffer_size-offset);
- for(i=0; i< pcang->Cang_Num; i++){
- offset += Get_CangData(buffer+offset, buffer_size-offset, i+1);
- if((offset+ANALOG_VALUE_SIZE) > buffer_size) {
- return offset;
- }
- }
- return offset;
- }
- /*
- 新的采控传感协议
- 功能增加: 郭强
- */
- void Read_SensorData_New(uint8_t* pTx, uint16_t* tx_len) // add by guoqiang
- {
- KZQ_Inf* pkzq = &kzq_inf;
- uint8_t Cang_Num = 0xFF;
-
- uint8_t* pPayload_len = pTx+11;
- pTx[16] = pkzq->data_buf[16];
- pTx[17] = pkzq->data_buf[17];
- uint16_t data_len = 2;
- uint8_t* buffer = pTx+18;
- uint16_t buffer_size = 256-16-2-2; //the pTx Size is 256.
- Cang_Num = pkzq->data_buf[17];
- switch(Cang_Num){
- case 0x00: //车身
- data_len += Get_BodyData(buffer, buffer_size);
- break;
- case 0x01: //第1仓
- case 0x02: //第2仓
- case 0x03: //第3仓
- case 0x04: //第4仓
- case 0x05: //第5仓
- case 0x06: //第6仓
- case 0x07: //第7仓
- case 0x08: //第8仓
- data_len += Get_CangData(buffer, buffer_size, Cang_Num);
- break;
- case 0x0A: //全部数据
- data_len += Get_AllData(buffer, buffer_size);
- break;
- default: //不支持
- break;
- }
- pTx[10] = data_len>>8;
- pTx[11] = data_len&0xFF;
- *tx_len = data_len+16;
- }
- uint16_t Read_CangSensorData(uint8_t* pTx)
- {
- //传感器数据顺序为温度4字节*3,角度4字节*3,液位4字节*1,容积四字节*1
- Angle_Inf* pangle = &angle_inf;
- TEM_Inf* ptem = tem_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- uint8_t Cang_Num = 0;
-
- Cang_Num = pkzq->data_buf[17]; //读取第几仓传感器数据
- if(Cang_Num < 1 ||Cang_Num > 8)
- return 0;
- pTx[11] = 32; //数据长度
- pTx[17] = pkzq->data_buf[17];
- /**********************温度传感器数据**********************************/
- if(ptem[Cang_Num].TEM_Error)
- {
- pTx[18] = 0x47;
- pTx[19] = 0x7F;
- pTx[20] = 0xFF;
- pTx[21] = 0x00;
-
- pTx[22] = 0x47;
- pTx[23] = 0x7F;
- pTx[24] = 0xFF;
- pTx[25] = 0x00;
-
- pTx[26] = 0x47;
- pTx[27] = 0x7F;
- pTx[28] = 0xFF;
- pTx[29] = 0x00;
- }
- else
- {
- pTx[18] = ptem[Cang_Num].TEM_HData[0]>>24&0xFF; //读取高位温度传感器数据
- pTx[19] = ptem[Cang_Num].TEM_HData[0]>>16&0xFF;
- pTx[20] = ptem[Cang_Num].TEM_HData[0]>>8&0xFF;
- pTx[21] = ptem[Cang_Num].TEM_HData[0]&0xFF;
-
- pTx[22] = ptem[Cang_Num].TEM_MData[0]>>24&0xFF; //读取中位温度传感器数据
- pTx[23] = ptem[Cang_Num].TEM_MData[0]>>16&0xFF;
- pTx[24] = ptem[Cang_Num].TEM_MData[0]>>8&0xFF;
- pTx[25] = ptem[Cang_Num].TEM_MData[0]&0xFF;
-
- pTx[26] = ptem[Cang_Num].TEM_LData[0]>>24&0xFF; //读取低位温度传感器数据
- pTx[27] = ptem[Cang_Num].TEM_LData[0]>>16&0xFF;
- pTx[28] = ptem[Cang_Num].TEM_LData[0]>>8&0xFF;
- pTx[29] = ptem[Cang_Num].TEM_LData[0]&0xFF;
- }
- /**********************读取角度传感器数据**********************************/
- if(pangle->Angle_Error)
- {
- pTx[30] = 0x47;
- pTx[31] = 0x7F;
- pTx[32] = 0xFF;
- pTx[33] = 0x00;
-
- pTx[34] = 0x47;
- pTx[35] = 0x7F;
- pTx[36] = 0xFF;
- pTx[37] = 0x00;
-
- pTx[38] = 0x47;
- pTx[39] = 0x7F;
- pTx[40] = 0xFF;
- pTx[41] = 0x00;
- }
- else
- {
- pTx[30] = pangle->Angle_DataX[0]>>24&0xFF; //读取X轴角度数据
- pTx[31] = pangle->Angle_DataX[0]>>16&0xFF;
- pTx[32] = pangle->Angle_DataX[0]>>8&0xFF;
- pTx[33] = pangle->Angle_DataX[0]&0xFF;
-
- pTx[34] = pangle->Angle_DataY[0]>>24&0xFF; //读取Y轴角度数据
- pTx[35] = pangle->Angle_DataY[0]>>16&0xFF;
- pTx[36] = pangle->Angle_DataY[0]>>8&0xFF;
- pTx[37] = pangle->Angle_DataY[0]&0xFF;
-
- pTx[38] = pangle->Angle_DataZ[0]>>24&0xFF; //读取Z轴角度数据
- pTx[39] = pangle->Angle_DataZ[0]>>16&0xFF;
- pTx[40] = pangle->Angle_DataZ[0]>>8&0xFF;
- pTx[41] = pangle->Angle_DataZ[0]&0xFF;
- }
-
- /**************************读取液位数据*********************************/
- if(plevel[Cang_Num].Level_Error)
- {
- pTx[42] = 0x47;
- pTx[43] = 0x7F;
- pTx[44] = 0xFF;
- pTx[45] = 0x00;
-
- pTx[46] = 0x47;
- pTx[47] = 0x7F;
- pTx[48] = 0xFF;
- pTx[49] = 0x00;
- }
- else
- {
- pTx[42] = (int)plevel[Cang_Num].Level_Data>>24&0xFF;
- pTx[43] = (int)plevel[Cang_Num].Level_Data>>16&0xFF;
- pTx[44] = (int)plevel[Cang_Num].Level_Data>>8&0xFF;
- pTx[45] = (int)plevel[Cang_Num].Level_Data&0xFF;
- /**************************读取容积数据*********************************/
- pTx[46] = (int)plevel[Cang_Num].Volume_Data>>24&0xFF;
- pTx[47] = (int)plevel[Cang_Num].Volume_Data>>16&0xFF;
- pTx[48] = (int)plevel[Cang_Num].Volume_Data>>8&0xFF;
- pTx[49] = (int)plevel[Cang_Num].Volume_Data&0xFF;
- }
- return 1;
- }
- void RstCPU(void)
- {
- uint16_t j;
- __disable_irq();
-
- while(1)
- {
- __set_FAULTMASK(1);
- NVIC_SystemReset();
- while(j --)
- {
- __nop(); __nop(); __nop(); __nop();
- }
- }
- }
- uint16_t Angle_SetZero(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- Angle_Inf* pangle = &angle_inf;
- if( pkzq->USE_XYF == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
- pkzq->USE_XYF = 1;
-
- XYF_TxBuf[0] = pkzq->data_buf[17];
- XYF_TxBuf[1] = 0x06;
- XYF_TxBuf[2] = 0x00;
- XYF_TxBuf[3] = 0x01;
- XYF_TxBuf[4] = 0x00;
- XYF_TxBuf[5] = 0x08;
- Uart_len_TouChuan=6;
- }
- else
- {
- if(pangle->Angle_Error)
- {
- pTx[18] = 0x47;
- pTx[19] = 0x7F;
- pTx[20] = 0xFF;
- pTx[21] = 0x00;
-
- pTx[22] = 0x47;
- pTx[23] = 0x7F;
- pTx[24] = 0xFF;
- pTx[25] = 0x00;
-
- pTx[26] = 0x47;
- pTx[27] = 0x7F;
- pTx[28] = 0xFF;
- pTx[29] = 0x00;
- }
- else
- {
- pTx[18] = pangle->Angle_DataX[0]>>24&0xFF; //读取X轴角度数据
- pTx[19] = pangle->Angle_DataX[0]>>16&0xFF;
- pTx[20] = pangle->Angle_DataX[0]>>8&0xFF;
- pTx[21] = pangle->Angle_DataX[0]&0xFF;
-
- pTx[22] = pangle->Angle_DataY[0]>>24&0xFF; //读取Y轴角度数据
- pTx[23] = pangle->Angle_DataY[0]>>16&0xFF;
- pTx[24] = pangle->Angle_DataY[0]>>8&0xFF;
- pTx[25] = pangle->Angle_DataY[0]&0xFF;
-
- pTx[26] = pangle->Angle_DataZ[0]>>24&0xFF; //读取Z轴角度数据
- pTx[27] = pangle->Angle_DataZ[0]>>16&0xFF;
- pTx[28] = pangle->Angle_DataZ[0]>>8&0xFF;
- pTx[29] = pangle->Angle_DataZ[0]&0xFF;
- }
- }
- return 0;
- }
- return 1;
- }
- uint16_t XYF_SetOFF(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- // Cang_Inf* pcang = &cang_inf;
- uint8_t i = 0,j = 0;
- uint16_t ModBusCRC = 0;
-
- if( pkzq->USE_XYF == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
- pkzq->USE_XYF = 1;
-
- // if((pcang->XYF_Type == 1)||(pkzq->data_buf[17] == 0x11)) //中化测试用
- /* if(pcang->XYF_Type == 1)
- {
- j = 2;
- XYF_TxBuf[i++] = 0x0D;
- XYF_TxBuf[i++] = 0x0A;
- }*/
- XYF_TxBuf[i++] = pkzq->data_buf[17];
- XYF_TxBuf[i++] = 0x06;
- XYF_TxBuf[i++] = 0x00;
- XYF_TxBuf[i++] = 0x02;
- XYF_TxBuf[i++] = 0x00;
- XYF_TxBuf[i++] = 0x01;
-
- ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf+j,6);
-
- XYF_TxBuf[i++] = ModBusCRC>>8;
- XYF_TxBuf[i++] = ModBusCRC&0xff;
-
- // if((pcang->XYF_Type == 1)||(pkzq->data_buf[17] == 0x11)) //中化测试用
- /* if(pcang->XYF_Type == 1)
- {
- XYF_TxBuf[i++] = 0x0D;
- XYF_TxBuf[i++] = 0x0A;
- }*/
- Uart_len_TouChuan=i;
- }
- else
- return 0;
- }
- else
- return 0;
- return 1;
- }
- uint16_t XYF_SetThreshold(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- Cang_Inf* pcang = &cang_inf;
- uint8_t i = 0,j = 0;
- uint16_t ModBusCRC = 0;
-
- if(pkzq->USE_XYF == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
- pkzq->USE_XYF = 1;
- if(pcang->XYF_Type == 1)
- {
- j = 0;
- // XYF_TxBuf[i++] = 0x0D;
- // XYF_TxBuf[i++] = 0x0A;
- }
- XYF_TxBuf[i++] = pkzq->data_buf[17];
- XYF_TxBuf[i++] = 0x06;
- XYF_TxBuf[i++] = 0x00;
- XYF_TxBuf[i++] = 0x10;
- XYF_TxBuf[i++] = pkzq->data_buf[18];
- XYF_TxBuf[i++] = pkzq->data_buf[19];
-
- ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf+j,6);
-
- XYF_TxBuf[i++] = ModBusCRC>>8;
- XYF_TxBuf[i++] = ModBusCRC&0xff;
- if(pcang->XYF_Type == 1)
- {
- // XYF_TxBuf[i++] = 0x0D;
- // XYF_TxBuf[i++] = 0x0A;
- }
- Uart_len_TouChuan=i;
- }
- else
- return 0;
- }
- else
- return 0;
- return 1;
- }
- uint16_t HDF_Set_CloseVal(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- // Cang_Inf* pcang = &cang_inf;
- uint8_t i = 0;
- uint16_t ModBusCRC = 0;
-
- if(pkzq->USE_XYF == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
- pkzq->USE_XYF = 1;
- XYF_TxBuf[i++] = pkzq->data_buf[17];
- XYF_TxBuf[i++] = 0x06;
- XYF_TxBuf[i++] = 0x10;
- XYF_TxBuf[i++] = pkzq->data_buf[19];
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
-
- ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
-
- XYF_TxBuf[i++] = ModBusCRC>>8;
- XYF_TxBuf[i++] = ModBusCRC&0xff;
- Uart_len_TouChuan=i;
- }
- else
- return 0;
- }
- else
- return 0;
- return 1;
- }
- uint16_t HDF_Set_Gain(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- // Cang_Inf* pcang = &cang_inf;
- uint8_t i = 0;
- uint16_t ModBusCRC = 0;
-
- if(pkzq->USE_XYF == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
- pkzq->USE_XYF = 1;
- XYF_TxBuf[i++] = pkzq->data_buf[17];
- XYF_TxBuf[i++] = 0x06;
- XYF_TxBuf[i++] = 0x12;
- XYF_TxBuf[i++] = pkzq->data_buf[19];
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
-
- ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
-
- XYF_TxBuf[i++] = ModBusCRC>>8;
- XYF_TxBuf[i++] = ModBusCRC&0xff;
- Uart_len_TouChuan=i;
- }
- else
- return 0;
- }
- else
- return 0;
- return 1;
- }
- uint16_t HDF_Reset(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- // Cang_Inf* pcang = &cang_inf;
- uint8_t i = 0;
- uint16_t ModBusCRC = 0;
-
- if(pkzq->USE_XYF == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
- pkzq->USE_XYF = 1;
- XYF_TxBuf[i++] = pkzq->data_buf[17];
- XYF_TxBuf[i++] = 0x06;
- XYF_TxBuf[i++] = 0x00;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
-
- ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
-
- XYF_TxBuf[i++] = ModBusCRC>>8;
- XYF_TxBuf[i++] = ModBusCRC&0xff;
- Uart_len_TouChuan=i;
- }
- else
- return 0;
- }
- else
- return 0;
- return 1;
- }
- uint16_t HDF_Set_Threshold(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- // Cang_Inf* pcang = &cang_inf;
- uint8_t i = 0;
- uint16_t ModBusCRC = 0;
-
- if(pkzq->USE_XYF == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
- pkzq->USE_XYF = 1;
- XYF_TxBuf[i++] = pkzq->data_buf[17];
- XYF_TxBuf[i++] = 0x06;
- XYF_TxBuf[i++] = 0x14;
- XYF_TxBuf[i++] = pkzq->data_buf[18];
- XYF_TxBuf[i++] = pkzq->data_buf[19];
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
- XYF_TxBuf[i++] = 0xA5;
-
- ModBusCRC = LIB_CRC_MODBUS(XYF_TxBuf,14);
-
- XYF_TxBuf[i++] = ModBusCRC>>8;
- XYF_TxBuf[i++] = ModBusCRC&0xff;
- Uart_len_TouChuan=i;
- }
- else
- return 0;
- }
- else
- return 0;
- return 1;
- }
- uint16_t RKG_SetZero(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- Cang_Inf* pcang = &cang_inf;
- uint8_t i = 0;
- uint16_t ModBusCRC = 0;
- uint8_t buf[8] = {0};
-
- if(pkzq->USE_RKG == 0)
- {
- if(pkzq->data_buf[7] == 0x06)
- {
-
- if(pcang->RKG_Type == 1)
- {
- // RKG_TxBuf[i++] = 0x0D;
- // RKG_TxBuf[i++] = 0x0A;
- }
- RKG_TxBuf[i++] = pkzq->data_buf[17]-0X30;
- RKG_TxBuf[i++] = 0x06;
- RKG_TxBuf[i++] = 0x00;
- RKG_TxBuf[i++] = 0x10;
- RKG_TxBuf[i++] = 0x00;
- RKG_TxBuf[i++] = 0xFF;
-
- buf[0] = pkzq->data_buf[17]-0x30;
- buf[1] = 0x06;
- buf[2] = 0x00;
- buf[3] = 0x10;
- buf[4] = 0x00;
- buf[5] = 0xFF;
- ModBusCRC = LIB_CRC_MODBUS(buf,6);
-
- RKG_TxBuf[i++] = ModBusCRC>>8;
- RKG_TxBuf[i++] = ModBusCRC&0xff;
- if(pcang->RKG_Type == 1)
- {
- // RKG_TxBuf[i++] = 0x0D;
- // RKG_TxBuf[i++] = 0x0A;
- }
- Uart_len_TouChuan=i;
- pkzq->USE_RKG = 1;
- }
- else
- return 0;
- }
- else
- return 0;
- return 1;
- }
- uint16_t RKG_SetThreshold(uint8_t* pTx)
- {
- RKG_Inf* prkg = rkg_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t flash_buf[10] = {0};
-
- flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
- if(pkzq->data_buf[7] == 0x06)
- {
- Flash_WriteBytes(flash_buf,ADDR_RKG_THRESHOLD,1);
- }
- flash_buf[0] = 0;
- Flash_ReadBytes(flash_buf,ADDR_RKG_THRESHOLD,1);
-
- prkg->RKG_Threshold = flash_buf[0];
- pTx[16] = flash_buf[0] >>8;
- pTx[17] = flash_buf[0]&0xFF;
-
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17]))
- return 1;
- else
- return 0;
- }
- uint16_t Sensor_SetJudgefNum(uint8_t* pTx)
- {
- RKG_Inf* prkg = rkg_inf;
- XYF_Inf* pxyf = xyf_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t flash_buf[10] = {0};
- flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(flash_buf,ADDR_SDATEJUDGE_NUM,1);
- Flash_ReadBytes(flash_buf,ADDR_SDATEJUDGE_NUM,1);
-
- prkg->RKG_StateKeepNum = flash_buf[0];
- pxyf->XYF_StateKeepNum = flash_buf[0];
-
- pTx[16] = flash_buf[0] >>8;
- pTx[17] = flash_buf[0]&0xFF;
-
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17]))
- return 1;
- else
- return 0;
- }
- uint16_t Read_Sensor(uint8_t* pTx)
- {
- Angle_Inf* pangle = &angle_inf;
- TEM_Inf* ptem = tem_inf;
- Level_Inf* plevel = level_inf;
- KZQ_Inf* pkzq = &kzq_inf;
-
- if(pkzq->data_buf[17] > 0x50 && pkzq->data_buf[17] < 0x5F) //液位传感器
- {
- if(plevel[pTx[17] - 0x50].Level_Error)
- {
- pTx[18] = 0x47;
- pTx[19] = 0x7F;
- pTx[20] = 0xFF;
- pTx[21] = 0x00;
- }
- else
- {
- pTx[18] = (int)plevel[pTx[17] - 0x50].Level_Data>>24&0xff;
- pTx[19] = (int)plevel[pTx[17] - 0x50].Level_Data>>16&0xff;
- pTx[20] = (int)plevel[pTx[17] - 0x50].Level_Data>>8&0xff;
- pTx[21] = (int)plevel[pTx[17] - 0x50].Level_Data&0xff;
- }
- }
- else if(pkzq->data_buf[17] > 0x60 && pkzq->data_buf[17] < 0x6F) //温度传感器
- {
- if(ptem[pTx[17] - 0x60].TEM_Error)
- {
- pTx[18] = 0x47;
- pTx[19] = 0x7F;
- pTx[20] = 0xFF;
- pTx[21] = 0x00;
-
- pTx[22] = 0x47;
- pTx[23] = 0x7F;
- pTx[24] = 0xFF;
- pTx[25] = 0x00;
-
- pTx[26] = 0x47;
- pTx[27] = 0x7F;
- pTx[28] = 0xFF;
- pTx[29] = 0x00;
-
- }
- pTx[18] = ptem[pTx[17] - 0x60].TEM_HData[0]>>24&0xff;
- pTx[19] = ptem[pTx[17] - 0x60].TEM_HData[0]>>16&0xff;
- pTx[20] = ptem[pTx[17] - 0x60].TEM_HData[0]>>8&0xff;
- pTx[21] = ptem[pTx[17] - 0x60].TEM_HData[0]&0xff;
-
- pTx[22] = ptem[pTx[17] - 0x60].TEM_MData[0]>>24&0xff;
- pTx[23] = ptem[pTx[17] - 0x60].TEM_MData[0]>>16&0xff;
- pTx[24] = ptem[pTx[17] - 0x60].TEM_MData[0]>>8&0xff;
- pTx[25] = ptem[pTx[17] - 0x60].TEM_MData[0]&0xff;
-
- pTx[26] = ptem[pTx[17] - 0x60].TEM_LData[0]>>24&0xff;
- pTx[27] = ptem[pTx[17] - 0x60].TEM_LData[0]>>16&0xff;
- pTx[28] = ptem[pTx[17] - 0x60].TEM_LData[0]>>8&0xff;
- pTx[29] = ptem[pTx[17] - 0x60].TEM_LData[0]&0xff;
- }
- else if(pkzq->data_buf[17] > 0x70 && pkzq->data_buf[17] < 0x7F) //压力传感器
- {
- /*暂未使用压力传感器*/
- }
- else if(pkzq->data_buf[17] > 0x80 && pkzq->data_buf[17] < 0x8F) //挂壁传感器
- {
- /*暂未使用挂壁传感器*/
- }
- else if(pkzq->data_buf[17] > 0xE0 && pkzq->data_buf[17] < 0xE3) //姿态传感器
- {
- if(pangle->Angle_Error)
- {
- pTx[18] = 0x47;
- pTx[19] = 0x7F;
- pTx[20] = 0xFF;
- pTx[21] = 0x00;
-
- pTx[22] = 0x47;
- pTx[23] = 0x7F;
- pTx[24] = 0xFF;
- pTx[25] = 0x00;
-
- pTx[26] = 0x47;
- pTx[27] = 0x7F;
- pTx[28] = 0xFF;
- pTx[29] = 0x00;
- }
- else
- {
- pTx[18] = pangle->Angle_DataX[0]>>24&0xff;
- pTx[19] = pangle->Angle_DataX[0]>>16&0xff;
- pTx[20] = pangle->Angle_DataX[0]>>8&0xff;
- pTx[21] = pangle->Angle_DataX[0]&0xff;
-
- pTx[18] = pangle->Angle_DataY[0]>>24&0xff;
- pTx[19] = pangle->Angle_DataY[0]>>16&0xff;
- pTx[20] = pangle->Angle_DataY[0]>>8&0xff;
- pTx[21] = pangle->Angle_DataY[0]&0xff;
-
- pTx[18] = pangle->Angle_DataZ[0]>>24&0xff;
- pTx[19] = pangle->Angle_DataZ[0]>>16&0xff;
- pTx[20] = pangle->Angle_DataZ[0]>>8&0xff;
- pTx[21] = pangle->Angle_DataZ[0]&0xff;
- }
- }
- else if(pkzq->data_buf[17] == 0xe4) //油气回收传感器
- {
- /*暂未使用挂壁传感器*/
- }
- else
- return 0;
- return 1;
- }
- uint16_t CJQ_SetConfig(uint8_t* pTx)
- {
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
- uint8_t i = 0;
- uint8_t data_len = 0x05;
-
- for(i = 0;i < data_len;i++)
- {
- Flash_buf[i] = pkzq->data_buf[16+i];
- }
- if(pkzq->data_buf[7] == 0x06)
- {
- Flash_WriteBytes(Flash_buf,ADDR_CANG_NUM,data_len);
- Cang_Init();
- }
- Flash_ReadBytes(Flash_buf,ADDR_CANG_NUM,data_len);
-
- for(i = 0;i < data_len;i++)
- {
- //if((Flash_buf[i] != pkzq->data_buf[16+i])&&(pkzq->data_buf[7] == 0x06))
- // return 0;
- pTx[16+i] = Flash_buf[i];
- }
- return 1;
- }
- uint16_t RKG_SetTypeNum(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
- uint8_t i = 0;
- uint8_t data_len = 0x09;
-
- for(i = 0;i < data_len;i++)
- {
- Flash_buf[i] = pkzq->data_buf[16+i];
- }
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf,ADDR_RKGSENSOR_TYPE,1);
- Flash_ReadBytes(Flash_buf,ADDR_RKGSENSOR_TYPE,1);
- pTx[16] = Flash_buf[0];
- if(Flash_buf[0] < 5)
- pcang->RKG_Type = Flash_buf[0];
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf+1,ADDR_RKG_NUM,8);
- Flash_ReadBytes(Flash_buf+1,ADDR_RKG_NUM,8);
-
- for(i = 0;i < 8;i++)
- {
- if((Flash_buf[i+1] != pkzq->data_buf[17+i])&&(pkzq->data_buf[7] == 0x06))
- return 0;
- if(Flash_buf[i+1] < 8)
- {
- pcang->RKG_Num[i] = Flash_buf[i+1];
- pTx[17+i] = Flash_buf[i+1];
- }
- }
- return 1;
- }
- uint16_t XYF_SetTypeNum(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
- uint8_t i = 0;
- uint8_t data_len = 0x09;
-
- for(i = 0;i < data_len;i++)
- {
- Flash_buf[i] = pkzq->data_buf[16+i];
- }
- if(pkzq->data_buf[7] == 0x06)
- {
- Flash_WriteBytes(Flash_buf,ADDR_XYFSENSOR_TYPE,1);
- }
- Flash_ReadBytes(Flash_buf,ADDR_XYFSENSOR_TYPE,1);
- pTx[16] = Flash_buf[0];
- if(Flash_buf[0] < 5)
- pcang->XYF_Type = Flash_buf[0];
- if(pkzq->data_buf[7] == 0x06)
- {
- Flash_WriteBytes(Flash_buf+1,ADDR_XYF_NUM,8);
- }
-
- Flash_ReadBytes(Flash_buf+1,ADDR_XYF_NUM,8);
-
- for(i = 0;i < 8;i++)
- {
- if((Flash_buf[i+1] != pkzq->data_buf[17+i])&&(pkzq->data_buf[7] == 0x06))
- return 0;
- if(Flash_buf[i+1] < 8)
- {
- pcang->XYF_Num[i] = Flash_buf[i+1];
- pTx[17+i] = Flash_buf[i+1];
- }
- }
- return 1;
- }
- uint16_t HDF_SetTypeNum(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
- uint8_t i = 0;
- uint8_t data_len = 0x09;
-
- for(i = 0;i < data_len;i++)
- {
- Flash_buf[i] = pkzq->data_buf[16+i];
- }
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf,ADDR_HDFSENSOR_TYPE,1);
- Flash_ReadBytes(Flash_buf,ADDR_HDFSENSOR_TYPE,1);
- pTx[16] = Flash_buf[0];
- if(Flash_buf[0] < 5)
- pcang->HDF_Type = Flash_buf[0];
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf+1,ADDR_HDF_NUM,8);
- Flash_ReadBytes(Flash_buf+1,ADDR_HDF_NUM,8);
-
- for(i = 0;i < 8;i++)
- {
- if((Flash_buf[i+1] != pkzq->data_buf[17+i])&&(pkzq->data_buf[7] == 0x06))
- return 0;
- if(Flash_buf[i+1] < 8)
- {
- pcang->HDF_Num[i] = Flash_buf[i+1];
- pTx[17+i] = Flash_buf[i+1];
- }
- }
- return 1;
- }
- uint16_t Level_SetType(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
-
- Flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf,ADDR_LEVEL_TYPE,1);
- Flash_ReadBytes(Flash_buf,ADDR_LEVEL_TYPE,1);
-
- pTx[16] = Flash_buf[0]>>8;
- pTx[17] = Flash_buf[0]&0xFF;
-
- if(Flash_buf[0] != 0xFFFF)
- pcang->Level = Flash_buf[0];
-
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17])&&(pkzq->data_buf[7] == 0x06))
- return 1;
- else
- return 0;
- }
- // 去向传感器总线读取数据时,如遇无回应,则参照这个标定的重试最大值来获取异常
- uint16_t RW_SensorBusMaxRetry(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
- // [7]为03,表示读取,06表示设置
- // [16,17]在设置时有效,表示设置值
- Flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
- if(pkzq->data_buf[7] == 0x06) {
- Flash_WriteBytes(Flash_buf,ADDR_SENSOR_BUS_MAX_RETRY,1);
- }
- Flash_ReadBytes(Flash_buf,ADDR_SENSOR_BUS_MAX_RETRY,1);
-
- pTx[16] = Flash_buf[0]>>8;
- pTx[17] = Flash_buf[0]&0xFF;
-
- if(Flash_buf[0] != 0xFFFF)
- pcang->sensorBusMaxReTry = Flash_buf[0];
-
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17])&&(pkzq->data_buf[7] == 0x06))
- return 1;
- else
- return 0;
- }
- // mcu的IO口采集的一种连续性滤波式的认可机制的参数
- uint16_t RW_PinIoHitSameParam(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
- // [7]为03,表示读取,06表示设置
- // [16,17]在设置时有效,表示设置值
- Flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
- if(pkzq->data_buf[7] == 0x06) {
- Flash_WriteBytes(Flash_buf,ADDR_PIN_IO_HIT_SAME,1);
- }
- Flash_ReadBytes(Flash_buf,ADDR_PIN_IO_HIT_SAME,1);
-
- pTx[16] = Flash_buf[0]>>8;
- pTx[17] = Flash_buf[0]&0xFF;
-
- if(Flash_buf[0] != 0xFFFF)
- pcang->pinIOHitSameParam = Flash_buf[0];
-
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17])&&(pkzq->data_buf[7] == 0x06))
- return 1;
- else
- return 0;
- }
- typedef union{
- float Ldcal_zero_temp1;
- uint8_t arr1[4];
- }Hex_to_float2;
- Hex_to_float2 hex_to_float2;
- uint16_t Level_SetCalvalue(uint8_t* pTx)
- {
- // Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- Level_Inf* plevel = level_inf;
- uint16_t Flash_buf[20] = {0};
- Flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
- Flash_buf[1] = pkzq->data_buf[18]<<8|pkzq->data_buf[19];
- Flash_buf[2] = pkzq->data_buf[20]<<8|pkzq->data_buf[21];
- Flash_buf[3] = pkzq->data_buf[22]<<8|pkzq->data_buf[23];
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf,CANG1_LEVEL_CAL,4);
- Flash_ReadBytes(Flash_buf,CANG1_LEVEL_CAL,4);
-
- pTx[16] = Flash_buf[0]>>8;
- pTx[17] = Flash_buf[0]&0xFF;
- pTx[18] = Flash_buf[1]>>8;
- pTx[19] = Flash_buf[1]&0xFF;
- pTx[20] = Flash_buf[2]>>8;
- pTx[21] = Flash_buf[2]&0xFF;
- pTx[22] = Flash_buf[3]>>8;
- pTx[23] = Flash_buf[4]&0xFF;
-
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17])&&(pkzq->data_buf[7] == 0x06))
- {
- hex_to_float2.arr1[3] = pkzq->data_buf[16];
- hex_to_float2.arr1[2] = pkzq->data_buf[17];
- hex_to_float2.arr1[1] = pkzq->data_buf[18];
- hex_to_float2.arr1[0] = pkzq->data_buf[19];
- plevel[1].Level_Cal_zero = hex_to_float2.Ldcal_zero_temp1;
- __NOP();
- hex_to_float2.arr1[3] = pkzq->data_buf[20];
- hex_to_float2.arr1[2] = pkzq->data_buf[21];
- hex_to_float2.arr1[1] = pkzq->data_buf[22];
- hex_to_float2.arr1[0] = pkzq->data_buf[23];
- plevel[2].Level_Cal_zero = hex_to_float2.Ldcal_zero_temp1;
- __NOP();
- //hex_to_float2.Ldcal_zero_temp1 = plevel[2].Level_Cal_zero;
- return 1;
- }
- else
- return 0;
- }
- uint16_t Angle_SetType(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
-
- Flash_buf[0] = pkzq->data_buf[16]<<8|pkzq->data_buf[17];
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf,ADDR_ANGLE_TYPE,1);
- Flash_ReadBytes(Flash_buf,ADDR_ANGLE_TYPE,1);
- pTx[16] = Flash_buf[0]>>8;
- pTx[17] = Flash_buf[0]&0xFF;
-
- if(Flash_buf[0] != 0xFFFF)
- pcang->Angle = Flash_buf[0];
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17])&&(pkzq->data_buf[7] == 0x06))
- return 1;
- else
- return 0;
- }
- uint16_t Tem_SetType(uint8_t* pTx)
- {
- Cang_Inf* pcang = &cang_inf;
- KZQ_Inf* pkzq = &kzq_inf;
- uint16_t Flash_buf[20] = {0};
-
- Flash_buf[0] = pkzq->data_buf[17]<<8|pkzq->data_buf[16];
- if(pkzq->data_buf[7] == 0x06)
- Flash_WriteBytes(Flash_buf,ADDR_TEM_TYPE,1);
- Flash_ReadBytes(Flash_buf,ADDR_TEM_TYPE,1);
- pTx[17] = Flash_buf[0]>>8;
- pTx[16] = Flash_buf[0]&0xFF;
-
- if(Flash_buf[0] != 0xFFFF)
- pcang->Temperture = Flash_buf[0];
- if((pTx[16] == pkzq->data_buf[16])&&(pTx[17] == pkzq->data_buf[17])&&(pkzq->data_buf[7] == 0x06))
- return 1;
- else
- return 0;
- }
- uint32_t Version_Soft[8] = {2, 2, 3, 13, 1, 1, 0, 20221109};
- uint16_t Read_SoftVersion(uint8_t *pTx)
- {
- int i;
- for (i = 0; i < 8; ++i)
- {
- pTx[i * 4+16] = (Version_Soft[i] >> 24) & 0xff;
- pTx[i * 4 + 1+16] = (Version_Soft[i] >> 16) & 0xff;
- pTx[i * 4 + 2+16] = (Version_Soft[i] >> 8) & 0xff;
- pTx[i * 4 + 3+16] = (Version_Soft[i] >> 0) & 0xff;
- }
- return 1;
- }
|