| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141 |
- #include "head.h"
- enum
- {
- JD_STEP_QD=0, // 启动判断
- JD_STEP_CHECK, //启动确认
- JD_STEP_COLLECT, //数据收集
- JD_STEP_CTFAULT, //暂态故障判定
- JD_STEP_SSFAULT, //稳态故障处理
- JD_STEP_RST, //复归
- JD_STEP_NET_RST, //等待网络复归
- };
- enum
- {
- JD_FAULT_DIR_ZERO=0,
- JD_FAULT_DIR_POS_QD, //大于启动值正方向
- JD_FAULT_DIR_NEG_QD, //大于启动值反方向
- JD_FAULT_DIR_POS, //大于零漂正方向
- JD_FAULT_DIR_NEG, //大于零漂反方向
- };
- #ifdef FUN_JDXX
- //#define XDL_PRINT
- #define UI_JDXX_I0_INDEX UI_SW_INDEX(sw,SW_AC_I0)
- #define UI_JDXX_I0S_INDEX UI_SW_INDEX(sw,SW_AC_I0s)
- ///////////////////////////////////////////////
- JDXX_SET tJDXX_val[SWITCH_NUM_MAX];
- bool TT_U0yx; //U0越限判据投退
- bool TT_Ulyy; //Ul线电压有压判据
- bool TT_Ipwl; //相电流无流判据投退
- bool TT_Ipph; //相电流相位判据
- bool TT_U0jd; //UO就接地
- extern unsigned int g_count_156us;
- ////////////////////////////////////////////////////////////////////////////////////////////////
- void jdxx_init(void)
- {
- //memset(&tJD,0,sizeof(tJD));
- _getjdxxdz_inf();
- rt_printf("Jdxx_Ver:%02d.%03d \r\n",(FUN_JDXX_VERSION/1000),(FUN_JDXX_VERSION%1000));
- }
- void jdxx_relayinit(void)
- {
- int i;
-
- for(i=0;i<SWITCH_NUM_MAX;i++)
- {
- JDXX_SET *pJdxx=&tJDXX_val[i];
- TRELAY_T *pR=&g_tRelay[i];
- //U0判出时间
- #ifdef FUN_JDXX_JXJD
- InitTR_Time(&pR->tJD.tJDXXU01Time,T_20ms, 0); //U01 20ms
- InitTR_Time(&pR->tJD.tJDXXU02Time,T_20ms, 0); //U02 20ms
- #elif defined FUN_JDXX_TBLQD
- InitTR_Time(&pR->tJD.tJDXXU01Time,T_25ms, T_10ms); //U01 40ms
- InitTR_Time(&pR->tJD.tJDXXU02Time,T_25ms, T_10ms); //U02 40ms
- #else
- InitTR_Time(&pR->tJD.tJDXXU01Time,T_20ms, T_20ms); //U01 20ms,保持100ms(弧光接地)
- InitTR_Time(&pR->tJD.tJDXXU02Time,T_20ms, T_20ms); //U02 20ms,保持100ms(弧光接地)
- #endif
- InitTR_Time(&pR->tJD.tJDXXU1yyTime,T_20ms*3,0); //有压60ms
- InitTR_Time(&pR->tJD.tJDXXU2yyTime,T_20ms*3,0); //有压60ms
- InitTR_Time(&pR->tJD.tJDXXIylTime,T_20ms*3,0); //有流60ms
- InitTR_Time(&pR->tJD.tJDXXTripTime, pJdxx->jd_trip_time, T_20ms);
- InitTR_Time(&pR->tJD.tJDXXAlarmTime, pJdxx->jd_alarm_time, T_20ms);
- #ifdef JDXX_YXEV_RST
- InitTR_Time(&pR->tJD.tJDGjEvRstTime, tRunPara.dTEventRst, 0);
- InitTR_Time(&pR->tJD.tJDTzEvRstTime, tRunPara.dTEventRst, 0);
- #endif
-
- #ifdef HJS_XDLJD
- InitTR(&pR->tJD.jdxx_jskf_time,pJdxx->jd_js_time, 0); // 开放时间
- #endif
- }
- }
- void jdxx_u0_rst(int sw)
- {
- TRELAY_T *pR=&g_tRelay[sw];
- ResetTR(&pR->tJD.tJDXXU01Time); //U02 20ms
- ResetTR(&pR->tJD.tJDXXU02Time); //U02 20ms
- ResetTR(&pR->tJD.tJDXXU1yyTime); //
- ResetTR(&pR->tJD.tJDXXU2yyTime); //
- ResetTR(&pR->tJD.tJDXXIylTime); //
- }
- void jdxx_qd_rst(int sw) //启动返回
- {
- int i;
- TRELAY_T *pR=&g_tRelay[sw];
-
- pR->tJD.jd_step = JD_STEP_QD;
- pR->tJD.sta.bFlag.bTz = false;
- pR->tJD.sta.bFlag.bGj = false;
- pR->tJD.qdPoints=0;
- pR->tJD.adPoints=0;
- pR->tJD.con_angle=0;
- #ifdef FUN_JDXX_SS_ANGLE
- pR->tJD.dir_cnt=0;
- #endif
- #ifdef HJS_XDLJD
- pR->tJD.sta.bFlag.bJd_qn = 0; //区外故障
- #endif
- for(i=0;i<NUM_ANGLE;i++)
- {
- pR->tJD.ui_angle[i]=0;
- }
- ResetTR(&pR->tJD.tJDXXTripTime);
- ResetTR(&pR->tJD.tJDXXAlarmTime);
- //soe
- pro_rst_event(sw,EV_LX_XDL_QD);
- pro_rst_event(sw,EV_JDXX_JWGZ);
- #ifdef FUN_JDXX_JXJD
- pro_rst_event(sw,EV_JDXX_SWIN_GJ);
- pro_rst_event(sw,EV_JDXX_LWIN_GJ);
- #endif
- }
- void jdxx_fg(int sw) //接地选线复归
- {
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_fg:sw=%d JD_STEP_FG",sw);
- #endif
- jdxx_qd_rst(sw);
- }
- //soe fugui
- void jdxx_soe_fg(int sw,DWORD dStep)
- {
- #ifdef JDXX_YXEV_RST
- {
- TRELAY_T *pR=&g_tRelay[sw];
-
- RunTR( &pR->tJD.tJDGjEvRstTime, true, dStep);
- RunTR( &pR->tJD.tJDTzEvRstTime, true, dStep);
- if(pR->tJD.tJDGjEvRstTime.boolTrip)
- {
- pro_rst_event(sw,EV_JDXX_GJ);
- //事故总 主程序复归
- //if(pJdxx->bTT_jdxx_fault_all)
- //{
- // pro_rst_event(sw,EV_ALL_FAULT);
- //}
- }
- if(pR->tJD.tJDTzEvRstTime.boolTrip)
- {
- pro_rst_event(sw,EV_JDXX_TZ);
- //事故总 主程序复归
- //if(pJdxx->bTT_jdxx_fault_all)
- //{
- // pro_rst_event(sw,EV_ALL_FAULT);
- //}
- #ifdef FUN_JDXX_JXJD
- pro_rst_event(sw,EV_JDXX_SWIN_TZ);
- pro_rst_event(sw,EV_JDXX_LWIN_TZ);
- pro_rst_event(sw,EV_JDXX_YJ_TZ);
- #endif
- }
- }
- #else
- {
- pro_rst_event(sw,EV_JDXX_GJ);
- pro_rst_event(sw,EV_JDXX_TZ);
- //事故总 主程序复归
- //if(pJdxx->bTT_jdxx_fault_all)
- //{
- // pro_rst_event(sw,EV_ALL_FAULT);
- //}
- #ifdef FUN_JDXX_JXJD
- pro_rst_event(sw,EV_JDXX_SWIN_TZ);
- pro_rst_event(sw,EV_JDXX_LWIN_TZ);
- pro_rst_event(sw,EV_JDXX_YJ_TZ);
- #endif
- }
- #endif
- }
- void jdxx_yxev_rst(int sw)
- {
- #ifdef JDXX_YXEV_RST
- TRELAY_T *pR=&g_tRelay[sw];
- ResetTR(&pR->tJD.tJDGjEvRstTime);
- ResetTR(&pR->tJD.tJDTzEvRstTime);
- #endif
- pro_rst_event(sw,EV_JDXX_GJ);
- pro_rst_event(sw,EV_JDXX_TZ);
- #ifdef FUN_JDXX_JXJD
- pro_rst_event(sw,EV_JDXX_SWIN_TZ);
- pro_rst_event(sw,EV_JDXX_LWIN_TZ);
- pro_rst_event(sw,EV_JDXX_YJ_TZ);
- #endif
- }
- /**********************************
- //启动前零序通道零漂模值
- **********************************/
- void jdxx_getzeroval(int sw)
- {
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
-
- if(pR->tJD.jd_step==JD_STEP_QD) //复归判断
- {
- pR->tJD.zeroval=g_ui[pJdxx->i0_chan].m2[0]+pJdxx->jd_qdval2;
- }
- }
- /**********************************
- //突变量
- //index:电流通道
- //cur:通道采样索要
- **********************************/
- s32 jdxx_get_qdval(u32 cur,int index)//突变量
- {
- s32 v,v1,v2,val;
- v = g_adc_dots_rec[cur][index];
- v1 = g_adc_dots_rec[(cur - ADC_REC_SAMPLE) & ADC_REC_DOTS_MASK][index];
- v2 = g_adc_dots_rec[(cur - ADC_REC_SAMPLE*2) & ADC_REC_DOTS_MASK][index];
- val = (v -2*v1 + v2);
- return val;
- }
- s32 jdxx_getI0_qdval(u32 cur,int index1,int index2,int index3)//突变量
- {
- s32 val=0;
- val = jdxx_get_qdval(cur,index1)
- +jdxx_get_qdval(cur,index2)
- +jdxx_get_qdval(cur,index3);
-
- return val;
- }
- ////////////////////////////////////////////////
- //复归信号保持
- bool jdxx_soe_check(int sw)
- {
- if(soe_check(EV_JDXX_GJ+sw*EV_SW_NUM)) return true;
- if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)) return true;
- //if(soe_check(EV_JDXX_JWGZ+sw*EV_SW_NUM)) return true;
- #ifdef FUN_JDXX_JXJD
- if(soe_check(EV_JDXX_SWIN_TZ+sw*EV_SW_NUM)) return true;
- if(soe_check(EV_JDXX_LWIN_TZ+sw*EV_SW_NUM)) return true;
- if(soe_check(EV_JDXX_YJ_TZ+sw*EV_SW_NUM)) return true;
- #endif
-
- return false;
- }
- #ifdef FUN_JDXX_JXJD
- //瞬时故障延时跳闸逻辑
- bool jdxx_ssjd_pro(int sw)
- {
- int i,num;
- bool bQDD;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
-
- //短延时接地故障
- if(pJdxx->bTT_jxjd_stz)
- {
- //I瞬时接地计次
- pR->tJD.cnt_sdelay++;
- if(pR->tJD.cnt_sdelay>pJdxx->jd_sdelay_cnt)
- {
- pR->tJD.cnt_sdelay=pJdxx->jd_sdelay_cnt;
- }
- #ifdef XDL_PRINT
- rt_printf("\r\nSW%d:间歇性接地保护I段计次!sdn=%d!",sw,pR->tJD.cnt_sdelay);
- #endif
-
- //jxjd_logic
- bQDD = (pR->tJD.cnt_sdelay>=pJdxx->jd_sdelay_cnt) && (ustimer_get_duration(pR->tJD.jdxx_sdelay_us0[pR->tJD.cnt_sdelay-2]) < (pJdxx->jd_sdelay_time*(USTIMER_SEC/SAM_FREQUENCY)));//短延时故障
- if(bQDD)
- {
- //led
- pR->tJD.sta.bFlag.bTz = true;
- pR->tJD.sta.bFlag.bTZLed = true;
- //soe
- if(soe_check(EV_JDXX_SWIN_TZ+sw*EV_SW_NUM)==false)
- {
- soe_record_ev(EV_JDXX_SWIN_TZ+sw*EV_SW_NUM,1, 0,0,0 );
- if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false) //区内故障
- {
- soe_record_ev(EV_JDXX_TZ+sw*EV_SW_NUM,1, 0,0,0 );
- }
- //事故总
- if(pJdxx->bTT_jdxx_fault_all)
- {
- if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
- {
- soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
- }
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n间歇性接地保护I段动作");
- #endif
- //故障处理完毕,进入复归处理流程
- pR->tJD.jd_step=JD_STEP_RST;
- pR->tJD.cnt_sdelay=0;
- pR->tJD.cnt_ldelay=0;//???
-
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_s_fault:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
- rt_printf("\r\njdxx_s_fault:sw=%d step_rst",sw);
- #endif
- }
-
- return true;
- }
- else//存储故障时刻
- {
- //SOE
- if(soe_check(EV_JDXX_SWIN_GJ+sw*EV_SW_NUM)==false)
- {
- soe_record_ev(EV_JDXX_SWIN_GJ+sw*EV_SW_NUM,1, 0,0,0 );
- }
- //us0 fifo
- num = pJdxx->jd_sdelay_cnt-1;
- for(i=0;i<num;i++)
- {
- pR->tJD.jdxx_sdelay_us0[num-i]=pR->tJD.jdxx_sdelay_us0[num-1-i];
- }
- pR->tJD.jdxx_sdelay_us0[0] = pR->tJD.time_qd;//ustimer_get_origin();
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_s_fault:T[0]=%d!",pR->tJD.jdxx_sdelay_us0[0]/USTIMER_SEC);
- #endif
- }
- }
- //长延时接地故障
- if(pJdxx->bTT_jxjd_ltz)
- {
- //II瞬时接地计次
- pR->tJD.cnt_ldelay++;
- if(pR->tJD.cnt_ldelay>pJdxx->jd_ldelay_cnt)
- {
- pR->tJD.cnt_ldelay=pJdxx->jd_ldelay_cnt;
- }
- #ifdef XDL_PRINT
- rt_printf("\r\nSW%d间歇性接地保护II段计次!ldn=%d!",sw,pR->tJD.cnt_ldelay);
- #endif
-
- //jxjd_logic
- bQDD = (pR->tJD.cnt_ldelay>=pJdxx->jd_ldelay_cnt) && (ustimer_get_duration(pR->tJD.jdxx_ldelay_us0[pR->tJD.cnt_ldelay-2]) < (pJdxx->jd_ldelay_time*(USTIMER_SEC/SAM_FREQUENCY)));//长延时故障
- if(bQDD)
- {
- //led
- pR->tJD.sta.bFlag.bTz = true;
- pR->tJD.sta.bFlag.bTZLed = true;
- //soe
- if(soe_check(EV_JDXX_LWIN_TZ+sw*EV_SW_NUM)==false)
- {
- soe_record_ev(EV_JDXX_LWIN_TZ+sw*EV_SW_NUM,1, 0,0,0 );
-
- if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false) //区内故障
- {
- soe_record_ev(EV_JDXX_TZ+sw*EV_SW_NUM,1, 0,0,0 );
- }
- //事故总
- if(pJdxx->bTT_jdxx_fault_all)
- {
- if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
- {
- soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
- }
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n间歇性接地保护II段动作");
- #endif
-
- //故障处理完毕,进入复归处理流程
- pR->tJD.jd_step=JD_STEP_RST;
- pR->tJD.cnt_sdelay=0;//???
- pR->tJD.cnt_ldelay=0;
-
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_l_fault:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
- rt_printf("\r\njdxx_l_fault:sw=%d step_rst",sw);
- #endif
- }
- return true;
- }
- else//存储故障时刻
- {
- //SOE
- if(soe_check(EV_JDXX_LWIN_GJ+sw*EV_SW_NUM)==false)
- {
- soe_record_ev(EV_JDXX_LWIN_GJ+sw*EV_SW_NUM,1, 0,0,0 );
- }
- //us0 fifo
- num = pJdxx->jd_ldelay_cnt-1;
- for(i=0;i<num;i++)
- {
- pR->tJD.jdxx_ldelay_us0[num-i]=pR->tJD.jdxx_ldelay_us0[num-1-i];
- }
- pR->tJD.jdxx_ldelay_us0[0] = pR->tJD.time_qd;//ustimer_get_origin();
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_l_fault:T[0]=%d!",pR->tJD.jdxx_ldelay_us0[0]/USTIMER_SEC);
- #endif
- }
- }
- return false;
- }
- #endif
- //复归
- void jdxx_rst(int sw, DWORD dStep)
- {
- TRELAY_T *pR=&g_tRelay[sw];
- //状态
- if(pR->tJD.jd_step==JD_STEP_QD)
- {
- jdxx_soe_fg(sw,dStep);
- return;
- }
- //复归
- if(pR->tJD.jd_step==JD_STEP_RST)
- {
- jdxx_fg(sw);
- }
- else//pR->tJD.jd_step==JD_STEP_RST
- {
- #ifdef FUN_JDXX_JXJD
- bool ret;
-
- ret=jdxx_ssjd_pro(sw); //多次瞬时故障跳闸
- if(!ret)
- #endif
- {
- jdxx_fg(sw);
- }
- }
- }
- s16 jdxx_get_adval(u32 dots,int index)
- {
- u32 cur=dots&ADC_REC_DOTS_MASK;
- s16 v;
- v = g_adc_dots_rec[cur][index];
- return v;
- }
- s16 jdxx_getI0_adval(u32 dots,int index1,int index2,int index3)
- {
- u32 cur=dots&ADC_REC_DOTS_MASK;
- s16 v;
- v = g_adc_dots_rec[cur][index1]
- +g_adc_dots_rec[cur][index2]
- +g_adc_dots_rec[cur][index3];
- return v;
- }
- /*bool jdxx_I0_ov(int sw) //判断零序是否失真
- {
- int i;
- JDXX_SET *pJdxx=&pRunSet->tSwSet[sw].tJDXX;
-
- for(i=0;i<pJdxx->jd_faultPoints;i++) // 统计接地时刻的波形,是否满偏失真 ,大于8A,即使用大量程零序波形判断
- {
- s16 v;
- v=jdxx_get_adval(tJD[sw].dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index);//jdxx_get_adval(tJD.dot_qd+i,g_ui[UI_JDXX_I0G_INDEX].chn_index);
- if(_AbsL(v)>=pJdxx->jd_ov_val)
- {
- return true;
- }
- }
- return false;
- }*/
- #define U0_FULL_DOTNUM 10
- bool jdxx_U0_ov(int sw) //判断一周波零序电压是否失真
- {
- int i,j,mod,index;
- u32 dotcur;
- TRELAY_T *pR=&g_tRelay[sw];
- if(pR->tJD.jd_u0_12==1) index=PUB_AC_U01;
- else index=PUB_AC_U02;
-
- mod = (int)(g_count_156us &0x03);
- dotcur=(g_adc_dots_count)*ADC_REC_SAMPLE_RATE+mod-ADC_REC_SAMPLE;
- for(i=0,j=0;i<ADC_REC_SAMPLE;i++) //ADC_REC_SAMPLE 统计接地时刻的波形,是否满偏失真 ,大于8A,即使用大量程零序波形判断
- {
- s16 v;
-
- v=jdxx_get_adval(dotcur+i,g_ui[index].chn_index);
- pR->tJD.jd_U0ov_val=(short)(7.2*g_ui[index].m2_factor_k/256.0+0.5); //EVT零序 7.8125V满偏,7.2V作为满偏定值
- if(_AbsL(v)>=pR->tJD.jd_U0ov_val)
- {
- if(++j>U0_FULL_DOTNUM)
- {
- return true;
- }
- }
- }
- return false;
- }
- bool jdxx_I0_ov(int sw) //判断零序是否失真
- {
- int i;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
- if(g_ui[UI_JDXX_I0S_INDEX].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- return false;
- }
-
- for(i=0;i<pJdxx->jd_faultPoints;i++) // 统计接地时刻的波形,是否满偏失真 ,大于0.5A,即使用大量程零序波形判断
- {
- s16 v;
- v=jdxx_get_adval(pR->tJD.dot_qd+i,g_ui[UI_JDXX_I0_INDEX].chn_index);
- if(_AbsL(v)>=pJdxx->jd_ov_val)
- {
- rt_printf("jdxx:sw=%d 零序小通道电流满偏失真!\r\n",sw);
- return true;
- }
- }
-
- return false;
- }
- int jdxx_I0Range(int sw) //
- {
- int i;
- int bv0=0,bv1=0;
- int dots=0;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
- for(i=0;i<pJdxx->jd_faultPoints-1;i++) // 取方向
- {
- if(pJdxx->bTT_jdxx_cph)//(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) > 0)//pJdxx->jd_zero)
- {
- bv0=1;
- break;
- }
- else if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) < 0)//-pJdxx->jd_zero)
- {
- bv0=-1;
- break;
- }
- }
- else
- {
- if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) > 0)//pJdxx->jd_zero)
- {
- bv0=1;
- break;
- }
- else if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) < 0)//-pJdxx->jd_zero)
- {
- bv0=-1;
- break;
- }
- }
- else
- {
- if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) > 0)//pJdxx->jd_zero)
- {
- bv0=1;
- break;
- }
- else if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) < 0)//-pJdxx->jd_zero)
- {
- bv0=-1;
- break;
- }
- }
- }
- }
- for(i++;i<pJdxx->jd_faultPoints;i++) // 取方向
- {
- if(pJdxx->bTT_jdxx_cph)//(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) > 0)//pJdxx->jd_zero)
- {
- bv1=1;
- }
- else if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) < 0)//-pJdxx->jd_zero)
- {
- bv1=-1;
- }
- }
- else
- {
- if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) > 0)//pJdxx->jd_zero)
- {
- bv1=1;
- }
- else if(jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index) < 0)//-pJdxx->jd_zero)
- {
- bv1=-1;
- }
- }
- else
- {
- if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) > 0)//pJdxx->jd_zero)
- {
- bv1=1;
- }
- else if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) < 0)//-pJdxx->jd_zero)
- {
- bv1=-1;
- }
- }
- }
- dots=i+1;
- if(bv0!=bv1)break;
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n sw=%d 启动后同方向点数%d",sw,dots);
- #endif
- return dots;
- }
- int jdxx_Iabc_check_dir(int sw) // Ia Ib Ic 接地相判断,以零序启动时刻为主,查找零序启动后32点内的最大值,做积分,看三相的方向
- {
- int dots;
- long va,vb,vc,v1,v2,v3;
- int i;
- TRELAY_T *pR=&g_tRelay[sw];
-
- dots=jdxx_I0Range(sw);
- va=0;
- vb=0;
- vc=0;
- for(i=0;i<dots;i++) //
- {
- va+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index);
- vb+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index);
- vc+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index);
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n三相积分值Ia=%d Ib=%d Ic=%d",va,vb,vc);
- #endif
- //一相和另外两相反相
- if((va>0&&vb<=0&&vc<=0)||(va<0&&vb>=0&&vc>=0)) //不同相
- {
- return SW_AC_IA; // A相接地
- }
- else if((vb>0&&va<=0&&vc<=0)||(vb<0&&va>=0&&vc>=0))
- {
- return SW_AC_IB; // B相接地
- }
- else if((vc>0&&va<=0&&vb<=0)||(vc<0&&va>=0&&vb>=0))
- {
- return SW_AC_IC; // C相接地
- }
- //突变:4倍
- v1=_AbsL(va);
- v2=_AbsL(vb);
- v3=_AbsL(vc);
- if((v1>>2)>v2 && (v1>>2)>v3)
- {
- return SW_AC_IA; // A相接地
- }
- else if((v2>>2)>v1 && (v2>>2)>v3)
- {
- return SW_AC_IB; // A相接地
- }
- else if((v3>>2)>v1 && (v3>>2)>v2)
- {
- return SW_AC_IC; // A相接地
- }
- //无法判相
- return -1;
- }
- // 电压波形起始点
- int jdxx_get_dotsoff(int sw,int pha)
- {
- int vdots=0,dotsoff=0;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
- if((pJdxx->jd_voltype==PUB_AC_U01)||(pJdxx->jd_voltype==PUB_AC_U02))
- {
- vdots=pR->tJD.dot_qd;
- }
- else if(pJdxx->jd_voltype==PUB_AC_UA1)
- {
- if(pha==SW_AC_IA) // A相接地,与UA1比较,波形不需偏移
- {
- dotsoff=0;
- }
- else if(pha==SW_AC_IB) // B相接地,与UA1比较,参考电压波形需后移120度,即128/3=42.66
- {
- dotsoff=-43;
- }
- else
- {
- dotsoff=43; // C相接地,参考电压UA1波形需前移120度
- }
- vdots=pR->tJD.dot_qd+dotsoff-ADC_REC_SAMPLE*2; // 电压波形起始点
- }
- else if(pJdxx->jd_voltype==PUB_AC_UAB1)
- {
- if(pha==SW_AC_IA) // A相接地,与UAB1比较,UAB1波形超前Ia30度,30/360*128=10.666(11点)
- {
- dotsoff=11;
- }
- else if(pha==SW_AC_IB) // B相接地,与UAB1比较,参考电压波形需后移120度,即128/3=42.66+10.66
- {
- dotsoff=-53;
- }
- else
- {
- dotsoff=53; // C相接地,参考电压UA1波形需前移120度
- }
- vdots=pR->tJD.dot_qd+dotsoff-ADC_REC_SAMPLE*2; // 电压波形起始点
- }
-
- return vdots;
- }
- int jdxx_VI0_dir(int sw,int pha)
- {
- int i,dotsnum,vdots;
- s32 v0,I0;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
-
- if(pha<0)return 0;
-
- vdots=jdxx_get_dotsoff(sw,pha);
- dotsnum=jdxx_I0Range(sw); // 零序电流统计点数
- if(dotsnum==0) return 0;
-
- //积分
- v0=0;
- I0=0;
- for(i=0;i<dotsnum;i++) //
- {
- if(pRunSet->bTT_U0ZC) //U0
- {
- if(pR->tJD.jd_u0_12==1)
- {
- v0+=jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[PUB_AC_UA1].chn_index,g_ui[PUB_AC_UB1].chn_index,g_ui[PUB_AC_UC1].chn_index);
- }
- else
- {
- v0+=jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[PUB_AC_UA2].chn_index,g_ui[PUB_AC_UB2].chn_index,g_ui[PUB_AC_UC2].chn_index);
- }
- }
- else
- {
- if(pR->tJD.jd_u0_12==1)
- {
- v0+=jdxx_get_qdval(vdots+i,g_ui[PUB_AC_U01].chn_index);
- }
- else
- {
- v0+=jdxx_get_qdval(vdots+i,g_ui[PUB_AC_U02].chn_index);
- }
- }
-
- if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO) //I0
- {
- I0+=jdxx_getI0_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index);
- }
- else
- {
- I0+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index);
- }
- }
- #ifdef XDL_PRINT
- rt_printf("\r\nV_I0积分:V=%d I0=%d",v0,I0);
- #endif
-
- //V0是否突变
- //if(_AbsL(v0)<=(DWORD)pJdxx->jd_volzero*dotsnum) return 0; //电压突变太小
- //区内区外判断
- if((v0>0&&I0>0)||(v0<0&&I0<0)) return 1;
- else return -1;
- }
- // 判界内界外,零序电流和参考电压比波形的相似度 chnl 为相别
- //返回:ret=-1 无法判出相、区内区外
- // ret=0 正确判出
- int jdxx_checkjd(int sw)
- {
- int pha0,ret0;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
- if(pJdxx->bTT_jdxx_cph)
- {
- pha0=jdxx_Iabc_check_dir(sw); // 通过三相电流方向判断接地相
- ret0=jdxx_VI0_dir(sw,pha0); // U 和I0的积分:同向为1,已向为 1
- if(ret0==0)
- {
- #ifdef XDL_PRINT
- if(pha0<0)
- {
- rt_printf("\r\n判相失败!pha=%d",pha0);
- }
- else
- {
- rt_printf("\r\n区内区外判别失败!电压零流方向=%d(1:界内,-1:界外)",ret0);
- }
- #endif
- return -1;
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n暂态接地判据:sw=%d 电压零流方向=%d(1:界内,-1:界外) pha=%d",sw,ret0,pha0);
- #endif
- //rcd_start(sw,RECORD_TYPE_LXGL, RECORD_LEN_TZQD); //录波类型:跳闸类
- //判断界内
- if(((pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0<0)||
- (!(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0>0))
- {
- pR->tJD.tc_result=1;
- }
- else
- {
- pR->tJD.tc_result=0;
- }
- }
- else//U0参与逻辑
- {
- pha0=4;//不判相
- ret0=jdxx_VI0_dir(sw,pha0); // U 和I0的积分,同向为1 ,反向为-1
- if(ret0==0)
- {
- #ifdef XDL_PRINT
- rt_printf("\r\n区内区外判别失败!电压零流方向=%d(1:界内,-1:界外)",ret0);
- #endif
- return -1;
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n暂态接地判据:sw=%d 电压零流方向=%d(1:界内,-1:界外)",sw,-ret0);//U0/I0反相为界内,同向为界外
- #endif
- //rcd_start(sw,RECORD_TYPE_LXGL, RECORD_LEN_TZQD); //录波类型:跳闸类
- //判断界内
- #if defined FUN_JDXX_JXJD || defined DTU_HUNAN
- if(((pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0>0)|| //极性
- (!(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0<0))
- #else
- if((((pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0>0)|| //极性
- (!(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0<0))
- &&(g_ui[pJdxx->i0_chan].m2[0] >= pJdxx->jd_qdval2)) //I0幅值
- #endif
- {
- pR->tJD.tc_result=1;
- }
- else
- {
- pR->tJD.tc_result=0;
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n首端算法结论:sw=%d result=%d(1:界内,-1:界外)",sw,pR->tJD.tc_result);
- #endif
- }
- return 0;
- }
- /**********************************
- //接地选线启动逻辑
- **********************************/
- //有功分量判据
- void jdxx_yg_qd(int sw)
- {
- int ret0;
- float pea,th_pea;
- TRELAY_T *pR=&g_tRelay[sw];
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- //判区内区外
- if(pR->tJD.jd_step==JD_STEP_QD)
- {
- //有功分量选择
- if(g_ui[UI_JDXX_I0S_INDEX].chn_index!=CFG_ADC_CHANNEL_ZERO) pea = g_ui_p0[sw].Peas;
- else pea = g_ui_p0[sw].Pea;
- //有功门槛值,约15K
- if(g_equ_config_ac[g_sw_pub.ac_cfg_index[pJdxx->i0_chan]].scale==EQU_SCALE_EVT_6V50_100V) th_pea=0.02;//_sw_ui_e_k(int ui_index)
- else th_pea=0.30; //100/6.5*0.02=0.30
-
- //有功分量判区内区外
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
- if((pea-th_pea)>0) ret0=-1;//0.30--100V;0.02--6.5V
- else ret0=1;
- }
- else
- {
- if((pea+th_pea)<0) ret0=-1;
- else ret0=1;
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n暂态接地判据:sw=%d 电压零流方向=%d(1:界内,-1:界外)",sw,-ret0);//U0/I0反相为界内,同向为界外
- #endif
- //rcd_start(sw,RECORD_TYPE_LXGL, RECORD_LEN_TZQD); //录波类型:跳闸类
- //判断界内
- if( ret0<0)
- {
- pR->tJD.tc_result=1;
- }
- else
- {
- pR->tJD.tc_result=0;
- }
- pR->tJD.jd_step = JD_STEP_SSFAULT;
- }
- }
- //首半波判据
- #define NUM_QDFX (ADC_REC_SAMPLE<<2) //四个周波
- void jdxx_qd(int sw)
- {
- s32 qdval;
- int mod,dir;
- u32 dotcnt,dotend,dotcur;//,dotnum;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
-
- mod = (int)(g_count_156us &0x03);
- dotend=(g_adc_dots_count)*ADC_REC_SAMPLE_RATE+mod;
- if(pR->tJD.jd_step==JD_STEP_RST||pR->tJD.jd_step==JD_STEP_SSFAULT) return;
- //tbl
- dotcur=dotend -NUM_QDFX;
- dir=0;
- for(dotcnt=0;dotcnt<NUM_QDFX;dotcnt++) //U0已持续四个周波 ADC_REC_SAMPLE*3
- {
- u32 cur;
- cur = dotcur & ADC_REC_DOTS_MASK; //当前采样点
- dotcur++;
- //启动判断
- if(pR->tJD.jd_step==JD_STEP_QD)
- {
- if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- qdval=jdxx_getI0_qdval(cur,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index);
- }
- else
- {
- qdval=jdxx_get_qdval(cur,g_ui[pJdxx->i0_chan].chn_index);
- }
- if(_AbsL(qdval) > pR->tJD.jd_qdval) //大于启动值
- {
- pR->tJD.jd_step=JD_STEP_CHECK;
- pR->tJD.qdPoints=0;
- pR->tJD.dot_qd=cur; //保存当前启动点的采样序号
- if(qdval>0)
- {
- dir=1;
- }
- else if(qdval<0)
- {
- dir=-1;
- }
- #ifdef XDL_PRINT
- rt_printf_time("jdxx:JD_STEP_CHECK sw=%d dot=%d qdval=%d set=%d\r\n",sw,cur,qdval,pR->tJD.jd_qdval);
- #endif
- }
- }
- else if(pR->tJD.jd_step==JD_STEP_CHECK) //收集数据
- {
- if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- qdval=jdxx_getI0_qdval(cur,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index);
- }
- else
- {
- qdval=jdxx_get_qdval(cur,g_ui[pJdxx->i0_chan].chn_index);
- }
- if((qdval*dir<0)//反相
- ||(_AbsL(qdval) < pR->tJD.jd_qdval)) //小于启动值
- {
- #ifdef XDL_PRINT
- if(qdval*dir<0)
- {
- rt_printf("jdxx:sw=%d dot=%d;启动后干扰\r\n",sw,cur);
- }
- else
- {
- rt_printf("jdxx:sw=%d dot=%d;启动后有值小于启动值\r\n",sw,cur);
- }
- #endif
- pR->tJD.jd_step=JD_STEP_QD;
- continue;
- }
- pR->tJD.qdPoints++;
- if(pR->tJD.qdPoints>=pJdxx->jd_qdPoints) // 大于启动个数,进入数据收集阶段,可启动录波
- {
- pR->tJD.jd_step=JD_STEP_COLLECT;
- pR->tJD.adPoints=0;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d dot=%d;JD_STEP_COLLECT\r\n",sw,cur);
- #endif
- }
- }
- else if(pR->tJD.jd_step==JD_STEP_COLLECT) //收集数据
- {
- pR->tJD.adPoints++;
- if(pR->tJD.adPoints>=pJdxx->jd_faultPoints)
- {
- pR->tJD.jd_step=JD_STEP_CTFAULT;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d JD_STEP_CTFAULT! dcnt=%d\r\n",sw,dotcnt);
- #endif
- }
- }
- else if(pR->tJD.jd_step==JD_STEP_CTFAULT) //暂态特征判断
- {
- int i,ret;
- bool bFault=false;
- s32 val=0;
- int ovQDpoints=0;
-
- if(!bFault) //故障未确认
- {
- for(i=pJdxx->jd_qdPoints;i<pJdxx->jd_faultPoints+pJdxx->jd_qdPoints;i++)
- {
- u32 cur=(pR->tJD.dot_qd+i)&ADC_REC_DOTS_MASK;
- if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
- {
- val=_AbsL(jdxx_getI0_qdval(cur,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index));
- }
- else
- {
- val=_AbsL(jdxx_get_qdval(cur,g_ui[pJdxx->i0_chan].chn_index));
- }
- if(val > pR->tJD.jd_qdval)
- {
- ovQDpoints++;
- }
- if(ovQDpoints>pJdxx->jd_surePoints)
- {
- bFault=true;
- break;
- }
- }
- }
- //故障确认,判断暂态接地线路逻辑
- if(bFault)
- {
- #ifdef FUN_JDXX_TBLQD
- if(pJdxx->bTT_jdxx_p0dir)
- {
- pR->tJD.tc_result=1; //启动
- pR->tJD.adPoints=0;
- pR->tJD.jd_step=JD_STEP_SSFAULT;
- if(soe_check(EV_LX_XDL_QD+sw*EV_SW_NUM)==false)
- {
- soe_record_ev( EV_LX_XDL_QD+sw*EV_SW_NUM,1, 0,0,0 );
- }
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d JD_STEP_SSFAULT\r\n",sw);
- #endif
-
- return;
- }
- else
- #endif
- {
- ret=jdxx_checkjd(sw);
- if(ret<0)
- {
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_fg:sw=%d JD_STEP_FG",sw);
- #endif
- return;
- }
- else
- {
- pR->tJD.adPoints=0;
- pR->tJD.jd_step=JD_STEP_SSFAULT;
- if(soe_check(EV_LX_XDL_QD+sw*EV_SW_NUM)==false)
- {
- soe_record_ev( EV_LX_XDL_QD+sw*EV_SW_NUM,1, 0,0,0 );
- }
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d JD_STEP_SSFAULT\r\n",sw);
- #endif
-
- return;
- }
- }
- }
- else//干扰,复归
- {
- #if 0//def FUN_JDXX_TBLQD //只需要U0期间出现了I0突变,就ok
- {
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 启动后确认干扰\r\n",sw);
- #endif
- pR->tJD.jd_step=JD_STEP_QD;
- continue;
- }
- #else
- if(dotcnt<(NUM_QDFX-128))//最后1周波前必须确认(512-128)
- {
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 启动后确认干扰\r\n",sw);
- #endif
- pR->tJD.jd_step=JD_STEP_QD;
- continue;
- }
- else
- {
- pR->tJD.adPoints=0;
- pR->tJD.jd_step=JD_STEP_RST;
-
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_fg:sw=%d JD_STEP_FG!(not sure)",sw);
- #endif
- return;
- }
- #endif
- }
- }
- }
- }
- //稳态判据
- #define ANGF150 (150*65536) //150度
- #define ANGN150 ((-150)*65536) //-150度
- #define ANGF30 (30*65536) //30度
- #define ANGN30 ((-30)*65536) //-30度
- #ifdef FUN_JDXX_12FS //针对电科院一二次融合测试
- #define ANGF96 (110*65536) //110度
- #define ANGN96 ((-110)*65536) //-110度
- #define ANGF45 (30*65536) //30度
- #define ANGN45 ((-30)*65536) //-30度
- #else
- #define ANGF96 (96*65536) //96度
- #define ANGN96 ((-96)*65536) //-96度
- #define ANGF45 (45*65536) //45度
- #define ANGN45 ((-45)*65536) //-45度
- #endif
- #define ANGF360 (360*65536) //360度
- #define ANGF90 (90*65536) //90度
- #define ANGN90 ((-90)*65536) //-90度
- #define ANGF70 (70*65536) //70度
- #define ANGN70 ((-70)*65536) //-70度
- int jdxx_angle_range(int sw)
- {
- int i,ret;
- long deltaA;
- TRELAY_T *pR=&g_tRelay[sw];
- #if 1
- long max,min;
- max=pR->tJD.ui_angle[0];
- min=pR->tJD.ui_angle[0];
- for(i=1;i<NUM_ANGLE;i++)
- {
- if(pR->tJD.ui_angle[i] > max)
- {
- max = pR->tJD.ui_angle[i];
- }
- else if(pR->tJD.ui_angle[i] < min)
- {
- min = pR->tJD.ui_angle[i];
- }
- }
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d AngleMax=%d , AngleMin=%d!\r\n",sw,(max>>16),(min>>16));
- #endif
- if((max > ANGF90) && (min<ANGN90))//在2-3象限
- {
- for(i=0;i<NUM_ANGLE;i++)
- {
- if(pR->tJD.ui_angle[i] < 0)
- {
- pR->tJD.ui_angle[i] += ANGF360;//归一化到0~360
- }
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d Angle23=%d!\r\n",sw,(pR->tJD.ui_angle[i]>>16));
- #endif
- }
- }
- //相角
- deltaA=0;
- for(i=0;i<NUM_ANGLE;i++)
- {
- deltaA += pR->tJD.ui_angle[i];
- }
- deltaA /=NUM_ANGLE;
- #else
- int j;
- ret=3;
- deltaA=0;
- for(i=0,j=0;i<NUM_ANGLE;i++)
- {
- if(pR->tJD.ui_angle[i] > 0) continue;
- else
- {
- deltaA +=pR->tJD.ui_angle[i];
- j++;
- }
- }
- if(j==0)
- {
- ret=3;//非界外
- }
- else
- {
- deltaA /=j;
- }
- #endif
- //判区内区外
- ret=3;
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
- if(deltaA>ANGF45 && deltaA<ANGF96) ret=2; //界外
- }
- else
- {
- if(deltaA>ANGN96 && deltaA<ANGN45) ret=2;//界外
- }
- #ifdef XDL_PRINT
- if(ret==2)
- {
- rt_printf("jdxx:sw=%d 零序功率方向判区外接地!ret0=%d!Angle=%d!\r\n",sw,ret,(deltaA>>16));
- }
- #endif
- return ret;
- }
- /**************************************************************************
- 函数名称:CalcUIzAng
- 函数版本:1.00
- 函数功能说明:接地零序角度必须归一到-180-180。(部分项目角度没有归一化到-180-180)
- 输入参数:long Real1,
- long Imag1,
- long Imag2,
- long Imag2
- 输出参数:
- 返回值: long 角差;
- **************************************************************************/
- long CalcUIzAng(long Real1, long Imag1, long Real2, long Imag2)
- {
- long lTmp;
- lTmp = _AngPQ(Real1, Imag1)- _AngPQ(Real2,Imag2);
- //规格化在0 ~ 360之间
- if(lTmp < 0)
- {
- lTmp += ANGLE_P360;
- }
- if(lTmp>ANGLE_P180) //转换为-180 ~180
- {
- lTmp-=ANGLE_P360;
- }
- return (lTmp);
- }
- void jdxx_fault(int sw,DWORD dStep)
- {
- int ret0,ret1,bQNGZ,u0_index;
- bool b_tz,b_gj;
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- TRELAY_T *pR=&g_tRelay[sw];
- #ifdef ITEM_FYF630Z
- b_gj = pJdxx->bTT_jdxx_gj;
- b_tz = pJdxx->bTT_jdxx_tz;
- #ifdef BH_JZ_YB
- if(!g_tRelay[sw].run_stu.bh_ck)
- #else
- if(pRunSet->tSwSet[sw].bSW_JZ)
- #endif
- {
- if(b_tz){
- b_tz = false;
- b_gj = true;
- }
- }
- #elif defined DFTU_LINUX_ZXJC || defined DTU_HUNAN || defined DTU4_GW_TEST || defined FB_SHANDONG || defined FBS_GX
- b_gj = pJdxx->bTT_jdxx_gj;
- b_tz = pJdxx->bTT_jdxx_tz;
- #else
- b_gj = pJdxx->bTT_jdxx_gj;
- b_tz = pJdxx->bTT_jdxx_tz;
- if(JZS_ALL_EN(sw)) // 集中模式或者就地式FA自适应非首开关不跳闸
- {
- if(b_tz){
- b_tz = false;
- b_gj = true;
- }
- }
- #endif
-
- if(pR->tJD.jd_step==JD_STEP_SSFAULT)//稳态逻辑判定
- {
- //判稳态电流
- #if defined FUN_JDXX_JXJD || defined DTU_HUNAN
- ret1=1;
- #else
- if(g_ui[pJdxx->i0_chan].m2[0] >= pJdxx->jd_qdval2)
- {
- ret1=1;
- }
- else
- {
- ret1=0;
- if(pR->tJD.tc_result)
- {
- pR->tJD.tc_result=0;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d ret1=%d--暂态误判!\r\n",sw,ret1);
- #endif
- }
- }
- #endif
- //判相位
- if(pR->tJD.jd_u0_12==1) u0_index=PUB_AC_U01;
- else u0_index=PUB_AC_U02;
- //判稳态相位
- if(!pJdxx->bTT_jdxx_p0dir)
- {
- ret0=3;
- }
- else
- {
- long deltaA;
- //计算零序功率角度:-180~180 (固定大通道)
- if(g_ui[pJdxx->i0_chan].m2[0] >= pJdxx->jd_qdval2)
- {
- deltaA=CalcUIzAng(g_ui[u0_index].ri.r,g_ui[u0_index].ri.i,g_ui[pJdxx->i0_chan].ri.r,g_ui[pJdxx->i0_chan].ri.i);
- if((g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].chn_index!=CFG_ADC_CHANNEL_ZERO)&&(g_ui[UI_JDXX_I0_INDEX].m2[0] > pJdxx->jd_ov_val2))
- {
- deltaA=CalcUIzAng(g_ui[u0_index].ri.r,g_ui[u0_index].ri.i,g_ui[UI_JDXX_I0_INDEX].ri.r,g_ui[UI_JDXX_I0_INDEX].ri.i);
- }
- }
- else //区外处理
- {
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
- deltaA=ANGF90;
- }
- else
- {
- deltaA=ANGN90;
- }
- }
- #ifdef XDL_PRINT
- if(pR->tJD.con_angle < NUM_ANGLE) rt_printf("jdxx:sw=%d Z_angle=%d\r\n",sw,(deltaA>>16));
- #endif
- #ifdef CN_AREA_GW_SHANXI
- if(deltaA>ANGF30 && deltaA<ANGF150)
- {
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
- ret0=2; //界外
- }
- else
- {
- ret0=1;//界内
- }
- }
- else if(deltaA>ANGN150 && deltaA<ANGN30)
- {
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
- ret0=1;//界内
- }
- else
- {
- ret0=2;//界外
- }
- }
- else
- {
- ret0=0;//干扰
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 零序功率方向不正确,非接地!\r\n",sw);
- #endif
- }
- #elif defined FUN_JDXX_SS_ANGLE
- if(deltaA>ANGF90 && deltaA<ANGF180)
- {
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
-
- if(pR->tJD.dir_cnt)
- {
- pR->tJD.dir_cnt--;
- ret0=1;//界内
- }
- if(pR->tJD.dir_cnt==0)
- {
- ret0=2; //界外
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 零序功率方向抖动,非接地!\r\n",sw);
- #endif
- }
- }
- else
- {
- //pR->tJD.dir_cnt=(pR->tJD.dir_cnt+1)%20;
- if(pR->tJD.dir_cnt<20)
- {
- pR->tJD.dir_cnt++;
- }
-
- if(pR->tJD.dir_cnt)
- {
- ret0=1;//界内
- }
- }
-
- }
- else if(deltaA>ANGN180 && deltaA<ANGN90)
- {
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
- //pR->tJD.dir_cnt=(pR->tJD.dir_cnt+1)%20;
- if(pR->tJD.dir_cnt<20)
- {
- pR->tJD.dir_cnt++;
- }
-
- if(pR->tJD.dir_cnt)
- {
- ret0=1;//界内
- }
-
- }
- else
- {
- if(pR->tJD.dir_cnt)
- {
- pR->tJD.dir_cnt--;
- ret0=1;//界内
- }
- if(pR->tJD.dir_cnt==0)
- {
- ret0=2;//界外
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 零序功率方向抖动,非接地!\r\n",sw);
- #endif
- }
- }
- }
- else
- {
- if(pR->tJD.dir_cnt)
- {
- pR->tJD.dir_cnt--;
- ret0=1;//界内
- }
-
- if(pR->tJD.dir_cnt==0)
- {
- ret0=0;//干扰
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 零序功率方向不正确,非接地!\r\n",sw);
- #endif
- }
- }
- #else
- //计算角度,判相位
- if(pR->tJD.con_angle < NUM_ANGLE)
- {
- pR->tJD.ui_angle[pR->tJD.con_angle++] = deltaA;
- return;
- }
- else
- {
- ret0=jdxx_angle_range(sw);
- }
- #endif
- }
- //U0强制启动
- if(TT_U0jd)
- {
- if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
- {
- ret0=2;
- ret1=0;
- }
- else
- {
- ret0=3;
- ret1=1;
- }
- }
- //故障处理
- if(pR->tJD.tc_result && (ret0==1||ret0==3)&&(ret1==1))
- {
- bQNGZ=1;
- }
- else if((pR->tJD.tc_result==0 && (ret0==2||ret0==3))
- ||(ret1==0))
- {
- bQNGZ=2;
- }
- else
- {
- bQNGZ=0;
- }
-
- //区内
- if(bQNGZ==1)
- {
- #ifdef HJS_XDLJD
- pR->tJD.sta.bFlag.bJd_qn = 1; //区内故障
- #endif
- //告警
- if(b_gj)
- {
- RunTR(&pR->tJD.tJDXXAlarmTime, bQNGZ, dStep);//故障持续时间
- pR->tJD.sta.bFlag.bGj=pR->tJD.tJDXXAlarmTime.boolTrip;
- if(pR->tJD.sta.bFlag.bGj)
- {
- if(soe_check(EV_JDXX_GJ+sw*EV_SW_NUM)==false)
- {
- //断面
- DWORD I0,U0;
- I0 = _Mul_Div_U(sqrt_32fix(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].m2[0]), 256, g_ui[UI_SW_INDEX(sw,SW_AC_I0)].m2_factor_k);
- U0 = _Mul_Div_U(sqrt_32fix(g_ui[u0_index].m2[0]), 256, g_ui[u0_index].m2_factor_k);
-
- pR->tJD.sta.bFlag.bGJLed = true;
- soe_record_ev(EV_JDXX_GJ+sw*EV_SW_NUM,1,I0,U0,0 );
- if(pJdxx->bTT_jdxx_fault_all)
- {
- if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
- {
- soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
- }
- }
- //故障处理完毕,进入复归处理流程
- if(!b_tz)//未投出口
- {
- pR->tJD.tc_result=0;
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_fault:sw=%d step_rst",sw);
- #endif
- }
- }
- }
- }
- //出口
- if(b_tz)
- {
- RunTR( &pR->tJD.tJDXXTripTime, bQNGZ , dStep);//故障持续时间
- pR->tJD.sta.bFlag.bTz=pR->tJD.tJDXXTripTime.boolTrip;
- #ifdef HJS_XDLJD
- if(pR->tJD.sta.bFlag.bHjsTz)
- {
- pR->tJD.sta.bFlag.bTz_prot = pR->tJD.sta.bFlag.bTz;
- }
- else
- {
- pR->tJD.sta.bFlag.bTz_prot = 0;
- }
- #endif
- if(pR->tJD.sta.bFlag.bTz) //出口
- {
- //断面
- DWORD I0,U0;
- I0 = _Mul_Div_U(sqrt_32fix(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].m2[0]), 256, g_ui[UI_SW_INDEX(sw,SW_AC_I0)].m2_factor_k);
- U0 = _Mul_Div_U(sqrt_32fix(g_ui[u0_index].m2[0]), 256, g_ui[u0_index].m2_factor_k);
- pR->tJD.sta.bFlag.bTZLed = true;
- //soe
- #ifdef FUN_JDXX_JXJD
- if(soe_check(EV_JDXX_YJ_TZ+sw*EV_SW_NUM)==false)
- {
- soe_record_ev(EV_JDXX_YJ_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
- #ifndef HJS_XDLJD
- if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false) //区内跳闸
- {
- soe_record_ev( EV_JDXX_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
- }
- #else
- if((soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false)&&(!pR->tJD.sta.bFlag.bHjsTz)) //区内跳闸
- {
- soe_record_ev( EV_JDXX_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
- }
- #endif
-
- if(pJdxx->bTT_jdxx_fault_all)
- {
- if(soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)==false) //保护总
- {
- soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
- }
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n区内永久接地动作");
- #endif
- }
- #else
- if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false)
- {
- soe_record_ev(EV_JDXX_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
- if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
- {
- soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
- }
- #ifdef XDL_PRINT
- rt_printf("\r\n区内接地动作");
- #endif
- }
- #endif
-
- //故障处理完毕,进入复归处理流程
- pR->tJD.tc_result=0;
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef FUN_JDXX_JXJD
- pR->tJD.cnt_sdelay=0;
- pR->tJD.cnt_ldelay=0;
- #endif
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_fault:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
- rt_printf("\r\njdxx_fault:sw=%d step_rst!",sw);
- #endif
- }
- }
- }
- else if(bQNGZ==2)//区外
- {
- if(soe_check(EV_JDXX_JWGZ+sw*EV_SW_NUM)==false) // soe返回
- {
- //断面
- DWORD I0,U0;
- I0 = _Mul_Div_U(sqrt_32fix(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].m2[0]), 256, g_ui[UI_SW_INDEX(sw,SW_AC_I0)].m2_factor_k);
- U0 = _Mul_Div_U(sqrt_32fix(g_ui[u0_index].m2[0]), 256, g_ui[u0_index].m2_factor_k);
- soe_record_ev(EV_JDXX_JWGZ+sw*EV_SW_NUM,1, I0,U0,0 );
- rt_printf("\r\n区外接地");
- }
- //故障处理完毕,进入复归处理流程
- #ifdef HJS_XDLJD
- pR->tJD.sta.bFlag.bJd_qn = 0; //区外故障
- #endif
- pR->tJD.tc_result=0;
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_fault:sw=%d step_rst",sw);
- #endif
- }
- else// if((tJD[sw].tc_result && ret0==2)||(tJD[sw].tc_result==0 && ret0==1))
- {
- //故障处理完毕,进入复归处理流程
- #ifdef HJS_XDLJD
- pR->tJD.sta.bFlag.bJd_qn = 0; //区外故障
- #endif
- pR->tJD.tc_result=0;
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx:sw=%d 暂态与稳态矛盾,非接地!",sw);
- rt_printf("\r\njdxx_fault:sw=%d step_rst",sw);
- #endif
- }
- }
- }
- #define ANGF145 (145*65536) //145度
- #define ANGF95 (95*65536) //95度
- #define ANGN145 ((-145)*65536) //-145度
- #define ANGN95 ((-95)*65536) //-95度
- #ifdef PT_DX_LOCK_XDL
- static bool check_pt_ok(u32 sw)
- {
- TSETSW *pSet = &pRunSet->tSwSet[sw];
- if(((FA_ALL_EN(sw) && (pSet->bTT_fa_ptdx))
- || (BH_ALL_EN(sw) && (pSet->bTT_bh_ptdx)))
- && (soe_check(EV_PT1ERR+sw*EV_SW_NUM) || soe_check(EV_PT2ERR+sw*EV_SW_NUM))
- )
- {
- return false;
- }
-
- return true;
- }
- #endif
- void jdxx_pro(int sw,DWORD dStep) //接地故障判断 5ms中断中处理
- {
- bool bQD1,bQD2,bQD3,bQD4,bQD5;
- int soeno;
- TRELAY_T *pR=&g_tRelay[sw];
- JDXX_SET *pJdxx=&tJDXX_val[sw];
- //if(!pJdxx->bTT_jdxx) return;
- #ifdef DFTU_LINUX_ZXJC
- if(!(pRunSet->tSwSet[sw].bTT_BH && pJdxx->bTT_jdxx)) return; //g_run_stu.bhall &&
- #else
- if(!(FUN_ALL_EN(sw) && pJdxx->bTT_jdxx)) return; //g_run_stu.bhall &&
- #endif
- #ifdef PT_DX_LOCK_XDL
- if(!check_pt_ok(sw))
- {
- return;
- }
- #endif
-
- #ifdef FUN_JDXX_JXJD
- //分位清计次
- if(pR->tSWST.uSWST.bFlag.bTZWZ) //跳位无流
- {
- pR->tJD.cnt_sdelay=0;
- pR->tJD.cnt_ldelay=0;
- }
- #endif
- //定义通道
- if(pRunSet->bTT_U0ZC)
- {
- if(((g_sw_pub.ui_flags & UI_FLAGS_MAKE_U01)==0)&&((g_sw_pub.ui_flags & UI_FLAGS_MAKE_U02)==0))
- return;
- }
- else
- {
- if(g_ui[PUB_AC_U01].chn_index==CFG_ADC_CHANNEL_ZERO && g_ui[PUB_AC_U02].chn_index==CFG_ADC_CHANNEL_ZERO)
- return;
- }
- //选相
- if(pJdxx->bTT_jdxx_cph)
- {
- if((g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index==CFG_ADC_CHANNEL_ZERO)
- ||(g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index==CFG_ADC_CHANNEL_ZERO)
- ||(g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index==CFG_ADC_CHANNEL_ZERO))
- return;
- }
-
- //U0启动录波
- bQD1 = (g_ui[PUB_AC_U01].m2[0] > pJdxx->jd_U0gl);
- bQD2 = (g_ui[PUB_AC_U02].m2[0] > pJdxx->jd_U0gl);
- RunTR( &pR->tJD.tJDXXU01Time, bQD1, dStep);//U0计算时间:20ms
- RunTR( &pR->tJD.tJDXXU02Time, bQD2, dStep);//U0计算时间:20ms
- //相有压有流
- #ifdef CN_AREA_FUJIAN_TEST//福建电压为小信号
- bQD3 = (g_sw_pub.m2_max[3] > pRunSet->dVOL70V_SQR_U2);//(g_ui[PUB_AC_UAB1].chn_index!=CFG_ADC_CHANNEL_ZERO || g_ui[PUB_AC_UBC1].chn_index!=CFG_ADC_CHANNEL_ZERO)
- #else
- bQD3 = (g_sw_pub.m2_max[2] > pRunSet->dVOL70V_SQR);//(g_ui[PUB_AC_UAB1].chn_index!=CFG_ADC_CHANNEL_ZERO || g_ui[PUB_AC_UBC1].chn_index!=CFG_ADC_CHANNEL_ZERO)
- #endif
- bQD4 = (g_sw_pub.m2_max[3] > pRunSet->dVOL70V_SQR);//(g_ui[PUB_AC_UAB2].chn_index!=CFG_ADC_CHANNEL_ZERO || g_ui[PUB_AC_UBC2].chn_index!=CFG_ADC_CHANNEL_ZERO)
- bQD5 = (g_sw[sw].m2_min >pRunSet->dIWL_SQR[sw]);
- RunTR( &pR->tJD.tJDXXU1yyTime, bQD3, dStep);//Ul有压时间时间:60ms
- RunTR( &pR->tJD.tJDXXU2yyTime, bQD4, dStep);//Ul有压时间时间:60ms
- RunTR( &pR->tJD.tJDXXIylTime, bQD5, dStep);//Iph有流时间时间:60ms
- //取通道启动前的采样值,作为零漂值,在故障复归时使用
- //if(!bQD1 && !bQD2)
- //{
- //tJD[sw].dot_save=(g_adc_dots_count)*ADC_REC_SAMPLE_RATE+mod;
- // jdxx_getzeroval(sw);
- //}
-
- //U01故障处理
- soeno = EV_XDL_U0GJ1+sw*EV_SW_NUM;
- if(pR->tJD.tJDXXU01Time.boolTrip)
- {
-
- if(soe_check(soeno)==false)
- {
- DWORD u0;
- pR->tJD.jd_u0_12 = 1;
- u0 = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_U01].m2[0]), 256, g_ui[PUB_AC_U01].m2_factor_k);
- soe_record_ev(soeno, 1, u0,0,0);
- // 置启动标志,记录启动不能放在录波启动成功的条件里,避免启动失败后频繁打印!记录启动时刻.
- if(pRunSet->tSwSet[sw].bTT_Power_v2 == 0)
- {
- jdxx_fg(sw);//零压启动强制复归
- #ifdef JDXX_YXEV_RST
- jdxx_yxev_rst(sw);
- #endif
- pR->tJD.time_qd = ustimer_get_origin();
- rcd_start(sw,RECORD_TYPE_XDLJD,RECORD_LEN_TZQD);
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_u01_time:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
- #endif
- }
- }
- }
- else
- {
- //计算零序功率:扩大10倍,提高计算分辨率
- if(pRunSet->tSwSet[sw].bTT_Power_v2 == 0)
- {
- if(bQD1)
- {
- g_ui_p0[sw].Pea += g_ui_p0[sw].p*10;
- g_ui_p0[sw].Per += g_ui_p0[sw].q*10;
- g_ui_p0[sw].Peas += g_ui_p0[sw].ps*10;
- g_ui_p0[sw].Pers += g_ui_p0[sw].qs*10;
- }
- else
- {
- g_ui_p0[sw].Pea =0;
- g_ui_p0[sw].Per =0;
- g_ui_p0[sw].Peas =0;
- g_ui_p0[sw].Pers =0;
- }
- }
- //soe复归
- if(soe_check(soeno)==true)
- {
- pR->tJD.jd_u0_12 = 0;
- soe_record_ev( soeno, 0, 0,0,0 );
- jdxx_u0_rst(sw);
- }
- }
- //U02
- soeno = EV_XDL_U0GJ2+sw*EV_SW_NUM;
- if(pR->tJD.tJDXXU02Time.boolTrip)
- {
-
- if(soe_check(soeno)==false)
- {
- DWORD u0;
- pR->tJD.jd_u0_12 = 2;
- u0 = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_U02].m2[0]), 256, g_ui[PUB_AC_U02].m2_factor_k);
- soe_record_ev(soeno, 1, u0,0,0);
- // 置启动标志,不能放在录波启动成功的条件里,避免启动失败后频繁打印!记录启动时刻.
- if(pRunSet->tSwSet[sw].bTT_Power_v2)
- {
- jdxx_fg(sw);//零压启动强制复归
- #ifdef JDXX_YXEV_RST
- jdxx_yxev_rst(sw);
- #endif
- pR->tJD.time_qd = ustimer_get_origin();
- rcd_start(sw,RECORD_TYPE_XDLJD,RECORD_LEN_TZQD);
- #ifdef XDL_PRINT
- rt_printf("\r\njdxx_u02_time:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
- #endif
- }
- }
- }
- else
- {
- //计算零序功率:扩大10倍,提高计算分辨率
- if(pRunSet->tSwSet[sw].bTT_Power_v2)
- {
- if(bQD2)
- {
- g_ui_p0[sw].Pea += g_ui_p0[sw].p*10;
- g_ui_p0[sw].Per += g_ui_p0[sw].q*10;
- g_ui_p0[sw].Peas += g_ui_p0[sw].ps*10;
- g_ui_p0[sw].Pers += g_ui_p0[sw].qs*10;
- }
- else
- {
- g_ui_p0[sw].Pea =0;
- g_ui_p0[sw].Per =0;
- g_ui_p0[sw].Peas =0;
- g_ui_p0[sw].Pers =0;
- }
- }
- //soe复归
- if(soe_check(soeno)==true)
- {
- pR->tJD.jd_u0_12 = 0;
- soe_record_ev( soeno, 0, 0,0,0 );
- jdxx_u0_rst(sw);
- }
- }
- //U0达到定值,启动
- if(pR->tJD.tJDXXU01Time.boolTrip||pR->tJD.tJDXXU02Time.boolTrip)
- {
- //正常波形
- if(pR->tJD.jd_step!=JD_STEP_RST)
- {
- //判电压满幅度
- if(TT_U0yx && jdxx_U0_ov(sw))
- {
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 零序电压失真!\r\n",sw);
- #endif
- return;
- }
- //判断线电压无压
- if(TT_Ulyy &&
- ((pR->tJD.tJDXXU1yyTime.boolTrip==false && pR->tJD.tJDXXU01Time.boolTrip) ||(pR->tJD.tJDXXU2yyTime.boolTrip==false && pR->tJD.tJDXXU02Time.boolTrip)))
- {
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 线路无压!\r\n",sw);
- #endif
- return;
- }
- //判断相电流无流
- if(TT_Ipwl && !pR->tJD.tJDXXIylTime.boolTrip)
- {
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 断线无流!\r\n",sw);
- #endif
- return;
- }
- //判断相电流相序
- if(TT_Ipph && pR->tJD.tJDXXIylTime.boolTrip)//有流
- {
- long deltaIAB,deltaIAC;
-
- deltaIAB=CalcAngSub(g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].ri.i);
- deltaIAC=CalcAngSub(g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].ri.i);
- if(deltaIAB<ANGF95||deltaIAB>ANGF145||deltaIAC>ANGN95||deltaIAC<ANGN145)
- {
- pR->tJD.jd_step=JD_STEP_RST;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d : PIab=%d,PIac=%d. 三相乱序! \r\n",sw,deltaIAB>>16,deltaIAC>>16);
- #endif
- return;
- }
- }
- //获得电流启动值
- if(pR->tJD.jd_step!=JD_STEP_SSFAULT)
- {
- g_ui[pJdxx->i0_chan].fz = _AmXY(g_ui[pJdxx->i0_chan].ri.r,g_ui[pJdxx->i0_chan].ri.i);
- pR->tJD.jd_qdval=(g_ui[pJdxx->i0_chan].fz>>2);//1/4
- if(pR->tJD.jd_qdval < pJdxx->jd_qdval)
- {
- pR->tJD.jd_qdval = pJdxx->jd_qdval;
- }
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 零流启动值=%d ,定值=%d!\r\n",sw,pR->tJD.jd_qdval,pJdxx->jd_qdval);
- //rt_printf("jdxx:sw=%d 零序有功=%f ,零序无功=%f;零序s有功=%f ,零序s无功=%f!\r\n",sw,g_ui_p0[sw].Pea,g_ui_p0[sw].Per,g_ui_p0[sw].Peas,g_ui_p0[sw].Pers);
- #endif
- }
- //fault
- #ifdef CN_AREA_GW_SHANXI
- if(pJdxx->bTT_jdxx_p0dir)
- {
- if(pR->tJD.jd_step==JD_STEP_QD)
- {
- if(g_ui[UI_JDXX_I0_INDEX].m2[0]>=pJdxx->jd_zero_N)
- {
- pR->tJD.tc_result=1;
- pR->tJD.jd_step = JD_STEP_SSFAULT;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 功率方向投,进入稳态判据!\r\n",sw);
- #endif
- }
- }
- }
- else
- #endif
- {
- #if 0
- if(pJdxx->jd_type==1)//有功分量法
- {
- jdxx_yg_qd(sw);
- }
- else//首半波
- #endif
- if(TT_U0jd)
- {
- if(pR->tJD.jd_step==JD_STEP_QD)
- {
- pR->tJD.tc_result=1;
- pR->tJD.jd_step = JD_STEP_SSFAULT;
- #ifdef XDL_PRINT
- rt_printf("jdxx:sw=%d 零压启动,进入稳态判据!\r\n",sw);
- #endif
-
- }
- }
- else
- {
- jdxx_qd(sw);
- }
- }
-
- jdxx_fault(sw,dStep);
- }
- }
- else//rst
- {
- jdxx_rst(sw,dStep);
- }
- }
- /////////////////////////////////////////////////////////////////////////
- void _getjdxxdz_inf(void)
- {
- int i,file_length;
- struct file * pfile;
- u8 *filebuf;
- loff_t pos;
-
- // 打开文件
- pfile = rt_file_open("/app/data/pcolcfg.ini",O_RDONLY ,0);
- if(IS_ERR(pfile))
- {
- dp_err_n_c_rt("error! 无法打开 pcolcfg.ini");
- goto jdxx_err;
- }
-
- // 得到文件长度
- file_length = rt_file_getfile_size(pfile);
-
- //file_length = rt_file_getfile_size(pfile);
- if(file_length <= 0)
- {
- rt_file_close(pfile,0);
- goto jdxx_err;
- }
- // 分配内存
- filebuf = rt_malloc(file_length);
- if((filebuf) == NULL)
- {
- rt_file_close(pfile,0);
- goto jdxx_err;
- }
- pos = 0;
- if(rt_file_read(pfile,filebuf,file_length,&pos) != file_length)
- {
- rt_file_close(pfile,0);
- rt_free(filebuf);
- goto jdxx_err;
- }
- //找到\r\n位置,得到一行长度
- for(i = 0; i < file_length; i++)
- {
- if(strncmp(&filebuf[i],"TT_U0yx", 7) == 0)
- {
- TT_U0yx = getstrval(&filebuf[i]);
- }
- else if(strncmp(&filebuf[i],"TT_Ipwl", 7) == 0)
- {
- TT_Ipwl = getstrval(&filebuf[i]);
- }
- else if(strncmp(&filebuf[i],"TT_Ipph", 7) == 0)
- {
- TT_Ipph = getstrval(&filebuf[i]);
- }
- else if(strncmp(&filebuf[i],"TT_Ulyy", 7) == 0)
- {
- TT_Ulyy = getstrval(&filebuf[i]);
- }
- else if(strncmp(&filebuf[i],"TT_U0jd", 7) == 0)
- {
- TT_U0jd = getstrval(&filebuf[i]);
- break;
- }
- }
- if(i >= file_length)
- {
- TT_U0yx = 0;
- TT_Ipwl = 0;
- TT_Ipph = 0;
- TT_Ulyy = 0;
- TT_U0jd = 0;
- }
- #ifdef XDL_PRINT
- rt_printf("TT_U0yx = %d\r\n", TT_U0yx);
- rt_printf("TT_Ipwl = %d\r\n", TT_Ipwl);
- rt_printf("TT_Ipph = %d\r\n", TT_Ipph);
- rt_printf("TT_Ulyy = %d\r\n", TT_Ulyy);
- rt_printf("TT_U0jd = %d\r\n", TT_U0jd);
- #endif
-
- if(TT_U0jd)
- {
- log_str_time(LOG_ERR,"U0接地投入",1,1);
- rt_printf("U0接地投入!\r\n");
- }
-
- rt_file_close(pfile,0); // 关闭文件
- rt_free(filebuf); // 释放内存
- return;
- jdxx_err:
- TT_U0yx = 0;
- TT_Ipwl = 0;
- TT_Ipph = 0;
- TT_Ulyy = 0;
- TT_U0jd = 0;
- #ifdef XDL_PRINT
- rt_printf("ERR!TT_U0yx = %d\r\n", TT_U0yx);
- rt_printf("ERR!TT_Ipwl = %d\r\n", TT_Ipwl);
- rt_printf("ERR!TT_Ipph = %d\r\n", TT_Ipph);
- rt_printf("ERR!TT_Ulyy = %d\r\n", TT_Ulyy);
- rt_printf("ERR!TT_U0jd = %d\r\n", TT_U0jd);
- #endif
- }
- //////////////////////////////////////////////////////////////////////////////
- #endif //FUN_JDXX
- /*------------------------------ 文件结束 -------------------------------------
- */
|