jdxx.c 64 KB

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