IEC101.c 123 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430
  1. /********************************************************************
  2. 版权所有:
  3. 文件版本: V1.00
  4. 文件名称: IEC101.c
  5. 生成日期: 2010年04月26日
  6. 作 者:hhw
  7. 使用范围:
  8. 功 能: IEC101规约处理
  9. 更新信息:
  10. 更新日志1
  11. 修改者:
  12. 修改日期:
  13. 修改内容:
  14. 修改原因:
  15. *********************************************************************/
  16. #include "head.h"
  17. u32 IEC101_SendEvent(IEC101_DEF *pt,int is_send_cos);
  18. void IEC101_Info_Printf_One(IEC101_DEF *p);
  19. extern int gprs_vs_write(const unsigned char * buf, int count);
  20. GPRS_INF_DEF tGprsInf;
  21. static void IEC101_State(IEC101_DEF *pt101,int state)
  22. {
  23. if(pt101->st101 != state)
  24. {
  25. char buf[64];
  26. char log_info[128];
  27. rt_printf_time("IEC101(%d) state: %d => %d!\r\n", pt101->chnl,pt101->st101,state);
  28. pt101->st101 = state;
  29. if(state == IEC101_ST_DATA)
  30. {
  31. sprintf(buf,"101主站连接(%s)!\r\n",get_comm_name(pt101->chnl + 1));
  32. log_str_time(LOG_OPERATE,buf,0,1);
  33. sprintf(log_info,"IEC101(%d):101 main station connection",pt101->chnl+1);
  34. load_hs_log_rcd(TYPE_CHNL_LINK,true,NULL,log_info,1);
  35. if(log_flag.com_err[pt101->chnl] == true)
  36. {
  37. memset(log_info,0,sizeof(log_info));
  38. sprintf(log_info,"IEC101(%d):Communication process anomaly return",pt101->chnl+1);
  39. load_hs_log_rcd(TYPE_COMM_ERR,true,NULL,log_info,0);
  40. log_flag.com_err[pt101->chnl] = false;
  41. }
  42. // SOE发送缓冲区复位,发送指针回到ACK的位置
  43. if(pRunSet->bTT_SoeResumeComm)
  44. {
  45. #ifdef SOE_RELINK_DISCOS
  46. if(!g_soe_queue.bSoeRelink[pt101->chnl])
  47. {
  48. //g_soe_queue.relink_tail_bak[pt101->chnl].n = g_soe_queue.tail_send[pt101->chnl].n;
  49. g_soe_queue.relink_tail_bak[pt101->chnl].n = g_soe_queue.tail_eep.n;
  50. }
  51. g_soe_queue.bSoeRelink[pt101->chnl] = true;
  52. #endif
  53. //pt101->bSoeRelink = true;
  54. g_soe_queue.tail_send[pt101->chnl].n=g_soe_queue.tail_ack[pt101->chnl].n;
  55. }
  56. }
  57. else if(state == IEC101_ST_NONE)
  58. {
  59. sprintf(buf,"101主站断开(%s)!\r\n",get_comm_name(pt101->chnl + 1));
  60. log_str_time(LOG_OPERATE,buf,0,0);
  61. sprintf(log_info,"IEC101(%d):101 main station disconnection",pt101->chnl + 1);
  62. load_hs_log_rcd(TYPE_CHNL_LINK,true,NULL,log_info,0);
  63. }
  64. }
  65. return;
  66. }
  67. static void IEC101_ResetTxBuf(IEC101_DEF *pt101)
  68. {
  69. pt101->btx_buf_m = false;
  70. pt101->btx_buf_s = false;
  71. memset(&pt101->tx_buf,0,sizeof(pt101->tx_buf));
  72. }
  73. static void IEC101_Reset(IEC101_DEF *pt101)
  74. {
  75. // 通道属性、连接计数不允许复位
  76. // 规约状态复位
  77. g_comm_link_status &= ~(1<<pt101->chnl);
  78. IEC101_State(pt101,IEC101_ST_NONE);
  79. pt101->bSendChange=false;
  80. // 计时
  81. pt101->us0_sec = ustimer_get_origin();
  82. pt101->secs = 0;
  83. pt101->us0_sendpiece=ustimer_get_origin();
  84. // 对时
  85. pt101->us0_frame = 0;
  86. pt101->ms_delay = 0;
  87. // 1级、2级数据发送
  88. pt101->bFirstFCV = 1;
  89. pt101->tb_index = -1;
  90. pt101->FCBSave=0;
  91. // 遥测发送处理
  92. pt101->bycsend = FALSE;
  93. pt101->ycno=0;
  94. pt101->us0_yc = ustimer_get_origin();
  95. memset(pt101->yc_save,0,sizeof(pt101->yc_save));
  96. // 其它状态复位
  97. pt101->bRmtSM2=false;
  98. pt101->dValidTime=0;
  99. pt101->bMSend=false;
  100. pt101->bDIR=true;
  101. pt101->bResetProcess = false;
  102. pt101->tm.us0_callall=dTCounter; // 不能用微妙定时器,最多支持13分钟
  103. pt101->tm.bAppEcho=false;
  104. //pt101->bSoeRelink = false;
  105. pt101->bTimeSyn = false;
  106. #if 0
  107. // SOE发送缓冲区复位,发送指针回到ACK的位置
  108. if(pRunSet->bTT_SoeResumeComm)
  109. {
  110. #ifdef SOE_RELINK_DISCOS
  111. if(!g_soe_queue.bSoeRelink[pt101->chnl])
  112. {
  113. //g_soe_queue.relink_tail_bak[pt101->chnl].n = g_soe_queue.tail_send[pt101->chnl].n;
  114. g_soe_queue.relink_tail_bak[pt101->chnl].n = g_soe_queue.tail_eep.n;
  115. }
  116. g_soe_queue.bSoeRelink[pt101->chnl] = true;
  117. #endif
  118. //pt101->bSoeRelink = true;
  119. g_soe_queue.tail_send[pt101->chnl].n=g_soe_queue.tail_ack[pt101->chnl].n;
  120. }
  121. #endif
  122. // 遥控信息复位
  123. ResetRctrl(MASTER_101+pt101->chnl);
  124. // 发送缓冲区复位
  125. IEC101_ResetTxBuf(pt101);
  126. RS_Recv_Enable(pt101->chnl);
  127. #ifdef RCD_STRAN_S
  128. rt_printf_time("-> Link Reset, Clear File Cache\r\n");
  129. iec_freefile(&pt101->tf);
  130. pt101->tf.bTransing=false;
  131. pt101->tf.bdatTraned=false;
  132. #endif
  133. }
  134. void IEC101_Init(IEC101_DEF *pt,u8 chnl)
  135. {
  136. // 接收帧间隔为重发间隔时间的一半
  137. g_tRsComm[chnl].us_recv_timeout = pRunSet->dT101Resend*USTIMER_SEC/2;
  138. memset(pt,0,sizeof(IEC101_DEF));
  139. pt->type=IEC101_CHN;
  140. pt->chnl=chnl;
  141. pt->bMaintainComm=false;
  142. if(tRunPara.tUartPara[chnl].wProtocol==PROTOCOL_MAINTAIN)
  143. {
  144. pt->bMaintainComm=true;
  145. }
  146. // 初始化接收buf结构
  147. pt->rx_buf.chn = pt->chnl;
  148. pt->rx_buf.buf = pt->recvbuf;
  149. rt_fifo_init(&pt->recv_fifo,pt->recv_fifo_buf,IEC101_FIFO_SIZE);
  150. #ifdef RCD_STRAN_S
  151. queue_init(&pt->rcd_qt.queue,NEWRCD_COUNT,&pt->rcd_qt.data,NEWRCD_SIZE);
  152. #endif
  153. IEC101_Reset(pt);
  154. }
  155. /**************************************************************************
  156. 函数名称:IEC101_Send
  157. 函数版本:1.00
  158. 作者:
  159. 创建日期:2008.9.1
  160. 函数功能说明:启动485口的数据发送
  161. 输入参数:
  162. 输出参数:
  163. 返回值:
  164. 更新信息:
  165. 更新日志1:
  166. 日期:
  167. 修改者:
  168. 修改内容:
  169. 修改原因:
  170. ***************************************************************************/
  171. void IEC101_SSend(IEC101_DEF *pt)
  172. {
  173. u8 *sb = g_tRsComm[pt->chnl].sendbuf;
  174. // 如果链路层没有数据,直接返回
  175. if(pt->btx_buf_s == false)
  176. {
  177. return;
  178. }
  179. // 有数据,复制到真正的发送BUF并清标志
  180. memcpy(sb,pt->tx_buf_s,pt->tx_buf_s[0]+1);
  181. pt->btx_buf_s = false;
  182. // 置发送标志
  183. RS_Send_Enable(pt->chnl);
  184. g_tRsComm[pt->chnl].nSendCnt=1; // 发送缓冲区的第一个字节为发送长度
  185. pt->bSend=true;
  186. if(!g_bCommLed)g_bCommLed=true;
  187. if(UART_CHANNEL[pt->chnl]==CFG_UART_GPRS_IN )
  188. {
  189. //gprs_vs_write(&sb[1], sb[0]);
  190. pt->bSend=false;
  191. s_stat_tx((int)pt->chnl, sb[0]);
  192. }
  193. #ifdef FUN_FUXI_ESAM
  194. if(UART_CHANNEL[pt->chnl]==CFG_UART_CHIP_S1 )
  195. {
  196. write_chip_s1(&sb[1], sb[0]);
  197. pt->bSend=false;
  198. }
  199. #endif
  200. if(g_print_101 && (g_print_port & (1<<pt->chnl)))
  201. {
  202. rt_printf("TX_S101_%d:",pt->chnl);
  203. print_msg("",&sb[1],sb[0]);
  204. }
  205. //统计发送帧数
  206. s_stat_tx_frame((int)pt->chnl);
  207. }
  208. /**************************************************************************
  209. 函数名称:IEC101_MSend
  210. 函数版本:1.00
  211. 作者:
  212. 创建日期:2008.9.1
  213. 函数功能说明:平衡101,作为主站发送
  214. 输入参数:
  215. 输出参数:
  216. 返回值:
  217. 更新信息:
  218. 更新日志1:
  219. 日期:
  220. 修改者:
  221. 修改内容:
  222. 修改原因:
  223. ***************************************************************************/
  224. static void IEC101_MSend(IEC101_DEF *pt)
  225. {
  226. u8 *sb = g_tRsComm[pt->chnl].sendbuf;
  227. // 如果链路层没有数据,直接返回
  228. if(pt->btx_buf_m == false)
  229. {
  230. return;
  231. }
  232. // 有数据,复制到真正的发送BUF并清标志
  233. memcpy(sb,pt->tx_buf_m,pt->tx_buf_m[0]+1);
  234. pt->btx_buf_m = false;
  235. // 置发送标志
  236. RS_Send_Enable(pt->chnl);
  237. g_tRsComm[pt->chnl].nSendCnt=1;
  238. pt->bSend=true;
  239. if(!g_bCommLed)g_bCommLed=true;
  240. if(UART_CHANNEL[pt->chnl]==CFG_UART_GPRS_IN )
  241. {
  242. //gprs_vs_write(&sb[1], sb[0]);
  243. pt->bSend=false;
  244. s_stat_tx((int)pt->chnl, sb[0]);
  245. }
  246. #ifdef FUN_FUXI_ESAM
  247. if(UART_CHANNEL[pt->chnl]==CFG_UART_CHIP_S1 )
  248. {
  249. write_chip_s1(&sb[1], sb[0]);
  250. pt->bSend=false;
  251. }
  252. #endif
  253. if(g_print_101 && (g_print_port & (1<<pt->chnl)))
  254. {
  255. rt_printf("TX_M101_%d:",pt->chnl);
  256. print_msg("",&sb[1],sb[0]);
  257. }
  258. //统计发送帧数
  259. s_stat_tx_frame((int)pt->chnl);
  260. }
  261. static void IEC101_ext_send(IEC101_DEF *pt, u8 *buf,u16 len)
  262. {
  263. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  264. if((tRunPara.tUartPara[0].wProtocol == PROTOCOL_WED_ENC) && pt->chnl==1)
  265. {//投入纬德规约时,串口通道1/3/4的待发数据统一由串口通道0发送处理
  266. u8 *sb = g_tRsComm[0].extsendbuf_1;
  267. memcpy(sb,buf,len);
  268. g_tRsComm[0].extsendcnt_1=0;
  269. g_tRsComm[0].extsendlen_1=len;
  270. g_tRsComm[0].bextsend_1=true;
  271. }
  272. else if((tRunPara.tUartPara[0].wProtocol == PROTOCOL_WED_ENC) && pt->chnl==3)
  273. {//投入纬德规约时,串口通道1/3/4的待发数据统一由串口通道0发送处理
  274. u8 *sb = g_tRsComm[0].extsendbuf_2;
  275. memcpy(sb,buf,len);
  276. g_tRsComm[0].extsendcnt_2=0;
  277. g_tRsComm[0].extsendlen_2=len;
  278. g_tRsComm[0].bextsend_2=true;
  279. }
  280. else if((tRunPara.tUartPara[0].wProtocol == PROTOCOL_WED_ENC) && pt->chnl==4)
  281. {//投入纬德规约时,串口通道1/3/4的待发数据统一由串口通道0发送处理
  282. u8 *sb = g_tRsComm[0].extsendbuf_3;
  283. memcpy(sb,buf,len);
  284. g_tRsComm[0].extsendcnt_3=0;
  285. g_tRsComm[0].extsendlen_3=len;
  286. g_tRsComm[0].bextsend_3=true;
  287. }
  288. else
  289. #endif
  290. {
  291. u8 *sb = g_tRsComm[pt->chnl].extsendbuf;
  292. memcpy(sb,buf,len);
  293. g_tRsComm[pt->chnl].extsendcnt=0;
  294. g_tRsComm[pt->chnl].extsendlen=len;
  295. g_tRsComm[pt->chnl].bextsend=true;
  296. }
  297. }
  298. static void IEC101_Send_Polling(IEC101_DEF *pt)
  299. {
  300. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  301. int i=0,j=0,crc_sum=0;
  302. #endif
  303. u8 *buf;
  304. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  305. memset(&g_tRsComm[pt->chnl].enc_sendbuf,0,sizeof(&g_tRsComm[pt->chnl].enc_sendbuf));
  306. #endif
  307. // 如果串口忙,不能发送数据
  308. if(g_tRsComm[pt->chnl].bextsend
  309. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  310. || g_tRsComm[0].bextsend_1 || g_tRsComm[0].bextsend_2 || g_tRsComm[0].bextsend_3
  311. #endif
  312. )
  313. {
  314. pt->us0_sendpiece=ustimer_get_origin();
  315. return;
  316. }
  317. if(pt->bSend)// 有数据要发送了
  318. {
  319. int len=g_tRsComm[pt->chnl].sendbuf[0];
  320. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  321. if(tRunPara.tUartPara[0].wProtocol == PROTOCOL_WED_ENC)
  322. {//纬德规约内容组包
  323. g_tRsComm[pt->chnl].enc_sendbuf[i++] = 0xAA;
  324. g_tRsComm[pt->chnl].enc_sendbuf[i++] = (u8)(len); //数据报文长度
  325. g_tRsComm[pt->chnl].enc_sendbuf[i++] = (u8)((len)>>8);
  326. g_tRsComm[pt->chnl].enc_sendbuf[i++] = pt->enc_tunnel;
  327. memcpy(&g_tRsComm[pt->chnl].enc_sendbuf[i],&g_tRsComm[pt->chnl].sendbuf[1],len);
  328. i = i+len;
  329. for(j=1;j<i;j++)
  330. {
  331. crc_sum = crc_sum + g_tRsComm[pt->chnl].enc_sendbuf[j];
  332. }
  333. g_tRsComm[pt->chnl].enc_sendbuf[i++] = (u8)crc_sum;
  334. g_tRsComm[pt->chnl].enc_sendbuf[i++] = 0x55;
  335. buf = &g_tRsComm[pt->chnl].enc_sendbuf[0];
  336. len = i;
  337. }
  338. else
  339. #endif
  340. {
  341. buf = &g_tRsComm[pt->chnl].sendbuf[1];
  342. }
  343. if(pRunSet->bTT_ESAM&&(!pt->bMaintainComm))
  344. {
  345. u8 ti,cot,se;
  346. u8 *out;
  347. iec_GetMsgInfo(buf,len,&ti,&cot,&se,true);
  348. len = sec_encrpt_iec(ti,cot,se,buf,len,&out);
  349. if(len > 0)
  350. {
  351. IEC101_ext_send(pt,out,len);
  352. }
  353. }
  354. else
  355. {
  356. IEC101_ext_send(pt,buf,len);
  357. }
  358. pt->bSend=false;
  359. return;
  360. }
  361. if(ustimer_get_duration(pt->us0_sendpiece) < USTIMER_MS*5) // 发送帧之间间隔5ms
  362. {
  363. return;
  364. }
  365. // 如果有从动站数据,发送
  366. if(pt->btx_buf_s)
  367. {
  368. IEC101_SSend(pt);
  369. pt->us0_sendpiece=ustimer_get_origin();
  370. }
  371. // 如果有启动站数据,发送
  372. else if(pt->btx_buf_m)
  373. {
  374. IEC101_MSend(pt);
  375. pt->us0_sendpiece=ustimer_get_origin();
  376. }
  377. else if(pt->bEchosecmd5)
  378. {
  379. u8 md5buf[24];
  380. u16 len;
  381. len=sec_md5_echo(md5buf);
  382. IEC101_ext_send(pt,md5buf,len);
  383. pt->bEchosecmd5=false;
  384. }
  385. }
  386. /**************************************************************************
  387. 函数名称:IEC101_GetOneBuf
  388. 函数版本:1.00
  389. 作者:
  390. 创建日期:2008.9.1
  391. 函数功能说明:将数据添加到一级数据缓冲区
  392. 输入参数:pt 各通道101结构定义首地址,ps源数据地址
  393. 输出参数:
  394. 返回值:
  395. 更新信息:
  396. 更新日志1:
  397. 日期:
  398. 修改者:
  399. 修改内容:
  400. 修改原因:
  401. ***************************************************************************/
  402. static int IEC101_BufFreeNum(iec_tbuf_t *pt)
  403. {
  404. return (pt->tb_tail_ack - pt->tb_head - 1)&(IEC_TBUF_NUM-1);
  405. }
  406. static u16 IEC101_GetOneBuf(iec_tbuf_t *pt)
  407. {
  408. u16 head;
  409. head = pt->tb_head;
  410. pt->tb_head++;
  411. // 系统设计时,保证缓冲不会满,以下情况不应出现
  412. if(pt->tb_head==pt->tb_tail_ack || pt->tb_head==pt->tb_tail_send)
  413. {
  414. rt_printf_time("IEC101: IEC101_GetOneBuf error:head=%d,send=%d,ack=%d.\r\n",pt->tb_head,pt->tb_tail_send,pt->tb_tail_ack);
  415. }
  416. return head;
  417. }
  418. /**************************************************************************
  419. 函数名称:IEC101_FrameEcho
  420. 函数版本:1.00
  421. 作者:
  422. 创建日期:2008.9.1
  423. 函数功能说明:应答短帧报文
  424. 输入参数:pt 各通道101结构定义首地址,ZoneByte短政控制域
  425. 输出参数:
  426. 返回值:
  427. 更新信息:
  428. 更新日志1:
  429. 日期:
  430. 修改者:
  431. 修改内容:
  432. 修改原因:
  433. ***************************************************************************/
  434. static void IEC101_FrameEcho(IEC101_DEF *pt,unsigned char ZoneByte)
  435. {
  436. u8 *pd=pt->tx_buf_s;
  437. // 如果此时正在发送数据,说明逻辑不对
  438. if(pt->btx_buf_s)
  439. {
  440. rt_printf("IEC101_FrameEcho(%d) err:链路层BUF已有数据\r\n",pt->chnl);
  441. }
  442. // 更新ACD或DIR位
  443. if(tRunPara.tUartPara[pt->chnl].b101PH)
  444. {
  445. // 平衡101,DIR置1
  446. if(!pt->bDIR)
  447. {
  448. IEC101_SETDIR(ZoneByte);
  449. }
  450. }
  451. else
  452. {
  453. // 目前所有数据都当成一级数据,等新标准正式颁布后再分一、二级数据。
  454. // 非平衡101, 如果还有一级数据,设置ACD位
  455. if((pt->tx_buf[0].tb_head != pt->tx_buf[0].tb_tail_send)
  456. || (pt->tx_buf[1].tb_head != pt->tx_buf[1].tb_tail_send)
  457. || (pt->tx_buf[2].tb_head != pt->tx_buf[2].tb_tail_send))
  458. {
  459. IEC101_SETACD(ZoneByte);
  460. }
  461. }
  462. // 形成报文
  463. if(!tRunPara.b101Addr2Byte)
  464. {
  465. pd[0]=5;
  466. pd[1]=0x10;
  467. pd[2]=ZoneByte;
  468. pd[3]=(u8)tRunPara.byAddr;
  469. pd[4]=pd[2]+pd[3];
  470. pd[5]=0x16;
  471. }
  472. else
  473. {
  474. pd[0]=6;
  475. pd[1]=0x10;
  476. pd[2]=ZoneByte;
  477. pd[3]=(u8)tRunPara.byAddr;
  478. pd[4]=(u8)(tRunPara.byAddr>>8);
  479. pd[5]=pd[2]+pd[3]+pd[4];
  480. pd[6]=0x16;
  481. }
  482. }
  483. /**************************************************************************
  484. 函数名称:IEC101_GetClassOne
  485. 函数版本:1.00
  486. 作者:
  487. 创建日期:2008.9.1
  488. 函数功能说明:从一级数据缓冲区里读取数据
  489. 输入参数:
  490. 输出参数:
  491. 返回值:
  492. 更新信息:
  493. 更新日志1:
  494. 日期:
  495. 修改者:
  496. 修改内容:
  497. 修改原因:
  498. ***************************************************************************/
  499. static void IEC101_UpdateCOS(u8 *pd)
  500. {
  501. u8 sq,num,i,ti;
  502. u16 cp;
  503. u8 addr=0; //传送原因双字节
  504. u8 SIQ;
  505. if(tRunPara.b101Cot2Byte) addr++;
  506. if(tRunPara.b101App2Byte) addr++;
  507. ti=pd[0];
  508. sq = pd[1]&0x80;
  509. num = pd[1]&0x7f;
  510. cp = pd[4+addr] | (pd[5+addr]<<8);
  511. pd +=(6+addr);
  512. for(i=0;i<num;i++)
  513. {
  514. SIQ = tbl_get_yx(tbl_cp2index(cp),(ti==3?1:0));
  515. #if !defined GD_AREA_SHANTOU && !defined FUNC_JX_YX_BEFORE
  516. if(g_run_stu.bjx)
  517. SIQ|=0x80;
  518. #endif
  519. *pd++ = SIQ;
  520. if(sq == 0)
  521. {
  522. cp = pd[0] | (pd[1]<<8);
  523. pd += 2;
  524. }
  525. else
  526. {
  527. cp++;
  528. }
  529. }
  530. }
  531. //101可变帧长中信息体相对于帧头的地址。
  532. u32 IEC101_InfoAddr(void)
  533. {
  534. u32 addr;
  535. // 10 = 68 L L 68 CTRL LADDR TYPE VSQ COT PADDR
  536. addr = 10;
  537. if(tRunPara.b101Addr2Byte) addr++;
  538. if(tRunPara.b101App2Byte) addr++;
  539. if(tRunPara.b101Cot2Byte) addr++;
  540. return addr;
  541. }
  542. static bool IEC101_SendOneBuf(IEC101_DEF *pt101)
  543. {
  544. u16 i,len,frm_attr,cnt;
  545. u8 *pd,cs,tb_send;
  546. iec_tbuf_t *pt;
  547. // 还有上帧数据没有发送完,直接返回。逻辑上不应该有这种现象出现
  548. if(tRunPara.tUartPara[pt101->chnl].b101PH ? pt101->btx_buf_m : pt101->btx_buf_s)
  549. {
  550. RT_PRINTF_POSITION();
  551. return false;
  552. }
  553. // 运行到这,如果有数据就无条件发送
  554. for(i=0;i<3;i++)
  555. {
  556. pt = &pt101->tx_buf[i];
  557. if(pt->tb_head == pt->tb_tail_send)
  558. {
  559. continue;
  560. }
  561. // 更新发送尾指针,保留老指针备用。
  562. // 由于系统设计时保证发送BUF队列不会溢出,所以指针先加也是没有问题的。
  563. tb_send = pt->tb_tail_send;
  564. pt->tb_tail_send++;
  565. //拷贝数据并设置控制域
  566. len = pt->tb_data[tb_send][0];
  567. if(tRunPara.tUartPara[pt101->chnl].b101PH)
  568. {
  569. u8 zone;
  570. // 获取数据
  571. pd = pt101->tx_buf_m;
  572. memcpy(pd,pt->tb_data[tb_send],len + 1);
  573. // 平衡101,将控制域修改,原来一级数据缓冲区中为8,现在需要变为3
  574. zone=IEC101_CALL_DATA;
  575. // 合纵FTU现场,测试长帧,功能码需回2,不能是3 (原来为3,不合理)
  576. if(pd[7+tRunPara.b101Addr2Byte]==104) //长帧测试帧
  577. {
  578. zone=IEC101_CALL_TESTLINK;
  579. pt101->bTestFrameL = true;
  580. }
  581. //梅州FTU,101主站总召前,通讯续传不回确认帧
  582. if((pd[7+tRunPara.b101Addr2Byte]==0x1e)&&(pt101->bSendChange == 0)) //SOE
  583. {
  584. pt101->bSoeResume = true;
  585. }
  586. IEC101_SETFCV(zone); //FCV位有效
  587. IEC101_SETPRM(zone);
  588. if(!pt101->bDIR)IEC101_SETDIR(zone);
  589. if(pt101->bMFCB)
  590. {
  591. IEC101_SETFCB(zone);
  592. }
  593. else
  594. {
  595. IEC101_CLRFCB(zone);
  596. }
  597. pd[5]=zone;
  598. }
  599. else
  600. {
  601. // 获取数据
  602. pd = pt101->tx_buf_s;
  603. memcpy(pd,pt->tb_data[tb_send],len + 1);
  604. // 目前所有数据都当成一级数据,等新标准正式颁布后再分一、二级数据。
  605. // 非平衡101,如果还有一级数据,设置ACD位
  606. if((pt101->tx_buf[0].tb_head != pt101->tx_buf[0].tb_tail_send)
  607. || (pt101->tx_buf[1].tb_head != pt101->tx_buf[1].tb_tail_send)
  608. || (pt101->tx_buf[2].tb_head != pt101->tx_buf[2].tb_tail_send))
  609. {
  610. IEC101_SETACD(pd[5]);
  611. }
  612. }
  613. // 更新低优先级的COS
  614. frm_attr = pt->tb_info[tb_send].frm_attr;
  615. if((frm_attr&(FRAME_I_PRIOR_LOW|FRAME_I_COS)) == (FRAME_I_PRIOR_LOW|FRAME_I_COS))
  616. {
  617. IEC101_UpdateCOS(pd + 7 + tRunPara.b101Addr2Byte);
  618. }
  619. // 如果是延时获取帧,校验和计算前计算延时
  620. if(frm_attr & FRAME_I_106)
  621. {
  622. u16 ms;
  623. u8 * info_addr;
  624. info_addr = pd + 1 + IEC101_InfoAddr();
  625. ms = info_addr[2] + (info_addr[3] << 8);
  626. ms += ustimer_get_duration(pt101->us0_frame)/USTIMER_MS;
  627. info_addr[0] = 0;
  628. info_addr[1] = 0;
  629. info_addr[2] = ms;
  630. info_addr[3] = ms>>8;
  631. }
  632. // 计算校验和
  633. cs=0;
  634. len = pd[2];
  635. pd=&pd[5];
  636. for(cnt=0;cnt<len;cnt++) //标示拷贝
  637. {
  638. cs+=*pd++;
  639. }
  640. *pd++=cs;
  641. // 保留发送的索引,供确认的时候用
  642. pt101->tb_index=i;
  643. // 设置安全报文发送标志
  644. if(frm_attr & FRAME_I_ENCRYPT)
  645. {
  646. pt101->bMSend_encrypt = true;
  647. }
  648. return true;
  649. }
  650. return false;
  651. }
  652. static void IEC101_AckOneBuf(IEC101_DEF *pt101) //调整一级数据缓冲区,已发送数据清除
  653. {
  654. iec_tbuf_t *pt;
  655. char log_info[128]={0};
  656. // 如果最后发送的遥测帧,确认遥测帧
  657. if (pt101->bycsend)
  658. {
  659. pt101->bycsend = FALSE;
  660. return;
  661. }
  662. // 如果没有发送报文,不需要确认
  663. if(pt101->tb_index < 0)
  664. {
  665. return;
  666. }
  667. // 如果没有需要确认的帧,返回,但这不是正常流程
  668. pt = &pt101->tx_buf[pt101->tb_index];
  669. pt101->tb_index = -1;
  670. if(pt->tb_tail_ack == pt->tb_tail_send)
  671. {
  672. rt_printf_time("IEC101_AckOneBuf error!\r\n");
  673. IEC101_Info_Printf_One(pt101);
  674. sprintf(log_info,"IEC101(%d):IEC101_AckOneBuf error!",pt101->chnl+1);
  675. load_hs_log_rcd(TYPE_COMM_ERR,true,NULL,log_info,1);
  676. log_flag.com_err[pt101->chnl] = true;
  677. return;
  678. }
  679. // 如果是SOE报文,需确认SOE缓冲池中SOE.
  680. if(pt->tb_info[pt->tb_tail_ack].frm_attr&FRAME_I_SOE)
  681. {
  682. soe_ack(pt101->chnl,pt->tb_info[pt->tb_tail_ack].soe_tail_send);
  683. }
  684. pt->tb_tail_ack++;
  685. }
  686. /**************************************************************************
  687. 函数名称: IEC101_Asdu_Yc
  688. 函数版本:1.00
  689. 作者:
  690. 创建日期:2008.9.1
  691. 函数功能说明:通用分类数据的链路直接响应
  692. 输入参数:pt 缓冲区地址,pdat报文数据,len报文长度
  693. vsq,inf,cot ,rii,IEC101规约要求的内容
  694. 输出参数:
  695. 返回值:
  696. 更新信息:
  697. 更新日志1:
  698. 日期:
  699. 修改者:
  700. 修改内容:
  701. 修改原因:
  702. ***************************************************************************/
  703. static void IEC101_Asdu_Yc(IEC101_DEF *pt,u8 *pdat,u8 len,u8 vsq, u8 cot)
  704. {
  705. u8 *pd,*pdata;
  706. u8 cnt,checksum,sum;
  707. u8 AddByte=0;
  708. sum=0;
  709. if(tRunPara.tUartPara[pt->chnl].b101PH)
  710. {
  711. pdata=pt->tx_buf_m;
  712. }
  713. else
  714. {
  715. pdata=pt->tx_buf_s;
  716. }
  717. if(tRunPara.b101Addr2Byte) AddByte=1;
  718. pd=&pdata[7+AddByte];
  719. if(tRunPara.bYcBDH) //标度化值
  720. {
  721. pd[sum++]=11; //类型标示
  722. }
  723. else if(tRunPara.bYcFloat) //浮点值
  724. {
  725. pd[sum++]=13; //类型标示浮点数
  726. }
  727. else
  728. {
  729. pd[sum++]=9; //类型标示
  730. }
  731. pd[sum++]=vsq; //VSQ
  732. pd[sum++]=cot; //传送原因
  733. if(tRunPara.b101Cot2Byte) pd[sum++]=0; //传送原因
  734. pd[sum++]=(u8)tRunPara.byAddr; //应用服务单元地址
  735. if(tRunPara.b101App2Byte) pd[sum++]=(u8)(tRunPara.byAddr>>8); //应用服务单元地址
  736. for(cnt=0;cnt<len;cnt++) //标示拷贝
  737. {
  738. pd[sum++]=*pdat++;
  739. }
  740. pdata[0]=(sum+2+6+AddByte); //报文长度 +2=控制域、地址 +6=报文头(4字节)校验和、结束符
  741. pdata[1]=0x68; //报文头
  742. pdata[2]=sum+2+AddByte; //数据长度
  743. pdata[3]=sum+2+AddByte;
  744. pdata[4]=0x68;
  745. if(tRunPara.tUartPara[pt->chnl].b101PH)
  746. {
  747. pdata[5]=IEC101_CALL_DATA;
  748. IEC101_SETFCV(pdata[5]); //FCV位有效
  749. IEC101_SETPRM(pdata[5]);
  750. if(!pt->bDIR)IEC101_SETDIR(pdata[5]);
  751. if(pt->bMFCB)
  752. {
  753. IEC101_SETFCB(pdata[5]);
  754. }
  755. else
  756. {
  757. IEC101_CLRFCB(pdata[5]);
  758. }
  759. }
  760. else
  761. {
  762. pdata[5]=IEC101_ECHO_DATA; //类型标示
  763. }
  764. pdata[6]=(u8)tRunPara.byAddr; //链路地址
  765. if(tRunPara.b101Addr2Byte) pdata[7]=(u8)(tRunPara.byAddr>>8); //链路地址
  766. checksum=0;
  767. pd=&pdata[5];
  768. for(cnt=0;cnt<pdata[2];cnt++) //标示拷贝
  769. {
  770. checksum+=*pd++;
  771. }
  772. *pd++=checksum;
  773. *pd++=0x16;
  774. }
  775. /**************************************************************************
  776. 函数名称:IEC101_GetYc
  777. 函数版本:1.00
  778. 作者:
  779. 创建日期:2008.9.1
  780. 函数功能说明:响应遥测帧
  781. 输入参数:
  782. 输出参数:
  783. 返回值:
  784. 更新信息:
  785. 更新日志1:
  786. 日期:
  787. 修改者:
  788. 修改内容:
  789. 修改原因:
  790. ***************************************************************************/
  791. static bool IEC101_GetYc(IEC101_DEF *pt)
  792. {
  793. bool bContinue=false; //是否保存当前判断的遥测位置
  794. u8 *pd;
  795. u8 vsq;
  796. int i,num;
  797. WORD cp=0;
  798. int ycvalue;
  799. union{
  800. float ff;
  801. u8 tt[4];
  802. }ff;
  803. // 主动上送遥测条件:
  804. // 1、总查询结束后可送
  805. // 2、没有在处理加密遥控报文
  806. // 3、不是复位进程状态
  807. // 4、主动上送遥测投入
  808. if((!pt->bSendChange) || pt->bRmtSM2 || pt->bResetProcess || (!tRunPara.bAutoSendYc))
  809. {
  810. return false;
  811. }
  812. //平衡101,主动发送不能小于发送间隔时间
  813. if(tRunPara.tUartPara[pt->chnl].b101PH)
  814. {
  815. if((ustimer_get_duration(pt->us0_yc) < (DWORD)rt_round(tRunPara.fYcTime*USTIMER_SEC))|| byc_filter)//
  816. {
  817. return false;
  818. }
  819. }
  820. #if defined IEC_JXYB_DEAL || defined NO_SEND_YC
  821. if(g_run_stu.bjx)
  822. return false;
  823. #endif
  824. // 得到一遥测帧
  825. pd=g_arrIECBuf;
  826. vsq=0;
  827. num=0;
  828. for(i=pt->ycno;i<g_table_head->ac_num;i++)
  829. {
  830. u8 QDS=0; //品质描述, 默认为零
  831. u8 no=g_ac_table[i].indexno;
  832. long lmeaval;
  833. bool bsend=false;
  834. if(g_ac_table[i].dead_value==0||g_ac_table[i].normal==0) continue; //死区或额定为零,不主动上送
  835. if(no>0)
  836. {
  837. DWORD dwMax=0;
  838. DWORD dwDeadVal=0;
  839. float rate;
  840. float f_65536=65536.0;
  841. u8 link_qds=0;
  842. no-=1;
  843. rate=(float)g_ac_table[i].rate/65536.0;
  844. //dwMax=(DWORD)g_ac_table[i].normal;
  845. dwMax = (tRunPara.bDeadType==true) ? (DWORD)g_ac_table[i].normal:_AbsL(pt->yc_save[i]);
  846. if(dwMax==0) //防止额定或者前一次保存值为0
  847. dwMax=1;
  848. dwDeadVal=_Mul_Div_U(g_ac_table[i].dead_value,dwMax,6553600);
  849. if(dwDeadVal==0)dwDeadVal=1;
  850. if(dwMax==0)f_65536=1.0;
  851. lmeaval=GetRmtMeaVal(g_ac_table[i].owner,no,&link_qds);
  852. ff.ff=(float)lmeaval/f_65536*rate; //转为浮点数
  853. #ifdef VOLT_ADAPTIVE_FACTOR
  854. if(pRunSet->bTT_AdaptiveFactor)
  855. {
  856. if(0 == g_ac_table[i].owner)
  857. {
  858. if((no <= PUB_AC_UCA1) && (no >= PUB_AC_UA1))
  859. {
  860. ff.ff=((float)lmeaval)/f_65536*10/pRunSet->pt1_two;
  861. }
  862. else if((no <= PUB_AC_UCA2) && (no >= PUB_AC_UA2))
  863. {
  864. ff.ff=((float)lmeaval)/f_65536*10/pRunSet->pt2_two;
  865. }
  866. }
  867. }
  868. #endif
  869. ycvalue=(int)rt_round(ff.ff);
  870. // 溢出处理
  871. if(tRunPara.bYcFloat)
  872. {
  873. if(_AbsL(lmeaval) > (dwMax*10)) // 大于额定值的10倍*65536
  874. {
  875. if(dwMax>0)QDS|=0x01; //遥测溢出
  876. }
  877. }
  878. else
  879. {
  880. if (ycvalue >= 0)
  881. {
  882. if (ycvalue > 32767)
  883. {
  884. ycvalue = 32767;
  885. QDS|=0x01; //遥测溢出
  886. }
  887. }
  888. else
  889. {
  890. if (ycvalue < (-32768))
  891. {
  892. ycvalue = -32768;
  893. QDS|=0x01; //遥测溢出
  894. }
  895. }
  896. }
  897. if(((no==PUB_AC_YC9) || (no==PUB_AC_YC10) || (no==PUB_AC_YC11) || (no==PUB_AC_YC12)))
  898. {
  899. bsend = true;
  900. }
  901. // 如果大于死区值,上送
  902. #ifndef IEC_JXYB_DEAL
  903. if(bsend || ((i<MAX_YC_NUMBER)&&(_AbsL(lmeaval-pt->yc_save[i])>=dwDeadVal)))
  904. #else
  905. if(bsend || ((i<MAX_YC_NUMBER)&&(_AbsL(lmeaval-pt->yc_save[i])>=dwDeadVal)&& (link_qds!=0x80)))
  906. #endif
  907. {
  908. if(g_run_stu.bToolRmtTest||g_run_stu.bHmiRmtTest) //在测试模式下,置无效状态
  909. {
  910. if(pRunSet->bTT_RmtTest)QDS|=0x80;
  911. }
  912. cp=g_ac_table[i].cp;
  913. if(i<MAX_YC_NUMBER) pt->yc_save[i]=lmeaval;
  914. pd[num++]=(u8)cp; //信息体地址L
  915. pd[num++]=(u8)(cp>>8); //信息体地址H
  916. if(tRunPara.bYcFloat) //浮点值上送
  917. {
  918. num += CopySwap(&pd[num],ff.tt,sizeof(ff.tt),true);
  919. }
  920. else
  921. {
  922. pd[num++]=(u8)(ycvalue); //无符号整数
  923. pd[num++]=(u8)(ycvalue>>8); //无符号整数
  924. }
  925. #if !defined GD_AREA_SHANTOU
  926. if(g_run_stu.bjx)
  927. {
  928. QDS|=0x80;//带品质描述,有效 <1>:=无效
  929. }
  930. #endif
  931. #ifdef IEC_QDS_HAVE
  932. QDS|=link_qds;
  933. #endif
  934. pd[num++]=QDS;
  935. vsq++;
  936. }
  937. if(num>MAX_101_FRAME_LENTH)
  938. {
  939. bContinue=true;
  940. break;
  941. }
  942. }
  943. }
  944. // 更新下一帧的遥测序号
  945. pt->ycno = bContinue ? (i+1) : 0;
  946. // 发送遥测帧
  947. if(num>0)
  948. {
  949. IEC101_Asdu_Yc(pt,g_arrIECBuf,num,vsq,3);
  950. pt->us0_yc = ustimer_get_origin();
  951. return true;
  952. }
  953. return false;
  954. }
  955. static void IEC101_LinkInf(IEC101_DEF *pt)
  956. {
  957. //68 bc bc 68 28 01 f0 08 14 01 01 40 00 00 00 00 00 00 00 00 00 00 00 00 00 遥测帧
  958. // vsq cot appaddr
  959. u8 *pd,*pdata;
  960. u8 checksum,sum;
  961. int i;
  962. WORD cp;
  963. u8 num;
  964. WORD count=0;
  965. pdata=pt->tx_buf_s;
  966. sum=0;
  967. pd=&pdata[5];
  968. pd[sum++]=IEC101_ECHO_DATA; //类型标示
  969. pd[sum++]=(u8)tRunPara.byAddr; //链路地址
  970. pd[sum++]=250; //类型标示
  971. pd[sum++]=8; //长度
  972. pd[sum++]=14; //传送原因
  973. pd[sum++]=1; //KOD
  974. pd[sum++]=0; //统计遥测遥信个数
  975. cp=g_di_table[0].cp;
  976. num=0;
  977. for(i=0;i<g_table_head->di_num;i++) // 遥信个数统计
  978. {
  979. if(g_di_table[i].cp==(cp+num))
  980. {
  981. num++;
  982. }
  983. else
  984. {
  985. pd[sum++]=1; //遥信类型
  986. pd[sum++]=num;
  987. pd[sum++]=(u8)cp; //遥信个数
  988. pd[sum++]=(u8)(cp>>8); //遥信个数
  989. count++;
  990. cp=g_di_table[i].cp;
  991. num=1;
  992. }
  993. }
  994. if(num)
  995. {
  996. pd[sum++]=1; //遥信类型
  997. pd[sum++]=num;
  998. pd[sum++]=(u8)cp; //遥信点号
  999. pd[sum++]=(u8)(cp>>8); //遥信点号
  1000. count++;
  1001. }
  1002. cp=g_ac_table[0].cp;
  1003. num=0;
  1004. for(i=0;i<g_table_head->ac_num;i++) // 遥测个数统计
  1005. {
  1006. if(g_ac_table[i].cp==(cp+num))
  1007. {
  1008. num++;
  1009. }
  1010. else
  1011. {
  1012. pd[sum++]=2; //遥测类型
  1013. pd[sum++]=num;
  1014. pd[sum++]=(u8)cp; //遥测个数
  1015. pd[sum++]=(u8)(cp>>8); //遥测个数
  1016. count++;
  1017. cp=g_ac_table[i].cp;
  1018. num=1;
  1019. }
  1020. }
  1021. if(num)
  1022. {
  1023. pd[sum++]=2; //遥测类型
  1024. pd[sum++]=num;
  1025. pd[sum++]=(u8)cp; //遥测个数
  1026. pd[sum++]=(u8)(cp>>8); //遥测个数
  1027. count++;
  1028. }
  1029. pdata[0]=sum+6; //报文长度 +2=控制域、地址 +6=报文头(4字节)校验和、结束符
  1030. pdata[1]=0x68; //报文头
  1031. pdata[2]=sum; //数据长度
  1032. pdata[3]=sum;
  1033. pdata[4]=0x68;
  1034. pdata[11]=count;
  1035. checksum=0;
  1036. pd=&pdata[5];
  1037. for(i=0;i<sum;i++) //标示拷贝
  1038. {
  1039. checksum+=*pd++;
  1040. }
  1041. *pd++=checksum;
  1042. *pd++=0x16;
  1043. }
  1044. /**************************************************************************
  1045. 函数名称:IEC101_Asdu_Add
  1046. 函数版本:1.00
  1047. 作者:
  1048. 创建日期:2008.9.1
  1049. 函数功能说明:将通用分类数据添加到一级数据缓冲区中
  1050. 输入参数:pt 缓冲区地址,pdat报文数据,len报文长度
  1051. vsq,inf,cot ,rii,IEC101规约要求的内容
  1052. 输出参数:
  1053. 返回值:
  1054. 更新信息:
  1055. 更新日志1:
  1056. 日期:
  1057. 修改者:
  1058. 修改内容:
  1059. 修改原因:
  1060. ***************************************************************************/
  1061. static void IEC101_Asdu_Add_sts(IEC101_DEF *pt,u8 *pdat,u8 len,u8 vsq, u8 cot,u8 type,u16 attr,u16 soe_tail_send)
  1062. {
  1063. u8 *pd;
  1064. u8 cnt,L;
  1065. u16 head;
  1066. iec_tbuf_t *ptb;
  1067. // 获取BUF
  1068. ptb=&pt->tx_buf[1];
  1069. if(attr&FRAME_I_PRIOR_HIGH)ptb=&pt->tx_buf[0];
  1070. else if(attr&FRAME_I_PRIOR_LOW)ptb=&pt->tx_buf[2];
  1071. head = IEC101_GetOneBuf(ptb);
  1072. // 保存数据
  1073. ptb->tb_info[head].frm_attr = attr;
  1074. ptb->tb_info[head].soe_tail_send = g_soe_queue.tail_send[pt->chnl].n;
  1075. L = IEC101_InfoAddr() + len - 4;
  1076. // 报文生成
  1077. pd=ptb->tb_data[head];
  1078. *pd++=L+6; //报文长度 +2=控制域、地址 +6=报文头(4字节)校验和、结束符
  1079. *pd++=0x68; //报文头
  1080. *pd++=L; //数据长度
  1081. *pd++=L;
  1082. *pd++=0x68;
  1083. *pd++=IEC101_ECHO_DATA; //非平衡功能码,平衡通道发送时再修改
  1084. *pd++=(u8)tRunPara.byAddr; //链路地址1
  1085. if(tRunPara.b101Addr2Byte)
  1086. {
  1087. *pd++=(u8)(tRunPara.byAddr>>8); //链路地址2
  1088. }
  1089. *pd++=type; //类型标示
  1090. *pd++=vsq; //VSQ
  1091. *pd++=cot; //传送原因1
  1092. if(tRunPara.b101Cot2Byte)
  1093. {
  1094. *pd++=0; //传送原因2
  1095. }
  1096. *pd++=(u8)tRunPara.byAddr; //应用服务单元地址1
  1097. if(tRunPara.b101App2Byte)
  1098. {
  1099. *pd++=(u8)(tRunPara.byAddr>>8); //应用服务单元地址2
  1100. }
  1101. for(cnt=0;cnt<len;cnt++)
  1102. {
  1103. *pd++=*pdat++; //信息体
  1104. }
  1105. *pd++=0; // 校验和,推迟计算
  1106. *pd++=0x16; // 结束字符
  1107. return;
  1108. }
  1109. void IEC101_Asdu_Add(IEC101_DEF *pt,u8 *pdat,u8 len,u8 vsq, u8 cot,u8 type,u16 attr)
  1110. {
  1111. IEC101_Asdu_Add_sts(pt,pdat,len,vsq,cot,type,attr,0);
  1112. }
  1113. /**************************************************************************
  1114. 函数名称:IEC101_TimeSet
  1115. 函数版本:1.00
  1116. 作者:
  1117. 创建日期:2008.9.1
  1118. 函数功能说明:时间同步,并应答
  1119. 输入参数:
  1120. 输出参数:
  1121. 返回值:
  1122. 更新信息:
  1123. 更新日志1:
  1124. 日期:
  1125. 修改者:
  1126. 修改内容:
  1127. 修改原因:
  1128. ***************************************************************************/
  1129. static void IEC101_TimeSetEcho(IEC101_DEF *pt101,u8 *ps,u8 scot) //确认帧
  1130. {
  1131. u8 *pd;
  1132. int num;
  1133. int check_time=false;
  1134. u8 cot;
  1135. TIME ct;
  1136. struct timespec ts;
  1137. u8 week;
  1138. //对时
  1139. if(scot == IEC_COT_ACT)
  1140. {
  1141. ct.ms=ps[0]+((WORD)ps[1]<<8);
  1142. ct.min=(ps[2]&0x3F);
  1143. ct.hour=(ps[3]&0x1F);
  1144. ct.day=(ps[4]&0x1F);
  1145. ct.month=(ps[5]&0x0F);
  1146. ct.year=(ps[6]&0x7F);
  1147. // 检查时间,如果合法,重新设置系统时间
  1148. check_time = check_rtc(&ct);
  1149. if(check_time)
  1150. {
  1151. u32 ms;
  1152. // 计算延时,传输延时T2和发送该报文的传输耗时T3
  1153. ms = ustimer_get_duration(pt101->us0_frame)/USTIMER_MS;
  1154. // rt_printf("时间设置:T2=%dms,T3=%dms.\r\n",pt101->ms_delay,ms);
  1155. ms += pt101->ms_delay;
  1156. // 修正时间
  1157. ct.ms += ms;
  1158. if(ct.ms>=60000)
  1159. {
  1160. ct.ms-=60000;
  1161. sys_time_change(&ct);
  1162. }
  1163. // 设置时间
  1164. sys_time_set_rmt(&ct);
  1165. }
  1166. }
  1167. clk_time_get(&ts);
  1168. timespec_to_rtc(ts,&ct,1);
  1169. // 得到星期
  1170. rtc_to_timespec(&ct, &ts);
  1171. week = WEEK_DAY(ts.tv_sec);
  1172. //组织报文,以最新时间返回
  1173. pd=g_arrIECBuf;
  1174. num=0;
  1175. #if defined GD_AREA_ZHONGSHAN || defined GD_AREA_ZHONGSHAN_2020
  1176. pd[num++]=0; //信息序号=0时钟同步
  1177. pd[num++]=0; //信息序号=0时钟同步
  1178. if(scot==IEC_COT_ACT)
  1179. {
  1180. pd[num++]=ps[0]; //MsL
  1181. pd[num++]=ps[1]; //MsH
  1182. pd[num++]=ps[2]; //Min
  1183. pd[num++]=ps[3]; //hour
  1184. pd[num++]=ps[4]; //Day
  1185. pd[num++]=ps[5]; //month
  1186. pd[num++]=ps[6]; //year
  1187. }
  1188. else
  1189. {
  1190. pd[num++]=(u8)ct.ms; //MsL
  1191. pd[num++]=(u8)(ct.ms>>8); //MsH
  1192. pd[num++]=ct.min; //Min
  1193. pd[num++]=ct.hour; //hour
  1194. pd[num++]=ct.day; //Day
  1195. pd[num++]=ct.month; //month
  1196. pd[num++]=ct.year; //year
  1197. }
  1198. #else
  1199. pd[num++]=0; //信息序号=0时钟同步
  1200. pd[num++]=0; //信息序号=0时钟同步
  1201. pd[num++]=(u8)ct.ms; //MsL
  1202. pd[num++]=(u8)(ct.ms>>8); //MsH
  1203. pd[num++]=ct.min; //Min
  1204. pd[num++]=ct.hour; //hour
  1205. pd[num++]=((week<<5) | ct.day); //Day
  1206. pd[num++]=ct.month; //month
  1207. pd[num++]=ct.year; //year
  1208. #endif
  1209. if(scot == IEC_COT_REQ)
  1210. {
  1211. cot=0x05;
  1212. }
  1213. else
  1214. {
  1215. cot = check_time ? 0x07:0x47; //对时内容非法,即将传送原因的P/N位置为1
  1216. }
  1217. IEC101_Asdu_Add(pt101,g_arrIECBuf,num,1,cot,103,FRAME_I);//
  1218. }
  1219. static void IEC101_TestFrame(IEC101_DEF *pt101,u8 *ps) //测试确认帧
  1220. {
  1221. u8 *pd;
  1222. int num;
  1223. //组织报文
  1224. pd=g_arrIECBuf;
  1225. num=0;
  1226. pd[num++]=0; //信息体地址
  1227. pd[num++]=0; //
  1228. pd[num++]=ps[0];//pd[num++]=0xAA; //测试码
  1229. pd[num++]=ps[1];//pd[num++]=0x55; //测试码
  1230. IEC101_Asdu_Add(pt101,g_arrIECBuf,num,1,7,104,FRAME_I|FRAME_I_PRIOR_LOW);//
  1231. }
  1232. /**************************************************************************
  1233. 函数名称:IEC101_InitOK
  1234. 函数版本:1.00
  1235. 作者:
  1236. 创建日期:2007.9.1
  1237. 函数功能说明:子站初始化完毕
  1238. 输入参数:
  1239. 输出参数:
  1240. 返回值:
  1241. 更新信息:
  1242. 更新日志1:
  1243. 日期:
  1244. 修改者:
  1245. 修改内容:
  1246. 修改原因:
  1247. ***************************************************************************/
  1248. static void IEC101_InitOK(IEC101_DEF *pt101)
  1249. {
  1250. u8 *pd;
  1251. int num;
  1252. u8 cot;
  1253. //组织报文
  1254. pd=g_arrIECBuf;
  1255. num=0;
  1256. pd[num++] = 0;
  1257. pd[num++] = 0;
  1258. if(pt101->bInitCot)
  1259. {
  1260. pd[num++]=2; //远方复位
  1261. }
  1262. else
  1263. {
  1264. pd[num++]=0; //当地电源合上
  1265. }
  1266. pt101->bInitCot=true;
  1267. cot = pRunSet->bTT_101Cot03 ? 3 : 4;
  1268. IEC101_Asdu_Add(pt101,g_arrIECBuf,num,1,cot,70,FRAME_I);//70 初始化结束帧
  1269. }
  1270. // 复位进程
  1271. static void IEC101_ResetProcess(IEC101_DEF *pt101,u8 qrp)
  1272. {
  1273. u8 *pd;
  1274. int num;
  1275. //组织报文
  1276. pd=g_arrIECBuf;
  1277. num=0;
  1278. pd[num++] = 0;
  1279. pd[num++] = 0;
  1280. pd[num++] = qrp;
  1281. IEC101_Asdu_Add(pt101,g_arrIECBuf,num,1,7,105,FRAME_I);
  1282. }
  1283. /**************************************************************************
  1284. 函数名称:IEC101_CallAll
  1285. 函数版本:1.00
  1286. 作者:
  1287. 创建日期:2008.9.1
  1288. 函数功能说明:通用范围总查询响应
  1289. 输入参数:
  1290. 输出参数:
  1291. 返回值:
  1292. 更新信息:
  1293. 更新日志1:
  1294. 日期:
  1295. 修改者:
  1296. 修改内容:
  1297. 修改原因:
  1298. ***************************************************************************/
  1299. static void IEC101_CallAll(IEC101_DEF *pt,u8 QOI) //确认帧
  1300. {
  1301. u8 *pd,*pdata;
  1302. u8 vsq;//通用分类数据集数目
  1303. u16 cp=0,attr;
  1304. int i,num,begin,end;
  1305. pdata=g_arrIECBuf;
  1306. pt->ycno=0;
  1307. attr = pt->bSendChange ? FRAME_I_PRIOR_LOW : FRAME_I;//| FRAME_I_PRIOR_HIGH
  1308. //总召唤确认帧
  1309. num=0;
  1310. pd=pdata;
  1311. pd[num++] = 0;
  1312. pd[num++] = 0;
  1313. pd[num++] = QOI;
  1314. IEC101_Asdu_Add(pt,pdata,num,1,7,100, FRAME_I);
  1315. // 遥测帧
  1316. if((QOI==IEC_QOI_CALL_ALL_GROUP)|((QOI >= IEC_QOI_CALL_YC_BEGIN && QOI <= IEC_QOI_CALL_YC_END)))
  1317. {
  1318. int ycvalue;
  1319. u8 ti;
  1320. union{
  1321. float ff;
  1322. u8 tt[4];
  1323. }ff;
  1324. long lmeaval;
  1325. // 类型标识
  1326. if(tRunPara.bYcBDH)
  1327. {
  1328. ti=11; // 标度化值
  1329. }
  1330. else if(tRunPara.bYcFloat)
  1331. {
  1332. ti=13; // 浮点值
  1333. }
  1334. else
  1335. {
  1336. ti=9; // 归一化值
  1337. }
  1338. // 确认起止点号
  1339. if(QOI == IEC_QOI_CALL_ALL_GROUP || pRunSet->dGroupYcSize == 0)
  1340. {
  1341. begin = 0;
  1342. end = g_table_head->ac_num;
  1343. }
  1344. else if(pRunSet->dGroupYcSize)
  1345. {
  1346. begin = (QOI - IEC_QOI_CALL_YC_BEGIN) * pRunSet->dGroupYcSize;
  1347. end = begin + pRunSet->dGroupYcSize;
  1348. if(end > g_table_head->ac_num)
  1349. {
  1350. end = g_table_head->ac_num;
  1351. }
  1352. }
  1353. // 得到第一点的通讯点号,必须检查g_ac_table,否则有可能系统崩溃
  1354. if(g_ac_table)
  1355. {
  1356. cp=g_ac_table[begin].cp;
  1357. }
  1358. // 初始数据
  1359. pd=pdata;
  1360. vsq=0;
  1361. num=0;
  1362. // 如果点号连续,保存第一点点号
  1363. if(pRunSet->bDIContinue)
  1364. {
  1365. pd[num++]=(u8)cp;
  1366. pd[num++]=(u8)(cp>>8);
  1367. }
  1368. // 发送begin到end之间的所有遥测值
  1369. for(i=begin;i<end;i++)
  1370. {
  1371. u8 QDS=0; //品质描述, 默认为零
  1372. u8 link_qds=0;
  1373. u8 no=g_ac_table[i].indexno;
  1374. // 得到遥测值
  1375. if(no>0)
  1376. {
  1377. DWORD dwMax=0;
  1378. float rate;
  1379. float f_65536=65536.0;
  1380. no-=1;
  1381. rate=(float)g_ac_table[i].rate/65536.0;
  1382. //dwMax=(DWORD)g_ac_table[i].normal;
  1383. dwMax = (tRunPara.bDeadType==true) ? (DWORD)g_ac_table[i].normal:_AbsL(pt->yc_save[i]);
  1384. if(dwMax==0) //防止额定或者前一次保存值为0
  1385. dwMax=1;
  1386. lmeaval=GetRmtMeaVal(g_ac_table[i].owner,no,&link_qds);
  1387. if(dwMax==0)f_65536=1.0;
  1388. ff.ff=((float)lmeaval)/f_65536*rate; //转为浮点数
  1389. #ifdef VOLT_ADAPTIVE_FACTOR
  1390. if(pRunSet->bTT_AdaptiveFactor)
  1391. {
  1392. if(0 == g_ac_table[i].owner)
  1393. {
  1394. if((no <= PUB_AC_UCA1) && (no >= PUB_AC_UA1))
  1395. {
  1396. ff.ff=((float)lmeaval)/f_65536*10/pRunSet->pt1_two;
  1397. }
  1398. else if((no <= PUB_AC_UCA2) && (no >= PUB_AC_UA2))
  1399. {
  1400. ff.ff=((float)lmeaval)/f_65536*10/pRunSet->pt2_two;
  1401. }
  1402. }
  1403. }
  1404. #endif
  1405. ycvalue=(int)rt_round(ff.ff);
  1406. if(tRunPara.bYcFloat)
  1407. {
  1408. if(_AbsL(lmeaval) > (dwMax*10)) // 大于额定值的10倍*65536
  1409. {
  1410. if(dwMax>0)QDS|=0x01; //遥测溢出
  1411. }
  1412. }
  1413. else
  1414. {
  1415. if (ycvalue >= 0)
  1416. {
  1417. if (ycvalue > 32767)
  1418. {
  1419. ycvalue = 32767;
  1420. QDS|=0x01; //遥测溢出
  1421. }
  1422. }
  1423. else
  1424. {
  1425. if (ycvalue < (-32768))
  1426. {
  1427. ycvalue = -32768;
  1428. QDS|=0x01; //遥测溢出
  1429. }
  1430. }
  1431. }
  1432. }
  1433. else //备用点号,数值上送0
  1434. {
  1435. lmeaval=0;
  1436. ycvalue=0;
  1437. ff.ff=0;
  1438. if(!pRunSet->bDIContinue) continue; // 点号不连续上送,可不送备用点
  1439. }
  1440. //如果在测试模式下,置无效状态
  1441. if(g_run_stu.bToolRmtTest||g_run_stu.bHmiRmtTest)
  1442. {
  1443. if(pRunSet->bTT_RmtTest)QDS|=0x80;//带品质描述,有效 <1>:=无效
  1444. }
  1445. #if !defined GD_AREA_SHANTOU && !defined FUNC_JX_YC_SIQ00
  1446. if(g_run_stu.bjx)
  1447. {
  1448. QDS|=0x80;//带品质描述,有效 <1>:=无效
  1449. }
  1450. #endif
  1451. #ifdef IEC_QDS_HAVE
  1452. QDS|=link_qds;
  1453. #endif
  1454. //保存遥测值,供主动遥测上送比较用
  1455. if(i<MAX_YC_NUMBER)pt->yc_save[i]=lmeaval;
  1456. // 如果点号不连续,上送每个点的点号
  1457. if(!pRunSet->bDIContinue)
  1458. {
  1459. cp=g_ac_table[i].cp;
  1460. pd[num++]=(u8)cp;
  1461. pd[num++]=(u8)(cp>>8);
  1462. }
  1463. // 上送值
  1464. if(tRunPara.bYcFloat)
  1465. {
  1466. //浮点值上送
  1467. num += CopySwap(&pd[num],ff.tt,sizeof(ff.tt),true);
  1468. }
  1469. else
  1470. { // 整型
  1471. pd[num++]=(u8)(ycvalue);
  1472. pd[num++]=(u8)(ycvalue>>8);
  1473. }
  1474. pd[num++]=QDS;
  1475. vsq++;
  1476. // 发送一帧
  1477. if(num>MAX_101_FRAME_LENTH&&(i<g_table_head->ac_num-1))
  1478. {
  1479. u8 vsq1=vsq;
  1480. if(pRunSet->bDIContinue)
  1481. {
  1482. vsq1|=0x80;
  1483. }
  1484. IEC101_Asdu_Add(pt,pdata,num,(vsq1),QOI,ti,attr);
  1485. num=0;
  1486. pd=pdata;
  1487. if(pRunSet->bDIContinue)
  1488. {
  1489. pd[num++]=(u8)(cp+vsq);
  1490. pd[num++]=(u8)((cp+vsq)>>8);
  1491. cp+=vsq;
  1492. }
  1493. vsq=0;
  1494. }
  1495. }
  1496. if(num>2)
  1497. {
  1498. u8 vsq1=vsq;
  1499. if(pRunSet->bDIContinue)
  1500. {
  1501. vsq1|=0x80;
  1502. }
  1503. IEC101_Asdu_Add(pt,pdata,num,(vsq1),QOI,ti,attr);
  1504. }
  1505. pt->us0_yc = ustimer_get_origin();
  1506. }
  1507. // 事件帧
  1508. if((QOI == IEC_QOI_CALL_ALL_GROUP) || (QOI >= IEC_QOI_CALL_YX_BEGIN && QOI <= IEC_QOI_CALL_YX_END))
  1509. {
  1510. u8 ti;
  1511. u8 yxtype=0;
  1512. // 确定类型标识,单点(1)或双点(3)
  1513. ti = tRunPara.bDPI ? 3:1;
  1514. // 确定起止点号
  1515. if(QOI == IEC_QOI_CALL_ALL_GROUP || pRunSet->dGroupYxSize == 0)
  1516. {
  1517. begin = 0;
  1518. end = g_table_head->di_num;
  1519. }
  1520. else
  1521. {
  1522. begin = (QOI - IEC_QOI_CALL_YX_BEGIN) * pRunSet->dGroupYxSize;
  1523. end = begin + pRunSet->dGroupYxSize;
  1524. if(end > g_table_head->di_num)
  1525. {
  1526. end = g_table_head->di_num;
  1527. }
  1528. }
  1529. // 初始数据
  1530. pd=pdata;
  1531. vsq=0;
  1532. num=0;
  1533. // 得到第一点的通讯点号,必须检查g_di_table,否则有可能系统崩溃
  1534. if(g_di_table)
  1535. {
  1536. cp=g_di_table[begin].cp;
  1537. yxtype=tbl_get_dpi(begin);
  1538. }
  1539. // 如果点号连续,保存第一点点号
  1540. if(pRunSet->bDIContinue)
  1541. {
  1542. pd[num++]=(u8)cp;
  1543. pd[num++]=(u8)(cp>>8);
  1544. }
  1545. // 发送begin到end之间的所有遥信值
  1546. for(i=begin;i<end;i++)
  1547. {
  1548. u8 SIQ;
  1549. // 得到遥信值
  1550. if(tRunPara.bSDPI) // 单双点分别上送
  1551. {
  1552. u8 type=tbl_get_dpi(i);
  1553. if(yxtype!=type&&num>2)
  1554. {
  1555. u8 vsq2=vsq;
  1556. u8 ti2=yxtype ? 3:1;
  1557. yxtype=type;
  1558. if(pRunSet->bDIContinue)
  1559. {
  1560. vsq2|=0x80;
  1561. }
  1562. IEC101_Asdu_Add(pt,pdata,num,(vsq2),QOI,ti2, attr| FRAME_I_COS);//cot=9总查询
  1563. num=0;
  1564. pd=pdata;
  1565. if(pRunSet->bDIContinue)
  1566. {
  1567. pd[num++]=(u8)(cp+vsq);
  1568. pd[num++]=(u8)((cp+vsq)>>8);
  1569. cp+=vsq;
  1570. }
  1571. vsq=0;
  1572. yxtype=type;
  1573. }
  1574. SIQ = tbl_get_yx(i,type);
  1575. ti=type ? 3:1;
  1576. }
  1577. else
  1578. {
  1579. SIQ = tbl_get_yx(i,tRunPara.bDPI);
  1580. }
  1581. #if !defined GD_AREA_SHANTOU && !defined FUNC_JX_YX_BEFORE
  1582. if(g_run_stu.bjx)
  1583. {
  1584. SIQ|=0x80;//带品质描述,有效 <1>:=无效
  1585. }
  1586. #endif
  1587. if(g_run_stu.bToolRmtTest||g_run_stu.bHmiRmtTest) //测试模式,遥信置为无效
  1588. {
  1589. if(pRunSet->bTT_RmtTest)SIQ|=0x80;
  1590. }
  1591. // 点号
  1592. if(!pRunSet->bDIContinue)
  1593. {
  1594. cp=g_di_table[i].cp;
  1595. pd[num++]=(u8)cp;
  1596. pd[num++]=(u8)(cp>>8);
  1597. }
  1598. pd[num++]=SIQ;
  1599. vsq++;
  1600. if(((vsq>120)||(num>MAX_101_FRAME_LENTH))&&(i<g_table_head->di_num-1)) // ngd不能超过128,因个数最高位为连续标示位
  1601. {
  1602. u8 vsq1=vsq;
  1603. if(pRunSet->bDIContinue)
  1604. {
  1605. vsq1|=0x80;
  1606. }
  1607. IEC101_Asdu_Add(pt,pdata,num,(vsq1),QOI,ti, attr| FRAME_I_COS);//cot=9总查询
  1608. num=0;
  1609. pd=pdata;
  1610. if(pRunSet->bDIContinue)
  1611. {
  1612. pd[num++]=(u8)(cp+vsq);
  1613. pd[num++]=(u8)((cp+vsq)>>8);
  1614. cp+=vsq;
  1615. }
  1616. vsq=0;
  1617. }
  1618. }
  1619. if(num>2)
  1620. {
  1621. u8 vsq1=vsq;
  1622. if(pRunSet->bDIContinue)
  1623. {
  1624. vsq1|=0x80;
  1625. }
  1626. IEC101_Asdu_Add(pt,pdata,num,(vsq1),QOI,ti, attr| FRAME_I_COS);//cot=9总查询
  1627. }
  1628. }
  1629. // 总召唤结束帧
  1630. num=0;
  1631. pd=pdata;
  1632. pd[num++] = 0;
  1633. pd[num++] = 0;
  1634. pd[num++] = QOI;
  1635. IEC101_Asdu_Add(pt,pdata,num,1,10,100, attr);
  1636. // 不允许通讯续传的情况下,第一次总召先清SOE队列,保证上传事件是总召后产生的,后续总召不清SOE队列
  1637. if((pRunSet->bTT_SoeResumeComm == 0) &&(!pt->bSendChange))
  1638. {
  1639. g_soe_queue.tail_send[pt->chnl].n=g_soe_queue.head.n;
  1640. g_soe_queue.tail_ack[pt->chnl].n = g_soe_queue.tail_send[pt->chnl].n;
  1641. }
  1642. #ifdef FUN_SOE_DELAY_TIME
  1643. if(pt->bSendChange == false)
  1644. {
  1645. pt->DTSendChange = dTCounter;
  1646. pt->bfirst_call = true;
  1647. }
  1648. #endif
  1649. // 置总召标志
  1650. pt->bSendChange=true;
  1651. }
  1652. static void IEC101_DDAll(IEC101_DEF *pt,u8 QCC) //确认帧
  1653. {
  1654. u8 *pd,*pdata;
  1655. u8 vsq,cot;//通用分类数据集数目
  1656. u16 cp;
  1657. int i,num;
  1658. pdata=g_arrIECBuf;
  1659. num=0;
  1660. //总召唤确认帧
  1661. pd=pdata;
  1662. pd[num++] = 0;
  1663. pd[num++] = 0;
  1664. pd[num++] = QCC;
  1665. IEC101_Asdu_Add(pt,pdata,num,1,7,101, FRAME_I);
  1666. // 电度值
  1667. if((QCC==1)||(QCC==5))
  1668. {
  1669. // 初始数据
  1670. pd=pdata;
  1671. vsq=0;
  1672. num=0;
  1673. cp=g_dd_table[0].cp;
  1674. if(QCC==5)cot=37; // 总召
  1675. else cot=QCC+37; // 召某一组
  1676. pd[num++]=(u8)cp;
  1677. pd[num++]=(u8)(cp>>8);
  1678. for(i=0;i<g_table_head->dd_num;i++)
  1679. {
  1680. int sw,no;
  1681. float rate;
  1682. union{
  1683. float ff;
  1684. u8 tt[4];
  1685. }ff;
  1686. sw=g_dd_table[i].owner;
  1687. no=g_dd_table[i].indexno;
  1688. if(no>0)
  1689. {
  1690. rate=(float)g_dd_table[i].rate/65536.0;
  1691. ff.ff=GetRmtDdVal(sw,no-1)*rate;
  1692. }
  1693. else
  1694. {
  1695. ff.ff=0;
  1696. }
  1697. num += CopySwap(&pd[num],ff.tt,sizeof(ff.tt),true);
  1698. pd[num++]=0;
  1699. vsq++;
  1700. // 发送一帧
  1701. if((num>MAX_101_FRAME_LENTH)||(i==g_table_head->dd_num-1))
  1702. {
  1703. IEC101_Asdu_Add(pt,pdata,num,(vsq|0x80),cot,206,FRAME_I_PRIOR_LOW);
  1704. cp+=vsq;
  1705. pd=pdata;
  1706. num=0;
  1707. vsq=0;
  1708. pd[num++]=(u8)cp;
  1709. pd[num++]=(u8)(cp>>8);
  1710. }
  1711. }
  1712. }
  1713. if(QCC==0x45)//主站扩展瞬时冻结电度命令
  1714. {
  1715. //rand_file_info.b_frz=true;
  1716. }
  1717. // 总召唤结束帧
  1718. num=0;
  1719. pd=pdata;
  1720. pd[num++] = 0;
  1721. pd[num++] = 0;
  1722. pd[num++] = QCC;
  1723. IEC101_Asdu_Add(pt,pdata,num,1,10,101, FRAME_I_PRIOR_LOW);
  1724. }
  1725. /**************************************************************************
  1726. 函数名称:IEC101_RmtCtrl
  1727. 函数版本:1.00
  1728. 作者:
  1729. 创建日期:2007.9.1
  1730. 函数功能说明:遥控处理
  1731. 输入参数: 点号开始21 0b 00 82 (10-13)
  1732. 输出参数:
  1733. 返回值:
  1734. 更新信息:
  1735. 更新日志1:
  1736. 日期:
  1737. 修改者:
  1738. 修改内容:
  1739. 修改原因:
  1740. ***************************************************************************/
  1741. void IEC101_Echo_YK(IEC101_DEF *pt,u16 cp,u8 ti,u8 cot,u8 v)
  1742. {
  1743. u8 *pd,*pdata;
  1744. int num;
  1745. pdata=g_arrIECBuf;
  1746. pd = pdata;
  1747. num=0;
  1748. pd[num++]=(u8)cp;
  1749. pd[num++]=(u8)(cp>>8);
  1750. pd[num++]=v;
  1751. IEC101_Asdu_Add(pt,pdata,num,1,cot,ti,FRAME_I|FRAME_I_PRIOR_HIGH);//cot=9总查询
  1752. pt->bRmtSM2 = false; //遥控执行完成,清除SM2标志,开放事件上传
  1753. }
  1754. void IEC101_Echo_PAR(IEC101_DEF *pt,u16 cp,u8 ti,u8 cot,BYTE *buf,u8 len,u8 vsq)
  1755. {
  1756. u8 *pd,*pdata;
  1757. int num;
  1758. pdata=g_arrIECBuf;
  1759. pd = pdata;
  1760. num=0;
  1761. //pd[num++]=(u8)cp;
  1762. //pd[num++]=(u8)(cp>>8);
  1763. memcpy(&pd[num],buf,len);
  1764. num+=len;
  1765. //pd[num++]=v;
  1766. IEC101_Asdu_Add(pt,pdata,num,vsq,cot,ti,FRAME_I);//cot=9总查询
  1767. }
  1768. int get_yk_info_cp(u8 cp)
  1769. {
  1770. int i;
  1771. for(i=0;i<g_table_head->do_num;i++)
  1772. {
  1773. //rt_printf("cp=%X link_ch=%x cp=%x \r\n",cp,(g_do_table[i].link_ch&0x0f),g_do_table[i].link_cp);
  1774. if((g_do_table[i].link_ch&0x01f) == cp)
  1775. {
  1776. return (u8)i;
  1777. }
  1778. }
  1779. return -1;
  1780. }
  1781. u8 get_par_link_101_to_104(BYTE *out,BYTE *in,BYTE parNum,u8 ti)
  1782. {
  1783. int size=0,i=0,j=0;
  1784. int no=0;
  1785. if((ti==FOS_PAR_SET_MUL) || (ti==FOS_PAR_SET_ONE))
  1786. size = (parNum*(sizeof(float)+2+1)); //写定值时需多一位QOS位
  1787. else if(ti==FOS_PAR_READ_MUL || ti==FOS_PAR_READ_ONE)
  1788. size = (parNum*(sizeof(float)+2));
  1789. rt_printf("size=%d,parNum=%d\n\r",size,parNum);
  1790. for(no=0;no<parNum;no++)
  1791. {
  1792. if((ti==FOS_PAR_READ_MUL) || (ti==FOS_PAR_READ_ONE))
  1793. {
  1794. out[j++] = in[i++]; //地址
  1795. out[j++] = in[i++]; //地址
  1796. out[j++] = 0;
  1797. out[j++] = in[i++]; //值
  1798. out[j++] = in[i++]; //值
  1799. out[j++] = in[i++]; //值
  1800. out[j++] = in[i++]; //值
  1801. }
  1802. else if((ti==FOS_PAR_SET_MUL) || (ti==FOS_PAR_SET_ONE))
  1803. {
  1804. out[j++] = in[i++]; //地址
  1805. out[j++] = in[i++]; //地址
  1806. out[j++] = 0;
  1807. out[j++] = in[i++]; //值
  1808. out[j++] = in[i++]; //值
  1809. out[j++] = in[i++]; //值
  1810. out[j++] = in[i++]; //值
  1811. out[j++] = in[i++]; //QOS
  1812. }
  1813. }
  1814. return (size+parNum);
  1815. }
  1816. u8 get_par_link_data(BYTE *out,BYTE *in,BYTE parNum,u8 ti)
  1817. {
  1818. int size;
  1819. if(ti == FOS_PAR_SET_MUL)//写带品质描述,长度+1
  1820. size = (parNum*(sizeof(float)+2+1));//4
  1821. else
  1822. size = (parNum*(sizeof(float)+2));
  1823. memcpy(out,in,size);//拷贝遥参点表地址=2 && 参数值=size
  1824. return (size);
  1825. }
  1826. u8 get_par_link_104_to_104(BYTE *out,BYTE *in,BYTE parNum,u8 ti)
  1827. {
  1828. int size;
  1829. if(ti == FOS_PAR_SET_MUL)//写带品质描述,长度+1
  1830. size = (parNum*(sizeof(float)+3+1));//4
  1831. else
  1832. size = (parNum*(sizeof(float)+3));
  1833. memcpy(out,in,size);//拷贝遥参点表地址=2 && 参数值=size
  1834. return (size);
  1835. }
  1836. u8 get_par_link_data_dz(BYTE *out,BYTE *in,BYTE parNum,u8 ti)
  1837. {
  1838. int size=0,i,j=0;
  1839. if((ti==FOS_PAR_SET_MUL) || (ti==FOS_PAR_SET_ONE))
  1840. size = (parNum*(sizeof(float)+3+1)); //写定值时需多一位QOS位
  1841. else if(ti==FOS_PAR_READ_MUL || ti==FOS_PAR_READ_ONE)
  1842. size = (parNum*(sizeof(float)+3));
  1843. rt_printf("size=%d,parNum=%d\n\r",size,parNum);
  1844. for(i=0;i<size;i++)
  1845. { //104遥调时,因管理机与级联间仍为101通讯,故管理机转发给级联的报文应去掉1位地址位(104为3位地址位,101为2位地址位)
  1846. if((ti==FOS_PAR_READ_MUL) || (ti==FOS_PAR_READ_ONE))
  1847. {
  1848. if(2 == i%7) //读定值时3位地址位+4位数据位共7位
  1849. continue; //跳过地址位第3位
  1850. else
  1851. {
  1852. out[j++]=in[i];
  1853. }
  1854. }
  1855. else if((ti==FOS_PAR_SET_MUL) || (ti==FOS_PAR_SET_ONE))
  1856. {
  1857. if(2 == i%8) //写定值时3位地址位+4位数据位+1位QOS位
  1858. continue; //跳过地址位第3位
  1859. else
  1860. {
  1861. out[j++]=in[i];
  1862. }
  1863. }
  1864. }
  1865. return (size-parNum);
  1866. }
  1867. //获取通道信息
  1868. bool get_par_ch_info(WORD parAddr,struct do_table *parTab)
  1869. {
  1870. WORD Addr=0;
  1871. int ykCp=0;
  1872. //判断遥参ID是否合法
  1873. if(parAddr<FOS_PAR_STATR_ADDR)
  1874. return false;
  1875. Addr = parAddr-FOS_PAR_STATR_ADDR;
  1876. #ifdef YC_QUANTITY
  1877. parTab->link_cp = (Addr/pRunSet->dYC_num)+1; //转发通信地址
  1878. #else
  1879. parTab->link_cp = (Addr/FOS_PAR_SW_NUM)+1; //转发通信地址
  1880. #endif
  1881. //通过遥控的级联地址去判断遥参是否合法
  1882. ykCp = get_yk_info_cp(parTab->link_cp);
  1883. if(ykCp<0)
  1884. {
  1885. rt_printf("定值参数未找到Yk对应的级联地址=%X link_ch=%x \r\n",parAddr,parTab->link_cp);
  1886. return false;
  1887. }
  1888. memcpy(parTab,&g_do_table[ykCp],sizeof(g_do_table[0])); //将遥控配置的转发信息赋到遥参
  1889. #if 0
  1890. parTab->cp = Addr%FOS_PAR_SW_NUM + FOS_PAR_STATR_ADDR; //转发点号
  1891. #endif
  1892. parTab->link_cp = parTab->cp = parAddr; //转发通信地址
  1893. #ifdef YC_QUANTITY
  1894. rt_printf("\n parAddr=%x link_cp=%x cp=%x link_ch=0X%X ykCp=%d linkAddr=%x\r\n",parAddr,parTab->link_cp,parTab->link_ch,parTab->cp,ykCp, Addr%pRunSet->dYC_num);
  1895. #else
  1896. rt_printf("\n parAddr=%x link_cp=%x cp=%x link_ch=0X%X ykCp=%d linkAddr=%x\r\n",parAddr,parTab->link_cp,parTab->link_ch,parTab->cp,ykCp, Addr%FOS_PAR_SW_NUM);
  1897. #endif
  1898. return true;
  1899. }
  1900. #ifdef FUNC_MORE_PRESET
  1901. YT_BUF PresetData101[256];
  1902. YT_BUF SetData101[256];
  1903. int WrongCount101[256];
  1904. int g_CountPreset101=0, g_CountSet101=0;
  1905. bool gb_101_yt=false;
  1906. #endif
  1907. static void IEC101_ParCtrl(IEC101_DEF *pt,u8 *pdat) // ps从传送原因开始
  1908. {
  1909. u8 cot,ykcot,ykvalue;
  1910. WORD parNum=1;
  1911. WORD ykno=0;
  1912. WORD yksave=0;
  1913. WORD parAddr=0;
  1914. u8 AppByte=0;
  1915. u8 CotByte=0;
  1916. u8 *ps=&pdat[2];
  1917. u8 ti=pdat[0]; //类型标示
  1918. struct do_table parTab;
  1919. BYTE buf[256];
  1920. BYTE len=0;
  1921. BYTE addrStart=0;
  1922. WORD sw=1;
  1923. static DWORD ctrlParTime=0; //系统定时器
  1924. static bool bSetParaDisable=false;
  1925. if(tRunPara.b101App2Byte) //应用单元双字节地址
  1926. {
  1927. AppByte=1;
  1928. }
  1929. if(tRunPara.b101Cot2Byte) //双字节传送原因
  1930. {
  1931. CotByte=1;
  1932. }
  1933. ykcot=(ps[0]&0x01f);
  1934. parNum=(pdat[1]&0xff);//遥参数量,支持遥调大于30个定值
  1935. ykno=ps[2+AppByte+CotByte]+(WORD)ps[3+AppByte+CotByte]*256;
  1936. addrStart = 2+AppByte+CotByte;
  1937. yksave=ykno;
  1938. cot=IEC_COT_UN_OA | IEC_COT_PN;
  1939. parAddr = (ps[addrStart+1]<<8)+ps[addrStart];//遥参通信地址
  1940. len = get_par_link_data(&buf[0],&ps[addrStart],parNum,ti);//2+(parNum*4);//2:点号 4:参数值
  1941. ykvalue=ps[AppByte+CotByte+2-1+7];//
  1942. rt_printf("ti=%d parAddr=%x parNum= %d recDataLen=%d addrStart=%d ykvalue=%x ykcot=%02x\r\n",ti,parAddr,parNum,len,addrStart,ykvalue,ykcot);
  1943. if(pRunSet->wEquTypeManager)// 通信管理机模式,转发
  1944. {
  1945. #ifdef YC_QUANTITY
  1946. if(!get_par_ch_info(parAddr,&parTab)||parNum>pRunSet->dYC_num)
  1947. #else
  1948. if(!get_par_ch_info(parAddr,&parTab)||parNum>FOS_PAR_SW_NUM)
  1949. #endif
  1950. {
  1951. cot = IEC_COT_ACTCON | IEC_COT_PN; // 否定应答
  1952. //refresh_co_file(true,ti,yktype,ykno,cot,yk_cmd);
  1953. return ;
  1954. }
  1955. //parTab.vsq = parNum;
  1956. if(lnk_master_par(&parTab ,ti,ps[0],len,&buf[0],parNum) == 0)
  1957. {
  1958. #ifdef FUNC_MORE_PREREAD /*级联遥参方式:0开关,1队列*/
  1959. pt->lnk_par_send_flag |= (1<<g_link_par_cnt);
  1960. rt_printf("-------lnk_par_send_flag=%x,g_link_par_cnt=%d\r\n",pt->lnk_par_send_flag,g_link_par_cnt);
  1961. g_link_par_cnt = (g_link_par_cnt+1)%SWITCH_NUM_EXT_PUB;
  1962. #else
  1963. pt->lnk_par_send_flag |= (1<<parTab.owner);
  1964. #endif
  1965. pt->us0_lnk_par = ustimer_get_origin();
  1966. }
  1967. }
  1968. else if (pRunSet->wEquTypeDFTU)// 测控装置遥参交互
  1969. {
  1970. WORD parCount;
  1971. WORD addLenParLen;
  1972. #ifdef FUNC_MORE_PRESET
  1973. int n;
  1974. #endif
  1975. cot=IEC_COT_ACTCON;
  1976. //ykvalue = (ti==FOS_PAR_SET_ONE) ? (ykvalue|0x80) :ykvalue;
  1977. #ifndef FUNC_MORE_PRESET
  1978. bfirst_sel = false;
  1979. #endif
  1980. #ifdef FUNC_MORE_PRESET
  1981. if((dTCounter-ctrlParTime) > tRunPara.dYKTime)
  1982. {//超时清零预置/执行/出错数据存储区
  1983. memset(SetData101,0,sizeof(SetData101));
  1984. g_CountSet101 = 0;
  1985. memset(PresetData101,0,sizeof(PresetData101));
  1986. g_CountPreset101 = 0;
  1987. memset(WrongCount101,0,sizeof(WrongCount101));
  1988. rt_printf("超时清除101报文缓存区\r\n");
  1989. }
  1990. #endif
  1991. if(ti==FOS_PAR_SET_ONE || ti==FOS_PAR_SET_MUL)
  1992. {
  1993. if(ykvalue&0x80)
  1994. {
  1995. #ifdef FUNC_MORE_PRESET
  1996. memcpy(&PresetData101[g_CountPreset101++].yc_data,&ps[addrStart],parNum*7);
  1997. rt_printf_time("101预置报文[第%d帧]:",g_CountPreset101);
  1998. for(n=0;n<parNum*7;n++)
  1999. {
  2000. rt_printf("%02x ",PresetData101[g_CountPreset101-1].yc_data[n]);
  2001. }
  2002. #else
  2003. //预置时先对buf_forCompare进行初始化,避免此数组有101/104共用的原因导致存储出错
  2004. memset(buf_forCompare,0,sizeof(buf_forCompare));
  2005. i_forCompare = 0;
  2006. j_forCompare = 0;
  2007. bfirst_sel = true; //为预置报文时才置1
  2008. #endif
  2009. }
  2010. #ifdef FUNC_MORE_PRESET
  2011. else
  2012. {
  2013. memcpy(&SetData101[g_CountSet101++].yc_data,&ps[addrStart],parNum*7);
  2014. rt_printf_time("101固化报文[第%d帧]:",g_CountSet101);
  2015. for(n=0;n<parNum*7;n++)
  2016. {
  2017. rt_printf("%02x ",SetData101[g_CountSet101-1].yc_data[n]);
  2018. }
  2019. }
  2020. #endif
  2021. }
  2022. for(parCount=0;parCount<parNum;parCount++)//多参数处理
  2023. {
  2024. #ifdef FUNC_MORE_PRESET
  2025. gb_101_yt = true;
  2026. #endif
  2027. if(ti == FOS_PAR_SET_MUL)//读取参数带品质描述
  2028. addLenParLen = (parCount)*(2+4+1);//ID=2,PAR=4,QDS=1
  2029. else
  2030. addLenParLen = (parCount)*(2+4);//ID=2,PAR=4
  2031. #ifdef YC_QUANTITY
  2032. parAddr = (ps[addrStart+1+addLenParLen]<<8)+ps[addrStart+addLenParLen]-((tRunPara.byAddr-1)*pRunSet->dYC_num);
  2033. #else
  2034. parAddr = (ps[addrStart+1+addLenParLen]<<8)+ps[addrStart+addLenParLen]-((tRunPara.byAddr-1)*FOS_PAR_SW_NUM);
  2035. #endif
  2036. //parAddr = (ps[addrStart+1]<<8)+ps[addrStart];//遥参通信地址
  2037. #ifdef YC_QUANTITY
  2038. if( ((ps[addrStart+1+addLenParLen]<<8)+ps[addrStart+addLenParLen]) >= FOS_PAR_STATR_ADDR
  2039. && ((ps[addrStart+1+addLenParLen]<<8)+ps[addrStart+addLenParLen]) < (FOS_PAR_STATR_ADDR+pRunSet->dYC_num))
  2040. #else
  2041. if( ((ps[addrStart+1+addLenParLen]<<8)+ps[addrStart+addLenParLen]) >= FOS_PAR_STATR_ADDR
  2042. && ((ps[addrStart+1+addLenParLen]<<8)+ps[addrStart+addLenParLen]) < (FOS_PAR_STATR_ADDR+FOS_PAR_SW_NUM))
  2043. #endif
  2044. {
  2045. parAddr = (ps[addrStart+1+addLenParLen]<<8)+ps[addrStart+addLenParLen];
  2046. }
  2047. rt_printf("parAddr=%x addr2=%X %x addrStart=%x\r\n",parAddr,(ps[addrStart+1]<<8)+ps[addrStart],addLenParLen,addrStart);
  2048. if(ti==FOS_PAR_READ_ONE || ti==FOS_PAR_READ_MUL)
  2049. {
  2050. rt_printf("读取遥参激活 parAddr=%x\r\n",parAddr);
  2051. if(!readRunParId(sw,parAddr,&ps[addrStart+2+addLenParLen]))//暂默认为0开关
  2052. cot = IEC_COT_ACTCON | IEC_COT_PN; // 否定应答// memcpy(&ps[addrStart+2],"1234",sizeof(float));//2:参数点表地址
  2053. }
  2054. else
  2055. {
  2056. #ifdef FUNC_FIT_QOS
  2057. if(ykcot == IEC_COT_DEACT)
  2058. {
  2059. cot = IEC_COT_DEACTCON; // 预置取消确认
  2060. bSetParaDisable = true; //取消预置时置1
  2061. rt_printf("QOS(101)=%02x,取消遥参预置...\r\n",ykvalue);
  2062. break;
  2063. }
  2064. #endif
  2065. if(ykvalue&0x80)
  2066. {
  2067. ctrlParTime = dTCounter; //系统时间戳
  2068. if(!selectRunParId(sw,parAddr,&ps[addrStart+2+addLenParLen]))
  2069. {
  2070. cot = IEC_COT_ACTCON | IEC_COT_PN;
  2071. #ifdef FUNC_MORE_PRESET
  2072. WrongCount101[g_CountPreset101-1] = g_CountPreset101;
  2073. #else
  2074. bSetParaDisable = true; //预置报文出错时置1,禁止固化定值
  2075. #endif
  2076. break;
  2077. }
  2078. else
  2079. {
  2080. bSetParaDisable = false; //重新预置时清0
  2081. }
  2082. }
  2083. else
  2084. {
  2085. #ifdef FUNC_MORE_PRESET
  2086. int s_stop;
  2087. s_stop = WrongCount101[g_CountSet101-1];
  2088. #endif
  2089. #if defined FUNC_MORE_PRESET
  2090. if(ykcot == IEC_COT_DEACT)
  2091. {
  2092. cot = IEC_COT_DEACTCON; // 预置取消确认
  2093. bSetParaDisable = true; //取消预置时置1
  2094. rt_printf("取消遥参预置...\r\n");
  2095. break;
  2096. }
  2097. else if( dTCounter-ctrlParTime > tRunPara.dYKTime || (0 != s_stop) || bSetParaDisable || !wirteRunParId(sw,parAddr,&ps[addrStart+2+addLenParLen],ti))//暂默认为0开关
  2098. #elif defined FUNC_FIT_QOS
  2099. if( dTCounter-ctrlParTime > tRunPara.dYKTime || bSetParaDisable || !wirteRunParId(sw,parAddr,&ps[addrStart+2+addLenParLen],ti))//暂默认为0开关
  2100. #else
  2101. if(ykcot == IEC_COT_DEACT)
  2102. {
  2103. cot = IEC_COT_DEACTCON; // 预置取消确认
  2104. bSetParaDisable = true; //取消预置时置1
  2105. rt_printf("取消遥参预置...\r\n");
  2106. break;
  2107. }
  2108. else if( dTCounter-ctrlParTime > tRunPara.dYKTime || bSetParaDisable || !wirteRunParId(sw,parAddr,&ps[addrStart+2+addLenParLen],ti))//暂默认为0开关
  2109. #endif
  2110. {
  2111. if(dTCounter-ctrlParTime > tRunPara.dYKTime)
  2112. {
  2113. bSetParaDisable = false; //超时后才清0,避免取消预置后在超时时间内多次发执行帧而误执行
  2114. rt_printf("设置遥参超时...\r\n");
  2115. }
  2116. #ifdef FUNC_MORE_PRESET
  2117. else if(0 != s_stop)
  2118. {
  2119. rt_printf("[第%d帧]101预置报文出错,请检查...\r\n",s_stop);
  2120. }
  2121. #endif
  2122. else if(bSetParaDisable)
  2123. {
  2124. #ifdef FUNC_MORE_PRESET
  2125. rt_printf("取消预置,禁止固化定值\r\n");
  2126. #else
  2127. rt_printf("预置报文出错或取消预置,禁止固化定值\r\n");
  2128. #endif
  2129. }
  2130. cot = IEC_COT_ACTCON | IEC_COT_PN; // 否定应答
  2131. //屏蔽break语句,除出错定值外均可修改,与104遥调统一做法
  2132. //break;
  2133. }
  2134. }
  2135. }
  2136. }
  2137. #ifdef FUNC_MORE_PRESET
  2138. gb_101_yt = false;
  2139. #endif
  2140. //parTab.vsq = parNum;
  2141. //
  2142. if(cot&IEC_COT_PN)
  2143. rt_printf("设置&&读取 遥参失败 parAddr=%x\r\n",parAddr);
  2144. else
  2145. rt_printf("设置&&读取 遥参OK parAddr=%x\r\n",parAddr);
  2146. #ifndef FUNC_MORE_PRESET
  2147. if((!(ykvalue&0x80) && ti==FOS_PAR_SET_MUL)
  2148. #ifdef FUNC_FIT_QOS
  2149. || (ykcot == IEC_COT_DEACT)
  2150. #endif
  2151. )
  2152. ctrlParTime = 0;
  2153. #endif
  2154. IEC101_Echo_PAR(pt,yksave,ti,cot,&ps[addrStart],len,parNum);
  2155. #ifndef FUNC_MORE_PRESET
  2156. if((!(ykvalue&0x80))
  2157. #ifdef FUNC_FIT_QOS
  2158. || (ykcot == IEC_COT_DEACT)
  2159. #endif
  2160. )
  2161. {
  2162. memset(buf_forCompare,0,sizeof(buf_forCompare));
  2163. i_forCompare = 0;
  2164. j_forCompare = 0;
  2165. }
  2166. #endif
  2167. return ;
  2168. }
  2169. cot = (ykcot == IEC_COT_ACT) ? IEC_COT_ACTCON : IEC_COT_DEACTCON;
  2170. cot |= IEC_COT_PN;
  2171. //rt_printf("设置遥参 error parAddr=%x\r\n",parAddr);
  2172. //IEC101_Echo_PAR(pt,yksave,ti,cot,&ps[addrStart],len);
  2173. }
  2174. static void IEC101_RmtCtrl(IEC101_DEF *pt,u8 *pdat) // ps从传送原因开始
  2175. {
  2176. u8 cot,ykcot,ykvalue,yktype,ykThz,v;
  2177. WORD ykno;
  2178. WORD yksave;
  2179. u8 AppByte=0;
  2180. u8 CotByte=0;
  2181. int i,ret;
  2182. bool bValidYk=false;
  2183. u8 *ps=&pdat[2];
  2184. u8 ti=pdat[0]; //类型标示
  2185. u8 yk_cmd;
  2186. yktype = 0;
  2187. if(tRunPara.b101App2Byte) //应用单元双字节地址
  2188. {
  2189. AppByte=1;
  2190. }
  2191. if(tRunPara.b101Cot2Byte) //双字节传送原因
  2192. {
  2193. CotByte=1;
  2194. }
  2195. ykcot=(ps[0]&0x01f);
  2196. ykvalue=ps[4+AppByte+CotByte];
  2197. yk_cmd = ykvalue&0x03;
  2198. ykno=ps[2+AppByte+CotByte]+(WORD)ps[3+AppByte+CotByte]*256;
  2199. yksave=ykno;
  2200. cot=IEC_COT_UN_OA | IEC_COT_PN;
  2201. v=ykvalue;
  2202. if(ti==45)
  2203. {
  2204. ykvalue+=1; //单点遥控转为双点遥控
  2205. }
  2206. for(i=0;i<g_table_head->do_num;i++) //查找遥控转发表,看是否有有效的遥控点
  2207. {
  2208. if(ykno != g_do_table[i].cp) // 遥控点号对应
  2209. {
  2210. continue;
  2211. }
  2212. // 如果配置了级联通道,转发
  2213. if(g_do_table[i].link_ch)
  2214. {
  2215. if(lnk_master_yk(&g_do_table[i] ,ti,ps[0],v) == 0)
  2216. {
  2217. pt->lnk_yk_send_flag |= (1<<g_do_table[i].owner);
  2218. pt->us0_lnk_yk = ustimer_get_origin();
  2219. }
  2220. else
  2221. { cot = (ykcot == IEC_COT_ACT) ? IEC_COT_ACTCON : IEC_COT_DEACTCON;
  2222. cot |= IEC_COT_PN;
  2223. IEC101_Echo_YK(pt,yksave,ti,cot,v);
  2224. }
  2225. if(ykvalue&0x80)
  2226. {
  2227. yktype=YK_TYPE_SEL;
  2228. }
  2229. else
  2230. {
  2231. yktype=YK_TYPE_EXE;
  2232. }
  2233. refresh_co_file(true,ti,yktype,ykno,cot,yk_cmd);
  2234. return;
  2235. }
  2236. // 本装置遥控
  2237. {
  2238. cot=IEC_COT_ACTCON;
  2239. bValidYk=true;
  2240. if(ykvalue&0x80)
  2241. {
  2242. yktype=YK_TYPE_SEL;
  2243. }
  2244. else
  2245. {
  2246. yktype=YK_TYPE_EXE;
  2247. }
  2248. if(ykcot==8) //遥控撤销
  2249. {
  2250. yktype=YK_TYPE_CANCEL;
  2251. cot=IEC_COT_DEACTCON;
  2252. }
  2253. if((ykvalue&0x03)==2)
  2254. {
  2255. ykThz=YK_VAL_HZ;
  2256. }
  2257. else
  2258. {
  2259. ykThz=YK_VAL_TZ;
  2260. }
  2261. ret = RemoteCtrl(yktype,i,ykThz,MASTER_101+pt->chnl);
  2262. if(ret != 0)
  2263. {
  2264. cot = IEC_COT_ACTCON | IEC_COT_PN; // 否定应答
  2265. }
  2266. //接收到主站的遥控信息:选择,执行,撤销
  2267. refresh_co_file(true,ti,yktype,ykno,cot,yk_cmd);
  2268. break;
  2269. }
  2270. }
  2271. // 没有找到对应遥控点
  2272. if(i == g_table_head->do_num)
  2273. {
  2274. char buf[128];
  2275. char log_info[128];
  2276. sprintf(buf,"遥控:转发点表未找到对应点(ykno=0x%04x,yktype=%d,ykvalue=%d)",ykno,yktype,ykvalue);
  2277. log_str_time(LOG_OPERATE,buf,0,0);
  2278. rt_printf_time("%s\r\n",buf);
  2279. sprintf(log_info,"IEC101(%d):Remote control:Corresponding di is not in the iectable(ykno=0x%04x,yktype=%d,ykvalue=%d)",pt->chnl+1,ykno,yktype,ykvalue);
  2280. load_hs_log_rcd(TYPE_COMM_ERR,true,NULL,log_info,1);
  2281. log_flag.com_err[pt->chnl] = true;
  2282. }
  2283. pt->bRmtSM2 = false;
  2284. IEC101_Echo_YK(pt,yksave,ti,cot,v);
  2285. //必须有对应点号
  2286. if(i != g_table_head->do_num)
  2287. {
  2288. //终端发出遥控信息:选择确认,执行确认
  2289. refresh_co_file(false,ti,yktype,ykno,cot,yk_cmd);
  2290. }
  2291. if((yktype==YK_TYPE_EXE)&&(cot==IEC_COT_ACTCON))
  2292. {
  2293. IEC101_Echo_YK(pt,yksave,ti,10,v);
  2294. refresh_co_file(false,ti,yktype,ykno,IEC_COT_ACTTERM,yk_cmd);
  2295. }
  2296. }
  2297. /**************************************************************************
  2298. 函数名称:IEC101_MFrameCall
  2299. 函数版本:1.00
  2300. 作者:
  2301. 创建日期:2008.9.1
  2302. 函数功能说明:应答短帧报文
  2303. 输入参数:平衡方式下,发送帧
  2304. 输出参数:
  2305. 返回值:
  2306. 更新信息:
  2307. 更新日志1:
  2308. 日期:
  2309. 修改者:
  2310. 修改内容:
  2311. 修改原因:
  2312. ***************************************************************************/
  2313. static void IEC101_MFrameCall(IEC101_DEF *pt,unsigned char ZoneByte)
  2314. {
  2315. u8 *pd=pt->tx_buf_m;
  2316. IEC101_SETPRM(ZoneByte);
  2317. if(!pt->bDIR)IEC101_SETDIR(ZoneByte);
  2318. if(!tRunPara.b101Addr2Byte)
  2319. {
  2320. pd[0]=5;
  2321. pd[1]=0x10;
  2322. pd[2]=ZoneByte;
  2323. pd[3]=(u8)tRunPara.byAddr;
  2324. pd[4]=pd[2]+pd[3];
  2325. pd[5]=0x16;
  2326. }
  2327. else
  2328. {
  2329. pd[0]=6;
  2330. pd[1]=0x10;
  2331. pd[2]=ZoneByte;
  2332. pd[3]=(u8)tRunPara.byAddr;
  2333. pd[4]=(u8)(tRunPara.byAddr>>8);
  2334. pd[5]=pd[2]+pd[3]+pd[4];
  2335. pd[6]=0x16;
  2336. }
  2337. }
  2338. static void IEC101_CallGprsInf(IEC101_DEF *pt)
  2339. {
  2340. u8 *pd=pt->tx_buf_s;
  2341. pd[0]=9;
  2342. pd[1]=0x55;
  2343. pd[2]=0xAA;
  2344. pd[3]=0x55;
  2345. pd[4]=0xAA;
  2346. pd[5]=0x1A;
  2347. pd[6]=0x00;
  2348. pd[7]=0x00;
  2349. pd[8]=0x9A;
  2350. pd[9]=0x7C;
  2351. }
  2352. /**************************************************************************
  2353. 函数名称:IEC101_link_par
  2354. 函数版本:1.00
  2355. 作者:
  2356. 创建日期:2019.4.19
  2357. 函数功能说明:101规约遥参级联处理
  2358. 输入参数:
  2359. 输出参数:
  2360. 返回值:
  2361. 更新信息:
  2362. 更新日志1:
  2363. 日期:
  2364. 修改者:
  2365. 修改内容:
  2366. 修改原因:
  2367. ***************************************************************************/
  2368. void IEC101_link_par(IEC101_DEF *pt)
  2369. {
  2370. int i;
  2371. LINKPAR_DEF *par;
  2372. LINK_PARDATA *yd;
  2373. if(pt->lnk_par_send_flag == 0)
  2374. {
  2375. return;
  2376. }
  2377. for(i=0; i<SWITCH_NUM_EXT_PUB; i++)
  2378. {
  2379. if(pt->lnk_par_send_flag & (1<<i))
  2380. {
  2381. par = &g_link_par[i];
  2382. // 遥控应答帧
  2383. if(par->flag[IECLINK_YK_ACK])
  2384. {
  2385. yd = &par->data[IECLINK_YK_ACK];
  2386. IEC101_Echo_PAR(pt, par->cp_m, yd->ti, yd->cot,&yd->buf[0], yd->len,yd->vsq);
  2387. par->flag[IECLINK_YK_ACK] = 0;
  2388. rt_printf("参数应答帧\r\n");
  2389. }
  2390. // 遥控结束帧
  2391. if(par->flag[IECLINK_YK_END])
  2392. {
  2393. yd = &par->data[IECLINK_YK_END];
  2394. IEC101_Echo_PAR(pt, par->cp_m, yd->ti, yd->cot,&yd->buf[0], yd->len,yd->vsq);
  2395. par->flag[IECLINK_YK_END] = 0;
  2396. pt->lnk_par_send_flag &= ~(1<<i);
  2397. rt_printf("参数结束帧\r\n");
  2398. }
  2399. // 遥控超时,复位
  2400. if(ustimer_get_duration(pt->us0_lnk_par) > tRunPara.dSM2Time*USTIMER_SEC)
  2401. {
  2402. yd = &par->data[IECLINK_YK_SND];
  2403. rt_printf("参数遥控超时复位:cp_m=%04x,cp_s=%04x,ti=%d,v=%d.\r\n",par->cp_m,par->cp_s,yd->ti,yd->len);
  2404. g_link_par[i].flag[IECLINK_YK_SND] = false;
  2405. pt->lnk_par_send_flag &= ~(1<<i);
  2406. }
  2407. }
  2408. }
  2409. }
  2410. /**************************************************************************
  2411. 函数名称:IEC101_Applay
  2412. 函数版本:1.00
  2413. 作者:
  2414. 创建日期:2008.9.1
  2415. 函数功能说明:101规约链路数据处理
  2416. 输入参数:
  2417. 输出参数:
  2418. 返回值:
  2419. 更新信息:
  2420. 更新日志1:
  2421. 日期:
  2422. 修改者:
  2423. 修改内容:
  2424. 修改原因:
  2425. ***************************************************************************/
  2426. void IEC101_lnk_yk(IEC101_DEF *pt)
  2427. {
  2428. int i;
  2429. LINKYK_DEF *yk;
  2430. LINK_YKDATA *yd;
  2431. if(pt->lnk_yk_send_flag == 0)
  2432. {
  2433. return;
  2434. }
  2435. for(i=0; i<SWITCH_NUM_EXT_PUB; i++)
  2436. {
  2437. if(pt->lnk_yk_send_flag & (1<<i))
  2438. {
  2439. u8 yktype,yk_cmd;
  2440. bool yk_hs=false;
  2441. yk = &g_lnk_yk[i];
  2442. // 遥控应答帧
  2443. if(yk->flag[IECLINK_YK_ACK])
  2444. {
  2445. yd = &yk->data[IECLINK_YK_ACK];
  2446. IEC101_Echo_YK(pt, yk->cp_m, yd->ti, yd->cot, yd->v);
  2447. yk->flag[IECLINK_YK_ACK] = 0;
  2448. }
  2449. // 遥控结束帧
  2450. if(yk->flag[IECLINK_YK_END])
  2451. {
  2452. yd = &yk->data[IECLINK_YK_END];
  2453. IEC101_Echo_YK(pt, yk->cp_m, yd->ti, yd->cot, yd->v);
  2454. yk->flag[IECLINK_YK_END] = 0;
  2455. pt->lnk_yk_send_flag &= ~(1<<i);
  2456. }
  2457. // 遥控超时,复位
  2458. if(ustimer_get_duration(pt->us0_lnk_yk) > tRunPara.dSM2Time*USTIMER_SEC)
  2459. {
  2460. yd = &yk->data[IECLINK_YK_SND];
  2461. rt_printf("级联遥控超时复位:cp_m=%04x,cp_s=%04x,ti=%d,v=%d.\r\n",yk->cp_m,yk->cp_s,yd->ti,yd->v);
  2462. pt->lnk_yk_send_flag &= ~(1<<i);
  2463. }
  2464. if(yk_hs)
  2465. {
  2466. if(yd->v&0x80)
  2467. {
  2468. yktype=YK_TYPE_SEL;
  2469. }
  2470. else
  2471. {
  2472. yktype=YK_TYPE_EXE;
  2473. }
  2474. if(yd->cot==IEC_COT_DEACT) //遥控撤销
  2475. {
  2476. yktype=YK_TYPE_CANCEL;
  2477. }
  2478. yk_cmd = yd->v&0x03;
  2479. refresh_co_file(false,yd->ti,yktype,yk->cp_m,yd->cot,yk_cmd);
  2480. }
  2481. }
  2482. }
  2483. }
  2484. #ifdef YPARA_LINK
  2485. void IEC101_lnk_msg_ypara(IEC101_DEF *pt101)
  2486. {
  2487. u8 *pd;
  2488. int num=0;
  2489. u8 pdi=0,cot=0,ti=0,vsq=0;
  2490. int index=0,i=0;
  2491. msg_data_struct *msg_data = &pt101->msg_ypara_recv;
  2492. pd = g_arrIECBuf;
  2493. #if 0
  2494. /*遥参是否超时*/
  2495. if(!pt101->msg_ypara_send.flag) return; /*没有下发遥参不返回*/
  2496. if(ustimer_get_duration(pt101->us0_msg_ypara) > tRunPara.dSM2Time*USTIMER_SEC)
  2497. {
  2498. pt101->msg_ypara_send.flag = 0; /*超时*/
  2499. return;
  2500. }
  2501. /*遥参是否超时*/
  2502. #endif
  2503. if(!msg_data->flag) return; /*有返回消息*/
  2504. msg_data->flag = 0;
  2505. if(msg_data->type == modify_set)
  2506. {
  2507. msg_ypara_data_struct *ypara_msg = &pt101->msg_ypara_recv.ypara_msg;
  2508. ti = 203;
  2509. /*该协议各类遥参返回格式一致,统一接口即可*/
  2510. switch(ypara_msg->cmd)
  2511. {
  2512. case YP_SEL_RETURN:
  2513. pdi = 0x80;
  2514. cot = IEC_COT_ACTCON;
  2515. break;
  2516. case YP_SEL_FAULT:
  2517. pdi = 0x80;
  2518. cot = IEC_COT_ACTCON|IEC_COT_PN;
  2519. break;
  2520. case YP_EXE_RETURN:
  2521. pdi = 0x00;
  2522. cot = IEC_COT_ACTCON;
  2523. break;
  2524. case YP_EXE_FAULT:
  2525. pdi = 0x00;
  2526. cot = IEC_COT_ACTCON|IEC_COT_PN;
  2527. break;
  2528. case YP_CANCEL_RETURN:
  2529. pdi = 0x40;
  2530. cot = IEC_COT_DEACTCON;
  2531. break;
  2532. case YP_CANCEL_FAULT:
  2533. pdi = 0x40;
  2534. cot = IEC_COT_DEACTCON|IEC_COT_PN;
  2535. break;
  2536. default:
  2537. break;
  2538. }
  2539. pd[num++]=(u8)m_runsection; //当前定值区
  2540. pd[num++]=(u8)(m_runsection>>8); //当前定值区
  2541. pd[num++] = pdi; /*特征符*/
  2542. //print_msg_base(ypara_msg);
  2543. for(i=0;i<ypara_msg->num;i++)
  2544. {
  2545. index = get_index_link(msg_data->sport,ypara_msg->base_data[i].cp_s);
  2546. if(index < 0) continue;
  2547. pd[num++]=(u8)tParaID[index].parId;
  2548. pd[num++]=(u8)(tParaID[index].parId>>8);
  2549. pd[num++]=ypara_msg->base_data[i].val_iec.tag;
  2550. pd[num++]=ypara_msg->base_data[i].val_iec.size;
  2551. if(ypara_msg->base_data[i].val_iec.size >0)
  2552. {
  2553. memcpy(&pd[num],ypara_msg->base_data[i].val_iec.value,ypara_msg->base_data[i].val_iec.size);
  2554. num += ypara_msg->base_data[i].val_iec.size;
  2555. }
  2556. vsq++;
  2557. }
  2558. IEC101_Asdu_Add(pt101,pd,num,vsq,cot,ti,FRAME_I);
  2559. }
  2560. }
  2561. void IEC101_Rmt_msg_ypara_write(IEC101_DEF *pt,BYTE *pdat,BYTE vsq,u8 link_cp)
  2562. {
  2563. WORD section=0;
  2564. BYTE *ps=0; //从点号开始
  2565. int i,j=0;
  2566. u16 di = 0;
  2567. msg_data_struct *msg_data;
  2568. msg_ypara_data_struct *msg;
  2569. iec_val_struct v;
  2570. BYTE pdi; //参数特征标识符
  2571. msg_data = &pt->msg_ypara_send;
  2572. msg = &pt->msg_ypara_send.ypara_msg;
  2573. memset(msg,0,sizeof(msg_ypara_data_struct));
  2574. pt->msg_ypara_send.dport = link_cp;
  2575. pt->msg_ypara_send.sport = pt->chnl;
  2576. pt->msg_ypara_send.flag = 1;
  2577. section=pdat[0]+(pdat[1]<<8); // 定值区号
  2578. pdi = pdat[2];
  2579. msg->section_p = section; //定值区
  2580. if((pdi&0xc0)==0) // 定值固化
  2581. {
  2582. msg->cmd = YP_EXE;
  2583. }
  2584. else if((pdi&0xc0)==0x40) /*撤销*/
  2585. {
  2586. msg->cmd = YP_CANCEL;
  2587. }
  2588. else // 参数预置
  2589. {
  2590. msg->cmd = YP_SEL;
  2591. ps=&pdat[3];
  2592. for(i=0;i<vsq;i++)
  2593. {
  2594. di=ps[0]+(ps[1]<<8);
  2595. ps += 2;
  2596. v.tag = *ps++;
  2597. v.size = *ps++;
  2598. memcpy(v.value,ps,v.size);
  2599. ps += v.size;
  2600. for(j=0;j<ParaIDNum;j++)
  2601. {
  2602. if(tParaID[j].link_ch == 0) continue;
  2603. if(di != tParaID[j].parId) continue;
  2604. msg->base_data[msg->num].cp_m = tParaID[j].parId;
  2605. msg->base_data[msg->num].cp_s = tParaID[j].link_cp;
  2606. msg->base_data[msg->num].val_iec = v;
  2607. msg->num++;
  2608. break;
  2609. }
  2610. }
  2611. }
  2612. msg_data->type = modify_set;
  2613. msg_data->sport = pt->chnl;
  2614. msg_data->dport = link_cp;
  2615. mananger_msg_ypara_s(msg_data,msg_data->sport,msg_data->dport);
  2616. pt->us0_msg_ypara = ustimer_get_origin();
  2617. }
  2618. #endif
  2619. int IEC101_TransFile(IEC101_DEF *pt,unsigned char *buf,int len);
  2620. int IEC101_Maintain(IEC101_DEF *pt,unsigned char *buf,int len);
  2621. #ifdef RCD_STRAN_S
  2622. static void IEC101_Rcd_Ack(IEC101_DEF *pt101) //发送新录波文件名
  2623. {
  2624. u8 *pd;
  2625. int num;
  2626. u8 rcd_num=0;
  2627. char tmp[128]={0};
  2628. char note[100];
  2629. //组织报文
  2630. pd=g_arrIECBuf;
  2631. num=0;
  2632. if(get_queue_count(&pt101->rcd_qt.queue) >0) /*有新录波*/
  2633. {
  2634. check_data_queque(&pt101->rcd_qt.queue,tmp);
  2635. sprintf(note, "%s----------准备\r\n",tmp);
  2636. log_str_time(LOG_OPERATE,note,0,1);
  2637. pd[num++]=0; //信息体地址
  2638. pd[num++]=0;
  2639. pd[num++]=1; /*文件数量*/
  2640. pd[num++]=strlen(tmp); /*文件名长度*/
  2641. memcpy(&pd[num],tmp,strlen(tmp));
  2642. num += strlen(tmp);
  2643. }
  2644. else
  2645. {
  2646. pd[num++]=0; //信息体地址
  2647. pd[num++]=0; //
  2648. pd[num++]=rcd_num;
  2649. }
  2650. IEC101_Asdu_Add(pt101,g_arrIECBuf,num,1,7,RCD_TYPE,FRAME_I|FRAME_I_PRIOR_LOW);//
  2651. }
  2652. #endif
  2653. void IEC101_Applay(IEC101_DEF *pt)
  2654. {
  2655. u8 *pd;
  2656. u8 AddByte=0;
  2657. u8 CotByte=0; //传送原因双字节
  2658. u8 AppByte=0; //应用单元地址双字节
  2659. u8 ti,vsq,cot,L,*info_addr,info_len;
  2660. bool bLFrame=false; //短帧标志
  2661. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  2662. if(tRunPara.tUartPara[0].wProtocol == PROTOCOL_WED_ENC)
  2663. {
  2664. if((pt->chnl != 1) && (pt->chnl != 3) && (pt->chnl != 4)) //投入海南加密时,固定串口2、4、5用于加密数据处理,不允许接收串口数据
  2665. {
  2666. // 接收报文
  2667. IEC101_Recv_App(pt);
  2668. if(pt->chnl == 0)
  2669. {
  2670. return;
  2671. }
  2672. }
  2673. }
  2674. else
  2675. #endif
  2676. {
  2677. // 接收报文
  2678. IEC101_Recv_App(pt);
  2679. }
  2680. #ifdef IEC_NOLINK_NO_CALLYX
  2681. if(g_link_comm.link_flag == false) return;
  2682. #endif
  2683. // 主动SOE处理,放在报文处理之前,使时间同步报文之前的SOE报文在时间报文应答前发送
  2684. IEC101_SendEvent(pt,tRunPara.bAutoCos);
  2685. // 处理级联遥控
  2686. IEC101_lnk_yk(pt);
  2687. // 处理级联遥参
  2688. IEC101_link_par(pt);
  2689. #ifdef YPARA_LINK
  2690. IEC101_lnk_msg_ypara(pt);
  2691. #endif
  2692. // 处理接收的加密报文
  2693. // 先处理加密报文,再处理普通报文,保证同一报文一个循环处理完
  2694. if(pt->bSM2Data)
  2695. {
  2696. if(pRunSet->bTT_SM2) //加密功能投入
  2697. {
  2698. #ifdef ENCRYPT_SM2
  2699. IEC101_SM2(pt);
  2700. #endif
  2701. }
  2702. pt->bSM2Data=false;
  2703. }
  2704. // 处理接收的普通报文
  2705. else if(pt->bData)
  2706. {
  2707. // 如果从动站buf有数据,说明至少有2帧报文还没有发送完,
  2708. // 在gprs网络,同时收到多帧报文后连续应答处理时会出现这种情况。
  2709. // 为了保证过程的完整性,待数据发送完后再处理接收的报文。
  2710. if(pt->btx_buf_s)
  2711. {
  2712. return;
  2713. }
  2714. // 报文长度调整变量赋值
  2715. if(tRunPara.b101Addr2Byte) AddByte=1;
  2716. if(tRunPara.b101Cot2Byte) CotByte=1;
  2717. if(tRunPara.b101App2Byte) AppByte=1;
  2718. // 打印接收的报文
  2719. if(g_print_101 && (g_print_port & (1<<pt->chnl)))
  2720. {
  2721. if(pt->recvbuf[0]==0x10)
  2722. {
  2723. rt_printf("RX_S101_%d:", pt->chnl);
  2724. print_msg("",pt->recvbuf,(5+AddByte));
  2725. }
  2726. else
  2727. {
  2728. rt_printf("RX_L101_%d:", pt->chnl);
  2729. print_msg("",pt->recvbuf,pt->recvbuf[1]+6);
  2730. }
  2731. }
  2732. // 由于101在本函数开始处接收数据,所以可以在此处复位接收标志
  2733. pt->bData=false;
  2734. // 检查帧标志并跳过固定报文头
  2735. if(pt->recvbuf[0]==0x10)
  2736. {
  2737. pd=&pt->recvbuf[1];//短帧
  2738. L = 2;
  2739. }
  2740. else if(pt->recvbuf[0]==0x68)
  2741. {
  2742. pd=&pt->recvbuf[4];//长帧
  2743. L = pt->recvbuf[1];
  2744. bLFrame=true;
  2745. }
  2746. else
  2747. {
  2748. return;
  2749. }
  2750. // 检查是否是GPRS维护信息
  2751. if(pd[0]==0x05)
  2752. {
  2753. memcpy(tGprsInf.data,&pd[1],64);
  2754. tGprsInf.bInf=true;
  2755. return;
  2756. }
  2757. // 检查地址
  2758. if(tRunPara.b101Addr2Byte) //双字节地址
  2759. {
  2760. WORD addr;
  2761. addr=pd[1]+(pd[2]<<8);
  2762. if(addr!=tRunPara.byAddr && addr!=0xffff)
  2763. return; //不是发给本装置的数据
  2764. }
  2765. else
  2766. {
  2767. if(pd[1]!=(u8)tRunPara.byAddr && pd[1]!=0xff)
  2768. return; //不是发给本装置的数据
  2769. }
  2770. // 通道空闲时间复位
  2771. pt->dValidTime=0;
  2772. // 私有101文件传输协议
  2773. if ((((pd[0]&0x0f) == 3) || ((pd[0]&0x0f) == 4))
  2774. && (pd[2+AddByte] ==137))
  2775. {
  2776. IEC101_TransFile(pt,&pd[2+AddByte],pt->recvbuf[1]-(2+AddByte));
  2777. pt->btx_buf_s = true;
  2778. return;
  2779. }
  2780. // 私有维护工具软件接口
  2781. if ((((pd[0]&0x0f) == 3) || ((pd[0]&0x0f) == 4))
  2782. && (pd[2+AddByte] ==138))
  2783. {
  2784. IEC101_Maintain(pt,&pd[2+AddByte],pt->recvbuf[1]-(2+AddByte));
  2785. pt->btx_buf_s = true;
  2786. return;
  2787. }
  2788. //主站主动发送数据PRM=1 master
  2789. if(pd[0]&0x40)
  2790. {
  2791. if(pd[0]&0x80)
  2792. {
  2793. pt->bDIR=true;
  2794. }
  2795. else
  2796. {
  2797. pt->bDIR=false;
  2798. }
  2799. // 非重复报文
  2800. if(!pRunSet->bTT_101FCB
  2801. ||(((pd[0]&0x10)&&pt->FCBSave!=(pd[0]&0x20)) // FCV位有效,FCB位变位
  2802. || (!(pd[0]&0x10)) // FCV位无效
  2803. || pt->bFirstFCV) ) // 该标志有效,不判断FCB位
  2804. {
  2805. //FCB位
  2806. if(pd[0]&0x10)
  2807. {
  2808. // 如果不是第一个FCB位且和以前FCB不同,确认发送BUF
  2809. if((pt->bFirstFCV == 0) && (pt->FCBSave != (pd[0]&0x20)))
  2810. {
  2811. IEC101_AckOneBuf(pt);
  2812. }
  2813. pt->FCBSave=pd[0]&0x20; // 保存帧记数位
  2814. pt->bFirstFCV = 0; // 如果FCV位有效,标志清0
  2815. }
  2816. switch((pd[0]&0x0f))
  2817. {
  2818. // 只有非平衡101才会请求一二级数据
  2819. case 10: //请求/响应(一级数据)
  2820. case 11: //请求/响应(二级数据)
  2821. // 如果不是数据状态,不应收到2、3、4、10、11,不进行任何应答,让主站超时复位
  2822. if(pt->st101!=IEC101_ST_DATA)
  2823. {
  2824. return;
  2825. }
  2826. if(!IEC101_SendOneBuf(pt))
  2827. {
  2828. if(pt->tfile.bSegtransing) // 文件传输,放入一级数据缓冲区
  2829. {
  2830. IEC101_SegmentContinue(pt);
  2831. }
  2832. else if(pt->tf.bTransing)
  2833. {
  2834. iec_readfile_send(pt,false);
  2835. }
  2836. if(!IEC101_SendOneBuf(pt))
  2837. {
  2838. pt->bycsend = IEC101_GetYc(pt);
  2839. if(!pt->bycsend) // add by sunxi
  2840. {
  2841. IEC101_FrameEcho(pt,IEC101_ECHO_NO_DATA);
  2842. }
  2843. }
  2844. }
  2845. break;
  2846. case 9: // 请求链路状态
  2847. IEC101_FrameEcho(pt,IEC101_ECHO_LINK_OK);
  2848. break;
  2849. case 3: //请求/确认
  2850. case 4: //请求/无应答
  2851. // 如果不是数据状态,不应收到2、3、4、10、11,不进行任何应答,让主站超时复位
  2852. // 如果是复位进程状态,不应答主站发送应用层报文
  2853. if(pt->st101!=IEC101_ST_DATA || pt->bResetProcess)
  2854. {
  2855. return;
  2856. }
  2857. ti = pd[2+AddByte];
  2858. vsq = pd[3+AddByte];
  2859. cot = pd[4+AddByte];
  2860. info_addr = pt->recvbuf + IEC101_InfoAddr();
  2861. info_len = L + 4 - IEC101_InfoAddr();
  2862. switch(ti) //类型标识判断
  2863. {
  2864. case 250: // 级联报文数据上送
  2865. IEC101_LinkInf(pt);
  2866. break;
  2867. case 106:
  2868. if(cot == 6) //延时获得
  2869. {
  2870. // 此处不修改报文,真正发送的时候再计算修改
  2871. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_ACTCON,ti,FRAME_I| FRAME_I_106);
  2872. }
  2873. else if(cot == 3) //延时传递
  2874. {
  2875. // 保存主站下发的传输延时
  2876. pt->ms_delay = info_addr[2] + (info_addr[3]<<8);
  2877. }
  2878. else
  2879. {
  2880. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  2881. }
  2882. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2883. break;
  2884. case 103://0xFF: //set time ,BroadCast Command
  2885. // 检查COT
  2886. if(cot == IEC_COT_REQ||cot == IEC_COT_ACT)
  2887. {
  2888. IEC101_TimeSetEcho(pt,&pd[8+AddByte+AppByte+CotByte],cot);// Addbyte 链路地址和应用单元地址多了2个字节,传送原因多1个字节
  2889. }
  2890. else
  2891. {
  2892. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  2893. }
  2894. pt->bTimeSyn= true;
  2895. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2896. break;
  2897. case 100: //总查询
  2898. // 检查COT
  2899. if(cot != IEC_COT_ACT)
  2900. {
  2901. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  2902. }
  2903. else
  2904. {
  2905. IEC101_CallAll(pt,pd[8+AddByte+AppByte+CotByte]);// Addbyte 链路地址和应用单元地址多了2个字节,传送原因多1个字节
  2906. lnk_call_all();
  2907. }
  2908. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2909. break;
  2910. case 101: //电度总召
  2911. // 检查COT
  2912. if(cot != IEC_COT_ACT)
  2913. {
  2914. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  2915. }
  2916. else
  2917. {
  2918. IEC101_DDAll(pt,pd[8+AddByte+AppByte+CotByte]);// Addbyte 链路地址和应用单元地址多了2个字节,传送原因多1个字节
  2919. }
  2920. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2921. break;
  2922. case 104: //测试帧
  2923. IEC101_TestFrame(pt,&pd[8+AddByte+AppByte+CotByte]);
  2924. IEC101_FrameEcho(pt,IEC101_ECHO_SURE);
  2925. break;
  2926. case 105:
  2927. // 检查COT
  2928. if(cot != IEC_COT_ACT)
  2929. {
  2930. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  2931. }
  2932. else
  2933. {
  2934. u8 qrp;
  2935. qrp = pd[8+AddByte+AppByte+CotByte];
  2936. #ifdef FUNC_RESET_EQU
  2937. gb_ResetEqu = true;
  2938. #endif
  2939. switch(qrp)//复位进程命令限定词 QRP
  2940. {
  2941. //进程的总复位
  2942. case 1:
  2943. rt_printf_time("IEC101(%d) Reset: 进程的总复位!\r\n",pt->chnl);
  2944. IEC101_ResetTxBuf(pt);
  2945. // 记录复位计时起点和设置复位进程标志
  2946. pt->us0_ResetProcess = ustimer_get_origin();
  2947. pt->bResetProcess = true;
  2948. break;
  2949. //复位事件缓冲区等待处理的带时标信息
  2950. case 2:
  2951. rt_printf_time("IEC101(%d) Reset: 复位事件缓冲区!\r\n",pt->chnl);
  2952. g_soe_queue.tail_send[pt->chnl].n = g_soe_queue.head.n;
  2953. g_soe_queue.tail_ack[pt->chnl].n = g_soe_queue.tail_send[pt->chnl].n;
  2954. break;
  2955. }
  2956. IEC101_ResetProcess(pt,qrp);
  2957. }
  2958. IEC101_FrameEcho(pt,IEC101_ECHO_SURE);
  2959. break;
  2960. case 45: //单点遥控
  2961. case 46: //双点遥控
  2962. // 检查单双点是否和参数设置相符
  2963. if((ti == 45 && tRunPara.YKtype == 1) || (ti == 46 && tRunPara.YKtype == 0) )
  2964. {
  2965. // 对不支持的类型标识,否定应答
  2966. IEC101_FrameEcho(pt,IEC101_ECHO_DENY);
  2967. rt_printf("101遥控类型不符(ti=%d,YKtype=%d)\r\n",ti,tRunPara.YKtype);
  2968. break;
  2969. }
  2970. // 检查COT
  2971. if(cot != IEC_COT_ACT && cot != IEC_COT_DEACT)
  2972. {
  2973. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I|FRAME_I_PRIOR_HIGH);
  2974. }
  2975. else
  2976. {
  2977. IEC101_RmtCtrl(pt, &pd[2+AddByte]);
  2978. }
  2979. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2980. break;
  2981. case 122: //召目录,选择文件,召唤文件,召唤节
  2982. IEC101_File_Echo(pt,&pd[2+AddByte]); //响应文件召唤
  2983. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2984. break;
  2985. case 124: //确认文件,确认节的应答
  2986. IEC101_File_Sure(pt,&pd[2+AddByte]); //对文件操作确认
  2987. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2988. break;
  2989. case 176: // 本装置复归
  2990. ResetHzLed(0);
  2991. SignalReset(0,false);
  2992. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2993. break;
  2994. #ifdef RCD_STRAN_S
  2995. case RCD_TYPE: // 本装置复归
  2996. IEC101_Rcd_Ack(pt);
  2997. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  2998. break;
  2999. #endif
  3000. case 200: // 切换定值区
  3001. if(cot == IEC_COT_ACT)
  3002. {
  3003. IEC101_SectionWrite(pt,&pd[8+AddByte+AppByte+CotByte]);// Addbyte 链路地址和应用单元地址多了2个字节,传送原因多1个字节
  3004. }
  3005. else
  3006. {
  3007. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  3008. }
  3009. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  3010. break;
  3011. case 201: // 读取当前定值区号
  3012. if(cot == IEC_COT_ACT)
  3013. {
  3014. IEC101_SectionRead(pt);// Addbyte 链路地址和应用单元地址多了2个字节,传送原因多1个字节
  3015. }
  3016. else
  3017. {
  3018. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  3019. }
  3020. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  3021. break;
  3022. break;
  3023. case FOS_PAR_READ_ONE://南网佛山局 读取单个参数
  3024. case FOS_PAR_READ_MUL://南网 读取多个参数
  3025. case FOS_PAR_SET_ONE: //南网佛山局 设置单个参数
  3026. case FOS_PAR_SET_MUL://南网 设置多数参数
  3027. // 检查COT
  3028. if(cot != IEC_COT_ACT && cot != IEC_COT_DEACT)
  3029. {
  3030. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  3031. }
  3032. else
  3033. {
  3034. IEC101_ParCtrl(pt, &pd[2+AddByte]);
  3035. }
  3036. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  3037. break;
  3038. case 202: // 读参数
  3039. if(cot == IEC_COT_ACT)
  3040. {
  3041. int ret;
  3042. #ifdef YPARA_LINK
  3043. ret=iec_setread_mananger((void*)pt,&pd[6+AddByte+AppByte+CotByte],vsq,false);
  3044. #else
  3045. ret=iec_setread((void*)pt,&pd[6+AddByte+AppByte+CotByte],vsq,false);//vsq为需读参数的个数,0,代表读全部参数,参数为从定值区开始的数据
  3046. #endif
  3047. if(ret!=0) // 读定值出错,否定应答
  3048. {
  3049. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_OA,ti,FRAME_I);
  3050. }
  3051. }
  3052. else
  3053. {
  3054. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  3055. }
  3056. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  3057. break;
  3058. case 203: // 修改参数
  3059. if(cot == IEC_COT_ACT||cot==IEC_COT_DEACT)
  3060. {
  3061. int ret;
  3062. #ifdef YPARA_LINK
  3063. int link_ch;
  3064. link_ch = get_ypara_linkch_write((void*)pt,&pd[6+AddByte+AppByte+CotByte],vsq,false);
  3065. if(link_ch == 0)
  3066. {
  3067. rt_printf("101------写本地定值\r\n");
  3068. ret=iec_setwrite((void*)pt,&pd[6+AddByte+AppByte+CotByte],cot,vsq,false);//vsq为需读参数的个数,0,代表固化参数,参数为从定值区开始的数据
  3069. if(ret!=0) // 写定值出错,否定应答
  3070. {
  3071. BYTE rcot=IEC_COT_ACTCON|IEC_COT_PN;
  3072. if(cot==IEC_COT_DEACT)rcot=IEC_COT_DEACTCON|IEC_COT_PN;
  3073. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,rcot,ti,FRAME_I);
  3074. }
  3075. else
  3076. {
  3077. BYTE rcot=IEC_COT_ACTCON;
  3078. if(cot==IEC_COT_DEACT)rcot=IEC_COT_DEACTCON;
  3079. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,rcot,ti,FRAME_I);
  3080. }
  3081. }
  3082. else
  3083. {
  3084. rt_printf("101------写级联定值\r\n");
  3085. IEC101_Rmt_msg_ypara_write((void*)pt,&pd[6+AddByte+AppByte+CotByte],vsq,link_ch);
  3086. if((link_ch&0x1f) == 0x1f) /*广播写直接返回确认*/
  3087. {
  3088. BYTE rcot= IEC_COT_ACTCON;
  3089. if(cot==IEC_COT_DEACT)rcot=IEC_COT_DEACTCON;
  3090. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,rcot,ti,FRAME_I);
  3091. }
  3092. }
  3093. #else
  3094. ret=iec_setwrite((void*)pt,&pd[6+AddByte+AppByte+CotByte],cot,vsq,false);//vsq为需读参数的个数,0,代表固化参数,参数为从定值区开始的数据
  3095. if(ret!=0) // 写定值出错,否定应答
  3096. {
  3097. BYTE rcot=IEC_COT_ACTCON|IEC_COT_PN;
  3098. if(cot==IEC_COT_DEACT)rcot=IEC_COT_DEACTCON|IEC_COT_PN;
  3099. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,rcot,ti,FRAME_I);
  3100. }
  3101. else
  3102. {
  3103. BYTE rcot=IEC_COT_ACTCON;
  3104. if(cot==IEC_COT_DEACT)rcot=IEC_COT_DEACTCON;
  3105. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,rcot,ti,FRAME_I);
  3106. }
  3107. #endif
  3108. }
  3109. else
  3110. {
  3111. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  3112. }
  3113. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  3114. break;
  3115. case 210: // 文件传输
  3116. {
  3117. pt->tf.vsq=vsq;
  3118. if(cot == IEC_COT_ACT||cot == IEC_COT_REQ)
  3119. { int ret;
  3120. ret=iec_file_app((void*)pt,&pt->recvbuf[12+AddByte+AppByte+CotByte],cot,pt->recvbuf[1]-(AddByte+CotByte+AppByte)-9,false);// 从操作标识开始
  3121. if(ret!=0) // 文件处理错误
  3122. {
  3123. BYTE rcot=IEC_COT_UN_OA;
  3124. if(ret==-2)rcot=IEC_COT_UN_COT;
  3125. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,rcot,ti,FRAME_I);
  3126. }
  3127. }
  3128. else
  3129. {
  3130. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  3131. }
  3132. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  3133. }
  3134. break;
  3135. case 211: // 文件升级
  3136. {
  3137. if(cot == IEC_COT_ACT||cot == IEC_COT_DEACT)
  3138. { int ret;
  3139. ret=iec_pro_update((void*)pt,cot,pd[8+AddByte+CotByte+AppByte],false);// 从操作标识开始
  3140. if(ret!=0) // 文件处理错误
  3141. {
  3142. BYTE rcot=IEC_COT_UN_OA;
  3143. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,rcot,ti,FRAME_I);
  3144. }
  3145. }
  3146. else
  3147. {
  3148. IEC101_Asdu_Add(pt,info_addr,info_len,vsq,IEC_COT_UN_COT|IEC_COT_PN,ti,FRAME_I);
  3149. }
  3150. IEC101_FrameEcho(pt,IEC101_ECHO_SURE); //链路应答确认
  3151. }
  3152. break;
  3153. default:
  3154. IEC101_FrameEcho(pt,IEC101_ECHO_DENY);
  3155. break;
  3156. }
  3157. break;
  3158. case 0: //复位通信单元
  3159. // 复位通道
  3160. IEC101_Reset(pt);
  3161. if(pd[0]&0x80) // add by sunxi 防止IEC101_Reset调用后,bDIR变为默认值,后续发送报文,标示出错
  3162. {
  3163. pt->bDIR=true;
  3164. }
  3165. else
  3166. {
  3167. pt->bDIR=false;
  3168. }
  3169. g_comm_link_status |= (1<<pt->chnl);
  3170. IEC101_State(pt,tRunPara.tUartPara[pt->chnl].b101PH ? IEC101_ST_LINK : IEC101_ST_DATA);
  3171. pt->LinkCount++;
  3172. // 应答报文
  3173. IEC101_InitOK(pt);
  3174. IEC101_FrameEcho(pt,IEC101_ECHO_SURE);
  3175. // "重新连接后,总召前,发送完所有老的SOE,不发送COS"
  3176. IEC101_SendEvent(pt,0);
  3177. break;
  3178. case 2: //链路测试功能
  3179. // 如果不是数据状态,不应收到2、3、4、10、11,不进行任何应答,让主站超时复位
  3180. if(pt->st101!=IEC101_ST_DATA)
  3181. {
  3182. return;
  3183. }
  3184. // 南瑞主站,功能码是2,发送长帧测试帧
  3185. if(bLFrame)
  3186. {
  3187. ti = pd[2+AddByte];
  3188. if(ti==104)
  3189. {
  3190. IEC101_TestFrame(pt,&pd[8+AddByte+AppByte+CotByte]);
  3191. }
  3192. }
  3193. IEC101_FrameEcho(pt,IEC101_ECHO_SURE);
  3194. break;
  3195. default:
  3196. IEC101_FrameEcho(pt,IEC101_ECHO_DENY);
  3197. break;
  3198. } //类型判断结束
  3199. // 广播地址不用应答
  3200. if( (pd[1]!=0xff)
  3201. || (tRunPara.b101Addr2Byte && (pd[2]!=0xff))
  3202. // 平衡101广播查询链路状态回本机地址,江西吉安博威主站要求
  3203. || (tRunPara.tUartPara[pt->chnl].b101PH && (pd[0]&0x0f) == 9))
  3204. {
  3205. pt->btx_buf_s = true;
  3206. }
  3207. }
  3208. // FCV位有效,FCB没有变位,重发保存的确认帧。
  3209. else
  3210. {
  3211. //重发数据
  3212. if(pt->st101 == IEC101_ST_DATA)
  3213. {
  3214. if(pt->btx_buf_s)
  3215. {
  3216. rt_printf_time("IEC101_Applay:,btx_buf_s==1.\r\n");
  3217. }
  3218. pt->btx_buf_s = true;
  3219. }
  3220. }
  3221. }
  3222. //平衡101 ,接收到主站回复的数据
  3223. else
  3224. {
  3225. if(!tRunPara.tUartPara[pt->chnl].b101PH)
  3226. return;
  3227. switch(pt->st101)
  3228. {
  3229. case IEC101_ST_LINK:
  3230. {
  3231. if((pd[0]&0x0f)==11) //应答链路状态
  3232. {
  3233. IEC101_State(pt,IEC101_ST_RSTLINK);
  3234. pt->bMSend=false;
  3235. }
  3236. break;
  3237. }
  3238. case IEC101_ST_RSTLINK:
  3239. {
  3240. if((pd[0]&0x0f)==0) //应答链路状态
  3241. {
  3242. IEC101_State(pt,IEC101_ST_DATA);
  3243. pt->bMSend=false;
  3244. }
  3245. break;
  3246. }
  3247. case IEC101_ST_DATA:
  3248. {
  3249. if((pd[0]&0x0f)==0) // 确认应答,调整一级数据缓冲区
  3250. {
  3251. IEC101_AckOneBuf(pt);
  3252. pt->bMSend=false;
  3253. }
  3254. break;
  3255. }
  3256. }
  3257. }
  3258. }
  3259. // 获取GPRS信息
  3260. else if(pt->bCallGprsInf)
  3261. {
  3262. if(g_tRsComm[pt->chnl].bextsend|| pt->btx_buf_s|| pt->btx_buf_m)
  3263. return; //正在发送数据,不处理
  3264. pt->bCallGprsInf=false;
  3265. IEC101_CallGprsInf(pt);
  3266. pt->btx_buf_s = true;
  3267. }
  3268. //无有效数据接收,平衡式101处理自动发送数据
  3269. else
  3270. {
  3271. if(!tRunPara.tUartPara[pt->chnl].b101PH)return;
  3272. //如果启动了主站发送,必须先处理应答
  3273. if(pt->bMSend)
  3274. {
  3275. bool bRtn=true;
  3276. // 20秒后,未收到应答报文
  3277. if(ustimer_get_duration(pt->us0_msend) > pRunSet->dT101Resend*USTIMER_SEC)
  3278. {
  3279. pt->us0_msend=ustimer_get_origin();
  3280. if(++pt->msend_retries>2) //重发三次后,重新初始化
  3281. {
  3282. //rt_printf_time("IEC101(%d):启动帧重发错误!\r\n",pt->chnl);
  3283. char log_info[128];
  3284. sprintf(log_info,"IEC101(%d):Restart the frame to make three errors",pt->chnl+1);
  3285. load_hs_log_rcd(TYPE_COMM_ERR,true,NULL,log_info,1);
  3286. log_flag.com_err[pt->chnl] = true;
  3287. IEC101_Info_Printf_One(pt);
  3288. IEC101_Reset(pt);
  3289. }
  3290. else
  3291. {
  3292. //需重新组织发送
  3293. pt->btx_buf_m = true;
  3294. }
  3295. return;
  3296. }
  3297. #ifdef COMM_STATION_NR
  3298. if(pt->tx_buf[0].tb_head!=pt->tx_buf[0].tb_tail_send) //有遥控报文要发送
  3299. {
  3300. if(ustimer_get_duration(pt->us0_msend) > 2*USTIMER_SEC) //且上帧报文发送超过2秒,不等待应道报文,直接发送
  3301. {
  3302. IEC101_AckOneBuf(pt);
  3303. pt->bMSend=false;
  3304. bRtn=false;
  3305. }
  3306. }
  3307. if(pt->bTestFrameL||pt->bSoeResume||pt->bTimeSyn)//总召前有SOE续传不需要主站确认
  3308. {
  3309. pt->bTestFrameL = false;
  3310. pt->bSoeResume = false;
  3311. pt->bTimeSyn =false;
  3312. IEC101_AckOneBuf(pt);
  3313. pt->bMSend=false;
  3314. bRtn=false;
  3315. }
  3316. #endif
  3317. if(bRtn)
  3318. {
  3319. return; // 发送,未收到数据,返回
  3320. }
  3321. }
  3322. // 平衡101应答完成
  3323. // 先复位应答相关变量
  3324. pt->msend_retries=0;
  3325. pt->us0_msend=ustimer_get_origin();
  3326. // 开始主动发送流程
  3327. switch(pt->st101)
  3328. {
  3329. case IEC101_ST_LINK:
  3330. {
  3331. IEC101_MFrameCall(pt,IEC101_CALL_LINK);
  3332. pt->bMFCB=false;
  3333. pt->bMSend=true;
  3334. break;
  3335. }
  3336. case IEC101_ST_RSTLINK:
  3337. {
  3338. IEC101_MFrameCall(pt,IEC101_CALL_RSTLINK);
  3339. pt->bMFCB=false;
  3340. pt->bMSend=true;
  3341. break;
  3342. }
  3343. case IEC101_ST_DATA:
  3344. {
  3345. pt->bMSend=IEC101_SendOneBuf(pt);
  3346. if(!pt->bMSend) // 无数据 判断
  3347. {
  3348. if(pt->tfile.bSegtransing) // 文件传输,放入一级数据缓冲区
  3349. {
  3350. IEC101_SegmentContinue(pt);
  3351. }
  3352. else if(pt->tf.bTransing) // 国网新标准文件传输
  3353. {
  3354. iec_readfile_send(pt,false);
  3355. }
  3356. else
  3357. {
  3358. pt->bycsend=IEC101_GetYc(pt);
  3359. if (pt->bycsend)pt->bMSend = TRUE;
  3360. }
  3361. }
  3362. break;
  3363. }
  3364. }
  3365. //有数据要发送
  3366. if(pt->bMSend)
  3367. {
  3368. if(pt->btx_buf_m)
  3369. {
  3370. //rt_printf_time("IEC101_Applay:bMSend==1,btx_buf_m==1.\r\n");
  3371. }
  3372. pt->bMFCB=!pt->bMFCB;
  3373. pt->btx_buf_m = true;
  3374. }
  3375. }
  3376. }
  3377. /**************************************************************************
  3378. 函数名称:IEC101_SendEvent
  3379. 函数版本:1.00
  3380. 作者:
  3381. 创建日期:2008.9.1
  3382. 函数功能说明:上送事件记录及变位信息,在RS485定时处理任务(IEC101_AutoTimer)中调用
  3383. 输入参数:
  3384. 输出参数:
  3385. 返回值:
  3386. 更新信息:
  3387. 更新日志1:
  3388. 日期:
  3389. 修改者:
  3390. 修改内容:
  3391. 修改原因:
  3392. ***************************************************************************/
  3393. EVENT_STRUCT event_p[64];
  3394. u32 IEC101_SendEvent(IEC101_DEF *pt,int is_send_cos)
  3395. {
  3396. u8 type;
  3397. int vsq=0, num_vsp;
  3398. u8 arrCos[200],arrSoe[200];
  3399. u8 arrCos1[200],arrSoe1[200];
  3400. u16 head,cnt;
  3401. u16 soe_no_s,soe_no_d,arg_index[64];
  3402. bool bFault;
  3403. FAULT_PARA_BUF *tf=&pt->tfault;
  3404. // 主动上送条件:
  3405. // 1、是IEC101_ST_DATA状态
  3406. // 2、没有在处理加密遥控报文
  3407. // 3、不是复位进程状态
  3408. if((pt->st101 != IEC101_ST_DATA) || pt->bRmtSM2 || pt->bResetProcess)
  3409. {
  3410. return 0;
  3411. }
  3412. // 不允许通讯续传的情况下,总召后才允许上送事件
  3413. if(pt->bSendChange == 0)// && pRunSet->bTT_SoeResumeComm == 0)
  3414. {
  3415. return 0;
  3416. }
  3417. #ifdef FUN_SOE_DELAY_TIME
  3418. if((pt->bfirst_call) && (dTCounter - pt->DTSendChange <= 15*T_1s))
  3419. {
  3420. return 0;
  3421. }
  3422. pt->bfirst_call = false;
  3423. #endif
  3424. //一级缓冲区未空,不添加事件记录
  3425. if(pt->tx_buf[0].tb_head != pt->tx_buf[0].tb_tail_send)
  3426. {
  3427. //rt_printf("%s(0):tb_head=%d,tb_tail_send=%d\r\n",__func__,pt->tx_buf[0].tb_head,pt->tx_buf[0].tb_tail_send);
  3428. return 0;
  3429. }
  3430. if(pt->tx_buf[1].tb_head != pt->tx_buf[1].tb_tail_send)
  3431. {
  3432. return 0;
  3433. }
  3434. #ifndef IEC_JXYB_DEAL
  3435. if(g_run_stu.bjx) //检修压板投入,不发送变化的事件记录
  3436. {
  3437. g_soe_queue.tail_send[pt->chnl].n = g_soe_queue.tail_eep.n; //soe cos
  3438. tf->head = tf->tail;//故障参数
  3439. return 0;
  3440. }
  3441. #endif
  3442. //发送级联来的故障参数
  3443. if(tRunPara.bEvPara)
  3444. {
  3445. if(tf->head!=tf->tail)
  3446. {
  3447. u8 index=tf->tail;
  3448. IEC101_Asdu_Add_sts(pt,&tf->data[index][1],tf->data[index][0],0,3,42,FRAME_I_PRIOR_LOW ,0);
  3449. tf->tail++;
  3450. return 0;
  3451. }
  3452. }
  3453. // 等SOE保存后再发送,避免通讯确认没有保存的事件
  3454. head = g_soe_queue.tail_eep.n;
  3455. // 一次调用,将事件池中所有事件发送完,
  3456. // 已保证满足"重新连接后,总召前,发送完所有老的SOE,不发送COS"的需求。
  3457. cnt = 0;
  3458. while(1)
  3459. {
  3460. u8 yxtype=0;
  3461. u8 pcosnum=0,pcosnum1=0;
  3462. // 检查发送队列空间,空间应大于1/4,防止发送缓冲区满
  3463. if(IEC101_BufFreeNum(&pt->tx_buf[0]) < (IEC_TBUF_NUM>>2))
  3464. {
  3465. rt_printf("IEC101_SendEvent:BufFreeNum=%d.\r\n",IEC101_BufFreeNum(&pt->tx_buf[0]));
  3466. break;
  3467. }
  3468. // 获取一帧报文的事件
  3469. bFault=false;
  3470. num_vsp = asdu_get_event(pt->chnl,head,arrCos,arrSoe,arrCos1,arrSoe1,&soe_no_s,&soe_no_d,0,&bFault,&event_p[0],&arg_index[0],&yxtype,&pcosnum,&pcosnum1);
  3471. if(num_vsp==0)
  3472. break;
  3473. //rt_printf("%s:vsq_s=%d\r\n",__func__,vsq);
  3474. if(pcosnum != 0)
  3475. {
  3476. // 发送COS
  3477. if(is_send_cos&&pt->bSendChange)
  3478. {
  3479. type = 1;
  3480. IEC101_Asdu_Add(pt,arrCos,pcosnum*3,pcosnum,3,type,FRAME_I_COS);
  3481. }
  3482. }
  3483. vsq=(u8)(num_vsp&0xff);
  3484. if(vsq != 0)
  3485. {
  3486. cnt += vsq;
  3487. // 发送SOE
  3488. type = 30;
  3489. IEC101_Asdu_Add_sts(pt,arrSoe,vsq*10,vsq,3,type,FRAME_I_SOE ,soe_no_s);
  3490. }
  3491. if(pcosnum1 != 0)
  3492. {
  3493. // 发送COS
  3494. if(is_send_cos)
  3495. {
  3496. type = 3;
  3497. IEC101_Asdu_Add(pt,arrCos1,pcosnum1*3,pcosnum1,3,type,FRAME_I_COS);
  3498. }
  3499. }
  3500. vsq=(u8)((num_vsp>>8)&0xff);
  3501. //rt_printf("%s:vsq_d=%d\r\n",__func__,vsq);
  3502. if(vsq != 0)
  3503. {
  3504. cnt += vsq;
  3505. // 发送SOE
  3506. type = 31 ;
  3507. IEC101_Asdu_Add_sts(pt,arrSoe1,vsq*10,vsq,3,type,FRAME_I_SOE ,soe_no_d);
  3508. // rt_printf_time("IEC101_SendEvent:soe_no=%d.\r\n",soe_no);
  3509. }
  3510. vsq=(u8)((num_vsp>>16)&0xff);
  3511. //rt_printf("%s:vsq_e=%d\r\n",__func__,vsq);
  3512. if(vsq>0 && tRunPara.bEvPara) // 上送故障信息
  3513. {
  3514. int i;
  3515. u16 no;
  3516. u8 SIQ,week;
  3517. struct rtc_time_t rt;
  3518. for(i=0;i<vsq;i++)
  3519. {
  3520. u8 *pd=g_arrIECBuf;
  3521. u8 yc_num;
  3522. no = soe_lp2cp(event_p[i].ev_type,event_p[i].ev_code,event_p[i].ev_arg[1]);
  3523. SIQ = event_p[i].ev_value;
  3524. if((yxtype==1) )
  3525. {
  3526. SIQ+=1; //转为双点信息
  3527. }
  3528. #if !defined GD_AREA_SHANTOU && !defined FUNC_JX_YC_SIQ00
  3529. if(g_run_stu.bjx)
  3530. {
  3531. SIQ|=0x80;//带品质描述,有效 <1>:=无效
  3532. }
  3533. #endif
  3534. timespec_to_rtc(event_p[i].ts,&rt,1);
  3535. week = WEEK_DAY(event_p[i].ts.tv_sec);
  3536. //if(pRunSet->bTT_faultparaDKY)
  3537. //{
  3538. yc_num=asdu_get_event_yc(arrSoe,0,arg_index[i]); // 101规约是6个字节 按照规约规定,101 及104 遥信信息体地址都是两个字节
  3539. //}
  3540. //else
  3541. //{
  3542. // vsq=asdu_get_event_yc(arrSoe,1,arg_index); // 101规约是6个字节 按照规约规定,101 及104 遥信信息体地址都是两个字节
  3543. //}
  3544. *pd++=1; //遥信个数
  3545. *pd++ =( yxtype==1) ? 31 : 30; //类型标识
  3546. *pd++=(u8)no; // 信息体地址L
  3547. *pd++=(u8)(no>>8); // 信息体地址H
  3548. if(pRunSet->bTT_faultparaDKY)
  3549. {
  3550. *pd++=0; // 信息体地址H2 按照规约规定,101 及104 遥信信息体地址都是两个字节
  3551. }
  3552. *pd++=SIQ; // 遥信
  3553. *pd++=(u8)rt.ms;
  3554. *pd++=(u8)(rt.ms>>8);
  3555. *pd++=(u8)rt.min;
  3556. *pd++=(u8)rt.hour;
  3557. *pd++=((week<<5) | rt.day);
  3558. *pd++=(u8)rt.month;
  3559. *pd++=(u8)rt.year;
  3560. *pd++=yc_num; //遥 测个数
  3561. *pd++ =13; //类型标识 浮点值
  3562. //if(pRunSet->bTT_faultparaDKY)
  3563. //{
  3564. memcpy(pd,arrSoe,yc_num*6); // 标准规定,遥测点号是2个字节
  3565. IEC101_Asdu_Add_sts(pt, g_arrIECBuf, yc_num * 6 + (pd - g_arrIECBuf), 0, 3, 42, FRAME_I_PRIOR_LOW, 0);
  3566. //}
  3567. // else
  3568. //{
  3569. // memcpy(pd,arrSoe,vsq*7); // 标准规定,遥测点号是3个字节
  3570. // IEC101_Asdu_Add_sts(pt,g_arrIECBuf,vsq*7+14,0,3,42,FRAME_I_PRIOR_LOW ,0);
  3571. //}
  3572. }
  3573. }
  3574. //pt->bSoeRelink=false;
  3575. }
  3576. return cnt;
  3577. }
  3578. /**************************************************************************
  3579. 函数名称:IEC101_Recv_Rst
  3580. 函数版本:1.00
  3581. 作者:
  3582. 创建日期:2008.9.1
  3583. 函数功能说明:复归数据的接受
  3584. 输入参数:
  3585. 输出参数:
  3586. 返回值:
  3587. 更新信息:
  3588. 更新日志1:
  3589. 日期:
  3590. 修改者:
  3591. 修改内容:
  3592. 修改原因:
  3593. ***************************************************************************/
  3594. static void IEC101_Recv_Rst(IEC101_DEF *pt)
  3595. {
  3596. if(pt->nTypeCounter)
  3597. {
  3598. rt_printf_time("IEC101_Recv_Rst:state=%d,counter=%d\r\n",pt->nTypeCounter,pt->nRecvCounter);
  3599. }
  3600. pt->nTypeCounter=0;
  3601. pt->nRecvLenth=0;
  3602. pt->nRecvCounter=0;
  3603. }
  3604. /**************************************************************************
  3605. 函数名称:IEC101_AutoTimer
  3606. 函数版本:1.00
  3607. 作者:
  3608. 创建日期:2008.9.1
  3609. 函数功能说明:101规约链路内容定时处理部分,100毫秒调用1次
  3610. 输入参数:
  3611. 输出参数:
  3612. 返回值:
  3613. 更新信息:
  3614. 更新日志1:
  3615. 日期:
  3616. 修改者:
  3617. 修改内容:
  3618. 修改原因:
  3619. ***************************************************************************/
  3620. void IEC101_AutoTimer(IEC101_DEF *pt)
  3621. {
  3622. // 如果有数据就发送
  3623. IEC101_Send_Polling(pt);
  3624. // 配电终端在发送复位进程确认命令后需等待3秒,然后重启进程
  3625. if(pt->bResetProcess && ustimer_get_duration(pt->us0_ResetProcess) > 3*USTIMER_SEC)
  3626. {
  3627. IEC101_Reset(pt);
  3628. #ifdef IEC_RESET_PROCESS
  3629. rt_printf("装置重启\r\n");
  3630. watchdog_reset_cpu(2); //装置复位
  3631. #endif
  3632. }
  3633. // 如果连接没有建立,不处理下面流程
  3634. if(pt->st101 == IEC101_ST_NONE)
  3635. {
  3636. return;
  3637. }
  3638. // 处理加密遥控报文标志超时返回
  3639. if(pRunSet->bTT_SM2)
  3640. {
  3641. if(ustimer_get_duration(pt->us0_SM2Over)>60*USTIMER_SEC)
  3642. {
  3643. pt->bRmtSM2 = false;
  3644. }
  3645. }
  3646. // 1秒处理任务
  3647. if(ustimer_get_duration(pt->us0_sec) > USTIMER_SEC)
  3648. {
  3649. pt->us0_sec += USTIMER_SEC;
  3650. pt->secs++;
  3651. // 通道检查 默认10分钟没有收到数据,认为通道错误
  3652. if(pt->dValidTime++>pRunSet->dT101Check)
  3653. {
  3654. char log_info[128];
  3655. rt_printf_time("IEC101(%d):通道超时\r\n",pt->chnl);
  3656. sprintf(log_info,"IEC101(%d):Channel timeout",pt->chnl+1);
  3657. load_hs_log_rcd(TYPE_COMM_ERR,true,NULL,log_info,1);
  3658. log_flag.com_err[pt->chnl] = true;
  3659. IEC101_Info_Printf_One(pt);
  3660. IEC101_Reset(pt);
  3661. }
  3662. }
  3663. if(pt->tf.bTransing||pt->tf.bdatTraned) // 文件启动了传输,在3次重发间隔内,未有文件内容传输更新,释放已申请的文件
  3664. {
  3665. if(ustimer_get_duration(pt->tf.us0_file_trans)>(pRunSet->dT101Resend*USTIMER_SEC*3))
  3666. {
  3667. #ifdef RCD_STRAN_S
  3668. log_str_time(LOG_OPERATE,"读文件传输超时!!!!!!!",0,1);
  3669. #endif
  3670. iec_freefile(&pt->tf);
  3671. pt->tf.bTransing=false;
  3672. pt->tf.bdatTraned=false;
  3673. }
  3674. }
  3675. if(pt->tf.bdatwriting) // 文件启动了传输,在3次重发间隔内,未有文件内容传输更新,释放已申请的写文件内存
  3676. {
  3677. if(ustimer_get_duration(pt->tf.us0_file_write)>(pRunSet->dT101Resend*USTIMER_SEC*3))
  3678. {
  3679. if(!pt->tf.writebuf)
  3680. {
  3681. rt_free(&pt->tf.writebuf);
  3682. pt->tf.writebuf=NULL;
  3683. }
  3684. pt->tf.bdatwriting=false;
  3685. }
  3686. }
  3687. if(pt->tf.bUpdateReset) // 文件启动了传输,在3次重发间隔内,未有文件内容传输更新,释放已申请的写文件内存
  3688. {
  3689. if(ustimer_get_duration(pt->tf.us0_updatereset)>(USTIMER_SEC*2))
  3690. {
  3691. rt_printf("101远程升级,装置复位\r\n");
  3692. pt->tf.bUpdateReset=false;
  3693. watchdog_reset_cpu(2); //装置复位
  3694. }
  3695. }
  3696. if(pt->tr.bpreset) // 参数预置
  3697. {
  3698. if(ustimer_get_duration(pt->tr.us0_preset)>(tRunPara.dSM2Time*USTIMER_SEC))
  3699. {
  3700. int i;
  3701. rt_printf("101预置参数超时清除\r\n");
  3702. pt->tr.bpreset=false;
  3703. for(i=0;i<RMT_SET_NUMBER;i++)
  3704. {
  3705. pt->tr.di[i]=0;
  3706. }
  3707. }
  3708. }
  3709. }
  3710. static bool IEC101_RmtCheck(IEC101_DEF *pt) //判断是否是遥控报文
  3711. {
  3712. u8 AddByte=0;
  3713. if(!pRunSet->bTT_SM2)return false; //加密功能未投入
  3714. if(tRunPara.b101Addr2Byte) AddByte=1;
  3715. if((pt->recvbuf[0]==0x68)
  3716. &&(pt->recvbuf[4]&0x40)
  3717. &&((pt->recvbuf[6+AddByte]==45)||(pt->recvbuf[6+AddByte]==46))) // 遥控报文
  3718. {
  3719. return true;
  3720. }
  3721. return false;
  3722. }
  3723. /**************************************************************************
  3724. 函数名称:IEC101_Recv
  3725. 函数版本:1.00
  3726. 作者:
  3727. 创建日期:2008.9.1
  3728. 函数功能说明:101规约数据接受判断,只判断是否满足报文格式
  3729. 输入参数:
  3730. 输出参数:有完整帧接受,返回1,否则返回 0
  3731. 返回值:
  3732. 更新信息:
  3733. 更新日志1:
  3734. 日期:
  3735. 修改者:
  3736. 修改内容:
  3737. 修改原因:
  3738. ***************************************************************************/
  3739. static int IEC101_Recv(IEC101_DEF *pt,u8 byRevData)
  3740. {
  3741. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  3742. IEC101_DEF *pt1;
  3743. static int iCount=0,enc_tunnel=0;
  3744. #endif
  3745. // 帧内字符间隔超时检测
  3746. if(g_tRsComm[pt->chnl].b_recv_reset)
  3747. {
  3748. // 不能复位fifo rt_fifo_reset(&pt->recv_fifo);
  3749. //IEC101_Recv_Rst(pt);
  3750. g_tRsComm[pt->chnl].b_recv_reset = 0;
  3751. }
  3752. pt->recvbuf[pt->nRecvCounter++]=byRevData;
  3753. pt->dTRecvPiece=dTCounter; //接收字符时的时刻,在大循环中判断,是否需要复归
  3754. switch(pt->nTypeCounter)
  3755. {
  3756. case 0:
  3757. //统计接收帧数
  3758. s_stat_rx_frame(pt->chnl);
  3759. if(byRevData==0x68)
  3760. {
  3761. pt->nTypeCounter=1;
  3762. }
  3763. else if(byRevData==0x10)
  3764. {
  3765. if(!tRunPara.b101Addr2Byte)
  3766. {
  3767. pt->nRecvLenth=2;
  3768. }
  3769. else
  3770. {
  3771. pt->nRecvLenth=3;
  3772. }
  3773. pt->nTypeCounter=6;
  3774. pt->nRecvCnt=0;
  3775. pt->sum=0;
  3776. }
  3777. else if(byRevData==0x16) //SM2 报文
  3778. {
  3779. pt->nTypeCounter=20;
  3780. pt->nRecvCounter=256;
  3781. pt->recvbuf[pt->nRecvCounter++]=byRevData;
  3782. pt->recvbuf[0]=0x68; //恢复被0x16 覆盖的第一字节数据
  3783. if(!pRunSet->bTT_SM2) //加密功能未投入
  3784. {
  3785. IEC101_Recv_Rst(pt);
  3786. //统计接收错误帧数
  3787. s_stat_rx_errframe(pt->chnl);
  3788. }
  3789. }
  3790. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  3791. else if(byRevData==0xAA)//海南101规约报文
  3792. {
  3793. pt->nTypeCounter=26;
  3794. pt->sum=0;
  3795. }
  3796. #endif
  3797. else
  3798. {
  3799. rt_printf_time("IEC101_Recv(%d):0x%02x.\r\n",pt->chnl,byRevData);
  3800. IEC101_Recv_Rst(pt);
  3801. //统计接收错误帧数
  3802. s_stat_rx_errframe(pt->chnl);
  3803. }
  3804. break;
  3805. case 1:
  3806. pt->nTypeCounter=2;
  3807. pt->nRecvLenth=byRevData; //长帧长度
  3808. if(pt->nRecvLenth>IEC101_RECVBUF_MAX)
  3809. {
  3810. IEC101_Recv_Rst(pt);
  3811. //统计接收错误帧数
  3812. s_stat_rx_errframe(pt->chnl);
  3813. }
  3814. break;
  3815. case 2:
  3816. if(pt->nRecvLenth==byRevData)
  3817. {
  3818. pt->nTypeCounter=3;
  3819. }
  3820. else
  3821. {
  3822. IEC101_Recv_Rst(pt);
  3823. //统计接收错误帧数
  3824. s_stat_rx_errframe(pt->chnl);
  3825. }
  3826. break;
  3827. case 3:
  3828. if(byRevData==0x68)
  3829. {
  3830. pt->nTypeCounter=6;
  3831. pt->nRecvCnt=0;
  3832. pt->sum=0;
  3833. }
  3834. else
  3835. {
  3836. IEC101_Recv_Rst(pt);
  3837. //统计接收错误帧数
  3838. s_stat_rx_errframe(pt->chnl);
  3839. }
  3840. break;
  3841. //case 4: //控制域
  3842. // pt->sum=byRevData;
  3843. // pt->nTypeCounter=5;
  3844. // break;
  3845. //case 5: //目标地址
  3846. // pt->sum+=byRevData;
  3847. // pt->nRecvCnt=0;
  3848. // pt->nTypeCounter=6;
  3849. // if(pt->nRecvLenth==2)//短帧
  3850. // pt->nTypeCounter=7;
  3851. // break;
  3852. case 6: //有效数据 //有效数据
  3853. if(pt->recvbuf[4]==0x05&&pt->recvbuf[0]==0x68) // 映翰通 GPRS信息返回报文,同101不同,需特殊处理
  3854. {
  3855. pt->nRecvLenth=0x30+1;
  3856. }
  3857. if(++pt->nRecvCnt>=pt->nRecvLenth)
  3858. {
  3859. pt->nTypeCounter=7;
  3860. }
  3861. pt->sum+=byRevData;
  3862. break;
  3863. case 7: //校验和
  3864. pt->recvsum=byRevData;
  3865. pt->nTypeCounter=8;
  3866. break;
  3867. case 8: //结束符
  3868. pt->nTypeCounter = 0;
  3869. IEC101_Recv_Rst(pt);
  3870. if(byRevData==0x16) //校验结束字符,报文接收完毕,
  3871. {
  3872. if((pt->sum != pt->recvsum)&&(pt->recvbuf[4]!=0x05)) // 映翰通 GPRS信息返回报文,同101不同,需特殊处理
  3873. {
  3874. s_stat_rx_errframe(pt->chnl);//统计接收帧错误计数
  3875. }
  3876. else if(IEC101_RmtCheck(pt)) //是遥控报文
  3877. {
  3878. pt->bData=false; //应用层暂不处理,等解密完成后处理
  3879. if(pRunSet->bTT_SM2)
  3880. {
  3881. pt->bRmtSM2 = true;
  3882. pt->us0_SM2Over=ustimer_get_origin();
  3883. }
  3884. }
  3885. else
  3886. {
  3887. pt->bData=true;
  3888. if (uart_test_begin)
  3889. {
  3890. uart_test_flag[pt->chnl][1] = 1;
  3891. }
  3892. // 唤醒主循环
  3893. mainloop_wakeup();
  3894. return 1;
  3895. }
  3896. }
  3897. break;
  3898. case 20: // SM2报文 L2长度
  3899. pt->SM2L2=byRevData;
  3900. pt->nTypeCounter++;
  3901. break;
  3902. case 21: // SM2报文 L2长度
  3903. pt->nTypeCounter++;
  3904. if(byRevData>=pt->SM2L2) //L2长度包含L3长度,L3<L2,做一简单校验
  3905. {
  3906. //统计接收错误帧数
  3907. s_stat_rx_errframe(pt->chnl);
  3908. IEC101_Recv_Rst(pt);
  3909. }
  3910. break;
  3911. case 22:
  3912. if(byRevData==0x16)
  3913. {
  3914. pt->nTypeCounter++;
  3915. pt->nRecvCnt=0;
  3916. }
  3917. else
  3918. {
  3919. //统计接收错误帧数
  3920. s_stat_rx_errframe(pt->chnl);
  3921. IEC101_Recv_Rst(pt);
  3922. }
  3923. break;
  3924. case 23:
  3925. if(++pt->nRecvCnt>=pt->SM2L2)
  3926. {
  3927. pt->nTypeCounter++;
  3928. }
  3929. break;
  3930. case 24: //校验和
  3931. pt->nTypeCounter++;
  3932. break;
  3933. case 25: //结束符
  3934. pt->nTypeCounter = 0;
  3935. IEC101_Recv_Rst(pt);
  3936. if(byRevData==0x16) //校验结束字符,报文接收完毕,
  3937. {
  3938. pt->bSM2Data=true;
  3939. mainloop_wakeup();
  3940. return 1;
  3941. }
  3942. else
  3943. {
  3944. s_stat_rx_errframe(pt->chnl);
  3945. }
  3946. break;
  3947. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  3948. case 26: //帧长低字节
  3949. pt->nTypeCounter++;
  3950. pt->nRecvLenth = byRevData;
  3951. pt->sum += byRevData;
  3952. break;
  3953. case 27: //帧长高字节
  3954. pt->nTypeCounter++;
  3955. pt->nRecvLenth = (byRevData<<8) | pt->nRecvLenth;
  3956. pt->sum += byRevData;
  3957. break;
  3958. case 28: //加密隧道编号
  3959. pt->nTypeCounter++;
  3960. pt->enc_tunnel = byRevData;
  3961. if(pt->enc_tunnel>1)
  3962. {
  3963. enc_tunnel = pt->enc_tunnel + 1;
  3964. }
  3965. else
  3966. {
  3967. enc_tunnel = pt->enc_tunnel;
  3968. }
  3969. pt->sum += byRevData;
  3970. pt->nRecvCnt=0;
  3971. break;
  3972. case 29: //数据
  3973. if(++pt->nRecvCnt>=pt->nRecvLenth)
  3974. {
  3975. pt->nTypeCounter++;
  3976. }
  3977. pt->sum += byRevData;
  3978. if(tRunPara.tUartPara[0].wProtocol == PROTOCOL_WED_ENC)
  3979. {
  3980. pt1 = (IEC101_DEF *)g_tRsComm[enc_tunnel].ptBuf;
  3981. pt1->recvbuf[iCount] = byRevData;
  3982. pt1->enc_tunnel = pt->enc_tunnel;
  3983. pt1->nRecvLenth = pt->nRecvLenth;
  3984. iCount++;
  3985. }
  3986. break;
  3987. case 30: //校验和
  3988. pt->recvsum = byRevData;
  3989. pt->nTypeCounter++;
  3990. break;
  3991. case 31: //帧尾
  3992. pt->nTypeCounter = 0;
  3993. IEC101_Recv_Rst(pt);
  3994. iCount = 0;
  3995. if(byRevData==0x55) //校验结束字符,报文接收完毕,
  3996. {
  3997. if(pt->sum != pt->recvsum)
  3998. {
  3999. s_stat_rx_errframe(pt->chnl);//统计接收帧错误计数
  4000. }
  4001. else
  4002. {
  4003. pt1 = (IEC101_DEF *)g_tRsComm[enc_tunnel].ptBuf;
  4004. pt1->bData=true;
  4005. enc_tunnel = 0;
  4006. // 唤醒主循环
  4007. mainloop_wakeup();
  4008. return 1;
  4009. }
  4010. }
  4011. break;
  4012. #endif
  4013. default:
  4014. //统计接收错误帧数
  4015. s_stat_rx_errframe(pt->chnl);
  4016. IEC101_Recv_Rst(pt);
  4017. break;
  4018. } //类型校验结束
  4019. return 0;
  4020. }
  4021. void IEC101_Recv_App(IEC101_DEF *pt)
  4022. {
  4023. u8 c;
  4024. // 接收数据
  4025. while(pt->bSM2Data== false && pt->bData == false)
  4026. {
  4027. if(rt_fifo_get(&pt->recv_fifo,&c,1) == 0)
  4028. {
  4029. if(g_tRsComm[pt->chnl].b_recv_reset)
  4030. {
  4031. IEC101_Recv_Rst(pt);
  4032. g_tRsComm[pt->chnl].b_recv_reset = 0;
  4033. }
  4034. break;
  4035. }
  4036. if(pRunSet->bTT_ESAM&&(!pt->bMaintainComm))
  4037. {
  4038. int ret;
  4039. ret = sec_recv(&pt->rx_buf,c,pt->extsendbuf,true);
  4040. if(ret==SEC_FRAME_OK_APP) // 带规约的报文
  4041. {
  4042. pt->bData = 1;
  4043. }
  4044. else if(ret==SEC_FRAME_OK_EXT) //纯安全扩展报文 发送
  4045. {
  4046. IEC101_ext_send(pt,pt->extsendbuf+2,((pt->extsendbuf[0]<<8)+pt->extsendbuf[1]));
  4047. }
  4048. }
  4049. else
  4050. {
  4051. #ifdef FUNC_ENCRY_IN_ONE_SERIAL
  4052. int ret;
  4053. ret = IEC101_Recv(pt,c);
  4054. if(ret == 1)
  4055. break;
  4056. #else
  4057. IEC101_Recv(pt,c);
  4058. #endif
  4059. }
  4060. }
  4061. }
  4062. void IEC101_Recv_Int(IEC101_DEF *pt,u8 byRevData)
  4063. {
  4064. //记录每个不定长帧报文的接收时刻
  4065. if(!pRunSet->bTT_ESAM||pt->bMaintainComm)
  4066. {
  4067. if(byRevData == 0x68)
  4068. {
  4069. struct rt_fifo *f;
  4070. f = &pt->recv_fifo;
  4071. // 判断不定帧长报头 0x68 L L 0X68
  4072. if( (f->buffer[(f->in-1)&(f->size - 1)]) == (f->buffer[(f->in-2)&(f->size - 1)])
  4073. && (f->buffer[(f->in-3)&(f->size - 1)]) == 0x68)
  4074. {
  4075. pt->us0_frame = ustimer_get_origin();
  4076. }
  4077. }
  4078. }
  4079. rt_fifo_put(&pt->recv_fifo,&byRevData,1);
  4080. }
  4081. int IEC101_PH_GprsInfo(void)
  4082. {
  4083. int i;
  4084. for(i=0;i<CFG_UART_NUM_MAX;i++)
  4085. {
  4086. if(UART_CHANNEL[i]< 0)
  4087. {
  4088. continue;
  4089. }
  4090. //外部通信报文处理
  4091. if(tRunPara.tUartPara[i].wProtocol==PROTOCOL_101_PH) // 101规约
  4092. {
  4093. IEC101_DEF *pt=(IEC101_DEF *)g_tRsComm[i].ptBuf;
  4094. pt->bCallGprsInf=true;
  4095. }
  4096. }
  4097. return 0;
  4098. }
  4099. void IEC101_Info_Printf_One(IEC101_DEF *p)
  4100. {
  4101. iec_tbuf_t *pt ;
  4102. rt_printf("\r\n 通道属性:type=%d,chnl=%d\r\n",p->type,p->chnl);
  4103. if(p->st101 == 0)
  4104. {
  4105. return;
  4106. }
  4107. rt_printf(" 规约状态:state=%d,bSendChange=%d\r\n",p->st101,p->bSendChange);
  4108. rt_printf(" 连接计时:LinkCount(%d):%d秒\r\n",p->LinkCount,p->secs);
  4109. pt= &p->tx_buf[0];
  4110. rt_printf("发送BUF[0]:head=%d,tail_send=%d,tail_ack=%d\r\n",pt->tb_head,pt->tb_tail_send,pt->tb_tail_ack);
  4111. pt= &p->tx_buf[1];
  4112. rt_printf("发送BUF[1]:head=%d,tail_send=%d,tail_ack=%d\r\n",pt->tb_head,pt->tb_tail_send,pt->tb_tail_ack);
  4113. rt_printf("SOE通讯BUF:head=%d,tail_send=%d,tail_ack=%d\r\n",g_soe_queue.head.n,g_soe_queue.tail_send[p->chnl].n,g_soe_queue.tail_ack[p->chnl].n);
  4114. rt_printf("SOE事件BUF:head=%d,tail_send=%d\r\n",
  4115. g_soe_queue.head.n,g_soe_queue.tail_eep.n);
  4116. pt= &p->tx_buf[2];
  4117. rt_printf("发送BUF[1]:head=%d,tail_send=%d,tail_ack=%d\r\n",pt->tb_head,pt->tb_tail_send,pt->tb_tail_ack);
  4118. rt_printf("SOE通讯BUF:head=%d,tail_send=%d,tail_ack=%d\r\n",g_soe_queue.head.n,g_soe_queue.tail_send[p->chnl].n,g_soe_queue.tail_ack[p->chnl].n);
  4119. rt_printf("SOE事件BUF:head=%d,tail_send=%d\r\n",
  4120. g_soe_queue.head.n,g_soe_queue.tail_eep.n);
  4121. return;
  4122. }
  4123. int IEC101_Info_Printf(void)
  4124. {
  4125. int i;
  4126. IEC101_DEF *p;
  4127. //串口101
  4128. rt_printf("\r\n串口101:");
  4129. for(i=0;i<CFG_UART_NUM_MAX;i++)
  4130. {
  4131. // 如果串口不存在,跳过
  4132. if(UART_CHANNEL[i]< 0)
  4133. {
  4134. continue;
  4135. }
  4136. if(tRunPara.tUartPara[i].wProtocol != PROTOCOL_101 && tRunPara.tUartPara[i].wProtocol != PROTOCOL_101_PH&&tRunPara.tUartPara[i].wProtocol != PROTOCOL_MAINTAIN)
  4137. {
  4138. rt_printf("\r\n通道属性:非104通道(chnl=%d)\r\n",i);
  4139. continue;
  4140. }
  4141. p = (IEC101_DEF *)g_tRsComm[i].ptBuf;
  4142. IEC101_Info_Printf_One(p);
  4143. }
  4144. return 0;
  4145. }
  4146. /************************************************下面是远方修改定值代码******************************************************/
  4147. void IEC101_setion_chg_msg(IEC101_DEF *pt101,u8 *ps)
  4148. {
  4149. #ifdef YPARA_LINK
  4150. WORD section;
  4151. msg_data_struct *msg_data = &temp_par;
  4152. msg_oper_setion_struct *setion_msg = &msg_data->setion_msg;
  4153. section=ps[0]+(ps[1]<<8); // 定值区号
  4154. msg_data->sport = pt101->chnl;
  4155. msg_data->dport = 0x1F; //进行广播
  4156. msg_data->type = settion_swht;
  4157. setion_msg->section_p = section;
  4158. mananger_msg_ypara_s(msg_data,msg_data->sport,msg_data->dport);
  4159. #endif
  4160. }
  4161. void IEC101_SectionWrite(IEC101_DEF *pt101,u8 *ps) //确认帧
  4162. {
  4163. u8 *pd;
  4164. int num;
  4165. u8 cot;
  4166. WORD section;
  4167. if(pRunSet->wEquTypeManager) IEC101_setion_chg_msg(pt101,ps);
  4168. //组包
  4169. section=ps[0]+(ps[1]<<8); // 定值区号
  4170. cot=0x47;
  4171. if(section<SEC_NUMBER)
  4172. {
  4173. m_dstsection=section;
  4174. if(mmd_changesection(section)==M_JUMP0) cot =0x07;
  4175. }
  4176. //组织报文
  4177. pd=g_arrIECBuf;
  4178. num=0;
  4179. pd[num++]=0; //信息体地址
  4180. pd[num++]=0; //信息体地址
  4181. pd[num++]=ps[0]; //当前定值区
  4182. pd[num++]=ps[1]; //当前定值区
  4183. IEC101_Asdu_Add(pt101,g_arrIECBuf,num,1,cot,200,FRAME_I);//
  4184. }
  4185. void IEC101_SectionRead(IEC101_DEF *pt101) // 读定值区
  4186. {
  4187. u8 *pd;
  4188. int num;
  4189. u8 cot;
  4190. //组织报文
  4191. pd=g_arrIECBuf;
  4192. num=0;
  4193. pd[num++]=0; //信息体地址
  4194. pd[num++]=0; //信息体地址
  4195. pd[num++]=(u8)m_runsection; //当前定值区
  4196. pd[num++]=(u8)(m_runsection>>8); //当前定值区
  4197. pd[num++]=0; //最小定值区
  4198. pd[num++]=0; //最小定值区
  4199. pd[num++]=SEC_NUMBER-1; //最大定值区 1 标准上是7个字节,暂时认为是2个字节
  4200. pd[num++]=0; //最大定值区 2
  4201. cot =IEC_COT_ACTCON;
  4202. IEC101_Asdu_Add(pt101,g_arrIECBuf,num,1,cot,201,FRAME_I);//
  4203. }
  4204. /**************************************************远方修改定值结束*****************************************************/
  4205. /***********************************************下面是101规约文件传输部分代码2016-8-10**************************************************/
  4206. /**************************************************************************
  4207. 函数名称:IEC101_Direct_Echo
  4208. 函数版本:1.00
  4209. 作者:
  4210. 创建日期:2007.9.1
  4211. 函数功能说明:101规约目录响应
  4212. 输出参数:pt101缓冲区地址,COT 传送原因
  4213. 返回值:
  4214. 更新信息:
  4215. 更新日志1:
  4216. 日期:
  4217. 修改者:
  4218. 修改内容:
  4219. 修改原因:
  4220. ***************************************************************************/
  4221. void IEC101_Direct_Echo(IEC101_DEF *pt101,DWORD InfoAddr)
  4222. {
  4223. BYTE *pd=g_arrIECBuf; //从第7个字节开始
  4224. BYTE vsq;
  4225. int filenum;
  4226. struct dir_file_struct *pdir,*pdirfree;
  4227. int i;
  4228. vsq=0;
  4229. pdir=hf_get_dir_file(IEC_Getdir(InfoAddr),&filenum); // 根据信息体地址,判断读读哪个目录,获取目录信息
  4230. if(pdir==NULL)
  4231. {
  4232. IEC101_Asdu_Add(pt101,g_arrIECBuf,0,vsq,5,126, FRAME_I); //无文件应答
  4233. return;
  4234. }
  4235. pdirfree=pdir;
  4236. *pd++ =(BYTE)InfoAddr;
  4237. *pd++ =(BYTE)(InfoAddr>>8);
  4238. for(i=0;i<filenum;i++)
  4239. {
  4240. struct rtc_time_t rtc;
  4241. /*文件名称*/
  4242. *pd++ = (BYTE)(pdir->file_name);
  4243. *pd++ = (BYTE)(pdir->file_name>>8);
  4244. /*文件长度*/
  4245. *pd++ = (BYTE)(pdir->file_size);
  4246. *pd++ = (BYTE)(pdir->file_size>>8);
  4247. *pd++ = (BYTE)(pdir->file_size>>16);
  4248. /*文件的状态SOF*/
  4249. *pd++ = 0;
  4250. /*日历时钟*/
  4251. timespec_to_rtc(pdir->file_time,&rtc,1);
  4252. *pd++ = (BYTE)(rtc.ms);
  4253. *pd++ = (BYTE)(rtc.ms>>8);
  4254. *pd++ = (BYTE)(rtc.min);
  4255. *pd++ = (BYTE)(rtc.hour);
  4256. *pd++ = (BYTE)(rtc.day);
  4257. *pd++ = (BYTE)(rtc.month);
  4258. *pd++ = (BYTE)(rtc.year);
  4259. vsq++;
  4260. if((vsq>=15)&&i<(pdir->file_size-1))// 目录超出一帧上送范围,分帧,VSQ置后续标准位
  4261. {
  4262. vsq|=0x80;
  4263. IEC101_Asdu_Add(pt101,g_arrIECBuf,(vsq&0x7f)*13+2,vsq,5,126, FRAME_I); //无文件应答
  4264. vsq=0;
  4265. pd=g_arrIECBuf;
  4266. }
  4267. pdir++;
  4268. }
  4269. rt_free(pdirfree);
  4270. if(vsq>0)
  4271. {
  4272. if(vsq>1)
  4273. {
  4274. vsq|=0x80;
  4275. }
  4276. IEC101_Asdu_Add(pt101,g_arrIECBuf,(vsq&0x7f)*13,vsq,5,126, FRAME_I); //无文件应答
  4277. }
  4278. else
  4279. {
  4280. IEC101_Asdu_Add(pt101,g_arrIECBuf,0,vsq,5,126, FRAME_I); //无文件应答
  4281. }
  4282. }
  4283. /**************************************************************************
  4284. 函数名称:IEC101_EchoFileReady
  4285. 函数版本:1.00
  4286. 作者:
  4287. 创建日期:2007.9.1
  4288. 函数功能说明:应答文件准备好
  4289. 输出参数:pt101缓冲区地址,filename 文件名
  4290. 返回值:
  4291. 更新信息:
  4292. 更新日志1:
  4293. 日期:
  4294. 修改者:
  4295. 修改内容:
  4296. 修改原因:
  4297. ***************************************************************************/
  4298. static void IEC101_EchoFileReady(IEC101_DEF *pt101,DWORD InfoAddr,WORD filename)
  4299. {
  4300. BYTE *pd=g_arrIECBuf; //从第7个字节开始
  4301. int filelenth,sectionnum;
  4302. filelenth=hf_get_file_inf(IEC_Getdir(InfoAddr),filename,&sectionnum);
  4303. /*文件名称*/
  4304. *pd++ =(BYTE)InfoAddr;
  4305. *pd++ =(BYTE)(InfoAddr>>8);
  4306. *pd++ = (BYTE)(filename); // 10
  4307. *pd++ = (BYTE)(filename>>8); // 11
  4308. *pd++=(BYTE)filelenth; // 文件长度
  4309. *pd++=(BYTE)(filelenth>>8); //文件长度
  4310. *pd++=(BYTE)(filelenth>>16); //文件长度
  4311. if(filelenth>0)
  4312. {
  4313. *pd++ = 0; /*FRQ=0肯定认可*/
  4314. }
  4315. else
  4316. {
  4317. *pd++ = 0x80; /*FRQ=0否定定认可*/
  4318. }
  4319. pt101->tfile.filelenth=filelenth;
  4320. pt101->tfile.setctionnum=sectionnum;
  4321. pt101->tfile.filename=filename;
  4322. pt101->tfile.InfoAddr=InfoAddr;
  4323. pt101->tfile.filechecksum=0;
  4324. IEC101_Asdu_Add(pt101,g_arrIECBuf,8,1,13,120, FRAME_I); //无文件应答
  4325. }
  4326. /**************************************************************************
  4327. 函数名称:IEC101_EchoSectionReady
  4328. 函数版本:1.00
  4329. 作者:
  4330. 创建日期:2007.9.1
  4331. 函数功能说明:应答节准备好
  4332. 输出参数:pt101缓冲区地址,filename 文件名
  4333. 返回值:
  4334. 更新信息:
  4335. 更新日志1:
  4336. 日期:
  4337. 修改者:
  4338. 修改内容:
  4339. 修改原因:
  4340. ***************************************************************************/
  4341. static void IEC101_EchoSectionReady(IEC101_DEF *pt101,DWORD InfoAddr,WORD filename,BYTE section)
  4342. {
  4343. BYTE *pd=g_arrIECBuf; //从第7个字节开始
  4344. int setctionlenth;
  4345. char *pdat=NULL;
  4346. IEC101_FreeFile(pt101);
  4347. *pd++ =(BYTE)InfoAddr;
  4348. *pd++ =(BYTE)(InfoAddr>>8);
  4349. /*文件名称*/
  4350. *pd++ = (BYTE)(filename); // 10
  4351. *pd++ = (BYTE)(filename>>8); // 11
  4352. if(pt101->tfile.InfoAddr==InfoAddr&&pt101->tfile.filename==filename&&section<=pt101->tfile.setctionnum) //文件名相同文件有效
  4353. {
  4354. pdat=hf_get_file_part(IEC_Getdir(InfoAddr), filename, section, &setctionlenth);
  4355. }
  4356. *pd++=section; //节名
  4357. /*节长度长度*/
  4358. *pd++ = (BYTE)(setctionlenth); //12
  4359. *pd++ = (BYTE)(setctionlenth>>8); // 13
  4360. *pd++ = (BYTE)(setctionlenth>>16); // 14
  4361. if(pdat==NULL||setctionlenth==0)
  4362. {
  4363. *pd++ = 0x80; /*FRQ=0否定定认可*/
  4364. }
  4365. else
  4366. {
  4367. *pd++ = 0x0; /*FRQ=0 肯定认可*/ // 15
  4368. pt101->tfile.pdat=pdat; //保存节内容地址,后续需要释放
  4369. pt101->tfile.sectionlenth=setctionlenth;
  4370. pt101->tfile.transsection=section;
  4371. pt101->tfile.bFiletransing=true;
  4372. pt101->tfile.bSegtransing=false;
  4373. pt101->tfile.us0_file_trans=ustimer_get_origin();
  4374. pt101->tfile.transBytes=0;
  4375. pt101->tfile.sectionchecksum=0;
  4376. }
  4377. IEC101_Asdu_Add(pt101,g_arrIECBuf,9,1,13,121, FRAME_I); //无文件应答
  4378. }
  4379. /**************************************************************************
  4380. 函数名称:IEC101_SegmentSend
  4381. 函数版本:1.00
  4382. 作者:
  4383. 创建日期:2007.9.1
  4384. 函数功能说明:应答节传输中段的数据
  4385. 输出参数:pt101缓冲区地址,filename 文件名,section 节名
  4386. 返回值:
  4387. 更新信息:
  4388. 更新日志1:
  4389. 日期:
  4390. 修改者:
  4391. 修改内容:
  4392. 修改原因:
  4393. ***************************************************************************/
  4394. static void IEC101_SegmentSend(IEC101_DEF *pt101,DWORD InfoAddr,WORD filename,BYTE section)
  4395. {
  4396. BYTE *pd=g_arrIECBuf; //从第7个字节开始
  4397. BYTE sectionchecksum=0; //节校验和
  4398. BYTE segmentbytes;
  4399. BYTE cot;
  4400. int i;
  4401. cot=13;
  4402. segmentbytes=0;
  4403. if(pt101->tfile.bFiletransing
  4404. &&pt101->tfile.InfoAddr==InfoAddr
  4405. &&pt101->tfile.filename==filename
  4406. &&section==pt101->tfile.transsection) //文件名相同 节相同
  4407. {
  4408. if(pt101->tfile.transBytes+FILE_SEGMENT_BYTES>=pt101->tfile.sectionlenth)
  4409. {
  4410. segmentbytes=pt101->tfile.sectionlenth%FILE_SEGMENT_BYTES; // 最后的段的字节数
  4411. }
  4412. else
  4413. {
  4414. segmentbytes=FILE_SEGMENT_BYTES;
  4415. }
  4416. pt101->tfile.sectionchecksum=sectionchecksum;
  4417. pt101->tfile.us0_file_trans=ustimer_get_origin();
  4418. pt101->tfile.bSegtransing=true;
  4419. }
  4420. else
  4421. {
  4422. cot|=0x40;
  4423. segmentbytes=0;
  4424. IEC101_FreeFile(pt101);
  4425. }
  4426. /*文件名称*/
  4427. *pd++ =(BYTE)InfoAddr;
  4428. *pd++ =(BYTE)(InfoAddr>>8);
  4429. *pd++ = (BYTE)(filename); // 10
  4430. *pd++ = (BYTE)(filename>>8); // 11
  4431. *pd++=section; //节名 12
  4432. *pd++=segmentbytes; //段的长度 13
  4433. for(i=0;i<segmentbytes;i++)
  4434. {
  4435. *pd=pt101->tfile.pdat[pt101->tfile.transBytes++];
  4436. sectionchecksum+=*pd++;
  4437. }
  4438. IEC101_Asdu_Add(pt101,g_arrIECBuf,6+segmentbytes,1,cot,125, FRAME_I); //无文件应答
  4439. }
  4440. /**************************************************************************
  4441. 函数名称:IEC101_EchoLastSection
  4442. 函数版本:1.00
  4443. 作者:
  4444. 创建日期:2007.9.1
  4445. 函数功能说明:应答最后的节或段
  4446. 输出参数:pt101缓冲区地址,filename 文件名,section 节名,LSQ限定词
  4447. 返回值:
  4448. 更新信息:
  4449. 更新日志1:
  4450. 日期:
  4451. 修改者:
  4452. 修改内容:
  4453. 修改原因:
  4454. ***************************************************************************/
  4455. static void IEC101_EchoLastSection(IEC101_DEF *pt101,WORD filename,BYTE section,BYTE LSQ)
  4456. {
  4457. BYTE *pd=g_arrIECBuf; //从第7个字节开始
  4458. /*文件名称*/
  4459. *pd++ =(BYTE)pt101->tfile.InfoAddr;
  4460. *pd++ =(BYTE)(pt101->tfile.InfoAddr>>8);
  4461. *pd++ = (BYTE)(filename); // 10
  4462. *pd++ = (BYTE)(filename>>8); // 11
  4463. *pd++=section; //节名 12
  4464. switch(LSQ)
  4465. {
  4466. case 1:
  4467. *pd++=1; //LSQ=1:不带停止激活文件传输13
  4468. *pd++=pt101->tfile.filechecksum; //文件校验和 14
  4469. break;
  4470. case 3:
  4471. *pd++=3; //LSQ=3:不带停止激活的节传输
  4472. *pd++=pt101->tfile.sectionchecksum; //节校验和
  4473. break;
  4474. }
  4475. IEC101_Asdu_Add(pt101,g_arrIECBuf,7,1,13,123, FRAME_I); //无文件应答
  4476. }
  4477. /**************************************************************************
  4478. 函数名称:IEC101_SegmentContinue
  4479. 函数版本:1.00
  4480. 作者:
  4481. 创建日期:2007.9.1
  4482. 函数功能说明:主循环中继续发送节中剩余的段
  4483. 输出参数:pt101缓冲区地址,filename 文件名,section 节名
  4484. 返回值:
  4485. 更新信息:
  4486. 更新日志1:
  4487. 日期:
  4488. 修改者:
  4489. 修改内容:
  4490. 修改原因:
  4491. ***************************************************************************/
  4492. void IEC101_SegmentContinue(IEC101_DEF *pt101)
  4493. {
  4494. BYTE *pd=g_arrIECBuf; //从第7个字节开始
  4495. BYTE sectionchecksum=0; //节校验和
  4496. BYTE segmentbytes;
  4497. int i;
  4498. if(!pt101->tfile.bSegtransing)return;
  4499. if(pt101->tfile.transBytes<pt101->tfile.sectionlenth) // 段还未传输完毕
  4500. {
  4501. if(pt101->tfile.transBytes+FILE_SEGMENT_BYTES>=pt101->tfile.sectionlenth)
  4502. {
  4503. segmentbytes=pt101->tfile.sectionlenth%FILE_SEGMENT_BYTES; // 最后的段的字节数
  4504. }
  4505. else
  4506. {
  4507. segmentbytes=FILE_SEGMENT_BYTES;
  4508. }
  4509. *pd++ =(BYTE)pt101->tfile.InfoAddr;
  4510. *pd++ =(BYTE)(pt101->tfile.InfoAddr>>8);
  4511. /*文件名称*/
  4512. *pd++ = (BYTE)(pt101->tfile.filename); // 10
  4513. *pd++ = (BYTE)(pt101->tfile.filename>>8); // 11
  4514. *pd++=pt101->tfile.transsection; //节名 12
  4515. *pd++=segmentbytes; //段的长度 13
  4516. for(i=0;i<segmentbytes;i++)
  4517. {
  4518. *pd=pt101->tfile.pdat[pt101->tfile.transBytes++];
  4519. sectionchecksum+=*pd++;
  4520. }
  4521. pt101->tfile.sectionchecksum+=sectionchecksum;
  4522. pt101->tfile.us0_file_trans=ustimer_get_origin();
  4523. IEC101_Asdu_Add(pt101,g_arrIECBuf,6+segmentbytes,1,13,125, FRAME_I); //无文件应答
  4524. }
  4525. else
  4526. {
  4527. IEC101_EchoLastSection(pt101,pt101->tfile.filename,pt101->tfile.transsection,3);
  4528. IEC101_FreeFile(pt101);
  4529. }
  4530. }
  4531. void IEC101_File_Respone(IEC101_DEF *pt101,BYTE *dat,BYTE cot,BYTE SCAFQ) //
  4532. {
  4533. BYTE *pd=g_arrIECBuf; //从第7个字节开始
  4534. u8 vsq,type;
  4535. u8 CotByte=0; //传送原因双字节
  4536. u8 AppByte=0; //应用单元地址双字节
  4537. if(tRunPara.b101Cot2Byte) CotByte=1;
  4538. if(tRunPara.b101App2Byte) AppByte=1;
  4539. type=dat[0];
  4540. vsq=dat[1];
  4541. *pd++=dat[4+CotByte+AppByte]; // 应用单元地址
  4542. *pd++=dat[5+CotByte+AppByte]; //
  4543. *pd++=dat[6+CotByte+AppByte]; // 文件名
  4544. *pd++=dat[7+CotByte+AppByte]; //
  4545. *pd++=dat[8+CotByte+AppByte]; //节名 12
  4546. *pd++=SCAFQ; //限定词
  4547. IEC101_Asdu_Add(pt101,g_arrIECBuf,6,vsq,cot,type, FRAME_I); //无文件应答
  4548. }
  4549. /**************************************************************************
  4550. 函数名称:IEC101_File_Echo
  4551. 函数版本:1.00
  4552. 作者:
  4553. 创建日期:2007.9.1
  4554. 函数功能说明:对文件召唤的应答处理
  4555. 输出参数:pt101缓冲区地址,dat报文缓冲区地址从报文的帧类型开始
  4556. 返回值:
  4557. 更新信息:
  4558. 更新日志1:
  4559. 日期:
  4560. 修改者:
  4561. 修改内容:
  4562. 修改原因:
  4563. ***************************************************************************/
  4564. void IEC101_File_App(IEC101_DEF *pt101,BYTE *dat) //dat 从报文的帧类型开始
  4565. {
  4566. BYTE COT,SCQ; //传送原因
  4567. WORD filename,section; //文件名 节名
  4568. DWORD InfoAddr; //信息体地址
  4569. u8 CotByte=0; //传送原因双字节
  4570. u8 AppByte=0; //应用单元地址双字节
  4571. if(tRunPara.b101Cot2Byte) CotByte=1;
  4572. if(tRunPara.b101App2Byte) AppByte=1;
  4573. COT=dat[2];
  4574. InfoAddr=dat[4+CotByte+AppByte]+(dat[5+CotByte+AppByte]<<8);
  4575. filename=dat[6+CotByte+AppByte]+(dat[7+CotByte+AppByte]<<8); //文件名
  4576. section=dat[8+CotByte+AppByte]; //节名
  4577. SCQ = dat[9+CotByte+AppByte]; //选择和召唤限定词
  4578. //rt_printf("\r\n COT=%d addr=%4x filename=%d,section=%d,SCQ=%d",COT,InfoAddr,filename,section,SCQ);
  4579. if(IEC_Getdir(InfoAddr)==NULL)
  4580. {
  4581. IEC101_File_Respone(pt101,dat,(47|0x40),SCQ); // 否定应答,非所希望的通信服务
  4582. return;
  4583. }
  4584. if(COT == 5) /*请求目录 */
  4585. {
  4586. IEC101_Direct_Echo(pt101,InfoAddr); /*目录响应 cot =5代表召唤目录*/
  4587. }
  4588. else if(COT == 13)
  4589. {
  4590. switch(SCQ)
  4591. {
  4592. case 1: /*选择文件*/
  4593. IEC101_EchoFileReady(pt101,InfoAddr,filename);
  4594. break;
  4595. case 2: /*请求文件*/
  4596. IEC101_EchoSectionReady(pt101,InfoAddr,filename,section);//节准备好报文
  4597. break;
  4598. case 6: /*请求节*/
  4599. IEC101_SegmentSend(pt101,InfoAddr,filename,section); //发送本节中所有的段
  4600. break;
  4601. default:
  4602. IEC101_File_Respone(pt101,dat,COT,SCQ|0x30); // 否定应答,非所希望的通信服务
  4603. break;
  4604. }
  4605. }
  4606. else
  4607. {
  4608. IEC101_File_Respone(pt101,dat,(45|0x40),SCQ); // 否定应答,未知的传送原因
  4609. }
  4610. }
  4611. /**************************************************************************
  4612. 函数名称:IEC101_File_Echo
  4613. 函数版本:1.00
  4614. 作者:
  4615. 创建日期:2007.9.1
  4616. 函数功能说明:对文件召唤的应答处理
  4617. 输出参数:pt101缓冲区地址,dat报文缓冲区地址从报文的帧类型开始
  4618. 返回值:
  4619. 更新信息:
  4620. 更新日志1:
  4621. 日期:
  4622. 修改者:
  4623. 修改内容:
  4624. 修改原因:
  4625. ***************************************************************************/
  4626. void IEC101_File_Echo(IEC101_DEF *pt101,BYTE *dat) //dat 从报文的帧类型开始
  4627. {
  4628. BYTE COT,SCQ; //传送原因
  4629. WORD filename,section; //文件名 节名
  4630. DWORD InfoAddr; //信息体地址
  4631. u8 CotByte=0; //传送原因双字节
  4632. u8 AppByte=0; //应用单元地址双字节
  4633. if(tRunPara.b101Cot2Byte) CotByte=1;
  4634. if(tRunPara.b101App2Byte) AppByte=1;
  4635. COT=dat[2];
  4636. InfoAddr=dat[4+CotByte+AppByte]+(dat[5+CotByte+AppByte]<<8);
  4637. filename=dat[6+CotByte+AppByte]+(dat[7+CotByte+AppByte]<<8); //文件名
  4638. section=dat[8+CotByte+AppByte]; //节名
  4639. SCQ = dat[9+CotByte+AppByte]; //选择和召唤限定词
  4640. //rt_printf("\r\n COT=%d addr=%4x filename=%d,section=%d,SCQ=%d",COT,InfoAddr,filename,section,SCQ);
  4641. if(IEC_Getdir(InfoAddr)==NULL)
  4642. {
  4643. IEC101_File_Respone(pt101,dat,(47|0x40),SCQ); // 否定应答,非所希望的通信服务
  4644. return;
  4645. }
  4646. if(COT == 5) /*请求目录 */
  4647. {
  4648. IEC101_Direct_Echo(pt101,InfoAddr); /*目录响应 cot =5代表召唤目录*/
  4649. }
  4650. else if(COT == 13)
  4651. {
  4652. switch(SCQ)
  4653. {
  4654. case 1: /*选择文件*/
  4655. IEC101_EchoFileReady(pt101,InfoAddr,filename);
  4656. break;
  4657. case 2: /*请求文件*/
  4658. IEC101_EchoSectionReady(pt101,InfoAddr,filename,section);//节准备好报文
  4659. break;
  4660. case 6: /*请求节*/
  4661. IEC101_SegmentSend(pt101,InfoAddr,filename,section); //发送本节中所有的段
  4662. break;
  4663. default:
  4664. IEC101_File_Respone(pt101,dat,COT,SCQ|0x30); // 否定应答,非所希望的通信服务
  4665. break;
  4666. }
  4667. }
  4668. else
  4669. {
  4670. IEC101_File_Respone(pt101,dat,(45|0x40),SCQ); // 否定应答,未知的传送原因
  4671. }
  4672. }
  4673. /**************************************************************************
  4674. 函数名称:IEC101_File_Sure
  4675. 函数版本:1.00
  4676. 作者:
  4677. 创建日期:2007.9.1
  4678. 函数功能说明:对文件处理的确认应答
  4679. 输出参数:pt缓冲区地址,dat报文缓冲区地址从报文的帧类型开始
  4680. 返回值:
  4681. 更新信息:
  4682. 更新日志1:
  4683. 日期:
  4684. 修改者:
  4685. 修改内容:
  4686. 修改原因:
  4687. ***************************************************************************/
  4688. void IEC101_File_Sure(IEC101_DEF *pt101,BYTE *dat) //dat 从报文的帧类型开始
  4689. {
  4690. BYTE COT,AFQ; //传送原因
  4691. WORD filename,section; //文件名 节名
  4692. DWORD InfoAddr; //信息体地址
  4693. u8 CotByte=0; //传送原因双字节
  4694. u8 AppByte=0; //应用单元地址双字节
  4695. if(tRunPara.b101Cot2Byte) CotByte=1;
  4696. if(tRunPara.b101App2Byte) AppByte=1;
  4697. COT=dat[2];
  4698. InfoAddr=dat[4+CotByte+AppByte]+(dat[5+CotByte+AppByte]<<8);
  4699. filename=dat[6+CotByte+AppByte]+(dat[7+CotByte+AppByte]<<8); //文件名
  4700. section=dat[8+CotByte+AppByte]; //节名
  4701. AFQ = dat[9+CotByte+AppByte]; //选择和召唤限定词
  4702. if(IEC_Getdir(InfoAddr)==NULL)
  4703. {
  4704. IEC101_File_Respone(pt101,dat,(47|0x40),AFQ); // 否定应答,未知的信息体地址
  4705. return;
  4706. }
  4707. if(COT != 13)
  4708. {
  4709. IEC101_File_Respone(pt101,dat,(45|0x40),AFQ); // 否定应答,未知的传送原因
  4710. }
  4711. switch(AFQ) /*AFQ文件确认或节确认*/
  4712. {
  4713. case 1: //文件传输的正确认可
  4714. IEC101_FreeFile(pt101);
  4715. IEC101_File_Respone(pt101,dat,COT,AFQ); // 需商讨,文件传输完毕后,对文件的确认,需要上送什么信息合适,以前是上送更新后的目录 sunxi
  4716. break;
  4717. case 2: //文件传输的否定认可
  4718. IEC101_FreeFile(pt101);
  4719. IEC101_File_Respone(pt101,dat,COT,AFQ); // 需商讨,文件传输完毕后,对文件的确认,需要上送什么信息合适,以前是上送更新后的目录 sunxi
  4720. break;
  4721. case 3: //节传输的正确认可
  4722. IEC101_FreeFile(pt101);
  4723. if(pt101->tfile.transsection<pt101->tfile.setctionnum-1)//现有调试工具UTDEBU,节名从0开始, tfile.setctionnum 需减1 sunxi ,后续程序恢复
  4724. {
  4725. pt101->tfile.filechecksum+=pt101->tfile.sectionchecksum; //文件校验和
  4726. section+=1;
  4727. IEC101_EchoSectionReady(pt101,InfoAddr,filename,section);//下一节准备好
  4728. }
  4729. else if(section>=pt101->tfile.setctionnum-1) // //现有调试工具UTDEBU,节名从0开始, tfile.setctionnum 需减1 sunxi,后续程序恢复
  4730. {
  4731. IEC101_EchoLastSection(pt101,filename,section,1); //LSQ = 3; 最后的段
  4732. }
  4733. break;
  4734. case 4: //节传输的否定认可
  4735. IEC101_FreeFile(pt101);
  4736. IEC101_EchoSectionReady(pt101,InfoAddr,filename,section);//节准备好报文
  4737. break;
  4738. default:
  4739. break;
  4740. }
  4741. }
  4742. void IEC101_FreeFile(IEC101_DEF *pt101)
  4743. {
  4744. if(pt101->tfile.bFiletransing)
  4745. {
  4746. pt101->tfile.bFiletransing=false;
  4747. pt101->tfile.bSegtransing=false;
  4748. if(!pt101->tfile.pdat)
  4749. {
  4750. rt_free(pt101->tfile.pdat);
  4751. pt101->tfile.pdat=NULL;
  4752. }
  4753. rt_printf("\r\nIEC101文件节传输完毕,释放内存,文件:%d 节:%d\r\n",pt101->tfile.filename,pt101->tfile.transsection);
  4754. }
  4755. }