jdxx.c 51 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149
  1. #include "head.h"
  2. enum
  3. {
  4. JD_STEP_QD=0, // 启动判断
  5. JD_STEP_CHECK, //启动确认
  6. JD_STEP_COLLECT, //数据收集
  7. JD_STEP_CTFAULT, //暂态故障判定
  8. JD_STEP_SSFAULT, //稳态故障处理
  9. JD_STEP_RST, //复归
  10. JD_STEP_NET_RST, //等待网络复归
  11. };
  12. enum
  13. {
  14. JD_FAULT_DIR_ZERO=0,
  15. JD_FAULT_DIR_POS_QD, //大于启动值正方向
  16. JD_FAULT_DIR_NEG_QD, //大于启动值反方向
  17. JD_FAULT_DIR_POS, //大于零漂正方向
  18. JD_FAULT_DIR_NEG, //大于零漂反方向
  19. };
  20. #ifdef FUN_JDXX
  21. //#define XDL_PRINT
  22. #define UI_JDXX_I0_INDEX UI_SW_INDEX(sw,SW_AC_I0)
  23. #define UI_JDXX_I0S_INDEX UI_SW_INDEX(sw,SW_AC_I0s)
  24. ///////////////////////////////////////////////
  25. JDXX_SET tJDXX_val[SWITCH_NUM_MAX];
  26. bool TT_U0yx; //U0越限判据投退
  27. bool TT_Ulyy; //Ul线电压有压判据
  28. bool TT_Ipwl; //相电流无流判据投退
  29. bool TT_Ipph; //相电流相位判据
  30. bool TT_U0jd; //UO就接地
  31. extern unsigned int g_count_156us;
  32. ////////////////////////////////////////////////////////////////////////////////////////////////
  33. void jdxx_init(void)
  34. {
  35. //memset(&tJD,0,sizeof(tJD));
  36. _getjdxxdz_inf();
  37. rt_printf("Jdxx_Ver:%02d.%03d \r\n",(FUN_JDXX_VERSION/1000),(FUN_JDXX_VERSION%1000));
  38. }
  39. void jdxx_relayinit(void)
  40. {
  41. int i;
  42. for(i=0;i<SWITCH_NUM_MAX;i++)
  43. {
  44. JDXX_SET *pJdxx=&tJDXX_val[i];
  45. TRELAY_T *pR=&g_tRelay[i];
  46. //U0判出时间
  47. #ifdef FUN_JDXX_JXJD
  48. InitTR_Time(&pR->tJD.tJDXXU01Time,T_20ms, 0); //U01 20ms
  49. InitTR_Time(&pR->tJD.tJDXXU02Time,T_20ms, 0); //U02 20ms
  50. #elif defined FUN_JDXX_TBLQD
  51. InitTR_Time(&pR->tJD.tJDXXU01Time,T_25ms, T_10ms); //U01 40ms
  52. InitTR_Time(&pR->tJD.tJDXXU02Time,T_25ms, T_10ms); //U02 40ms
  53. #else
  54. InitTR_Time(&pR->tJD.tJDXXU01Time,T_20ms, T_20ms); //U01 20ms,保持100ms(弧光接地)
  55. InitTR_Time(&pR->tJD.tJDXXU02Time,T_20ms, T_20ms); //U02 20ms,保持100ms(弧光接地)
  56. #endif
  57. InitTR_Time(&pR->tJD.tJDXXU1yyTime,T_20ms*3,0); //有压60ms
  58. InitTR_Time(&pR->tJD.tJDXXU2yyTime,T_20ms*3,0); //有压60ms
  59. InitTR_Time(&pR->tJD.tJDXXIylTime,T_20ms*3,0); //有流60ms
  60. InitTR_Time(&pR->tJD.tJDXXTripTime, pJdxx->jd_trip_time, T_20ms);
  61. InitTR_Time(&pR->tJD.tJDXXAlarmTime, pJdxx->jd_alarm_time, T_20ms);
  62. #ifdef JDXX_YXEV_RST
  63. InitTR_Time(&pR->tJD.tJDGjEvRstTime, tRunPara.dTEventRst, 0);
  64. InitTR_Time(&pR->tJD.tJDTzEvRstTime, tRunPara.dTEventRst, 0);
  65. #endif
  66. #ifdef HJS_XDLJD
  67. InitTR(&pR->tJD.jdxx_jskf_time,pJdxx->jd_js_time, 0); // 开放时间
  68. #endif
  69. }
  70. }
  71. void jdxx_u0_rst(int sw)
  72. {
  73. TRELAY_T *pR=&g_tRelay[sw];
  74. ResetTR(&pR->tJD.tJDXXU01Time); //U02 20ms
  75. ResetTR(&pR->tJD.tJDXXU02Time); //U02 20ms
  76. ResetTR(&pR->tJD.tJDXXU1yyTime); //
  77. ResetTR(&pR->tJD.tJDXXU2yyTime); //
  78. ResetTR(&pR->tJD.tJDXXIylTime); //
  79. }
  80. void jdxx_qd_rst(int sw) //启动返回
  81. {
  82. int i;
  83. TRELAY_T *pR=&g_tRelay[sw];
  84. pR->tJD.jd_step = JD_STEP_QD;
  85. pR->tJD.sta.bFlag.bTz = false;
  86. pR->tJD.sta.bFlag.bGj = false;
  87. pR->tJD.qdPoints=0;
  88. pR->tJD.adPoints=0;
  89. pR->tJD.con_angle=0;
  90. #ifdef FUN_JDXX_SS_ANGLE
  91. pR->tJD.dir_cnt=0;
  92. #endif
  93. #ifdef HJS_XDLJD
  94. pR->tJD.sta.bFlag.bJd_qn = 0; //区外故障
  95. #endif
  96. for(i=0;i<NUM_ANGLE;i++)
  97. {
  98. pR->tJD.ui_angle[i]=0;
  99. }
  100. ResetTR(&pR->tJD.tJDXXTripTime);
  101. ResetTR(&pR->tJD.tJDXXAlarmTime);
  102. //soe
  103. pro_rst_event(sw,EV_JDXX_QD);
  104. pro_rst_event(sw,EV_JDXX_JWGZ);
  105. #ifdef FUN_JDXX_JXJD
  106. pro_rst_event(sw,EV_JDXX_SWIN_GJ);
  107. pro_rst_event(sw,EV_JDXX_LWIN_GJ);
  108. #endif
  109. }
  110. void jdxx_fg(int sw) //接地选线复归
  111. {
  112. #ifdef XDL_PRINT
  113. rt_printf("\r\njdxx_fg:sw=%d JD_STEP_FG",sw);
  114. #endif
  115. jdxx_qd_rst(sw);
  116. }
  117. //soe fugui
  118. void jdxx_soe_fg(int sw,DWORD dStep)
  119. {
  120. #ifdef JDXX_YXEV_RST
  121. {
  122. TRELAY_T *pR=&g_tRelay[sw];
  123. RunTR( &pR->tJD.tJDGjEvRstTime, true, dStep);
  124. RunTR( &pR->tJD.tJDTzEvRstTime, true, dStep);
  125. if(pR->tJD.tJDGjEvRstTime.boolTrip)
  126. {
  127. pro_rst_event(sw,EV_JDXX_GJ);
  128. //事故总 主程序复归
  129. //if(pJdxx->bTT_jdxx_fault_all)
  130. //{
  131. // pro_rst_event(sw,EV_ALL_FAULT);
  132. //}
  133. }
  134. if(pR->tJD.tJDTzEvRstTime.boolTrip)
  135. {
  136. pro_rst_event(sw,EV_JDXX_TZ);
  137. //事故总 主程序复归
  138. //if(pJdxx->bTT_jdxx_fault_all)
  139. //{
  140. // pro_rst_event(sw,EV_ALL_FAULT);
  141. //}
  142. #ifdef FUN_JDXX_JXJD
  143. pro_rst_event(sw,EV_JDXX_SWIN_TZ);
  144. pro_rst_event(sw,EV_JDXX_LWIN_TZ);
  145. pro_rst_event(sw,EV_JDXX_YJ_TZ);
  146. #endif
  147. }
  148. }
  149. #else
  150. {
  151. pro_rst_event(sw,EV_JDXX_GJ);
  152. pro_rst_event(sw,EV_JDXX_TZ);
  153. //事故总 主程序复归
  154. //if(pJdxx->bTT_jdxx_fault_all)
  155. //{
  156. // pro_rst_event(sw,EV_ALL_FAULT);
  157. //}
  158. #ifdef FUN_JDXX_JXJD
  159. pro_rst_event(sw,EV_JDXX_SWIN_TZ);
  160. pro_rst_event(sw,EV_JDXX_LWIN_TZ);
  161. pro_rst_event(sw,EV_JDXX_YJ_TZ);
  162. #endif
  163. }
  164. #endif
  165. }
  166. void jdxx_yxev_rst(int sw)
  167. {
  168. #ifdef JDXX_YXEV_RST
  169. TRELAY_T *pR=&g_tRelay[sw];
  170. ResetTR(&pR->tJD.tJDGjEvRstTime);
  171. ResetTR(&pR->tJD.tJDTzEvRstTime);
  172. #endif
  173. pro_rst_event(sw,EV_JDXX_GJ);
  174. pro_rst_event(sw,EV_JDXX_TZ);
  175. #ifdef FUN_JDXX_JXJD
  176. pro_rst_event(sw,EV_JDXX_SWIN_TZ);
  177. pro_rst_event(sw,EV_JDXX_LWIN_TZ);
  178. pro_rst_event(sw,EV_JDXX_YJ_TZ);
  179. #endif
  180. }
  181. /**********************************
  182. //启动前零序通道零漂模值
  183. **********************************/
  184. void jdxx_getzeroval(int sw)
  185. {
  186. JDXX_SET *pJdxx=&tJDXX_val[sw];
  187. TRELAY_T *pR=&g_tRelay[sw];
  188. if(pR->tJD.jd_step==JD_STEP_QD) //复归判断
  189. {
  190. pR->tJD.zeroval=g_ui[pJdxx->i0_chan].m2[0]+pJdxx->jd_qdval2;
  191. }
  192. }
  193. /**********************************
  194. //突变量
  195. //index:电流通道
  196. //cur:通道采样索要
  197. **********************************/
  198. s32 jdxx_get_qdval(u32 cur,int index)//突变量
  199. {
  200. s32 v,v1,v2,val;
  201. v = g_adc_dots_rec[cur][index];
  202. v1 = g_adc_dots_rec[(cur - ADC_REC_SAMPLE) & ADC_REC_DOTS_MASK][index];
  203. v2 = g_adc_dots_rec[(cur - ADC_REC_SAMPLE*2) & ADC_REC_DOTS_MASK][index];
  204. val = (v -2*v1 + v2);
  205. return val;
  206. }
  207. s32 jdxx_getI0_qdval(u32 cur,int index1,int index2,int index3)//突变量
  208. {
  209. s32 val=0;
  210. val = jdxx_get_qdval(cur,index1)
  211. +jdxx_get_qdval(cur,index2)
  212. +jdxx_get_qdval(cur,index3);
  213. return val;
  214. }
  215. ////////////////////////////////////////////////
  216. //复归信号保持
  217. bool jdxx_soe_check(int sw)
  218. {
  219. if(soe_check(EV_JDXX_GJ+sw*EV_SW_NUM)) return true;
  220. if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)) return true;
  221. //if(soe_check(EV_JDXX_JWGZ+sw*EV_SW_NUM)) return true;
  222. #ifdef FUN_JDXX_JXJD
  223. if(soe_check(EV_JDXX_SWIN_TZ+sw*EV_SW_NUM)) return true;
  224. if(soe_check(EV_JDXX_LWIN_TZ+sw*EV_SW_NUM)) return true;
  225. if(soe_check(EV_JDXX_YJ_TZ+sw*EV_SW_NUM)) return true;
  226. #endif
  227. return false;
  228. }
  229. #ifdef FUN_JDXX_JXJD
  230. //瞬时故障延时跳闸逻辑
  231. bool jdxx_ssjd_pro(int sw)
  232. {
  233. int i,num;
  234. bool bQDD;
  235. JDXX_SET *pJdxx=&tJDXX_val[sw];
  236. TRELAY_T *pR=&g_tRelay[sw];
  237. //短延时接地故障
  238. if(pJdxx->bTT_jxjd_stz)
  239. {
  240. //I瞬时接地计次
  241. pR->tJD.cnt_sdelay++;
  242. if(pR->tJD.cnt_sdelay>pJdxx->jd_sdelay_cnt)
  243. {
  244. pR->tJD.cnt_sdelay=pJdxx->jd_sdelay_cnt;
  245. }
  246. #ifdef XDL_PRINT
  247. rt_printf("\r\nSW%d:间歇性接地保护I段计次!sdn=%d!",sw,pR->tJD.cnt_sdelay);
  248. #endif
  249. //jxjd_logic
  250. 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)));//短延时故障
  251. if(bQDD)
  252. {
  253. //led
  254. pR->tJD.sta.bFlag.bTz = true;
  255. pR->tJD.sta.bFlag.bTZLed = true;
  256. //soe
  257. if(soe_check(EV_JDXX_SWIN_TZ+sw*EV_SW_NUM)==false)
  258. {
  259. soe_record_ev(EV_JDXX_SWIN_TZ+sw*EV_SW_NUM,1, 0,0,0 );
  260. if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false) //区内故障
  261. {
  262. soe_record_ev(EV_JDXX_TZ+sw*EV_SW_NUM,1, 0,0,0 );
  263. }
  264. //事故总
  265. if(pJdxx->bTT_jdxx_fault_all)
  266. {
  267. if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
  268. {
  269. soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
  270. }
  271. }
  272. #ifdef XDL_PRINT
  273. rt_printf("\r\n间歇性接地保护I段动作");
  274. #endif
  275. //故障处理完毕,进入复归处理流程
  276. pR->tJD.jd_step=JD_STEP_RST;
  277. pR->tJD.cnt_sdelay=0;
  278. pR->tJD.cnt_ldelay=0;//???
  279. #ifdef XDL_PRINT
  280. rt_printf("\r\njdxx_s_fault:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
  281. rt_printf("\r\njdxx_s_fault:sw=%d step_rst",sw);
  282. #endif
  283. }
  284. return true;
  285. }
  286. else//存储故障时刻
  287. {
  288. //SOE
  289. if(soe_check(EV_JDXX_SWIN_GJ+sw*EV_SW_NUM)==false)
  290. {
  291. soe_record_ev(EV_JDXX_SWIN_GJ+sw*EV_SW_NUM,1, 0,0,0 );
  292. }
  293. //us0 fifo
  294. num = pJdxx->jd_sdelay_cnt-1;
  295. for(i=0;i<num;i++)
  296. {
  297. pR->tJD.jdxx_sdelay_us0[num-i]=pR->tJD.jdxx_sdelay_us0[num-1-i];
  298. }
  299. pR->tJD.jdxx_sdelay_us0[0] = pR->tJD.time_qd;//ustimer_get_origin();
  300. #ifdef XDL_PRINT
  301. rt_printf("\r\njdxx_s_fault:T[0]=%d!",pR->tJD.jdxx_sdelay_us0[0]/USTIMER_SEC);
  302. #endif
  303. }
  304. }
  305. //长延时接地故障
  306. if(pJdxx->bTT_jxjd_ltz)
  307. {
  308. //II瞬时接地计次
  309. pR->tJD.cnt_ldelay++;
  310. if(pR->tJD.cnt_ldelay>pJdxx->jd_ldelay_cnt)
  311. {
  312. pR->tJD.cnt_ldelay=pJdxx->jd_ldelay_cnt;
  313. }
  314. #ifdef XDL_PRINT
  315. rt_printf("\r\nSW%d间歇性接地保护II段计次!ldn=%d!",sw,pR->tJD.cnt_ldelay);
  316. #endif
  317. //jxjd_logic
  318. 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)));//长延时故障
  319. if(bQDD)
  320. {
  321. //led
  322. pR->tJD.sta.bFlag.bTz = true;
  323. pR->tJD.sta.bFlag.bTZLed = true;
  324. //soe
  325. if(soe_check(EV_JDXX_LWIN_TZ+sw*EV_SW_NUM)==false)
  326. {
  327. soe_record_ev(EV_JDXX_LWIN_TZ+sw*EV_SW_NUM,1, 0,0,0 );
  328. if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false) //区内故障
  329. {
  330. soe_record_ev(EV_JDXX_TZ+sw*EV_SW_NUM,1, 0,0,0 );
  331. }
  332. //事故总
  333. if(pJdxx->bTT_jdxx_fault_all)
  334. {
  335. if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
  336. {
  337. soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
  338. }
  339. }
  340. #ifdef XDL_PRINT
  341. rt_printf("\r\n间歇性接地保护II段动作");
  342. #endif
  343. //故障处理完毕,进入复归处理流程
  344. pR->tJD.jd_step=JD_STEP_RST;
  345. pR->tJD.cnt_sdelay=0;//???
  346. pR->tJD.cnt_ldelay=0;
  347. #ifdef XDL_PRINT
  348. rt_printf("\r\njdxx_l_fault:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
  349. rt_printf("\r\njdxx_l_fault:sw=%d step_rst",sw);
  350. #endif
  351. }
  352. return true;
  353. }
  354. else//存储故障时刻
  355. {
  356. //SOE
  357. if(soe_check(EV_JDXX_LWIN_GJ+sw*EV_SW_NUM)==false)
  358. {
  359. soe_record_ev(EV_JDXX_LWIN_GJ+sw*EV_SW_NUM,1, 0,0,0 );
  360. }
  361. //us0 fifo
  362. num = pJdxx->jd_ldelay_cnt-1;
  363. for(i=0;i<num;i++)
  364. {
  365. pR->tJD.jdxx_ldelay_us0[num-i]=pR->tJD.jdxx_ldelay_us0[num-1-i];
  366. }
  367. pR->tJD.jdxx_ldelay_us0[0] = pR->tJD.time_qd;//ustimer_get_origin();
  368. #ifdef XDL_PRINT
  369. rt_printf("\r\njdxx_l_fault:T[0]=%d!",pR->tJD.jdxx_ldelay_us0[0]/USTIMER_SEC);
  370. #endif
  371. }
  372. }
  373. return false;
  374. }
  375. #endif
  376. //复归
  377. void jdxx_rst(int sw, DWORD dStep)
  378. {
  379. TRELAY_T *pR=&g_tRelay[sw];
  380. //状态
  381. if(pR->tJD.jd_step==JD_STEP_QD)
  382. {
  383. jdxx_soe_fg(sw,dStep);
  384. return;
  385. }
  386. //复归
  387. if(pR->tJD.jd_step==JD_STEP_RST)
  388. {
  389. jdxx_fg(sw);
  390. }
  391. else//pR->tJD.jd_step==JD_STEP_RST
  392. {
  393. #ifdef FUN_JDXX_JXJD
  394. bool ret;
  395. ret=jdxx_ssjd_pro(sw); //多次瞬时故障跳闸
  396. if(!ret)
  397. #endif
  398. {
  399. jdxx_fg(sw);
  400. }
  401. }
  402. }
  403. s16 jdxx_get_adval(u32 dots,int index)
  404. {
  405. u32 cur=dots&ADC_REC_DOTS_MASK;
  406. s16 v;
  407. v = g_adc_dots_rec[cur][index];
  408. return v;
  409. }
  410. s16 jdxx_getI0_adval(u32 dots,int index1,int index2,int index3)
  411. {
  412. u32 cur=dots&ADC_REC_DOTS_MASK;
  413. s16 v;
  414. v = g_adc_dots_rec[cur][index1]
  415. +g_adc_dots_rec[cur][index2]
  416. +g_adc_dots_rec[cur][index3];
  417. return v;
  418. }
  419. /*bool jdxx_I0_ov(int sw) //判断零序是否失真
  420. {
  421. int i;
  422. JDXX_SET *pJdxx=&pRunSet->tSwSet[sw].tJDXX;
  423. for(i=0;i<pJdxx->jd_faultPoints;i++) // 统计接地时刻的波形,是否满偏失真 ,大于8A,即使用大量程零序波形判断
  424. {
  425. s16 v;
  426. 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);
  427. if(_AbsL(v)>=pJdxx->jd_ov_val)
  428. {
  429. return true;
  430. }
  431. }
  432. return false;
  433. }*/
  434. #define U0_FULL_DOTNUM 10
  435. bool jdxx_U0_ov(int sw) //判断一周波零序电压是否失真
  436. {
  437. int i,j,mod,index;
  438. u32 dotcur;
  439. TRELAY_T *pR=&g_tRelay[sw];
  440. if(pR->tJD.jd_u0_12==1) index=PUB_AC_U01;
  441. else index=PUB_AC_U02;
  442. mod = (int)(g_count_156us &0x03);
  443. dotcur=(g_adc_dots_count)*ADC_REC_SAMPLE_RATE+mod-ADC_REC_SAMPLE;
  444. for(i=0,j=0;i<ADC_REC_SAMPLE;i++) //ADC_REC_SAMPLE 统计接地时刻的波形,是否满偏失真 ,大于8A,即使用大量程零序波形判断
  445. {
  446. s16 v;
  447. v=jdxx_get_adval(dotcur+i,g_ui[index].chn_index);
  448. pR->tJD.jd_U0ov_val=(short)(7.2*g_ui[index].m2_factor_k/256.0+0.5); //EVT零序 7.8125V满偏,7.2V作为满偏定值
  449. if(_AbsL(v)>=pR->tJD.jd_U0ov_val)
  450. {
  451. if(++j>U0_FULL_DOTNUM)
  452. {
  453. return true;
  454. }
  455. }
  456. }
  457. return false;
  458. }
  459. bool jdxx_I0_ov(int sw) //判断零序是否失真
  460. {
  461. int i;
  462. JDXX_SET *pJdxx=&tJDXX_val[sw];
  463. TRELAY_T *pR=&g_tRelay[sw];
  464. if(g_ui[UI_JDXX_I0S_INDEX].chn_index==CFG_ADC_CHANNEL_ZERO)
  465. {
  466. return false;
  467. }
  468. for(i=0;i<pJdxx->jd_faultPoints;i++) // 统计接地时刻的波形,是否满偏失真 ,大于0.5A,即使用大量程零序波形判断
  469. {
  470. s16 v;
  471. v=jdxx_get_adval(pR->tJD.dot_qd+i,g_ui[UI_JDXX_I0_INDEX].chn_index);
  472. if(_AbsL(v)>=pJdxx->jd_ov_val)
  473. {
  474. rt_printf("jdxx:sw=%d 零序小通道电流满偏失真!\r\n",sw);
  475. return true;
  476. }
  477. }
  478. return false;
  479. }
  480. int jdxx_I0Range(int sw) //
  481. {
  482. int i;
  483. int bv0=0,bv1=0;
  484. int dots=0;
  485. JDXX_SET *pJdxx=&tJDXX_val[sw];
  486. TRELAY_T *pR=&g_tRelay[sw];
  487. for(i=0;i<pJdxx->jd_faultPoints-1;i++) // 取方向
  488. {
  489. if(pJdxx->bTT_jdxx_cph)//(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index==CFG_ADC_CHANNEL_ZERO)
  490. {
  491. 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)
  492. {
  493. bv0=1;
  494. break;
  495. }
  496. 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)
  497. {
  498. bv0=-1;
  499. break;
  500. }
  501. }
  502. else
  503. {
  504. if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
  505. {
  506. 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)
  507. {
  508. bv0=1;
  509. break;
  510. }
  511. 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)
  512. {
  513. bv0=-1;
  514. break;
  515. }
  516. }
  517. else
  518. {
  519. if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) > 0)//pJdxx->jd_zero)
  520. {
  521. bv0=1;
  522. break;
  523. }
  524. else if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) < 0)//-pJdxx->jd_zero)
  525. {
  526. bv0=-1;
  527. break;
  528. }
  529. }
  530. }
  531. }
  532. for(i++;i<pJdxx->jd_faultPoints;i++) // 取方向
  533. {
  534. if(pJdxx->bTT_jdxx_cph)//(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index==CFG_ADC_CHANNEL_ZERO)
  535. {
  536. 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)
  537. {
  538. bv1=1;
  539. }
  540. 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)
  541. {
  542. bv1=-1;
  543. }
  544. }
  545. else
  546. {
  547. if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
  548. {
  549. 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)
  550. {
  551. bv1=1;
  552. }
  553. 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)
  554. {
  555. bv1=-1;
  556. }
  557. }
  558. else
  559. {
  560. if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) > 0)//pJdxx->jd_zero)
  561. {
  562. bv1=1;
  563. }
  564. else if(jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index) < 0)//-pJdxx->jd_zero)
  565. {
  566. bv1=-1;
  567. }
  568. }
  569. }
  570. dots=i+1;
  571. if(bv0!=bv1)break;
  572. }
  573. #ifdef XDL_PRINT
  574. rt_printf("\r\n sw=%d 启动后同方向点数%d",sw,dots);
  575. #endif
  576. return dots;
  577. }
  578. int jdxx_Iabc_check_dir(int sw) // Ia Ib Ic 接地相判断,以零序启动时刻为主,查找零序启动后32点内的最大值,做积分,看三相的方向
  579. {
  580. int dots;
  581. long va,vb,vc,v1,v2,v3;
  582. int i;
  583. TRELAY_T *pR=&g_tRelay[sw];
  584. dots=jdxx_I0Range(sw);
  585. va=0;
  586. vb=0;
  587. vc=0;
  588. for(i=0;i<dots;i++) //
  589. {
  590. va+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index);
  591. vb+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index);
  592. vc+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index);
  593. }
  594. #ifdef XDL_PRINT
  595. rt_printf("\r\n三相积分值Ia=%d Ib=%d Ic=%d",va,vb,vc);
  596. #endif
  597. //一相和另外两相反相
  598. if((va>0&&vb<=0&&vc<=0)||(va<0&&vb>=0&&vc>=0)) //不同相
  599. {
  600. return SW_AC_IA; // A相接地
  601. }
  602. else if((vb>0&&va<=0&&vc<=0)||(vb<0&&va>=0&&vc>=0))
  603. {
  604. return SW_AC_IB; // B相接地
  605. }
  606. else if((vc>0&&va<=0&&vb<=0)||(vc<0&&va>=0&&vb>=0))
  607. {
  608. return SW_AC_IC; // C相接地
  609. }
  610. //突变:4倍
  611. v1=_AbsL(va);
  612. v2=_AbsL(vb);
  613. v3=_AbsL(vc);
  614. if((v1>>2)>v2 && (v1>>2)>v3)
  615. {
  616. return SW_AC_IA; // A相接地
  617. }
  618. else if((v2>>2)>v1 && (v2>>2)>v3)
  619. {
  620. return SW_AC_IB; // A相接地
  621. }
  622. else if((v3>>2)>v1 && (v3>>2)>v2)
  623. {
  624. return SW_AC_IC; // A相接地
  625. }
  626. //无法判相
  627. return -1;
  628. }
  629. // 电压波形起始点
  630. int jdxx_get_dotsoff(int sw,int pha)
  631. {
  632. int vdots=0,dotsoff=0;
  633. JDXX_SET *pJdxx=&tJDXX_val[sw];
  634. TRELAY_T *pR=&g_tRelay[sw];
  635. if((pJdxx->jd_voltype==PUB_AC_U01)||(pJdxx->jd_voltype==PUB_AC_U02))
  636. {
  637. vdots=pR->tJD.dot_qd;
  638. }
  639. else if(pJdxx->jd_voltype==PUB_AC_UA1)
  640. {
  641. if(pha==SW_AC_IA) // A相接地,与UA1比较,波形不需偏移
  642. {
  643. dotsoff=0;
  644. }
  645. else if(pha==SW_AC_IB) // B相接地,与UA1比较,参考电压波形需后移120度,即128/3=42.66
  646. {
  647. dotsoff=-43;
  648. }
  649. else
  650. {
  651. dotsoff=43; // C相接地,参考电压UA1波形需前移120度
  652. }
  653. vdots=pR->tJD.dot_qd+dotsoff-ADC_REC_SAMPLE*2; // 电压波形起始点
  654. }
  655. else if(pJdxx->jd_voltype==PUB_AC_UAB1)
  656. {
  657. if(pha==SW_AC_IA) // A相接地,与UAB1比较,UAB1波形超前Ia30度,30/360*128=10.666(11点)
  658. {
  659. dotsoff=11;
  660. }
  661. else if(pha==SW_AC_IB) // B相接地,与UAB1比较,参考电压波形需后移120度,即128/3=42.66+10.66
  662. {
  663. dotsoff=-53;
  664. }
  665. else
  666. {
  667. dotsoff=53; // C相接地,参考电压UA1波形需前移120度
  668. }
  669. vdots=pR->tJD.dot_qd+dotsoff-ADC_REC_SAMPLE*2; // 电压波形起始点
  670. }
  671. return vdots;
  672. }
  673. int jdxx_VI0_dir(int sw,int pha)
  674. {
  675. int i,dotsnum,vdots;
  676. s32 v0,I0;
  677. JDXX_SET *pJdxx=&tJDXX_val[sw];
  678. TRELAY_T *pR=&g_tRelay[sw];
  679. if(pha<0)return 0;
  680. vdots=jdxx_get_dotsoff(sw,pha);
  681. dotsnum=jdxx_I0Range(sw); // 零序电流统计点数
  682. if(dotsnum==0) return 0;
  683. //积分
  684. v0=0;
  685. I0=0;
  686. for(i=0;i<dotsnum;i++) //
  687. {
  688. if(pRunSet->bTT_U0ZC) //U0
  689. {
  690. if(pR->tJD.jd_u0_12==1)
  691. {
  692. 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);
  693. }
  694. else
  695. {
  696. 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);
  697. }
  698. }
  699. else
  700. {
  701. if(pR->tJD.jd_u0_12==1)
  702. {
  703. v0+=jdxx_get_qdval(vdots+i,g_ui[PUB_AC_U01].chn_index);
  704. }
  705. else
  706. {
  707. v0+=jdxx_get_qdval(vdots+i,g_ui[PUB_AC_U02].chn_index);
  708. }
  709. }
  710. if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO) //I0
  711. {
  712. 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);
  713. }
  714. else
  715. {
  716. I0+=jdxx_get_qdval(pR->tJD.dot_qd+i,g_ui[pJdxx->i0_chan].chn_index);
  717. }
  718. }
  719. #ifdef XDL_PRINT
  720. rt_printf("\r\nV_I0积分:V=%d I0=%d",v0,I0);
  721. #endif
  722. //V0是否突变
  723. //if(_AbsL(v0)<=(DWORD)pJdxx->jd_volzero*dotsnum) return 0; //电压突变太小
  724. //区内区外判断
  725. if((v0>0&&I0>0)||(v0<0&&I0<0)) return 1;
  726. else return -1;
  727. }
  728. // 判界内界外,零序电流和参考电压比波形的相似度 chnl 为相别
  729. //返回:ret=-1 无法判出相、区内区外
  730. // ret=0 正确判出
  731. int jdxx_checkjd(int sw)
  732. {
  733. int pha0,ret0;
  734. JDXX_SET *pJdxx=&tJDXX_val[sw];
  735. TRELAY_T *pR=&g_tRelay[sw];
  736. if(pJdxx->bTT_jdxx_cph)
  737. {
  738. pha0=jdxx_Iabc_check_dir(sw); // 通过三相电流方向判断接地相
  739. ret0=jdxx_VI0_dir(sw,pha0); // U 和I0的积分:同向为1,已向为 1
  740. if(ret0==0)
  741. {
  742. #ifdef XDL_PRINT
  743. if(pha0<0)
  744. {
  745. rt_printf("\r\n判相失败!pha=%d",pha0);
  746. }
  747. else
  748. {
  749. rt_printf("\r\n区内区外判别失败!电压零流方向=%d(1:界内,-1:界外)",ret0);
  750. }
  751. #endif
  752. return -1;
  753. }
  754. #ifdef XDL_PRINT
  755. rt_printf("\r\n暂态接地判据:sw=%d 电压零流方向=%d(1:界内,-1:界外) pha=%d",sw,ret0,pha0);
  756. #endif
  757. //rcd_start(sw,RECORD_TYPE_LXGL, RECORD_LEN_TZQD); //录波类型:跳闸类
  758. //判断界内
  759. if(((pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0<0)||
  760. (!(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0>0))
  761. {
  762. pR->tJD.tc_result=1;
  763. }
  764. else
  765. {
  766. pR->tJD.tc_result=0;
  767. }
  768. }
  769. else//U0参与逻辑
  770. {
  771. pha0=4;//不判相
  772. ret0=jdxx_VI0_dir(sw,pha0); // U 和I0的积分,同向为1 ,反向为-1
  773. if(ret0==0)
  774. {
  775. #ifdef XDL_PRINT
  776. rt_printf("\r\n区内区外判别失败!电压零流方向=%d(1:界内,-1:界外)",ret0);
  777. #endif
  778. return -1;
  779. }
  780. #ifdef XDL_PRINT
  781. rt_printf("\r\n暂态接地判据:sw=%d 电压零流方向=%d(1:界内,-1:界外)",sw,-ret0);//U0/I0反相为界内,同向为界外
  782. #endif
  783. //rcd_start(sw,RECORD_TYPE_LXGL, RECORD_LEN_TZQD); //录波类型:跳闸类
  784. //判断界内
  785. #if defined FUN_JDXX_JXJD || defined DTU_HUNAN
  786. if(((pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0>0)|| //极性
  787. (!(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0<0))
  788. #else
  789. if((((pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0>0)|| //极性
  790. (!(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw)) && ret0<0))
  791. &&(g_ui[pJdxx->i0_chan].m2[0] >= pJdxx->jd_qdval2)) //I0幅值
  792. #endif
  793. {
  794. pR->tJD.tc_result=1;
  795. }
  796. else
  797. {
  798. pR->tJD.tc_result=0;
  799. }
  800. #ifdef XDL_PRINT
  801. rt_printf("\r\n首端算法结论:sw=%d result=%d(1:界内,-1:界外)",sw,pR->tJD.tc_result);
  802. #endif
  803. }
  804. return 0;
  805. }
  806. /**********************************
  807. //接地选线启动逻辑
  808. **********************************/
  809. //有功分量判据
  810. void jdxx_yg_qd(int sw)
  811. {
  812. int ret0;
  813. float pea,th_pea;
  814. TRELAY_T *pR=&g_tRelay[sw];
  815. JDXX_SET *pJdxx=&tJDXX_val[sw];
  816. //判区内区外
  817. if(pR->tJD.jd_step==JD_STEP_QD)
  818. {
  819. //有功分量选择
  820. if(g_ui[UI_JDXX_I0S_INDEX].chn_index!=CFG_ADC_CHANNEL_ZERO) pea = g_ui_p0[sw].Peas;
  821. else pea = g_ui_p0[sw].Pea;
  822. //有功门槛值,约15K
  823. 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)
  824. else th_pea=0.30; //100/6.5*0.02=0.30
  825. //有功分量判区内区外
  826. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  827. {
  828. if((pea-th_pea)>0) ret0=-1;//0.30--100V;0.02--6.5V
  829. else ret0=1;
  830. }
  831. else
  832. {
  833. if((pea+th_pea)<0) ret0=-1;
  834. else ret0=1;
  835. }
  836. #ifdef XDL_PRINT
  837. rt_printf("\r\n暂态接地判据:sw=%d 电压零流方向=%d(1:界内,-1:界外)",sw,-ret0);//U0/I0反相为界内,同向为界外
  838. #endif
  839. //rcd_start(sw,RECORD_TYPE_LXGL, RECORD_LEN_TZQD); //录波类型:跳闸类
  840. //判断界内
  841. if( ret0<0)
  842. {
  843. pR->tJD.tc_result=1;
  844. }
  845. else
  846. {
  847. pR->tJD.tc_result=0;
  848. }
  849. pR->tJD.jd_step = JD_STEP_SSFAULT;
  850. }
  851. }
  852. //首半波判据
  853. #define NUM_QDFX (ADC_REC_SAMPLE<<2) //四个周波
  854. void jdxx_qd(int sw)
  855. {
  856. s32 qdval;
  857. int mod,dir;
  858. u32 dotcnt,dotend,dotcur;//,dotnum;
  859. JDXX_SET *pJdxx=&tJDXX_val[sw];
  860. TRELAY_T *pR=&g_tRelay[sw];
  861. mod = (int)(g_count_156us &0x03);
  862. dotend=(g_adc_dots_count)*ADC_REC_SAMPLE_RATE+mod;
  863. if(pR->tJD.jd_step==JD_STEP_RST||pR->tJD.jd_step==JD_STEP_SSFAULT) return;
  864. //tbl
  865. dotcur=dotend -NUM_QDFX;
  866. dir=0;
  867. for(dotcnt=0;dotcnt<NUM_QDFX;dotcnt++) //U0已持续四个周波 ADC_REC_SAMPLE*3
  868. {
  869. u32 cur;
  870. cur = dotcur & ADC_REC_DOTS_MASK; //当前采样点
  871. dotcur++;
  872. //启动判断
  873. if(pR->tJD.jd_step==JD_STEP_QD)
  874. {
  875. if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
  876. {
  877. 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);
  878. }
  879. else
  880. {
  881. qdval=jdxx_get_qdval(cur,g_ui[pJdxx->i0_chan].chn_index);
  882. }
  883. if(_AbsL(qdval) > pR->tJD.jd_qdval) //大于启动值
  884. {
  885. pR->tJD.jd_step=JD_STEP_CHECK;
  886. pR->tJD.qdPoints=0;
  887. pR->tJD.dot_qd=cur; //保存当前启动点的采样序号
  888. if(qdval>0)
  889. {
  890. dir=1;
  891. }
  892. else if(qdval<0)
  893. {
  894. dir=-1;
  895. }
  896. #ifdef XDL_PRINT
  897. rt_printf_time("jdxx:JD_STEP_CHECK sw=%d dot=%d qdval=%d set=%d\r\n",sw,cur,qdval,pR->tJD.jd_qdval);
  898. #endif
  899. }
  900. }
  901. else if(pR->tJD.jd_step==JD_STEP_CHECK) //收集数据
  902. {
  903. if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
  904. {
  905. 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);
  906. }
  907. else
  908. {
  909. qdval=jdxx_get_qdval(cur,g_ui[pJdxx->i0_chan].chn_index);
  910. }
  911. if((qdval*dir<0)//反相
  912. ||(_AbsL(qdval) < pR->tJD.jd_qdval)) //小于启动值
  913. {
  914. #ifdef XDL_PRINT
  915. if(qdval*dir<0)
  916. {
  917. rt_printf("jdxx:sw=%d dot=%d;启动后干扰\r\n",sw,cur);
  918. }
  919. else
  920. {
  921. rt_printf("jdxx:sw=%d dot=%d;启动后有值小于启动值\r\n",sw,cur);
  922. }
  923. #endif
  924. pR->tJD.jd_step=JD_STEP_QD;
  925. continue;
  926. }
  927. pR->tJD.qdPoints++;
  928. if(pR->tJD.qdPoints>=pJdxx->jd_qdPoints) // 大于启动个数,进入数据收集阶段,可启动录波
  929. {
  930. pR->tJD.jd_step=JD_STEP_COLLECT;
  931. pR->tJD.adPoints=0;
  932. #ifdef XDL_PRINT
  933. rt_printf("jdxx:sw=%d dot=%d;JD_STEP_COLLECT\r\n",sw,cur);
  934. #endif
  935. }
  936. }
  937. else if(pR->tJD.jd_step==JD_STEP_COLLECT) //收集数据
  938. {
  939. pR->tJD.adPoints++;
  940. if(pR->tJD.adPoints>=pJdxx->jd_faultPoints)
  941. {
  942. pR->tJD.jd_step=JD_STEP_CTFAULT;
  943. #ifdef XDL_PRINT
  944. rt_printf("jdxx:sw=%d JD_STEP_CTFAULT! dcnt=%d\r\n",sw,dotcnt);
  945. #endif
  946. }
  947. }
  948. else if(pR->tJD.jd_step==JD_STEP_CTFAULT) //暂态特征判断
  949. {
  950. int i,ret;
  951. bool bFault=false;
  952. s32 val=0;
  953. int ovQDpoints=0;
  954. if(!bFault) //故障未确认
  955. {
  956. for(i=pJdxx->jd_qdPoints;i<pJdxx->jd_faultPoints+pJdxx->jd_qdPoints;i++)
  957. {
  958. u32 cur=(pR->tJD.dot_qd+i)&ADC_REC_DOTS_MASK;
  959. if(g_ui[pJdxx->i0_chan].chn_index==CFG_ADC_CHANNEL_ZERO)
  960. {
  961. 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));
  962. }
  963. else
  964. {
  965. val=_AbsL(jdxx_get_qdval(cur,g_ui[pJdxx->i0_chan].chn_index));
  966. }
  967. if(val > pR->tJD.jd_qdval)
  968. {
  969. ovQDpoints++;
  970. }
  971. if(ovQDpoints>pJdxx->jd_surePoints)
  972. {
  973. bFault=true;
  974. break;
  975. }
  976. }
  977. }
  978. //故障确认,判断暂态接地线路逻辑
  979. if(bFault)
  980. {
  981. #ifdef FUN_JDXX_TBLQD
  982. if(pJdxx->bTT_jdxx_p0dir)
  983. {
  984. pR->tJD.tc_result=1; //启动
  985. pR->tJD.adPoints=0;
  986. pR->tJD.jd_step=JD_STEP_SSFAULT;
  987. if(soe_check(EV_JDXX_QD+sw*EV_SW_NUM)==false)
  988. {
  989. soe_record_ev( EV_JDXX_QD+sw*EV_SW_NUM,1, 0,0,0 );
  990. }
  991. #ifdef XDL_PRINT
  992. rt_printf("jdxx:sw=%d JD_STEP_SSFAULT\r\n",sw);
  993. #endif
  994. return;
  995. }
  996. else
  997. #endif
  998. {
  999. ret=jdxx_checkjd(sw);
  1000. if(ret<0)
  1001. {
  1002. pR->tJD.jd_step=JD_STEP_RST;
  1003. #ifdef XDL_PRINT
  1004. rt_printf("\r\njdxx_fg:sw=%d JD_STEP_FG",sw);
  1005. #endif
  1006. return;
  1007. }
  1008. else
  1009. {
  1010. pR->tJD.adPoints=0;
  1011. pR->tJD.jd_step=JD_STEP_SSFAULT;
  1012. if(soe_check(EV_JDXX_QD+sw*EV_SW_NUM)==false)
  1013. {
  1014. soe_record_ev( EV_JDXX_QD+sw*EV_SW_NUM,1, 0,0,0 );
  1015. }
  1016. #ifdef XDL_PRINT
  1017. rt_printf("jdxx:sw=%d JD_STEP_SSFAULT\r\n",sw);
  1018. #endif
  1019. return;
  1020. }
  1021. }
  1022. }
  1023. else//干扰,复归
  1024. {
  1025. #if 0//def FUN_JDXX_TBLQD //只需要U0期间出现了I0突变,就ok
  1026. {
  1027. #ifdef XDL_PRINT
  1028. rt_printf("jdxx:sw=%d 启动后确认干扰\r\n",sw);
  1029. #endif
  1030. pR->tJD.jd_step=JD_STEP_QD;
  1031. continue;
  1032. }
  1033. #else
  1034. if(dotcnt<(NUM_QDFX-128))//最后1周波前必须确认(512-128)
  1035. {
  1036. #ifdef XDL_PRINT
  1037. rt_printf("jdxx:sw=%d 启动后确认干扰\r\n",sw);
  1038. #endif
  1039. pR->tJD.jd_step=JD_STEP_QD;
  1040. continue;
  1041. }
  1042. else
  1043. {
  1044. pR->tJD.adPoints=0;
  1045. pR->tJD.jd_step=JD_STEP_RST;
  1046. #ifdef XDL_PRINT
  1047. rt_printf("\r\njdxx_fg:sw=%d JD_STEP_FG!(not sure)",sw);
  1048. #endif
  1049. return;
  1050. }
  1051. #endif
  1052. }
  1053. }
  1054. }
  1055. }
  1056. //稳态判据
  1057. #define ANGF150 (150*65536) //150度
  1058. #define ANGN150 ((-150)*65536) //-150度
  1059. #define ANGF30 (30*65536) //30度
  1060. #define ANGN30 ((-30)*65536) //-30度
  1061. #ifdef FUN_JDXX_12FS //针对电科院一二次融合测试
  1062. #define ANGF96 (110*65536) //110度
  1063. #define ANGN96 ((-110)*65536) //-110度
  1064. #define ANGF45 (30*65536) //30度
  1065. #define ANGN45 ((-30)*65536) //-30度
  1066. #else
  1067. #define ANGF96 (96*65536) //96度
  1068. #define ANGN96 ((-96)*65536) //-96度
  1069. #define ANGF45 (45*65536) //45度
  1070. #define ANGN45 ((-45)*65536) //-45度
  1071. #endif
  1072. #define ANGF360 (360*65536) //360度
  1073. #define ANGF90 (90*65536) //90度
  1074. #define ANGN90 ((-90)*65536) //-90度
  1075. #define ANGF70 (70*65536) //70度
  1076. #define ANGN70 ((-70)*65536) //-70度
  1077. int jdxx_angle_range(int sw)
  1078. {
  1079. int i,ret;
  1080. long deltaA;
  1081. TRELAY_T *pR=&g_tRelay[sw];
  1082. #if 1
  1083. long max,min;
  1084. max=pR->tJD.ui_angle[0];
  1085. min=pR->tJD.ui_angle[0];
  1086. for(i=1;i<NUM_ANGLE;i++)
  1087. {
  1088. if(pR->tJD.ui_angle[i] > max)
  1089. {
  1090. max = pR->tJD.ui_angle[i];
  1091. }
  1092. else if(pR->tJD.ui_angle[i] < min)
  1093. {
  1094. min = pR->tJD.ui_angle[i];
  1095. }
  1096. }
  1097. #ifdef XDL_PRINT
  1098. rt_printf("jdxx:sw=%d AngleMax=%d , AngleMin=%d!\r\n",sw,(max>>16),(min>>16));
  1099. #endif
  1100. if((max > ANGF90) && (min<ANGN90))//在2-3象限
  1101. {
  1102. for(i=0;i<NUM_ANGLE;i++)
  1103. {
  1104. if(pR->tJD.ui_angle[i] < 0)
  1105. {
  1106. pR->tJD.ui_angle[i] += ANGF360;//归一化到0~360
  1107. }
  1108. #ifdef XDL_PRINT
  1109. rt_printf("jdxx:sw=%d Angle23=%d!\r\n",sw,(pR->tJD.ui_angle[i]>>16));
  1110. #endif
  1111. }
  1112. }
  1113. //相角
  1114. deltaA=0;
  1115. for(i=0;i<NUM_ANGLE;i++)
  1116. {
  1117. deltaA += pR->tJD.ui_angle[i];
  1118. }
  1119. deltaA /=NUM_ANGLE;
  1120. #else
  1121. int j;
  1122. ret=3;
  1123. deltaA=0;
  1124. for(i=0,j=0;i<NUM_ANGLE;i++)
  1125. {
  1126. if(pR->tJD.ui_angle[i] > 0) continue;
  1127. else
  1128. {
  1129. deltaA +=pR->tJD.ui_angle[i];
  1130. j++;
  1131. }
  1132. }
  1133. if(j==0)
  1134. {
  1135. ret=3;//非界外
  1136. }
  1137. else
  1138. {
  1139. deltaA /=j;
  1140. }
  1141. #endif
  1142. //判区内区外
  1143. ret=3;
  1144. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  1145. {
  1146. if(deltaA>ANGF45 && deltaA<ANGF96) ret=2; //界外
  1147. }
  1148. else
  1149. {
  1150. if(deltaA>ANGN96 && deltaA<ANGN45) ret=2;//界外
  1151. }
  1152. #ifdef XDL_PRINT
  1153. if(ret==2)
  1154. {
  1155. rt_printf("jdxx:sw=%d 零序功率方向判区外接地!ret0=%d!Angle=%d!\r\n",sw,ret,(deltaA>>16));
  1156. }
  1157. #endif
  1158. return ret;
  1159. }
  1160. /**************************************************************************
  1161. 函数名称:CalcUIzAng
  1162. 函数版本:1.00
  1163. 函数功能说明:接地零序角度必须归一到-180-180。(部分项目角度没有归一化到-180-180)
  1164. 输入参数:long Real1,
  1165. long Imag1,
  1166. long Imag2,
  1167. long Imag2
  1168. 输出参数:
  1169. 返回值: long 角差;
  1170. **************************************************************************/
  1171. long CalcUIzAng(long Real1, long Imag1, long Real2, long Imag2)
  1172. {
  1173. long lTmp;
  1174. lTmp = _AngPQ(Real1, Imag1)- _AngPQ(Real2,Imag2);
  1175. //规格化在0 ~ 360之间
  1176. if(lTmp < 0)
  1177. {
  1178. lTmp += ANGLE_P360;
  1179. }
  1180. if(lTmp>ANGLE_P180) //转换为-180 ~180
  1181. {
  1182. lTmp-=ANGLE_P360;
  1183. }
  1184. return (lTmp);
  1185. }
  1186. void jdxx_fault(int sw,DWORD dStep)
  1187. {
  1188. int ret0,ret1,bQNGZ,u0_index;
  1189. bool b_tz,b_gj;
  1190. JDXX_SET *pJdxx=&tJDXX_val[sw];
  1191. TRELAY_T *pR=&g_tRelay[sw];
  1192. #ifdef ITEM_FYF630Z
  1193. b_gj = pJdxx->bTT_jdxx_gj;
  1194. b_tz = pJdxx->bTT_jdxx_tz;
  1195. #ifdef BH_JZ_YB
  1196. if(!g_tRelay[sw].run_stu.bh_ck)
  1197. #else
  1198. if(pRunSet->tSwSet[sw].bSW_JZ)
  1199. #endif
  1200. {
  1201. if(b_tz){
  1202. b_tz = false;
  1203. b_gj = true;
  1204. }
  1205. }
  1206. #elif defined DFTU_LINUX_ZXJC || defined DTU_HUNAN || defined FBS_GD_MAIN || defined DTU4_GW_TEST || defined FB_SHANDONG || defined FBS_GX
  1207. b_gj = pJdxx->bTT_jdxx_gj;
  1208. b_tz = pJdxx->bTT_jdxx_tz;
  1209. #else
  1210. b_gj = pJdxx->bTT_jdxx_gj;
  1211. b_tz = pJdxx->bTT_jdxx_tz;
  1212. #if defined CN_AREA_GUIZHOU_2022 || defined CN_AREA_ZUNYI_2022
  1213. if(pRunSet->bTT_JZS_YB) // 集中模式不跳闸
  1214. #else
  1215. #ifdef FUNC_JZ_TZ2GJ
  1216. if(JZ_ALL_EN(sw) || (pRunSet->faMode && pRunSet->tSwSet[sw].bTT_fa_auto && !pRunSet->tSwSet[sw].bTT_fa_skg)) // 集中模式或者就地式FA自适应非首开关不跳闸
  1217. #else
  1218. if(pRunSet->jzMode || (pRunSet->faMode && pRunSet->tSwSet[sw].bTT_fa_auto && !pRunSet->tSwSet[sw].bTT_fa_skg)) // 集中模式或者就地式FA自适应非首开关不跳闸
  1219. #endif
  1220. #endif
  1221. {
  1222. if(b_tz){
  1223. b_tz = false;
  1224. b_gj = true;
  1225. }
  1226. }
  1227. #endif
  1228. if(pR->tJD.jd_step==JD_STEP_SSFAULT)//稳态逻辑判定
  1229. {
  1230. //判稳态电流
  1231. #if defined FUN_JDXX_JXJD || defined DTU_HUNAN
  1232. ret1=1;
  1233. #else
  1234. if(g_ui[pJdxx->i0_chan].m2[0] >= pJdxx->jd_qdval2)
  1235. {
  1236. ret1=1;
  1237. }
  1238. else
  1239. {
  1240. ret1=0;
  1241. if(pR->tJD.tc_result)
  1242. {
  1243. pR->tJD.tc_result=0;
  1244. #ifdef XDL_PRINT
  1245. rt_printf("jdxx:sw=%d ret1=%d--暂态误判!\r\n",sw,ret1);
  1246. #endif
  1247. }
  1248. }
  1249. #endif
  1250. //判相位
  1251. if(pR->tJD.jd_u0_12==1) u0_index=PUB_AC_U01;
  1252. else u0_index=PUB_AC_U02;
  1253. //判稳态相位
  1254. if(!pJdxx->bTT_jdxx_p0dir)
  1255. {
  1256. ret0=3;
  1257. }
  1258. else
  1259. {
  1260. long deltaA;
  1261. //计算零序功率角度:-180~180 (固定大通道)
  1262. if(g_ui[pJdxx->i0_chan].m2[0] >= pJdxx->jd_qdval2)
  1263. {
  1264. 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);
  1265. 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))
  1266. {
  1267. 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);
  1268. }
  1269. }
  1270. else //区外处理
  1271. {
  1272. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  1273. {
  1274. deltaA=ANGF90;
  1275. }
  1276. else
  1277. {
  1278. deltaA=ANGN90;
  1279. }
  1280. }
  1281. #ifdef XDL_PRINT
  1282. if(pR->tJD.con_angle < NUM_ANGLE) rt_printf("jdxx:sw=%d Z_angle=%d\r\n",sw,(deltaA>>16));
  1283. #endif
  1284. #ifdef CN_AREA_GW_SHANXI
  1285. if(deltaA>ANGF30 && deltaA<ANGF150)
  1286. {
  1287. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  1288. {
  1289. ret0=2; //界外
  1290. }
  1291. else
  1292. {
  1293. ret0=1;//界内
  1294. }
  1295. }
  1296. else if(deltaA>ANGN150 && deltaA<ANGN30)
  1297. {
  1298. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  1299. {
  1300. ret0=1;//界内
  1301. }
  1302. else
  1303. {
  1304. ret0=2;//界外
  1305. }
  1306. }
  1307. else
  1308. {
  1309. ret0=0;//干扰
  1310. #ifdef XDL_PRINT
  1311. rt_printf("jdxx:sw=%d 零序功率方向不正确,非接地!\r\n",sw);
  1312. #endif
  1313. }
  1314. #elif defined FUN_JDXX_SS_ANGLE
  1315. if(deltaA>ANGF90 && deltaA<ANGF180)
  1316. {
  1317. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  1318. {
  1319. if(pR->tJD.dir_cnt)
  1320. {
  1321. pR->tJD.dir_cnt--;
  1322. ret0=1;//界内
  1323. }
  1324. if(pR->tJD.dir_cnt==0)
  1325. {
  1326. ret0=2; //界外
  1327. #ifdef XDL_PRINT
  1328. rt_printf("jdxx:sw=%d 零序功率方向抖动,非接地!\r\n",sw);
  1329. #endif
  1330. }
  1331. }
  1332. else
  1333. {
  1334. //pR->tJD.dir_cnt=(pR->tJD.dir_cnt+1)%20;
  1335. if(pR->tJD.dir_cnt<20)
  1336. {
  1337. pR->tJD.dir_cnt++;
  1338. }
  1339. if(pR->tJD.dir_cnt)
  1340. {
  1341. ret0=1;//界内
  1342. }
  1343. }
  1344. }
  1345. else if(deltaA>ANGN180 && deltaA<ANGN90)
  1346. {
  1347. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  1348. {
  1349. //pR->tJD.dir_cnt=(pR->tJD.dir_cnt+1)%20;
  1350. if(pR->tJD.dir_cnt<20)
  1351. {
  1352. pR->tJD.dir_cnt++;
  1353. }
  1354. if(pR->tJD.dir_cnt)
  1355. {
  1356. ret0=1;//界内
  1357. }
  1358. }
  1359. else
  1360. {
  1361. if(pR->tJD.dir_cnt)
  1362. {
  1363. pR->tJD.dir_cnt--;
  1364. ret0=1;//界内
  1365. }
  1366. if(pR->tJD.dir_cnt==0)
  1367. {
  1368. ret0=2;//界外
  1369. #ifdef XDL_PRINT
  1370. rt_printf("jdxx:sw=%d 零序功率方向抖动,非接地!\r\n",sw);
  1371. #endif
  1372. }
  1373. }
  1374. }
  1375. else
  1376. {
  1377. if(pR->tJD.dir_cnt)
  1378. {
  1379. pR->tJD.dir_cnt--;
  1380. ret0=1;//界内
  1381. }
  1382. if(pR->tJD.dir_cnt==0)
  1383. {
  1384. ret0=0;//干扰
  1385. #ifdef XDL_PRINT
  1386. rt_printf("jdxx:sw=%d 零序功率方向不正确,非接地!\r\n",sw);
  1387. #endif
  1388. }
  1389. }
  1390. #else
  1391. //计算角度,判相位
  1392. if(pR->tJD.con_angle < NUM_ANGLE)
  1393. {
  1394. pR->tJD.ui_angle[pR->tJD.con_angle++] = deltaA;
  1395. return;
  1396. }
  1397. else
  1398. {
  1399. ret0=jdxx_angle_range(sw);
  1400. }
  1401. #endif
  1402. }
  1403. //U0强制启动
  1404. if(TT_U0jd)
  1405. {
  1406. if(pRunSet->tSwSet[sw].bTT_Current_Inv ^ get_power_on_dir(sw))
  1407. {
  1408. ret0=2;
  1409. ret1=0;
  1410. }
  1411. else
  1412. {
  1413. ret0=3;
  1414. ret1=1;
  1415. }
  1416. }
  1417. //故障处理
  1418. if(pR->tJD.tc_result && (ret0==1||ret0==3)&&(ret1==1))
  1419. {
  1420. bQNGZ=1;
  1421. }
  1422. else if((pR->tJD.tc_result==0 && (ret0==2||ret0==3))
  1423. ||(ret1==0))
  1424. {
  1425. bQNGZ=2;
  1426. }
  1427. else
  1428. {
  1429. bQNGZ=0;
  1430. }
  1431. //区内
  1432. if(bQNGZ==1)
  1433. {
  1434. #ifdef HJS_XDLJD
  1435. pR->tJD.sta.bFlag.bJd_qn = 1; //区内故障
  1436. #endif
  1437. //告警
  1438. if(b_gj)
  1439. {
  1440. RunTR(&pR->tJD.tJDXXAlarmTime, bQNGZ, dStep);//故障持续时间
  1441. pR->tJD.sta.bFlag.bGj=pR->tJD.tJDXXAlarmTime.boolTrip;
  1442. if(pR->tJD.sta.bFlag.bGj)
  1443. {
  1444. if(soe_check(EV_JDXX_GJ+sw*EV_SW_NUM)==false)
  1445. {
  1446. //断面
  1447. DWORD I0,U0;
  1448. 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);
  1449. U0 = _Mul_Div_U(sqrt_32fix(g_ui[u0_index].m2[0]), 256, g_ui[u0_index].m2_factor_k);
  1450. pR->tJD.sta.bFlag.bGJLed = true;
  1451. soe_record_ev(EV_JDXX_GJ+sw*EV_SW_NUM,1,I0,U0,0 );
  1452. if(pJdxx->bTT_jdxx_fault_all)
  1453. {
  1454. if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
  1455. {
  1456. soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
  1457. }
  1458. }
  1459. //故障处理完毕,进入复归处理流程
  1460. if(!b_tz)//未投出口
  1461. {
  1462. pR->tJD.tc_result=0;
  1463. pR->tJD.jd_step=JD_STEP_RST;
  1464. #ifdef XDL_PRINT
  1465. rt_printf("\r\njdxx_fault:sw=%d step_rst",sw);
  1466. #endif
  1467. }
  1468. }
  1469. }
  1470. }
  1471. //出口
  1472. if(b_tz)
  1473. {
  1474. RunTR( &pR->tJD.tJDXXTripTime, bQNGZ , dStep);//故障持续时间
  1475. pR->tJD.sta.bFlag.bTz=pR->tJD.tJDXXTripTime.boolTrip;
  1476. #ifdef HJS_XDLJD
  1477. if(pR->tJD.sta.bFlag.bHjsTz)
  1478. {
  1479. pR->tJD.sta.bFlag.bTz_prot = pR->tJD.sta.bFlag.bTz;
  1480. }
  1481. else
  1482. {
  1483. pR->tJD.sta.bFlag.bTz_prot = 0;
  1484. }
  1485. #endif
  1486. if(pR->tJD.sta.bFlag.bTz) //出口
  1487. {
  1488. //断面
  1489. DWORD I0,U0;
  1490. 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);
  1491. U0 = _Mul_Div_U(sqrt_32fix(g_ui[u0_index].m2[0]), 256, g_ui[u0_index].m2_factor_k);
  1492. pR->tJD.sta.bFlag.bTZLed = true;
  1493. //soe
  1494. #ifdef FUN_JDXX_JXJD
  1495. if(soe_check(EV_JDXX_YJ_TZ+sw*EV_SW_NUM)==false)
  1496. {
  1497. soe_record_ev(EV_JDXX_YJ_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
  1498. #ifndef HJS_XDLJD
  1499. if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false) //区内跳闸
  1500. {
  1501. soe_record_ev( EV_JDXX_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
  1502. }
  1503. #else
  1504. if((soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false)&&(!pR->tJD.sta.bFlag.bHjsTz)) //区内跳闸
  1505. {
  1506. soe_record_ev( EV_JDXX_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
  1507. }
  1508. #endif
  1509. if(pJdxx->bTT_jdxx_fault_all)
  1510. {
  1511. if(soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)==false) //保护总
  1512. {
  1513. soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
  1514. }
  1515. }
  1516. #ifdef XDL_PRINT
  1517. rt_printf("\r\n区内永久接地动作");
  1518. #endif
  1519. }
  1520. #else
  1521. if(soe_check(EV_JDXX_TZ+sw*EV_SW_NUM)==false)
  1522. {
  1523. soe_record_ev(EV_JDXX_TZ+sw*EV_SW_NUM,1, I0,U0,0 );
  1524. if(!soe_check(EV_ALL_FAULT+sw*EV_SW_NUM)) //保护总
  1525. {
  1526. soe_record_ev( EV_ALL_FAULT+sw*EV_SW_NUM,1, 0,0,0 );
  1527. }
  1528. #ifdef XDL_PRINT
  1529. rt_printf("\r\n区内接地动作");
  1530. #endif
  1531. }
  1532. #endif
  1533. //故障处理完毕,进入复归处理流程
  1534. pR->tJD.tc_result=0;
  1535. pR->tJD.jd_step=JD_STEP_RST;
  1536. #ifdef FUN_JDXX_JXJD
  1537. pR->tJD.cnt_sdelay=0;
  1538. pR->tJD.cnt_ldelay=0;
  1539. #endif
  1540. #ifdef XDL_PRINT
  1541. rt_printf("\r\njdxx_fault:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
  1542. rt_printf("\r\njdxx_fault:sw=%d step_rst!",sw);
  1543. #endif
  1544. }
  1545. }
  1546. }
  1547. else if(bQNGZ==2)//区外
  1548. {
  1549. if(soe_check(EV_JDXX_JWGZ+sw*EV_SW_NUM)==false) // soe返回
  1550. {
  1551. //断面
  1552. DWORD I0,U0;
  1553. 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);
  1554. U0 = _Mul_Div_U(sqrt_32fix(g_ui[u0_index].m2[0]), 256, g_ui[u0_index].m2_factor_k);
  1555. soe_record_ev(EV_JDXX_JWGZ+sw*EV_SW_NUM,1, I0,U0,0 );
  1556. rt_printf("\r\n区外接地");
  1557. }
  1558. //故障处理完毕,进入复归处理流程
  1559. #ifdef HJS_XDLJD
  1560. pR->tJD.sta.bFlag.bJd_qn = 0; //区外故障
  1561. #endif
  1562. pR->tJD.tc_result=0;
  1563. pR->tJD.jd_step=JD_STEP_RST;
  1564. #ifdef XDL_PRINT
  1565. rt_printf("\r\njdxx_fault:sw=%d step_rst",sw);
  1566. #endif
  1567. }
  1568. else// if((tJD[sw].tc_result && ret0==2)||(tJD[sw].tc_result==0 && ret0==1))
  1569. {
  1570. //故障处理完毕,进入复归处理流程
  1571. #ifdef HJS_XDLJD
  1572. pR->tJD.sta.bFlag.bJd_qn = 0; //区外故障
  1573. #endif
  1574. pR->tJD.tc_result=0;
  1575. pR->tJD.jd_step=JD_STEP_RST;
  1576. #ifdef XDL_PRINT
  1577. rt_printf("\r\njdxx:sw=%d 暂态与稳态矛盾,非接地!",sw);
  1578. rt_printf("\r\njdxx_fault:sw=%d step_rst",sw);
  1579. #endif
  1580. }
  1581. }
  1582. }
  1583. #define ANGF145 (145*65536) //145度
  1584. #define ANGF95 (95*65536) //95度
  1585. #define ANGN145 ((-145)*65536) //-145度
  1586. #define ANGN95 ((-95)*65536) //-95度
  1587. #ifdef PT_DX_LOCK_XDL
  1588. static bool check_pt_ok(u32 sw)
  1589. {
  1590. TSETSW *pSet = &pRunSet->tSwSet[sw];
  1591. if(((FA_ALL_EN(sw) && (pSet->bTT_fa_ptdx))
  1592. || (BH_ALL_EN(sw) && (pSet->bTT_bh_ptdx)))
  1593. && (soe_check(EV_PT1ERR+sw*EV_SW_NUM) || soe_check(EV_PT2ERR+sw*EV_SW_NUM))
  1594. )
  1595. {
  1596. return false;
  1597. }
  1598. return true;
  1599. }
  1600. #endif
  1601. void jdxx_pro(int sw,DWORD dStep) //接地故障判断 5ms中断中处理
  1602. {
  1603. bool bQD1,bQD2,bQD3,bQD4,bQD5;
  1604. int soeno;
  1605. TRELAY_T *pR=&g_tRelay[sw];
  1606. JDXX_SET *pJdxx=&tJDXX_val[sw];
  1607. //if(!pJdxx->bTT_jdxx) return;
  1608. #ifdef DFTU_LINUX_ZXJC
  1609. if(!(pRunSet->tSwSet[sw].bTT_BH && pJdxx->bTT_jdxx)) return; //g_run_stu.bhall &&
  1610. #else
  1611. if(!(FUN_ALL_EN(sw) && pJdxx->bTT_jdxx)) return; //g_run_stu.bhall &&
  1612. #endif
  1613. #ifdef PT_DX_LOCK_XDL
  1614. if(!check_pt_ok(sw))
  1615. {
  1616. return;
  1617. }
  1618. #endif
  1619. #ifdef FUN_JDXX_JXJD
  1620. //分位清计次
  1621. if(pR->tSWST.uSWST.bFlag.bTZWZ) //跳位无流
  1622. {
  1623. pR->tJD.cnt_sdelay=0;
  1624. pR->tJD.cnt_ldelay=0;
  1625. }
  1626. #endif
  1627. //定义通道
  1628. if(pRunSet->bTT_U0ZC)
  1629. {
  1630. if(((g_sw_pub.ui_flags & UI_FLAGS_MAKE_U01)==0)&&((g_sw_pub.ui_flags & UI_FLAGS_MAKE_U02)==0))
  1631. return;
  1632. }
  1633. else
  1634. {
  1635. if(g_ui[PUB_AC_U01].chn_index==CFG_ADC_CHANNEL_ZERO && g_ui[PUB_AC_U02].chn_index==CFG_ADC_CHANNEL_ZERO)
  1636. return;
  1637. }
  1638. //选相
  1639. if(pJdxx->bTT_jdxx_cph)
  1640. {
  1641. if((g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index==CFG_ADC_CHANNEL_ZERO)
  1642. ||(g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index==CFG_ADC_CHANNEL_ZERO)
  1643. ||(g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index==CFG_ADC_CHANNEL_ZERO))
  1644. return;
  1645. }
  1646. //U0启动录波
  1647. bQD1 = (g_ui[PUB_AC_U01].m2[0] > pJdxx->jd_U0gl);
  1648. bQD2 = (g_ui[PUB_AC_U02].m2[0] > pJdxx->jd_U0gl);
  1649. RunTR( &pR->tJD.tJDXXU01Time, bQD1, dStep);//U0计算时间:20ms
  1650. RunTR( &pR->tJD.tJDXXU02Time, bQD2, dStep);//U0计算时间:20ms
  1651. //相有压有流
  1652. #ifdef CN_AREA_FUJIAN_TEST//福建电压为小信号
  1653. 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)
  1654. #else
  1655. 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)
  1656. #endif
  1657. 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)
  1658. bQD5 = (g_sw[sw].m2_min >pRunSet->dIWL_SQR[sw]);
  1659. RunTR( &pR->tJD.tJDXXU1yyTime, bQD3, dStep);//Ul有压时间时间:60ms
  1660. RunTR( &pR->tJD.tJDXXU2yyTime, bQD4, dStep);//Ul有压时间时间:60ms
  1661. RunTR( &pR->tJD.tJDXXIylTime, bQD5, dStep);//Iph有流时间时间:60ms
  1662. //取通道启动前的采样值,作为零漂值,在故障复归时使用
  1663. //if(!bQD1 && !bQD2)
  1664. //{
  1665. //tJD[sw].dot_save=(g_adc_dots_count)*ADC_REC_SAMPLE_RATE+mod;
  1666. // jdxx_getzeroval(sw);
  1667. //}
  1668. //U01故障处理
  1669. soeno = EV_JDXX_U01GJ+sw*EV_SW_NUM;
  1670. if(pR->tJD.tJDXXU01Time.boolTrip)
  1671. {
  1672. if(soe_check(soeno)==false)
  1673. {
  1674. DWORD u0;
  1675. pR->tJD.jd_u0_12 = 1;
  1676. u0 = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_U01].m2[0]), 256, g_ui[PUB_AC_U01].m2_factor_k);
  1677. soe_record_ev(soeno, 1, u0,0,0);
  1678. // 置启动标志,记录启动不能放在录波启动成功的条件里,避免启动失败后频繁打印!记录启动时刻.
  1679. if(pRunSet->tSwSet[sw].bTT_Power_v2 == 0)
  1680. {
  1681. jdxx_fg(sw);//零压启动强制复归
  1682. #ifdef JDXX_YXEV_RST
  1683. jdxx_yxev_rst(sw);
  1684. #endif
  1685. pR->tJD.time_qd = ustimer_get_origin();
  1686. rcd_start(sw,RECORD_TYPE_XDLJD,RECORD_LEN_TZQD);
  1687. #ifdef XDL_PRINT
  1688. rt_printf("\r\njdxx_u01_time:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
  1689. #endif
  1690. }
  1691. }
  1692. }
  1693. else
  1694. {
  1695. //计算零序功率:扩大10倍,提高计算分辨率
  1696. if(pRunSet->tSwSet[sw].bTT_Power_v2 == 0)
  1697. {
  1698. if(bQD1)
  1699. {
  1700. g_ui_p0[sw].Pea += g_ui_p0[sw].p*10;
  1701. g_ui_p0[sw].Per += g_ui_p0[sw].q*10;
  1702. g_ui_p0[sw].Peas += g_ui_p0[sw].ps*10;
  1703. g_ui_p0[sw].Pers += g_ui_p0[sw].qs*10;
  1704. }
  1705. else
  1706. {
  1707. g_ui_p0[sw].Pea =0;
  1708. g_ui_p0[sw].Per =0;
  1709. g_ui_p0[sw].Peas =0;
  1710. g_ui_p0[sw].Pers =0;
  1711. }
  1712. }
  1713. //soe复归
  1714. if(soe_check(soeno)==true)
  1715. {
  1716. pR->tJD.jd_u0_12 = 0;
  1717. soe_record_ev( soeno, 0, 0,0,0 );
  1718. jdxx_u0_rst(sw);
  1719. }
  1720. }
  1721. //U02
  1722. soeno = EV_JDXX_U02GJ+sw*EV_SW_NUM;
  1723. if(pR->tJD.tJDXXU02Time.boolTrip)
  1724. {
  1725. if(soe_check(soeno)==false)
  1726. {
  1727. DWORD u0;
  1728. pR->tJD.jd_u0_12 = 2;
  1729. u0 = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_U02].m2[0]), 256, g_ui[PUB_AC_U02].m2_factor_k);
  1730. soe_record_ev(soeno, 1, u0,0,0);
  1731. // 置启动标志,不能放在录波启动成功的条件里,避免启动失败后频繁打印!记录启动时刻.
  1732. if(pRunSet->tSwSet[sw].bTT_Power_v2)
  1733. {
  1734. jdxx_fg(sw);//零压启动强制复归
  1735. #ifdef JDXX_YXEV_RST
  1736. jdxx_yxev_rst(sw);
  1737. #endif
  1738. pR->tJD.time_qd = ustimer_get_origin();
  1739. rcd_start(sw,RECORD_TYPE_XDLJD,RECORD_LEN_TZQD);
  1740. #ifdef XDL_PRINT
  1741. rt_printf("\r\njdxx_u02_time:T[0]=%d!",pR->tJD.time_qd/USTIMER_SEC);
  1742. #endif
  1743. }
  1744. }
  1745. }
  1746. else
  1747. {
  1748. //计算零序功率:扩大10倍,提高计算分辨率
  1749. if(pRunSet->tSwSet[sw].bTT_Power_v2)
  1750. {
  1751. if(bQD2)
  1752. {
  1753. g_ui_p0[sw].Pea += g_ui_p0[sw].p*10;
  1754. g_ui_p0[sw].Per += g_ui_p0[sw].q*10;
  1755. g_ui_p0[sw].Peas += g_ui_p0[sw].ps*10;
  1756. g_ui_p0[sw].Pers += g_ui_p0[sw].qs*10;
  1757. }
  1758. else
  1759. {
  1760. g_ui_p0[sw].Pea =0;
  1761. g_ui_p0[sw].Per =0;
  1762. g_ui_p0[sw].Peas =0;
  1763. g_ui_p0[sw].Pers =0;
  1764. }
  1765. }
  1766. //soe复归
  1767. if(soe_check(soeno)==true)
  1768. {
  1769. pR->tJD.jd_u0_12 = 0;
  1770. soe_record_ev( soeno, 0, 0,0,0 );
  1771. jdxx_u0_rst(sw);
  1772. }
  1773. }
  1774. //U0达到定值,启动
  1775. if(pR->tJD.tJDXXU01Time.boolTrip||pR->tJD.tJDXXU02Time.boolTrip)
  1776. {
  1777. //正常波形
  1778. if(pR->tJD.jd_step!=JD_STEP_RST)
  1779. {
  1780. //判电压满幅度
  1781. if(TT_U0yx && jdxx_U0_ov(sw))
  1782. {
  1783. pR->tJD.jd_step=JD_STEP_RST;
  1784. #ifdef XDL_PRINT
  1785. rt_printf("jdxx:sw=%d 零序电压失真!\r\n",sw);
  1786. #endif
  1787. return;
  1788. }
  1789. //判断线电压无压
  1790. if(TT_Ulyy &&
  1791. ((pR->tJD.tJDXXU1yyTime.boolTrip==false && pR->tJD.tJDXXU01Time.boolTrip) ||(pR->tJD.tJDXXU2yyTime.boolTrip==false && pR->tJD.tJDXXU02Time.boolTrip)))
  1792. {
  1793. pR->tJD.jd_step=JD_STEP_RST;
  1794. #ifdef XDL_PRINT
  1795. rt_printf("jdxx:sw=%d 线路无压!\r\n",sw);
  1796. #endif
  1797. return;
  1798. }
  1799. //判断相电流无流
  1800. if(TT_Ipwl && !pR->tJD.tJDXXIylTime.boolTrip)
  1801. {
  1802. pR->tJD.jd_step=JD_STEP_RST;
  1803. #ifdef XDL_PRINT
  1804. rt_printf("jdxx:sw=%d 断线无流!\r\n",sw);
  1805. #endif
  1806. return;
  1807. }
  1808. //判断相电流相序
  1809. if(TT_Ipph && pR->tJD.tJDXXIylTime.boolTrip)//有流
  1810. {
  1811. long deltaIAB,deltaIAC;
  1812. 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);
  1813. 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);
  1814. if(deltaIAB<ANGF95||deltaIAB>ANGF145||deltaIAC>ANGN95||deltaIAC<ANGN145)
  1815. {
  1816. pR->tJD.jd_step=JD_STEP_RST;
  1817. #ifdef XDL_PRINT
  1818. rt_printf("jdxx:sw=%d : PIab=%d,PIac=%d. 三相乱序! \r\n",sw,deltaIAB>>16,deltaIAC>>16);
  1819. #endif
  1820. return;
  1821. }
  1822. }
  1823. //获得电流启动值
  1824. if(pR->tJD.jd_step!=JD_STEP_SSFAULT)
  1825. {
  1826. g_ui[pJdxx->i0_chan].fz = _AmXY(g_ui[pJdxx->i0_chan].ri.r,g_ui[pJdxx->i0_chan].ri.i);
  1827. pR->tJD.jd_qdval=(g_ui[pJdxx->i0_chan].fz>>2);//1/4
  1828. if(pR->tJD.jd_qdval < pJdxx->jd_qdval)
  1829. {
  1830. pR->tJD.jd_qdval = pJdxx->jd_qdval;
  1831. }
  1832. #ifdef XDL_PRINT
  1833. rt_printf("jdxx:sw=%d 零流启动值=%d ,定值=%d!\r\n",sw,pR->tJD.jd_qdval,pJdxx->jd_qdval);
  1834. //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);
  1835. #endif
  1836. }
  1837. //fault
  1838. #ifdef CN_AREA_GW_SHANXI
  1839. if(pJdxx->bTT_jdxx_p0dir)
  1840. {
  1841. if(pR->tJD.jd_step==JD_STEP_QD)
  1842. {
  1843. if(g_ui[UI_JDXX_I0_INDEX].m2[0]>=pJdxx->jd_zero_N)
  1844. {
  1845. pR->tJD.tc_result=1;
  1846. pR->tJD.jd_step = JD_STEP_SSFAULT;
  1847. #ifdef XDL_PRINT
  1848. rt_printf("jdxx:sw=%d 功率方向投,进入稳态判据!\r\n",sw);
  1849. #endif
  1850. }
  1851. }
  1852. }
  1853. else
  1854. #endif
  1855. {
  1856. #if 0
  1857. if(pJdxx->jd_type==1)//有功分量法
  1858. {
  1859. jdxx_yg_qd(sw);
  1860. }
  1861. else//首半波
  1862. #endif
  1863. if(TT_U0jd)
  1864. {
  1865. if(pR->tJD.jd_step==JD_STEP_QD)
  1866. {
  1867. pR->tJD.tc_result=1;
  1868. pR->tJD.jd_step = JD_STEP_SSFAULT;
  1869. #ifdef XDL_PRINT
  1870. rt_printf("jdxx:sw=%d 零压启动,进入稳态判据!\r\n",sw);
  1871. #endif
  1872. }
  1873. }
  1874. else
  1875. {
  1876. jdxx_qd(sw);
  1877. }
  1878. }
  1879. jdxx_fault(sw,dStep);
  1880. }
  1881. }
  1882. else//rst
  1883. {
  1884. jdxx_rst(sw,dStep);
  1885. }
  1886. }
  1887. /////////////////////////////////////////////////////////////////////////
  1888. void _getjdxxdz_inf(void)
  1889. {
  1890. int i,file_length;
  1891. struct file * pfile;
  1892. u8 *filebuf;
  1893. loff_t pos;
  1894. // 打开文件
  1895. pfile = rt_file_open("/app/data/pcolcfg.ini",O_RDONLY ,0);
  1896. if(IS_ERR(pfile))
  1897. {
  1898. rt_printf("error! 无法打开 pcolcfg.ini\r\n");
  1899. goto jdxx_err;
  1900. }
  1901. // 得到文件长度
  1902. file_length = rt_file_getfile_size(pfile);
  1903. //file_length = rt_file_getfile_size(pfile);
  1904. if(file_length <= 0)
  1905. {
  1906. rt_file_close(pfile,0);
  1907. goto jdxx_err;
  1908. }
  1909. // 分配内存
  1910. filebuf = rt_malloc(file_length);
  1911. if((filebuf) == NULL)
  1912. {
  1913. rt_file_close(pfile,0);
  1914. goto jdxx_err;
  1915. }
  1916. pos = 0;
  1917. if(rt_file_read(pfile,filebuf,file_length,&pos) != file_length)
  1918. {
  1919. rt_file_close(pfile,0);
  1920. rt_free(filebuf);
  1921. goto jdxx_err;
  1922. }
  1923. //找到\r\n位置,得到一行长度
  1924. for(i = 0; i < file_length; i++)
  1925. {
  1926. if(strncmp(&filebuf[i],"TT_U0yx", 7) == 0)
  1927. {
  1928. TT_U0yx = getstrval(&filebuf[i]);
  1929. }
  1930. else if(strncmp(&filebuf[i],"TT_Ipwl", 7) == 0)
  1931. {
  1932. TT_Ipwl = getstrval(&filebuf[i]);
  1933. }
  1934. else if(strncmp(&filebuf[i],"TT_Ipph", 7) == 0)
  1935. {
  1936. TT_Ipph = getstrval(&filebuf[i]);
  1937. }
  1938. else if(strncmp(&filebuf[i],"TT_Ulyy", 7) == 0)
  1939. {
  1940. TT_Ulyy = getstrval(&filebuf[i]);
  1941. }
  1942. else if(strncmp(&filebuf[i],"TT_U0jd", 7) == 0)
  1943. {
  1944. TT_U0jd = getstrval(&filebuf[i]);
  1945. break;
  1946. }
  1947. }
  1948. if(i >= file_length)
  1949. {
  1950. TT_U0yx = 0;
  1951. TT_Ipwl = 0;
  1952. TT_Ipph = 0;
  1953. TT_Ulyy = 0;
  1954. TT_U0jd = 0;
  1955. }
  1956. #ifdef XDL_PRINT
  1957. rt_printf("TT_U0yx = %d\r\n", TT_U0yx);
  1958. rt_printf("TT_Ipwl = %d\r\n", TT_Ipwl);
  1959. rt_printf("TT_Ipph = %d\r\n", TT_Ipph);
  1960. rt_printf("TT_Ulyy = %d\r\n", TT_Ulyy);
  1961. rt_printf("TT_U0jd = %d\r\n", TT_U0jd);
  1962. #endif
  1963. if(TT_U0jd)
  1964. {
  1965. log_str_time(LOG_ERR,"U0接地投入",1,1);
  1966. rt_printf("U0接地投入!\r\n");
  1967. }
  1968. rt_file_close(pfile,0); // 关闭文件
  1969. rt_free(filebuf); // 释放内存
  1970. return;
  1971. jdxx_err:
  1972. TT_U0yx = 0;
  1973. TT_Ipwl = 0;
  1974. TT_Ipph = 0;
  1975. TT_Ulyy = 0;
  1976. TT_U0jd = 0;
  1977. #ifdef XDL_PRINT
  1978. rt_printf("ERR!TT_U0yx = %d\r\n", TT_U0yx);
  1979. rt_printf("ERR!TT_Ipwl = %d\r\n", TT_Ipwl);
  1980. rt_printf("ERR!TT_Ipph = %d\r\n", TT_Ipph);
  1981. rt_printf("ERR!TT_Ulyy = %d\r\n", TT_Ulyy);
  1982. rt_printf("ERR!TT_U0jd = %d\r\n", TT_U0jd);
  1983. #endif
  1984. }
  1985. //////////////////////////////////////////////////////////////////////////////
  1986. #endif //FUN_JDXX
  1987. /*------------------------------ 文件结束 -------------------------------------
  1988. */