SOE.c 47 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853
  1. /*************************************************************************
  2. * 版权所有:
  3. * 文件版本: V1.00
  4. * 文件名称:SOE.c
  5. * 生成日期: 2008年9月1日
  6. * 作 者: xxxxxx
  7. * 功 能: 事件记录处理
  8. * 更新信息:
  9. 2015-11-02
  10. 增强了SOE处理时资源竞争保护,此次增强基于以下假设
  11. 1、除了优先级别低于主循环的地方外,可以在其它各个优先级别调用SOE记录函数。
  12. 2、处理SOE必须在主循环中,也就是说优先级别最低的地方。
  13. */
  14. /*------------------------------- 头文件 --------------------------------------
  15. */
  16. #include "head.h"
  17. /*------------------------------- 宏定义 --------------------------------------
  18. */
  19. #define RCDTYPE_EVENT 1
  20. #define RCDTYPE_YX 2
  21. #define SOE_SAVE_BUF_NUM 64
  22. /*-------------------------------类型结构--------------------------------------
  23. */
  24. /*------------------------------ 全局变量 -------------------------------------
  25. */
  26. u32 g_ev_words[EV_NUMBER_WORDS]; // 所有事件的状态保存
  27. SOE_QUEUE g_soe_queue; // 事件队列
  28. SOE_INF g_soe_info; // 系统事件的信息结构
  29. int g_soe_test;
  30. static EVENT_SAVE g_soe_sbuf[SOE_SAVE_BUF_NUM]; // SOE保存加速BUF
  31. #ifdef ADD_DEBUG_RECORD_AUTO_SHOW_FUN
  32. const u16 ExecuteEventIdTbl[]={EV_GL1TZ,EV_GL2TZ,EV_GL3TZ,
  33. EV_LX1TZ,EV_LX2TZ,
  34. #ifdef DISP_SET_LX3
  35. EV_LX3TZ,
  36. #endif
  37. EV_GLJS,EV_LXJS,EV_FA_GL_TZ,
  38. #if defined GD_AREA_CHAOZHOU || defined GD_AREA_SHANTOU || defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020
  39. EV_FA_GL_TZ2,
  40. #endif
  41. EV_FA_LX_TZ,EV_AR1,EV_AR2,EV_AR3,EV_ARBS,EV_U0TZ,EV_XBBS,EV_BS_ALL,
  42. EV_BS_FZMORE,EV_TQHZ,EV_GGDY_TZ,EV_GDDY_TZ,EV_GDY_TZ,EV_DDY_TZ,EV_LOWPL_TZ,EV_GPL_TZ,EV_DPL_TZ,
  43. EV_GOOSE_QC_QD,EV_GOOSE_GL_QD,EV_GOOSE_HZ_QD,EV_GOOSE_GL_TZ,
  44. #if defined GD_AREA_ZHONGSHAN || defined GD_AREA_ZHONGSHAN_2020 || defined GD_AREA_MAIN_2020
  45. EV_GOOSE_GL2_TZ, // 过流2段跳闸
  46. #endif
  47. #ifdef GD_AREA_ZHONGSHAN_2020
  48. EV_GOOSE_HZ_GL1,EV_GOOSE_HZ_GL2,EV_GOOSE_HZ_LX,EV_BSTZ,
  49. #endif
  50. EV_GOOSE_LX_TZ,EV_GOOSE_SDLOST_TZ,EV_GOOSE_ERRLOST_TZ,EV_GOOSE_EXT_TZ,EV_BSTZ,EV_FA_FZ,
  51. EV_BS_U0,EV_HHGZ,EV_HHGZ_P,EV_HHGZ_L,EV_BSTZ_FA,EV_FA_HZ,EV_FA_LL_HZ,EV_FA_FZ,
  52. #ifdef XDL_ZT
  53. EV_LX_XDL_TZ, // 零序小电流跳闸
  54. #endif
  55. EV_GOOSE_ERR,
  56. EV_SYS_GOOSE_ERR,
  57. EV_PT1ERR,EV_PT2ERR,
  58. EV_BS_UF_P,EV_BS_UF_L,
  59. }; //TODO: add param
  60. #define EXECUTE_EVENT_NUM (sizeof(ExecuteEventIdTbl)/sizeof(u16))
  61. #endif
  62. /*------------------------------ 函数声明 -------------------------------------
  63. */
  64. /*------------------------------ 外部函数 -------------------------------------
  65. 外部函数供其它实体文件引用,必须仔细检查传入参数的合法性.
  66. */
  67. // 遥信取SOE BUF,因为遥信处理在最高优先级,所以可以不用屏蔽中断
  68. // 如果采用屏蔽中断的方式,在10个遥信同时动作的情况下,一次遥信处理会多消耗38us。
  69. EVENT_SAVE *soe_get_buffer_yx(void)
  70. {
  71. u16 i,head;
  72. head = g_soe_queue.head.n++;
  73. if(g_soe_queue.head.n == g_soe_queue.tail_eep.n)
  74. {
  75. g_soe_queue.tail_eep.n++;
  76. g_soe_queue.stat_eep_over++;
  77. }
  78. // 缓冲区满了,调整tail_send和tail_ack
  79. for(i=0;i<COMM_CHANNEL_NUM;i++)
  80. {
  81. if(g_soe_queue.head.n==g_soe_queue.tail_send[i].n)
  82. {
  83. g_soe_queue.tail_send[i].n++;
  84. g_soe_queue.stat_send_over[i]++;
  85. }
  86. if(g_soe_queue.head.n==g_soe_queue.tail_ack[i].n)
  87. {
  88. g_soe_queue.tail_ack[i].n++;
  89. g_soe_queue.stat_ack_over[i]++;
  90. }
  91. }
  92. // 保存标志清零,防止不该有的事件确认
  93. g_soe_queue.soe[head].es_flag = 0;
  94. // 唤醒主循环
  95. mainloop_wakeup();
  96. return &g_soe_queue.soe[head];
  97. }
  98. EVENT_SAVE *soe_get_buffer(u16 *extarg)
  99. {
  100. u16 i,head;
  101. uint32_t flags;
  102. rt_irq_save(flags);
  103. head = g_soe_queue.head.n++;
  104. rt_irq_restore(flags);
  105. rt_irq_save(flags);
  106. if(g_soe_queue.head.n == g_soe_queue.tail_eep.n)
  107. {
  108. g_soe_queue.tail_eep.n++;
  109. g_soe_queue.stat_eep_over++;
  110. }
  111. rt_irq_restore(flags);
  112. // 缓冲区满了,调整tail_send和tail_ack
  113. for(i=0;i<COMM_CHANNEL_NUM;i++)
  114. {
  115. rt_irq_save(flags);
  116. if(g_soe_queue.head.n==g_soe_queue.tail_send[i].n)
  117. {
  118. g_soe_queue.tail_send[i].n++;
  119. g_soe_queue.stat_send_over[i]++;
  120. }
  121. if(g_soe_queue.head.n==g_soe_queue.tail_ack[i].n)
  122. {
  123. g_soe_queue.tail_ack[i].n++;
  124. g_soe_queue.stat_ack_over[i]++;
  125. }
  126. rt_irq_restore(flags);
  127. }
  128. // 保存标志清零,防止不该有的事件确认
  129. g_soe_queue.soe[head].es_flag = 0;
  130. // 唤醒主循环
  131. mainloop_wakeup();
  132. if(extarg!=NULL)*extarg=head;
  133. return &g_soe_queue.soe[head];
  134. }
  135. void soe_init(void)
  136. {
  137. u32 i,addr;
  138. u16 index;
  139. EVENT_SAVE tEvt;
  140. // 清零事件状态和事件队列
  141. // 以下1行需屏蔽
  142. // 原因1:定值初始化中会对开出软压板定值及对应事件状态初始化,此处会把该初始化清0
  143. // 原因2:手动清除事件和操作时,会把当前事件的标志清0,会对事件的管理造成混乱
  144. //memset(&g_ev_words,0,sizeof(g_ev_words));
  145. memset(&g_soe_queue,0,sizeof(g_soe_queue));
  146. // 事件保存信息初始化
  147. g_soe_info.wEvIndex = -1;
  148. g_soe_info.wEvNumber= 0;
  149. g_soe_info.wEvID = 0;
  150. g_soe_info.wEvAck = 0;
  151. g_soe_info.wOpIndex = -1;
  152. g_soe_info.wOpNumber= 0;
  153. g_soe_info.wOpID = 0;
  154. g_soe_info.wVipIndex = -1;
  155. g_soe_info.wVipNumber= 0;
  156. g_soe_info.wVipID = 0;
  157. #ifdef ADD_DEBUG_RECORD_FUN
  158. g_soe_info.wDebugIndex = -1;
  159. g_soe_info.wDebugNumber= 0;
  160. g_soe_info.wDebugID = 0;
  161. #endif
  162. // 统计事件记录信息
  163. for(i=0; i<MAX_EVENT_NUMBER; i++)
  164. {
  165. addr=EEP_SOE_ADDR+i*(sizeof(EVENT_SAVE));
  166. e2prom_read(addr,(u8 *)&tEvt,sizeof(EVENT_SAVE));
  167. if(tEvt.es_flag!=SOE_ID_MASK)
  168. {
  169. break;
  170. }
  171. if((s16)(tEvt.es_id - g_soe_info.wEvID) > 0)
  172. {
  173. g_soe_info.wEvIndex=i;
  174. g_soe_info.wEvID=tEvt.es_id;
  175. }
  176. g_soe_info.wEvNumber++;
  177. }
  178. g_soe_info.wEvID++;
  179. // 统计操作记录信息
  180. for(i=0;i<MAX_OPERATE_NUMBER;i++)
  181. {
  182. addr=EEP_OPERATE_ADDR+i*(sizeof(EVENT_SAVE));
  183. e2prom_read(addr,(u8 *)&tEvt,sizeof(EVENT_SAVE));
  184. if(tEvt.es_flag!=SOE_ID_MASK)
  185. {
  186. break;
  187. }
  188. if((s16)(tEvt.es_id - g_soe_info.wOpID) > 0)
  189. {
  190. g_soe_info.wOpIndex=i;
  191. g_soe_info.wOpID=tEvt.es_id;
  192. }
  193. g_soe_info.wOpNumber++;
  194. }
  195. g_soe_info.wOpID++;
  196. // 统计关键记录信息
  197. for(i=0;i<MAX_VIP_NUMBER;i++)
  198. {
  199. addr=EEP_VIP_ADDR+i*(sizeof(EVENT_SAVE));
  200. e2prom_read(addr,(u8 *)&tEvt,sizeof(EVENT_SAVE));
  201. if(tEvt.es_flag!=SOE_ID_MASK)
  202. {
  203. break;
  204. }
  205. if((s16)(tEvt.es_id - g_soe_info.wVipID) > 0)
  206. {
  207. g_soe_info.wVipIndex=i;
  208. g_soe_info.wVipID=tEvt.es_id;
  209. }
  210. g_soe_info.wVipNumber++;
  211. }
  212. g_soe_info.wVipID++;
  213. //#ifdef ADD_DEBUG_RECORD_FUN
  214. for(i=0; i<MAX_DEBUG_RECORD_NUMBER; i++)
  215. {
  216. addr=EEP_DEBUG_RECORD_ADDR+i*(sizeof(EVENT_SAVE));
  217. e2prom_read(addr,(u8 *)&tEvt,sizeof(EVENT_SAVE));
  218. if(tEvt.es_flag!=SOE_ID_MASK)
  219. {
  220. break;
  221. }
  222. //if((s16)(tEvt.es_id - g_soe_info.wVipID) > 0) //可考虑去除此判断
  223. {
  224. g_soe_info.wDebugIndex=i;
  225. //g_soe_info.wVipID=tEvt.es_id;
  226. }
  227. g_soe_info.wDebugNumber++;
  228. }
  229. //#endif
  230. // 如果SOE上电续传没有投入,直接返回
  231. if(pRunSet->bTT_SoeResumePower == 0)
  232. {
  233. return;
  234. }
  235. // 将后台没有确认的事件导入事件队列
  236. index = g_soe_info.wEvIndex+1;
  237. for(i=0;i<MAX_EVENT_NUMBER;i++)
  238. {
  239. // 调整索引
  240. if(index == MAX_EVENT_NUMBER)
  241. {
  242. index = 0;
  243. }
  244. // 取出事件
  245. addr=EEP_SOE_ADDR+index*(sizeof(EVENT_SAVE));
  246. e2prom_read(addr,(u8 *)&tEvt,sizeof(EVENT_SAVE));
  247. // 如果是没有确认的事件,放入事件队列
  248. // rt_printf("soe_init:index=%04d,flag=%02x,ack=%02x.\r\n",index,tEvt.es_flag,tEvt.es_ack);
  249. if((tEvt.es_flag == SOE_ID_MASK) && (tEvt.es_ack == SOE_ID_ACK_NONE))
  250. {
  251. EVENT_SAVE *ev=soe_get_buffer(NULL);
  252. *ev = tEvt ;
  253. ev->es_id = addr-EEP_SOE_BASE;
  254. g_soe_info.wEvAck++;
  255. }
  256. index++;
  257. }
  258. // 保证事件队列中没有确认的事件不会重新保存
  259. g_soe_queue.tail_eep.n = g_soe_queue.head.n;
  260. }
  261. int soe_ev_set(u16 code,u8 v)
  262. {
  263. if(code >= EV_NUMBER)
  264. {
  265. return -1;
  266. }
  267. if(code < EV_PUB_START)
  268. {
  269. g_sw[code/EV_SW_NUM].di[code%EV_SW_NUM+SW_DI_NUM] = v ? SW_DI_TYPE_ON : SW_DI_TYPE_OFF;
  270. }
  271. else
  272. {
  273. g_sw_pub.di[code-EV_PUB_START+PUB_DI_NUM] = v ? SW_DI_TYPE_ON : SW_DI_TYPE_OFF;
  274. }
  275. if(v)
  276. {
  277. g_ev_words[code/32]|=(1<<(code%32)); // 状态更新
  278. }
  279. else
  280. {
  281. g_ev_words[code/32]&=~(DWORD)(1<<(code%32)); //状态更新
  282. }
  283. return 0;
  284. }
  285. u16 soe_lp2cp(u8 ev_type,u16 ev_code,s32 is_mix)
  286. {
  287. int index;
  288. u16 cp = 0;
  289. u8 slot,no;
  290. switch(ev_type&SOE_TYPE_MASK)
  291. {
  292. // 事件通讯点从逻辑单点数组中找
  293. case SOE_TYPE_EV:
  294. if(ev_code < EV_PUB_END)
  295. {
  296. // index = ev_code + PUB_DI_NUM+(SW_DI_NUM*SWITCH_NUM_MAX);
  297. if(ev_code < EV_PUB_START)
  298. {
  299. int sw;
  300. sw = ev_code/EV_SW_NUM;
  301. index = ev_code%EV_SW_NUM;
  302. index = PUB_DI_NUM_ALL + sw*SW_DI_NUM_ALL + SW_DI_NUM + index;
  303. }
  304. else
  305. {
  306. index = ev_code -EV_PUB_START + PUB_DI_NUM;
  307. }
  308. cp = g_lp[index].cp;
  309. }
  310. break;
  311. // 遥信事件通讯点从逻辑单点数组中找
  312. case SOE_TYPE_YX:
  313. slot = ev_code>>8;
  314. no = ev_code&0xff;
  315. index = plc_yx2index(g_di_st[slot][no].owner,g_di_st[slot][no].type);
  316. if(index >= 0)
  317. {
  318. cp = g_lp[index].cp;
  319. }
  320. break;
  321. // 级联事件通讯点
  322. case SOE_TYPE_LNK:
  323. if(is_mix==0)cp = ev_code; //若是级联点是合并点,不上送,由PLC逻辑上送
  324. break;
  325. // 双点事件通讯点从转发点表中的双点部分找
  326. case SOE_TYPE_DPI:
  327. if(ev_code < g_table_head->di_db_num)
  328. {
  329. cp = g_di_db_table[ev_code].cp;
  330. }
  331. break;
  332. // PLC事件通讯点从PLC结构数组中找
  333. case SOE_TYPE_PLC:
  334. if(ev_code < g_plc_num)
  335. {
  336. cp = g_plc[ev_code].cp;
  337. }
  338. break;
  339. // 测试事件通讯点直接传送
  340. case SOE_TYPE_TST:
  341. cp = ev_code;
  342. break;
  343. // 操作事件不送后台
  344. case SOE_TYPE_OPT:
  345. cp = 0;
  346. break;
  347. }
  348. return cp;
  349. }
  350. void soe_ext_arg(u16 index,u32 sw)
  351. {
  352. EVENT_EXT_ARG *pArg;
  353. int ui_begin;
  354. if(sw>0&&sw<=SWITCH_NUM_MAX)
  355. {
  356. sw-=1;
  357. }
  358. else
  359. {
  360. sw=0;
  361. }
  362. pArg=&g_soe_queue.tExtArg[index]; //附加参数
  363. ui_begin = UI_SW_INDEX_BEGIN(sw);
  364. pArg->arg[0] = _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_IA].m2[0]), 256, g_ui[ui_begin + SW_AC_IA].m2_factor_k);
  365. pArg->arg[1] = _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_IB].m2[0]), 256, g_ui[ui_begin + SW_AC_IB].m2_factor_k);
  366. pArg->arg[2] = _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_IC].m2[0]), 256, g_ui[ui_begin + SW_AC_IC].m2_factor_k);
  367. pArg->arg[3] = _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_I0].m2[0]), 256, g_ui[ui_begin + SW_AC_I0].m2_factor_k);
  368. if(pRunSet->tSwSet[sw].bTT_Power_v2)
  369. {
  370. pArg->arg[4] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UA2].m2[0]), 256, g_ui[PUB_AC_UA2].m2_factor_k);
  371. pArg->arg[5] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UB2].m2[0]), 256, g_ui[PUB_AC_UB2].m2_factor_k);
  372. pArg->arg[6] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UC2].m2[0]), 256, g_ui[PUB_AC_UC2].m2_factor_k);
  373. pArg->arg[7] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_U02].m2[0]), 256, g_ui[PUB_AC_U02].m2_factor_k);
  374. pArg->arg[8] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UAB2].m2[0]), 256, g_ui[PUB_AC_UAB2].m2_factor_k);
  375. pArg->arg[9] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UBC2].m2[0]), 256, g_ui[PUB_AC_UBC2].m2_factor_k);
  376. pArg->arg[10] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UCA2].m2[0]), 256, g_ui[PUB_AC_UCA2].m2_factor_k);
  377. }
  378. else
  379. {
  380. pArg->arg[4] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UA1].m2[0]), 256, g_ui[PUB_AC_UA1].m2_factor_k);
  381. pArg->arg[5] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UB1].m2[0]), 256, g_ui[PUB_AC_UB1].m2_factor_k);
  382. pArg->arg[6] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UC1].m2[0]), 256, g_ui[PUB_AC_UC1].m2_factor_k);
  383. pArg->arg[7] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_U01].m2[0]), 256, g_ui[PUB_AC_U01].m2_factor_k);
  384. pArg->arg[8] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UAB1].m2[0]), 256, g_ui[PUB_AC_UAB1].m2_factor_k);
  385. pArg->arg[9] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UBC1].m2[0]), 256, g_ui[PUB_AC_UBC1].m2_factor_k);
  386. pArg->arg[10] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UCA1].m2[0]), 256, g_ui[PUB_AC_UCA1].m2_factor_k);
  387. }
  388. pArg->arg[11] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_US1].m2[0]), 256, g_ui[PUB_AC_US1].m2_factor_k);
  389. pArg->arg[12] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_US2].m2[0]), 256, g_ui[PUB_AC_US2].m2_factor_k);
  390. #ifdef GD_AREA_ECZD_MAOMING
  391. pArg->arg[13] = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UAB2].m2[0]), 256, g_ui[PUB_AC_UAB2].m2_factor_k);
  392. pArg->arg[14] = g_sw_pub.ac_in[PUB_AC_IN_UZ1];
  393. #endif
  394. pArg->type[0]=SW_AC_IA;
  395. pArg->type[1]=SW_AC_IB;
  396. pArg->type[2]=SW_AC_IC;
  397. pArg->type[3]=SW_AC_I0;
  398. if(pRunSet->tSwSet[sw].bTT_Power_v2)
  399. {
  400. pArg->type[4]=PUB_AC_UA2|0x80;
  401. pArg->type[5]=PUB_AC_UB2|0x80;
  402. pArg->type[6]=PUB_AC_UC2|0x80;
  403. pArg->type[7]=PUB_AC_U02|0x80;
  404. pArg->type[8]=PUB_AC_UAB2|0x80;
  405. pArg->type[9]=PUB_AC_UBC2|0x80;
  406. pArg->type[10]=PUB_AC_UCA2|0x80;
  407. }
  408. else
  409. {
  410. pArg->type[4]=PUB_AC_UA1|0x80;
  411. pArg->type[5]=PUB_AC_UB1|0x80;
  412. pArg->type[6]=PUB_AC_UC1|0x80;
  413. pArg->type[7]=PUB_AC_U01|0x80;
  414. pArg->type[8]=PUB_AC_UAB1|0x80;
  415. pArg->type[9]=PUB_AC_UBC1|0x80;
  416. pArg->type[10]=PUB_AC_UCA1|0x80;
  417. }
  418. pArg->type[11]=PUB_AC_US1|0x80;
  419. pArg->type[12]=PUB_AC_US2|0x80;
  420. #ifdef GD_AREA_ECZD_MAOMING
  421. pArg->type[13]=PUB_AC_UAB2|0x80;
  422. pArg->type[14]=PUB_AC_IN_UZ1|0x80;
  423. #endif
  424. pArg->sw=sw;
  425. }
  426. #ifdef SOE_PARA_ALL_SAVE
  427. void soe_record_allArg(s32 *arg,int sw)
  428. {
  429. int ui_begin;
  430. if(sw>0&&sw<=SWITCH_NUM_MAX)
  431. {
  432. sw-=1;
  433. }
  434. else
  435. {
  436. sw=0;
  437. }
  438. ui_begin = UI_SW_INDEX_BEGIN(sw);
  439. *arg++ = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UAB1].m2[0]), 256, g_ui[PUB_AC_UAB1].m2_factor_k);
  440. *arg++ = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UBC1].m2[0]), 256, g_ui[PUB_AC_UBC1].m2_factor_k);
  441. *arg++ = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_UCA1].m2[0]), 256, g_ui[PUB_AC_UCA1].m2_factor_k);
  442. *arg++ = _Mul_Div_U(sqrt_32fix(g_ui[PUB_AC_U01].m2[0]), 256, g_ui[PUB_AC_U01].m2_factor_k);
  443. *arg++ = _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_IA].m2[0]), 256, g_ui[ui_begin + SW_AC_IA].m2_factor_k);
  444. *arg++= _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_IB].m2[0]), 256, g_ui[ui_begin + SW_AC_IB].m2_factor_k);
  445. *arg++ = _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_IC].m2[0]), 256, g_ui[ui_begin + SW_AC_IC].m2_factor_k);
  446. *arg++ = _Mul_Div_U(sqrt_32fix(g_ui[ui_begin + SW_AC_I0].m2[0]), 256, g_ui[ui_begin + SW_AC_I0].m2_factor_k);
  447. }
  448. #endif
  449. void soe_record_ev(u16 code,u8 value,long v1,long v2,long v3 )
  450. {
  451. u16 extarg;
  452. EVENT_STRUCT *ev;
  453. u32 sw;
  454. bool allarg=false;
  455. if(code<EV_PUB_START)
  456. {
  457. sw=(code/EV_SW_NUM)+1;
  458. }
  459. else
  460. {
  461. sw=0;
  462. }
  463. if(code<EV_PUB_START) // add by sunxi 增加故障记录标示
  464. {
  465. #ifdef SOE_RECORD_DELAY
  466. if(!gb_wake_soe) //首次上电时,对前一次上电产生的闭锁事件不做延时处理,避免逻辑运行出错
  467. {
  468. if(tAllSOE[code%EV_SW_NUM].soe_def&SOE_TYPE_DELAY_FHZ && (value==0))
  469. { /*清SOE事件应在置SOE事件完成上送后再清,如果当前SOE事件未置则一直等待,
  470. 避免因分合闸延时上送SOE导致先清了SOE事件再送置SOE事件导致上送COS出错(正确是先置再清)*/
  471. if(g_soe_queue.fzsoe_wait_flag)
  472. {
  473. int i;
  474. g_soe_queue.fzsoe_delay_flag = true;
  475. g_soe_queue.fzsoe_wait_flag = false;
  476. for(i=0;i<DELAY_SOE_MAX;i++)
  477. {
  478. if(g_soe_queue.delay_fzsoe_tab[i].value==0) break;
  479. g_soe_queue.delay_fzsoe_count = i;
  480. soe_record_ev( g_soe_queue.delay_fzsoe_tab[i].code,g_soe_queue.delay_fzsoe_tab[i].value, g_soe_queue.delay_fzsoe_tab[i].v1,g_soe_queue.delay_fzsoe_tab[i].v2,g_soe_queue.delay_fzsoe_tab[i].v3);
  481. }
  482. /*置SOE后调用一次plc_scan,避免置->清SOE间隔过短导致正常plc_san扫描时无法扫描到置SOE*/
  483. plc_scan(1);
  484. memset((char *)&g_soe_queue.delay_fzsoe_tab,0,sizeof(DELAY_SOE_DATA)*DELAY_SOE_MAX);//clear delay_soe_tab[] buffer
  485. g_soe_queue.delay_fzsoe_count = 0;
  486. g_soe_queue.fzsoe_delay_flag = false;
  487. }
  488. if(g_soe_queue.hzsoe_wait_flag)
  489. {
  490. int i;
  491. g_soe_queue.hzsoe_delay_flag = true;
  492. g_soe_queue.hzsoe_wait_flag = false;
  493. for(i=0;i<DELAY_SOE_MAX;i++)
  494. {
  495. if(g_soe_queue.delay_hzsoe_tab[i].value==0) break;
  496. g_soe_queue.delay_hzsoe_count = i;
  497. soe_record_ev( g_soe_queue.delay_hzsoe_tab[i].code,g_soe_queue.delay_hzsoe_tab[i].value, g_soe_queue.delay_hzsoe_tab[i].v1,g_soe_queue.delay_hzsoe_tab[i].v2,g_soe_queue.delay_hzsoe_tab[i].v3);
  498. }
  499. memset((char *)&g_soe_queue.delay_hzsoe_tab,0,sizeof(DELAY_SOE_DATA)*DELAY_SOE_MAX);//clear delay_soe_tab[] buffer
  500. g_soe_queue.delay_hzsoe_count = 0;
  501. g_soe_queue.hzsoe_delay_flag = false;
  502. }
  503. }
  504. else if(tAllSOE[code%EV_SW_NUM].soe_def&SOE_TYPE_DELAY_FHZ && value )//开关延时保存分/合闸动作SOE && 动作
  505. {
  506. u8 i=0;
  507. bool soe_fh=((code%EV_SW_NUM)==EV_AR1)||((code%EV_SW_NUM)==EV_AR2)||((code%EV_SW_NUM)==EV_AR3)||
  508. ((code%EV_SW_NUM)==EV_FA_HZ)||((code%EV_SW_NUM)==EV_FA_LL_HZ);//0-fz soe;1-hz soe
  509. //延时soe入QUEUE
  510. if((g_soe_queue.fzsoe_delay_flag==0) && (g_tRelay[0].run_stu.sw==2) && (!soe_fh))//非分闸延时SOE QUEUE转录SOE && 合位 && 分闸SOE fzsoe_tab[]
  511. {
  512. for(i=0;i<DELAY_SOE_MAX;i++)//大于最大缓存,直接保存SOE
  513. {
  514. if(g_soe_queue.delay_fzsoe_tab[i].code==code)//当前SOE已保存
  515. {
  516. return;//此次不保存数据
  517. }
  518. else if(g_soe_queue.delay_fzsoe_tab[i].value==0)
  519. {
  520. clk_time_get(&g_soe_queue.delay_fzsoe_tab[i].ts);
  521. g_soe_queue.delay_fzsoe_tab[i].value = value;
  522. g_soe_queue.delay_fzsoe_tab[i].code=code;
  523. g_soe_queue.delay_fzsoe_tab[i].v1=v1;
  524. g_soe_queue.delay_fzsoe_tab[i].v2=v2;
  525. g_soe_queue.delay_fzsoe_tab[i].v3=v3;
  526. g_soe_queue.fzsoe_wait_flag = true;
  527. return;//此次不保存数据
  528. }
  529. }
  530. }
  531. else if((g_soe_queue.hzsoe_delay_flag==0) && (g_tRelay[0].run_stu.sw==1) && soe_fh)////非合闸延时SOE QUEUE转录SOE && 分位 && 闸SOE hzsoe_tab[]
  532. {
  533. for(i=0;i<DELAY_SOE_MAX;i++)//大于最大缓存,直接保存SOE
  534. {
  535. if(g_soe_queue.delay_hzsoe_tab[i].code==code)//当前SOE已保存
  536. {
  537. return;//此次不保存数据
  538. }
  539. else if(g_soe_queue.delay_hzsoe_tab[i].value==0)
  540. {
  541. clk_time_get(&g_soe_queue.delay_hzsoe_tab[i].ts);
  542. g_soe_queue.delay_hzsoe_tab[i].value = value;
  543. g_soe_queue.delay_hzsoe_tab[i].code=code;
  544. g_soe_queue.delay_hzsoe_tab[i].v1=v1;
  545. g_soe_queue.delay_hzsoe_tab[i].v2=v2;
  546. g_soe_queue.delay_hzsoe_tab[i].v3=v3;
  547. g_soe_queue.hzsoe_wait_flag = true;
  548. return;//此次不保存数据
  549. }
  550. }
  551. }
  552. }
  553. }
  554. #endif
  555. ev = &soe_get_buffer(&extarg)->es_ev;
  556. ev->ev_type=SOE_TYPE_EV;
  557. if(tAllSOE[code%EV_SW_NUM].soe_def&0x80) // 需上送故障记录
  558. {
  559. ev->ev_type|=SOE_TYPE_FAULT;
  560. soe_ext_arg(extarg,sw);
  561. }
  562. if(tAllSOE[code%EV_SW_NUM].soe_def&0x40) // 置关键事件标志
  563. {
  564. ev->ev_type|=SOE_TYPE_VIP;
  565. }
  566. if(tAllSOE[code%EV_SW_NUM].soe_def&0x10) // 全数据保存
  567. {
  568. allarg=true;
  569. }
  570. }
  571. else
  572. {
  573. #ifdef SOE_RECORD_DELAY
  574. if(!gb_wake_soe) //首次上电时,对前一次上电产生的闭锁事件不做延时处理,避免逻辑运行出错
  575. {
  576. if(tAllSOE[code-EV_PUB_START+EV_SW_NUM].soe_def&SOE_TYPE_DELAY_FHZ && (value==0))
  577. {
  578. if(g_soe_queue.fzsoe_wait_flag)
  579. {
  580. int i;
  581. g_soe_queue.fzsoe_delay_flag = true;
  582. g_soe_queue.fzsoe_wait_flag = false;
  583. for(i=0;i<DELAY_SOE_MAX;i++)
  584. {
  585. if(g_soe_queue.delay_fzsoe_tab[i].value==0) break;
  586. g_soe_queue.delay_fzsoe_count = i;
  587. soe_record_ev( g_soe_queue.delay_fzsoe_tab[i].code,g_soe_queue.delay_fzsoe_tab[i].value, g_soe_queue.delay_fzsoe_tab[i].v1,g_soe_queue.delay_fzsoe_tab[i].v2,g_soe_queue.delay_fzsoe_tab[i].v3);
  588. }
  589. memset((char *)&g_soe_queue.delay_fzsoe_tab,0,sizeof(DELAY_SOE_DATA)*DELAY_SOE_MAX);//clear delay_soe_tab[] buffer
  590. g_soe_queue.delay_fzsoe_count = 0;
  591. g_soe_queue.fzsoe_delay_flag = false;
  592. }
  593. if(g_soe_queue.hzsoe_wait_flag)
  594. {
  595. int i;
  596. g_soe_queue.hzsoe_delay_flag = true;
  597. g_soe_queue.hzsoe_wait_flag = false;
  598. for(i=0;i<DELAY_SOE_MAX;i++)
  599. {
  600. g_soe_queue.delay_hzsoe_count = i;
  601. if(g_soe_queue.delay_hzsoe_tab[i].value==0) break;
  602. soe_record_ev( g_soe_queue.delay_hzsoe_tab[i].code,g_soe_queue.delay_hzsoe_tab[i].value, g_soe_queue.delay_hzsoe_tab[i].v1,g_soe_queue.delay_hzsoe_tab[i].v2,g_soe_queue.delay_hzsoe_tab[i].v3);
  603. }
  604. memset((char *)&g_soe_queue.delay_hzsoe_tab,0,sizeof(DELAY_SOE_DATA)*DELAY_SOE_MAX);//clear delay_soe_tab[] buffer
  605. g_soe_queue.delay_hzsoe_count = 0;
  606. g_soe_queue.hzsoe_delay_flag = false;
  607. }
  608. }
  609. else if(tAllSOE[code-EV_PUB_START+EV_SW_NUM].soe_def&SOE_TYPE_DELAY_FHZ && value)//开关延时保存分/合闸动作SOE && 动作
  610. {
  611. u8 i=0;
  612. bool soe_fh=(((code-EV_PUB_START+EV_SW_NUM)%EV_SW_NUM)==EV_AR1)||(((code-EV_PUB_START+EV_SW_NUM)%EV_SW_NUM)==EV_AR2)||(((code-EV_PUB_START+EV_SW_NUM)%EV_SW_NUM)==EV_AR3)||
  613. (((code-EV_PUB_START+EV_SW_NUM)%EV_SW_NUM)==EV_FA_HZ)||(((code-EV_PUB_START+EV_SW_NUM)%EV_SW_NUM)==EV_FA_LL_HZ);//0-fz soe;1-hz soe
  614. //延时soe入QUEUE
  615. if((g_soe_queue.fzsoe_delay_flag==0) && (g_tRelay[sw].run_stu.sw==2) && (!soe_fh))//非分闸延时SOE QUEUE转录SOE && 合位 && 分闸SOE fzsoe_tab[]
  616. {
  617. for(i=0;i<DELAY_SOE_MAX;i++)//大于最大缓存,直接保存SOE
  618. {
  619. if(g_soe_queue.delay_fzsoe_tab[i].code==code)//当前SOE已保存
  620. {
  621. return;//此次不保存数据
  622. }
  623. else if(g_soe_queue.delay_fzsoe_tab[i].value==0)
  624. {
  625. clk_time_get(&g_soe_queue.delay_fzsoe_tab[i].ts);
  626. g_soe_queue.delay_fzsoe_tab[i].value = value;
  627. g_soe_queue.delay_fzsoe_tab[i].code=code;
  628. g_soe_queue.delay_fzsoe_tab[i].v1=v1;
  629. g_soe_queue.delay_fzsoe_tab[i].v2=v2;
  630. g_soe_queue.delay_fzsoe_tab[i].v3=v3;
  631. g_soe_queue.fzsoe_wait_flag = true;
  632. return;//此次不保存数据
  633. }
  634. }
  635. }
  636. else if((g_soe_queue.hzsoe_delay_flag==0) && (g_tRelay[sw].run_stu.sw==1) && soe_fh)////非合闸延时SOE QUEUE转录SOE && 分位 && 合闸SOE hzsoe_tab[]
  637. {
  638. for(i=0;i<DELAY_SOE_MAX;i++)//大于最大缓存,直接保存SOE
  639. {
  640. if(g_soe_queue.delay_hzsoe_tab[i].code==code)//当前SOE已保存
  641. {
  642. return;//此次不保存数据
  643. }
  644. else if(g_soe_queue.delay_hzsoe_tab[i].value==0)
  645. {
  646. clk_time_get(&g_soe_queue.delay_hzsoe_tab[i].ts);
  647. g_soe_queue.delay_hzsoe_tab[i].value = value;
  648. g_soe_queue.delay_hzsoe_tab[i].code=code;
  649. g_soe_queue.delay_hzsoe_tab[i].v1=v1;
  650. g_soe_queue.delay_hzsoe_tab[i].v2=v2;
  651. g_soe_queue.delay_hzsoe_tab[i].v3=v3;
  652. g_soe_queue.hzsoe_wait_flag = true;
  653. return;//此次不保存数据
  654. }
  655. }
  656. }
  657. }
  658. }
  659. #endif
  660. ev = &soe_get_buffer(&extarg)->es_ev;
  661. ev->ev_type=SOE_TYPE_EV;
  662. if(tAllSOE[code-EV_PUB_START+EV_SW_NUM].soe_def&0x80) // 需上送故障记录
  663. {
  664. ev->ev_type|=SOE_TYPE_FAULT;
  665. soe_ext_arg(extarg,sw);
  666. }
  667. if(tAllSOE[code-EV_PUB_START+EV_SW_NUM].soe_def&0x40) // 需上送故障记录
  668. {
  669. ev->ev_type|=SOE_TYPE_VIP;
  670. }
  671. if(tAllSOE[code-EV_PUB_START+EV_SW_NUM].soe_def&0x10) // 需上送故障记录
  672. {
  673. allarg=true;
  674. }
  675. }
  676. if(allarg) //保存全参数
  677. {
  678. #ifdef SOE_PARA_ALL_SAVE
  679. soe_record_allArg(&ev->allarg[0],sw);
  680. #endif
  681. }
  682. soe_ev_set(code,value);
  683. ev->ev_value = value;
  684. ev->ev_code=code;
  685. ev->ev_arg[0]=v1;
  686. ev->ev_arg[1]=v2;
  687. ev->ev_arg[2]=v3;
  688. #ifdef SOE_RECORD_DELAY
  689. //延时SOE QUEUE中SOE时标获得
  690. //转录SOE && QUEUE非空 && code对应 && 动作
  691. if(!gb_wake_soe)
  692. {
  693. if(g_soe_queue.fzsoe_delay_flag && !g_soe_queue.fzsoe_wait_flag && g_soe_queue.delay_fzsoe_tab[g_soe_queue.delay_fzsoe_count].code==code && value )
  694. {
  695. memcpy(&ev->ts,&g_soe_queue.delay_fzsoe_tab[g_soe_queue.delay_fzsoe_count].ts,sizeof(struct timespec));
  696. }
  697. else if(g_soe_queue.hzsoe_delay_flag && !g_soe_queue.hzsoe_wait_flag && g_soe_queue.delay_hzsoe_tab[g_soe_queue.delay_hzsoe_count].code==code && value )
  698. {
  699. memcpy(&ev->ts,&g_soe_queue.delay_hzsoe_tab[g_soe_queue.delay_hzsoe_count].ts,sizeof(struct timespec));
  700. }
  701. else //其它非延时SOE 时标获得
  702. {
  703. clk_time_get(&ev->ts);
  704. }
  705. }
  706. else //其它非延时SOE 时标获得
  707. {
  708. clk_time_get(&ev->ts);
  709. }
  710. #else
  711. clk_time_get(&ev->ts);
  712. #endif
  713. g_soe_queue.stat_cnt_type[SOE_TYPE_EV]++;
  714. }
  715. int soe_record_imp(u16 code,u8 val)
  716. {
  717. int i;
  718. u8 slot=(u8)(code>>8); //板卡号
  719. u8 dino=(u8)(code); //遥信号
  720. for(i=0; i< g_equ_config->di_num; i++)
  721. {
  722. if((g_equ_config_di[i].slot==slot)&&(g_equ_config_di[i].index==dino))
  723. {
  724. break;
  725. }
  726. }
  727. if(i<g_equ_config->di_num)
  728. {
  729. u8 sw=g_equ_config_di[i].owner;
  730. u8 type=g_equ_config_di[i].type;
  731. if(type==0||sw==0||sw>SWITCH_NUM_MAX)return 0;
  732. type-=1;
  733. sw-=1;
  734. if(type>=SW_DI_IMP1&&type<=SW_DI_IMP2) //是脉冲计数
  735. {
  736. if(val==1)g_sw[sw].ac_in[SW_AC_IN_IMP1+type-SW_DI_IMP1]++;
  737. return 1;
  738. }
  739. }
  740. return 0;
  741. }
  742. void soe_record_yx(u16 code,u8 value,struct timespec * ts)
  743. {
  744. EVENT_STRUCT *ev;
  745. if(soe_record_imp(code ,value)) return; //是脉冲计数值,直接返回,不保存
  746. ev = &soe_get_buffer_yx()->es_ev;
  747. ev->ev_type=SOE_TYPE_YX;
  748. ev->ev_value = value;
  749. ev->ev_code=code;
  750. ev->ev_arg[0]=0;
  751. ev->ev_arg[1]=0;
  752. ev->ev_arg[2]=0;
  753. ev->ts=*ts;
  754. // 双点触发
  755. plc_db_soe(ev);
  756. g_soe_queue.stat_cnt_type[SOE_TYPE_YX]++;
  757. //关键遥信变位处理
  758. {
  759. u8 type;
  760. u8 slot=(u8)(code>>8); //板卡号
  761. u8 no=(u8)(code); //遥信号
  762. type=equ_di_type(slot,no);
  763. if(type>0)
  764. {
  765. type--;
  766. //佛山局要求开关分合位为关键记录
  767. #if defined GD_AREA_FOS || defined GD_AREA_FOS_2021 || defined FOS_2021
  768. if(type==SW_DI_KRHW ||type==SW_DI_KRTW) // 跳位
  769. {
  770. ev->ev_type|=SOE_TYPE_VIP;
  771. }
  772. #endif
  773. }
  774. }
  775. }
  776. void soe_record_lnk(u16 code,u8 value,struct timespec * ts, s32 v1,bool bmix,u32 cp_s)
  777. {
  778. EVENT_STRUCT *ev = &soe_get_buffer(NULL)->es_ev;
  779. //rt_printf("\r\n soe_record_lnk :code=%04x v=%d v1=%d bmix=%d",code,value,v1,bmix);
  780. ev->ev_type=SOE_TYPE_LNK;
  781. ev->ev_value=value;
  782. ev->ev_code=code;
  783. ev->ev_arg[0]=v1;
  784. ev->ev_arg[1]=bmix;
  785. ev->ev_arg[2]=cp_s;
  786. ev->ts=*ts;
  787. g_soe_queue.stat_cnt_type[SOE_TYPE_LNK]++;
  788. }
  789. void soe_record_dpi(u16 code,u8 value,struct timespec * ts)
  790. {
  791. EVENT_STRUCT *ev = &soe_get_buffer(NULL)->es_ev;
  792. ev->ev_type = SOE_TYPE_DPI;
  793. ev->ev_value=value;
  794. ev->ev_code=code;
  795. ev->ev_arg[0]=0;
  796. ev->ev_arg[1]=0;
  797. ev->ev_arg[2]=0;
  798. ev->ts=*ts;
  799. g_soe_queue.stat_cnt_type[SOE_TYPE_DPI]++;
  800. }
  801. void soe_record_plc(u16 code,u8 value, u32 flag)
  802. {
  803. u16 extarg;
  804. EVENT_STRUCT *ev = &soe_get_buffer(&extarg)->es_ev;
  805. ev->ev_type = SOE_TYPE_PLC;
  806. if(flag & PLC_FLAG_FAULT)
  807. {
  808. ev->ev_type|=SOE_TYPE_FAULT;
  809. soe_ext_arg(extarg,(flag>>16));
  810. }
  811. ev->ev_value =value;
  812. ev->ev_code=code;
  813. ev->ev_arg[0]=0;
  814. ev->ev_arg[1]=0;
  815. ev->ev_arg[2]=0;
  816. clk_time_get(&ev->ts);
  817. g_soe_queue.stat_cnt_type[SOE_TYPE_PLC]++;
  818. }
  819. void soe_record_tst(u16 code,u8 value)
  820. {
  821. EVENT_STRUCT *ev = &soe_get_buffer(NULL)->es_ev;
  822. ev->ev_type = SOE_TYPE_TST;
  823. ev->ev_value =value;
  824. ev->ev_code=code;
  825. ev->ev_arg[0]=0;
  826. ev->ev_arg[1]=0;
  827. ev->ev_arg[2]=0;
  828. clk_time_get(&ev->ts);
  829. g_soe_queue.stat_cnt_type[SOE_TYPE_TST]++;
  830. }
  831. void soe_record_opt(u16 code,long v1)
  832. {
  833. EVENT_STRUCT *ev = &soe_get_buffer(NULL)->es_ev;
  834. ev->ev_type=SOE_TYPE_OPT;
  835. #ifdef GD_AREA_FOS_2020
  836. if(tAllSOE[code-EV_SW_NUM*(SWITCH_NUM_MAX-1)].soe_def&0x40) // 置关键事件标志
  837. {
  838. ev->ev_type|=SOE_TYPE_VIP;
  839. }
  840. #endif
  841. ev->ev_value=1;
  842. ev->ev_code=code;
  843. ev->ev_arg[0]=v1;
  844. ev->ev_arg[1]=0;
  845. ev->ev_arg[2]=0;
  846. clk_time_get(&ev->ts);
  847. g_soe_queue.stat_cnt_type[SOE_TYPE_OPT]++;
  848. }
  849. #ifdef FUN_SET_CHANGE_SOE
  850. void soe_record_opt3(u16 code,long v1,long v2,long v3)
  851. {
  852. EVENT_STRUCT *ev = &soe_get_buffer(NULL)->es_ev;
  853. ev->ev_type=SOE_TYPE_OPT;
  854. #ifdef GD_AREA_FOS_2020
  855. if(tAllSOE[code-EV_SW_NUM*(SWITCH_NUM_MAX-1)].soe_def&0x40) // 置关键事件标志
  856. {
  857. ev->ev_type|=SOE_TYPE_VIP;
  858. }
  859. #endif
  860. ev->ev_value=1;
  861. ev->ev_code=code;
  862. ev->ev_arg[0]=v1;
  863. ev->ev_arg[1]=v2;
  864. ev->ev_arg[2]=v3;
  865. clk_time_get(&ev->ts);
  866. g_soe_queue.stat_cnt_type[SOE_TYPE_OPT]++;
  867. }
  868. #endif
  869. int soe_get(u8 ch,EVENT_STRUCT *ev)
  870. {
  871. u16 tail_send;
  872. sbi_t tail_send_new;
  873. uint32_t flags;
  874. int ok;
  875. // 检查参数
  876. if(ch >= COMM_CHANNEL_NUM || ev == NULL)
  877. {
  878. return -1;
  879. }
  880. // 检查是否有数据
  881. if(g_soe_queue.tail_send[ch].n == g_soe_queue.head.n)
  882. {
  883. return -2;
  884. }
  885. // 为了防止取出不正确或不完整的数据(在SOE池已满且事件正在产生,此时104主站连接进来时最容易产生)
  886. // 需检查tail_send是否被中断修改。
  887. while(1)
  888. {
  889. // 获取事件,调整尾指针
  890. tail_send = g_soe_queue.tail_send[ch].n;
  891. *ev = g_soe_queue.soe[tail_send].es_ev;
  892. tail_send_new.n = tail_send+1;
  893. // 在关中断的情况下,检测修改尾指针,避免数据错误。
  894. ok = 0;
  895. rt_irq_save(flags);
  896. if(tail_send == g_soe_queue.tail_send[ch].n)
  897. {
  898. g_soe_queue.tail_send[ch].n = tail_send_new.n;
  899. ok=1;
  900. }
  901. rt_irq_restore(flags);
  902. if(ok)
  903. {
  904. break;
  905. }
  906. rt_printf_time("soe_get(%d): old =%d,new=%d!\r\n",ch,tail_send ,g_soe_queue.tail_send[ch].n);
  907. }
  908. return tail_send_new.n;
  909. }
  910. // 注意:ack是已确认事件的下一个(还不能确认)
  911. void soe_ack(u8 chnl,u16 ack)
  912. {
  913. u32 es_save_addr=0,es_save_cnt = 0;
  914. sbi_t num_all,num_send,num_ack;
  915. EVENT_SAVE *es,tEvt;
  916. u8 soe_type;
  917. u32 addr;
  918. // 检查ack是否在合法的范围内,ack的位置必须在tail_ack和tail_send之间
  919. num_send.n = g_soe_queue.tail_send[chnl].n - g_soe_queue.tail_ack[chnl].n;
  920. num_ack.n = ack - g_soe_queue.tail_ack[chnl].n;
  921. if(num_ack.n > num_send.n)
  922. {
  923. num_all.n = g_soe_queue.head.n - g_soe_queue.tail_ack[chnl].n;
  924. rt_printf_time("soe_ack error:num_send=%d,num_ack=%d,head=%d,tail_send=%d,tail_ack=%d,ack=%d.\r\n",
  925. num_send.n,num_ack.n,g_soe_queue.head.n,g_soe_queue.tail_send[chnl].n,g_soe_queue.tail_ack[chnl].n, ack);
  926. return;
  927. }
  928. // 循环确认事件
  929. for(;g_soe_queue.tail_ack[chnl].n != ack; g_soe_queue.tail_ack[chnl].n++)
  930. {
  931. es = &g_soe_queue.soe[g_soe_queue.tail_ack[chnl].n];
  932. // 检查是否是不需要确认的事件
  933. soe_type = es->es_ev.ev_type & SOE_TYPE_MASK;
  934. if(soe_type >= SOE_TYPE_ACK)
  935. {
  936. continue;
  937. }
  938. // 没有保存过的事件不能更新
  939. if(es->es_flag != SOE_ID_MASK)
  940. {
  941. rt_printf_time("soe_ack_ev:没有保存过的事件不能更新,es_flag=%02x.\r\n",es->es_flag);
  942. continue;
  943. }
  944. // 已确认过的事件不再确认
  945. if(es->es_ack == SOE_ID_ACK_OK)
  946. {
  947. continue;
  948. }
  949. es->es_ack = SOE_ID_ACK_OK;
  950. // 读出已保存的事件
  951. addr = es->es_id+EEP_SOE_BASE;
  952. e2prom_read(addr,(u8 *)&tEvt,sizeof(EVENT_SAVE));
  953. es->es_id = tEvt.es_id;
  954. // 两份内容除了ack外,应完全一样
  955. tEvt.es_ack = es->es_ack;
  956. if(memcmp(es,&tEvt,sizeof(tEvt)))
  957. {
  958. rt_printf_time("soe_update_ev:memcmp error!\r\n");
  959. continue;
  960. }
  961. // 处理保存信息
  962. if(es_save_cnt == 0)
  963. {
  964. es_save_addr = addr;
  965. }
  966. // 如果地址不连续或BUF已满,先保存一段
  967. else if((addr != es_save_addr+es_save_cnt*sizeof(EVENT_SAVE)) || es_save_cnt == SOE_SAVE_BUF_NUM)
  968. {
  969. e2prom_write(es_save_addr,(u8 *)&g_soe_sbuf,sizeof(EVENT_SAVE)*es_save_cnt);
  970. es_save_cnt = 0;
  971. es_save_addr = addr;
  972. }
  973. // 写入确认事件
  974. memcpy(&g_soe_sbuf[es_save_cnt++],&tEvt,sizeof(EVENT_SAVE));
  975. g_soe_info.wEvAck--;
  976. }
  977. if(es_save_cnt)
  978. {
  979. e2prom_write(es_save_addr,(u8 *)&g_soe_sbuf,sizeof(EVENT_SAVE)*es_save_cnt);
  980. }
  981. // rt_printf("SOE通讯BUF:head=%d,tail_send=%d,tail_ack=%d\r\n",g_soe_queue.head.n,g_soe_queue.tail_send[chnl].n,g_soe_queue.tail_ack[chnl].n);
  982. return;
  983. }
  984. void soe_log(EVENT_STRUCT * er)
  985. {
  986. static char log[512];
  987. u8 soe_type;
  988. char *buf;
  989. struct rtc_time_t tm;
  990. timespec_to_rtc(er->ts,&tm,0);
  991. buf = log;
  992. sprintf(buf,"20%02hu-%02hu-%02hu %02hu:%02hu:%02hu.%06u ",tm.year,tm.month,tm.day,tm.hour,tm.min,tm.ms/1000,er->ts.tv_nsec/1000);
  993. buf += strlen(buf);
  994. soe_type = er->ev_type&SOE_TYPE_MASK;
  995. if(soe_type==SOE_TYPE_EV||soe_type==SOE_TYPE_OPT) // 不是遥信变位
  996. {
  997. int i;
  998. int ev_sw=0;
  999. int len=0;
  1000. u16 code;
  1001. const SOE_DEF * psoe;
  1002. if(er->ev_code>=EV_NUMBER)
  1003. {
  1004. sprintf(buf,"错误代码:%d",er->ev_code);
  1005. log_str_ext(LOG_SOE,log);
  1006. return;
  1007. }
  1008. if (er->ev_code < EV_SW_NUM)
  1009. {
  1010. code = er->ev_code;
  1011. ev_sw = 1;
  1012. }
  1013. else if ((er->ev_code >= EV_SW_NUM)&& (er->ev_code < EV_PUB_START))
  1014. {
  1015. code = er->ev_code % EV_SW_NUM;
  1016. ev_sw = (er->ev_code / EV_SW_NUM) + 1;
  1017. }
  1018. else
  1019. {
  1020. #ifdef FUN_SET_CHANGE_SOE
  1021. if(er->ev_code==EV_SET_CHANGE_PARA)return; //定值修改操作记录,不做日志,已经有修改内容记录
  1022. #endif
  1023. code = er->ev_code - EV_SW_NUM*(SWITCH_NUM_MAX-1);
  1024. }
  1025. #if SWITCH_NUM_MAX != 1
  1026. {
  1027. if ((ev_sw > 0) && (ev_sw <= SWITCH_NUM_MAX))
  1028. {
  1029. sprintf(buf,"开关%02d ",ev_sw);
  1030. len = strlen(buf);
  1031. }
  1032. }
  1033. #endif
  1034. psoe=&tAllSOE[code];
  1035. if(soe_ev_is_on(er)) // 置1 ,产生,显示参数
  1036. {
  1037. #ifdef XDL_ZT
  1038. if(code == EV_LX_XDL_QD)
  1039. {
  1040. if(er->ev_arg[2] == 1)
  1041. strcpy(&buf[len],"小电流接地:启动[界内动作]");
  1042. else if(er->ev_arg[2] == 0)
  1043. strcpy(&buf[len],"小电流接地:启动[界外动作]");
  1044. else if(er->ev_arg[2] == -1)
  1045. strcpy(&buf[len],"小电流接地:启动[线路无流]");
  1046. else if(er->ev_arg[2] == -2)
  1047. strcpy(&buf[len],"小电流接地:启动[电压欠幅]");
  1048. else if(er->ev_arg[2] == -3)
  1049. strcpy(&buf[len],"小电流接地:启动[电压无向]");
  1050. else if(er->ev_arg[2] == -4)
  1051. strcpy(&buf[len],"小电流接地:启动[无首半波]");
  1052. else if(er->ev_arg[2] == -11)
  1053. strcpy(&buf[len],"小电流接地:启动[无电压通道]");
  1054. else if(er->ev_arg[2] == -12)
  1055. strcpy(&buf[len],"小电流接地:启动[功能禁止]");
  1056. else if(er->ev_arg[2] == -13)
  1057. strcpy(&buf[len],"小电流接地:启动[无电流通道]");
  1058. else if(er->ev_arg[2] == -14)
  1059. strcpy(&buf[len],"小电流接地:启动[处理超时]");
  1060. else if(er->ev_arg[2] == -15)
  1061. strcpy(&buf[len],"小电流接地:启动[开关序号异常]");
  1062. }
  1063. else
  1064. {
  1065. strcpy(&buf[len],psoe->strName);
  1066. }
  1067. #else
  1068. strcpy(&buf[len],psoe->strName);
  1069. #endif
  1070. buf += strlen(buf);
  1071. for(i=0;i<3;i++)
  1072. {
  1073. u8 index=(psoe->Attrib[i]&0x1f);
  1074. if(index == 0)
  1075. {
  1076. continue;
  1077. }
  1078. switch((psoe->Attrib[i]>>5)&0x07)
  1079. {
  1080. case 0: // 浮点数
  1081. sprintf(buf," %s=%f%s",ev_para[index].strName,(float)er->ev_arg[i]/Q16_BASE,g_unit[ev_para[index].byNo].name);
  1082. break;
  1083. case 1: // 整型值
  1084. sprintf(buf," %s=%d%s",ev_para[index].strName,er->ev_arg[i],g_unit[ev_para[index].byNo].name);
  1085. break;
  1086. case 2: // 遥控操作
  1087. if(i == 0)
  1088. {
  1089. u8 sw=(er->ev_arg[0]>>8)&0xff; //开关号
  1090. u8 no=(er->ev_arg[0]>>0)&0xff; //序号
  1091. char *ykowner;
  1092. ykowner=get_yk_owner((er->ev_arg[0]>>16)&0xff);
  1093. if(sw==0)
  1094. {
  1095. sprintf(buf,"--%s:公共开出%02d",ykowner,no);
  1096. }
  1097. else
  1098. {
  1099. sprintf(buf,"--%s:开关%02d开出%02d",ykowner,sw,no);
  1100. }
  1101. }
  1102. break;
  1103. case 3: // 压板操作
  1104. {
  1105. strcpy(buf,"投入");
  1106. }
  1107. break;
  1108. default:
  1109. sprintf(buf," 参数错误");
  1110. break;
  1111. }
  1112. buf += strlen(buf);
  1113. }
  1114. }
  1115. else // 置 0,显示返回值
  1116. {
  1117. strcpy(&buf[len],psoe->strName);
  1118. buf += strlen(buf);
  1119. strcpy(buf,ev_back[(psoe->soe_def&0x03)]);
  1120. }
  1121. if(soe_type==SOE_TYPE_EV)
  1122. {
  1123. log_str_ext(LOG_SOE,log);
  1124. if(soe_ev_is_on(er)) // 置1 ,产生,显示参数
  1125. {
  1126. if(er->ev_code == EV_TWYL)
  1127. {
  1128. load_hs_log_rcd(TYPE_SW_YX,false,&tm,"Tripping position but current occured",1);
  1129. }
  1130. else if(er->ev_code == EV_BOARDCOMM)
  1131. {
  1132. load_hs_log_rcd(TYPE_HW_ERR,false,&tm,"The subboard communication is abnormal occured",1);
  1133. }
  1134. else if(er->ev_code == EV_HMIERR)
  1135. {
  1136. load_hs_log_rcd(TYPE_HW_ERR,false,&tm,"Panel communication error occured",1);
  1137. }
  1138. else if(er->ev_code == EV_TZFAIL)
  1139. {
  1140. load_hs_log_rcd(TYPE_CTL_LOOP,false,&tm,"Tripping failure occured",1);
  1141. }
  1142. }
  1143. else
  1144. {
  1145. if(er->ev_code == EV_TWYL)
  1146. {
  1147. load_hs_log_rcd(TYPE_SW_YX,false,&tm,"Tripping position but current disappeared",0);
  1148. }
  1149. else if(er->ev_code == EV_BOARDCOMM)
  1150. {
  1151. load_hs_log_rcd(TYPE_HW_ERR,false,&tm,"The subboard communication is abnormal disappeared",0);
  1152. }
  1153. else if(er->ev_code == EV_HMIERR)
  1154. {
  1155. load_hs_log_rcd(TYPE_HW_ERR,false,&tm,"Panel communication error disappeared",0);
  1156. }
  1157. else if(er->ev_code == EV_TZFAIL)
  1158. {
  1159. load_hs_log_rcd(TYPE_CTL_LOOP,false,&tm,"Tripping failure disappeared",0);
  1160. }
  1161. }
  1162. }
  1163. else
  1164. {
  1165. log_str(LOG_OPERATE,log);
  1166. if(er->ev_code == EV_SET_OK)
  1167. {
  1168. load_hs_log_rcd(TYPE_DEV_PARM,false,&tm,"The fixed value is determined successfully",1);
  1169. }
  1170. else if(er->ev_code == EV_CSTSET_OK)
  1171. {
  1172. load_hs_log_rcd(TYPE_DEV_PARM,false,&tm,"The setting of the internal fixed value is determined successfully",1);
  1173. }
  1174. else if(er->ev_code == EV_EQUPARA_OK)
  1175. {
  1176. load_hs_log_rcd(TYPE_DEV_PARM,false,&tm,"Device parameter setting successfully",1);
  1177. }
  1178. else if(er->ev_code == EV_SET_FAIL)
  1179. {
  1180. load_hs_log_rcd(TYPE_DEV_PARM,false,&tm,"The fixed value is set to fail",1);
  1181. }
  1182. else if(er->ev_code == EV_CSTSET_FAIL)
  1183. {
  1184. load_hs_log_rcd(TYPE_DEV_PARM,false,&tm,"Internal setting failed",1);
  1185. }
  1186. else if(er->ev_code == EV_EQUPARA_FAIL)
  1187. {
  1188. load_hs_log_rcd(TYPE_DEV_PARM,false,&tm,"Device parameter setting failed",1);
  1189. }
  1190. if(er->ev_code == EV_BAT_AUTOACTIVE)
  1191. {
  1192. load_hs_log_rcd(TYPE_STANDBY_POW,false,&tm,"Automatic battery activation",0);
  1193. }
  1194. else if(er->ev_code == EV_BAT_HANDACTIVE)
  1195. {
  1196. load_hs_log_rcd(TYPE_STANDBY_POW,false,&tm,"Battery activation",0);
  1197. }
  1198. else if(er->ev_code == EV_BAT_HANDACTOFF)
  1199. {
  1200. load_hs_log_rcd(TYPE_STANDBY_POW,false,&tm,"Battery activation exit",0);
  1201. }
  1202. else if(er->ev_code == EV_BAT_HANDOFF)
  1203. {
  1204. load_hs_log_rcd(TYPE_STANDBY_POW,false,&tm,"Manual exit of battery",0);
  1205. }
  1206. //else if(er->ev_code == EV_BATERR)
  1207. //{
  1208. // load_hs_log_rcd(TYPE_STANDBY_POW,false,&tm,"Abnormal battery alarm",0);
  1209. //}
  1210. }
  1211. }
  1212. // 遥信变位记录
  1213. else if(soe_type==SOE_TYPE_YX)
  1214. {
  1215. u8 slot=(u8)(er->ev_code>>8); //板卡号
  1216. u8 dino=(u8)(er->ev_code); //遥信号
  1217. char * name;
  1218. name = equ_di_name(slot,dino);
  1219. if(name)
  1220. {
  1221. sprintf(buf,"板卡%02d开入%02d[%s]变位",slot,dino+1,name);
  1222. }
  1223. else
  1224. {
  1225. sprintf(buf,"板卡%02d开入%02d[]变位",slot,dino+1);
  1226. }
  1227. buf += strlen(buf);
  1228. if(soe_ev_is_on(er)) // 置1 ,产生,显示参数
  1229. {
  1230. sprintf(buf," 0->1");
  1231. }
  1232. else
  1233. {
  1234. sprintf(buf," 1->0");
  1235. }
  1236. log_str_ext(LOG_YX,log);
  1237. }
  1238. // 级联SOE记录
  1239. else if(soe_type==SOE_TYPE_LNK)
  1240. {
  1241. char name[TRANS_SZ_BUF_LEN];
  1242. LINK_TABLE * lt;
  1243. lt = (LINK_TABLE *)er->ev_arg[0];
  1244. name[0] = 0;
  1245. if(lt->is_mix==1)
  1246. {
  1247. sprintf(name,"合并点%d",lt->tbl_index+1);
  1248. }
  1249. else
  1250. {
  1251. tbl_getname(RES_TYPE_YX,lt->tbl_index,name);
  1252. }
  1253. sprintf(buf,"通道%d地址%02d 点号0x%04x(级联点号0x%04x %s)变位",(u8)((lt->cp_s>>21)&0x0f),(u8)((lt->cp_s>>16)&0x1f),lt->cp,(lt->cp_s)&0xffff,name);
  1254. buf += strlen(buf);
  1255. if(soe_ev_is_on(er)) // 置1 ,产生,显示参数
  1256. {
  1257. sprintf(buf," 0->1");
  1258. }
  1259. else
  1260. {
  1261. sprintf(buf," 1->0");
  1262. }
  1263. log_str_ext(LOG_SOE,log);
  1264. }
  1265. // 双点变位记录
  1266. else if(soe_type==SOE_TYPE_DPI)
  1267. {
  1268. sprintf(buf,"双点%02d变位[值:%d,通讯点:0x%04x]",er->ev_code,er->ev_value,g_di_db_table[er->ev_code].cp);
  1269. log_str_ext(LOG_SOE,log);
  1270. }
  1271. // PLC变位记录
  1272. else if(soe_type==SOE_TYPE_PLC)
  1273. {
  1274. sprintf(buf,"PLC%02d变位[值:%d,通讯点:0x%04x]",er->ev_code,er->ev_value,g_plc[er->ev_code].cp);
  1275. log_str_ext(LOG_SOE,log);
  1276. }
  1277. else
  1278. {
  1279. sprintf(buf,"未知类型:%d",er->ev_code);
  1280. log_str_ext(LOG_SOE,log);
  1281. }
  1282. }
  1283. #ifdef ADD_DEBUG_RECORD_AUTO_SHOW_FUN
  1284. //TODO: add execute event judge
  1285. u8 JudgeExecuteEventFun(EVENT_SAVE es)
  1286. {
  1287. u8 res=FALSE;
  1288. u16 count;
  1289. //rt_printf("EXECUTE_EVENT_NUM=%d\r\n",EXECUTE_EVENT_NUM);
  1290. for(count=0;count<EXECUTE_EVENT_NUM;count++)
  1291. if(ExecuteEventIdTbl[count]==es.es_ev.ev_code)
  1292. {
  1293. res=TRUE;
  1294. break;
  1295. }
  1296. return res;
  1297. }
  1298. #endif
  1299. void soe_save(void)
  1300. {
  1301. u32 es_save_addr=0,es_save_cnt = 0;
  1302. u32 addr,ok,head;
  1303. sbi_t tail_send,tail_send_new;
  1304. EVENT_SAVE es,*esp;
  1305. uint32_t flags;
  1306. u8 soe_type;
  1307. u64 us0;
  1308. // 循环保存所有记录
  1309. us0 = bsp_ustimer_get_origin();
  1310. head = g_soe_queue.head.n;
  1311. while(g_soe_queue.tail_eep.n != head && es_save_cnt < SOE_SAVE_BUF_NUM)
  1312. {
  1313. // 为了防止取出不正确或不完整的数据(在SOE池已满且事件正在产生)
  1314. // 需检查tail_send是否被中断修改。
  1315. while(1)
  1316. {
  1317. // 获取事件,调整尾指针
  1318. tail_send.n = g_soe_queue.tail_eep.n;
  1319. es=g_soe_queue.soe[tail_send.n];
  1320. esp = &g_soe_queue.soe[tail_send.n];
  1321. // 在关中断的情况下,检测修改尾指针,避免数据错误。
  1322. ok = 0;
  1323. tail_send_new.n = tail_send.n+1;
  1324. rt_irq_save(flags);
  1325. if(tail_send.n == g_soe_queue.tail_eep.n)
  1326. {
  1327. g_soe_queue.tail_eep.n = tail_send_new.n;
  1328. ok=1;
  1329. }
  1330. rt_irq_restore(flags);
  1331. if(ok)
  1332. {
  1333. break;
  1334. }
  1335. rt_printf("soe_save: old =%d,new=%d!\r\n",tail_send.n ,g_soe_queue.tail_eep.n);
  1336. }
  1337. soe_type = es.es_ev.ev_type & SOE_TYPE_MASK;
  1338. if(soe_type != SOE_TYPE_TST)
  1339. {
  1340. // 输出到日志记录文本文件
  1341. soe_log(&es.es_ev);
  1342. //输出历史SOE记录文件
  1343. refresh_soe_file(&es.es_ev);
  1344. // 初始化事件保存信息
  1345. addr = 0;
  1346. es.es_flag=SOE_ID_MASK; // 记录标志
  1347. es.es_ack= pRunSet->bTT_SoeResumePower ? SOE_ID_ACK_NONE : SOE_ID_ACK_OK;
  1348. // 记录事件
  1349. if(soe_type< SOE_TYPE_ACK)
  1350. {
  1351. // 刷新显示
  1352. if(!g_bVipSoe_show)
  1353. {
  1354. g_soe_info.bDpNew=true;
  1355. g_soe_info.wDpAutoShow=tail_send.n;
  1356. }
  1357. // 调整事件指针
  1358. g_soe_info.wEvIndex++;
  1359. if(g_soe_info.wEvIndex>=MAX_EVENT_NUMBER)
  1360. {
  1361. g_soe_info.wEvIndex=0;
  1362. // 如果事件回绕,先保存一段
  1363. if(es_save_cnt)
  1364. {
  1365. e2prom_write(es_save_addr,(u8 *)&g_soe_sbuf,sizeof(EVENT_SAVE)*es_save_cnt);
  1366. //rt_printf("soe_save:cnt=%d,head=%d,tail=%d.\r\n",es_save_cnt,head,g_soe_queue.tail_eep.n);
  1367. es_save_cnt = 0;
  1368. }
  1369. }
  1370. // 计算地址
  1371. addr=EEP_SOE_ADDR+g_soe_info.wEvIndex*(sizeof(EVENT_SAVE));
  1372. if(es_save_cnt == 0)
  1373. {
  1374. es_save_addr=addr;
  1375. }
  1376. // 放入保存buf中
  1377. es.es_id=g_soe_info.wEvID++;
  1378. memcpy(&g_soe_sbuf[es_save_cnt],&es,sizeof(EVENT_SAVE));
  1379. // 保存计数加一
  1380. es_save_cnt++;
  1381. if(pRunSet->bTT_SoeResumePower)
  1382. {
  1383. g_soe_info.wEvAck++;
  1384. }
  1385. // 调整事件记录数
  1386. if(g_soe_info.wEvNumber < MAX_EVENT_NUMBER)
  1387. {
  1388. g_soe_info.wEvNumber++;
  1389. }
  1390. //保存到关键事件缓冲区
  1391. if(es.es_ev.ev_type&SOE_TYPE_VIP)
  1392. {
  1393. #ifdef ADD_DEBUG_RECORD_AUTO_SHOW_FUN
  1394. u8 IsExeEvent=FALSE;
  1395. IsExeEvent=JudgeExecuteEventFun(es);
  1396. if(IsExeEvent==TRUE)
  1397. #endif
  1398. // 只有关键记录才刷新显示
  1399. if(g_bVipSoe_show)
  1400. {
  1401. g_soe_info.bDpNew=true;
  1402. g_soe_info.wDpAutoShow=tail_send.n;
  1403. #ifdef GD_AREA_FOS_2020
  1404. g_soe_info.bDpType=false;
  1405. #endif
  1406. }
  1407. es.es_id=g_soe_info.wVipID++;
  1408. g_soe_info.wVipIndex++;
  1409. if(g_soe_info.wVipIndex>=MAX_VIP_NUMBER)
  1410. {
  1411. g_soe_info.wVipIndex=0;
  1412. }
  1413. addr=EEP_VIP_ADDR+g_soe_info.wVipIndex*(sizeof(EVENT_SAVE));
  1414. e2prom_write(addr,(u8 *)&es,sizeof(EVENT_SAVE));
  1415. if(g_soe_info.wVipNumber < MAX_VIP_NUMBER)
  1416. {
  1417. g_soe_info.wVipNumber++;
  1418. }
  1419. #ifdef ADD_DEBUG_RECORD_FUN
  1420. #ifdef ADD_DEBUG_RECORD_AUTO_SHOW_FUN
  1421. if((es.es_ev.ev_value==TRUE)&&(IsExeEvent==TRUE)) //当为被选中的动作事件时才存入动作记录中
  1422. #else
  1423. if(es.es_ev.ev_value==TRUE)
  1424. #endif
  1425. {
  1426. g_soe_info.wDebugIndex++;
  1427. if(g_soe_info.wDebugIndex>=MAX_DEBUG_RECORD_NUMBER)
  1428. {
  1429. g_soe_info.wDebugIndex=0;
  1430. }
  1431. addr=EEP_DEBUG_RECORD_ADDR+g_soe_info.wDebugIndex*(sizeof(EVENT_SAVE));
  1432. e2prom_write(addr,(u8 *)&es,sizeof(EVENT_SAVE));
  1433. if(g_soe_info.wDebugNumber < MAX_DEBUG_RECORD_NUMBER)
  1434. {
  1435. g_soe_info.wDebugNumber++;
  1436. }
  1437. }
  1438. #endif
  1439. }
  1440. }
  1441. // 记录操作
  1442. else if(soe_type==SOE_TYPE_OPT)
  1443. {
  1444. #ifdef GD_AREA_FOS_2020
  1445. if(es.es_ev.ev_type&SOE_TYPE_VIP)
  1446. {
  1447. if(g_bVipSoe_show)
  1448. {
  1449. g_soe_info.bDpNew=true;
  1450. g_soe_info.wDpAutoShow=tail_send.n;
  1451. g_soe_info.bDpType=true;
  1452. }
  1453. }
  1454. #endif
  1455. es.es_id=g_soe_info.wOpID++;
  1456. g_soe_info.wOpIndex++;
  1457. if(g_soe_info.wOpIndex>=MAX_OPERATE_NUMBER)
  1458. {
  1459. g_soe_info.wOpIndex=0;
  1460. }
  1461. addr=EEP_OPERATE_ADDR+g_soe_info.wOpIndex*(sizeof(EVENT_SAVE));
  1462. e2prom_write(addr,(u8 *)&es,sizeof(EVENT_SAVE));
  1463. if(g_soe_info.wOpNumber < MAX_OPERATE_NUMBER)
  1464. {
  1465. g_soe_info.wOpNumber++;
  1466. }
  1467. }
  1468. // 事件内容保存完后,将事件队列的事件保存信息完善,
  1469. // 如果队列溢出,没有办法保证事件确认的正确性。
  1470. esp->es_flag = es.es_flag;
  1471. esp->es_ack= es.es_ack;
  1472. esp->es_id = addr; //事件队列中的ID用来保存事件的地址,供事件确认用
  1473. }
  1474. }
  1475. if(es_save_cnt)
  1476. {
  1477. e2prom_write(es_save_addr,(u8 *)&g_soe_sbuf,sizeof(EVENT_SAVE)*es_save_cnt);
  1478. //rt_printf("soe_save:cnt=%d,head=%d,tail=%d.\r\n",es_save_cnt,head,g_soe_queue.tail_eep.n);
  1479. }
  1480. log_str_ext_flush(LOG_YX);
  1481. log_str_ext_flush(LOG_SOE);
  1482. rt_stat_other_in(5,bsp_ustimer_get_duration(us0)/USTIMER_US);
  1483. }
  1484. void soe_clear_ev(void)
  1485. {
  1486. u32 i,addr;
  1487. u8 tempflag[4];
  1488. #ifdef BATTERY_WITH_COMM
  1489. bool b_bat_comm=false;
  1490. #endif
  1491. tempflag[0]=0;
  1492. tempflag[1]=0;
  1493. tempflag[2]=0;
  1494. tempflag[3]=0;
  1495. for(i=0;i<MAX_EVENT_NUMBER;i++)
  1496. {
  1497. addr=EEP_SOE_ADDR+i*(sizeof(EVENT_SAVE));
  1498. e2prom_write(addr,tempflag,4);
  1499. }
  1500. for(i=0;i<MAX_VIP_NUMBER;i++)
  1501. {
  1502. addr=EEP_VIP_ADDR+i*(sizeof(EVENT_SAVE));
  1503. e2prom_write(addr,tempflag,4);
  1504. }
  1505. #ifdef ADD_DEBUG_RECORD_FUN
  1506. for(i=0; i<MAX_DEBUG_RECORD_NUMBER; i++)
  1507. {
  1508. addr=EEP_DEBUG_RECORD_ADDR+i*(sizeof(EVENT_SAVE));
  1509. e2prom_write(addr,tempflag,4);
  1510. }
  1511. #endif
  1512. soe_init();
  1513. tRunPara.sysData.wSwTzCount = 0;
  1514. tRunPara.sysData.wSwHzCount = 0;
  1515. tRunPara.sysData.bWriteFlag = TRUE;//无需等待定时扫描循环,立即保存数据
  1516. #ifdef BATTERY_WITH_COMM
  1517. for(i=0;i<CFG_UART_NUM_MAX;i++)
  1518. {
  1519. if(tRunPara.tUartPara[i].wProtocol == PROTOCOL_POWER_MOD)
  1520. {
  1521. b_bat_comm = true;
  1522. }
  1523. }
  1524. if(b_bat_comm)
  1525. {
  1526. ClearBattActInfo();
  1527. }
  1528. #endif
  1529. }
  1530. void soe_clear_opt(void)
  1531. {
  1532. u32 i,addr;
  1533. u8 tempflag[4];
  1534. tempflag[0]=0;
  1535. tempflag[1]=0;
  1536. tempflag[2]=0;
  1537. tempflag[3]=0;
  1538. for(i=0;i<MAX_OPERATE_NUMBER;i++)
  1539. {
  1540. addr=EEP_OPERATE_ADDR+i*(sizeof(EVENT_SAVE));
  1541. e2prom_write(addr,tempflag,4);
  1542. }
  1543. soe_init();
  1544. }
  1545. bool soe_check(u32 code)
  1546. {
  1547. DWORD dv=g_ev_words[code/32];
  1548. if(dv&(1<<(code%32)))
  1549. {
  1550. return true;
  1551. }
  1552. return false;
  1553. }
  1554. int soe_stat_reset(void)
  1555. {
  1556. int i;
  1557. g_soe_queue.stat_eep_over = 0;
  1558. for(i=0;i<COMM_CHANNEL_NUM;i++)
  1559. {
  1560. g_soe_queue.stat_send_over[i] = 0;
  1561. g_soe_queue.stat_ack_over[i] = 0;
  1562. }
  1563. for(i=0;i<SOE_TYPE_NUM;i++)
  1564. {
  1565. g_soe_queue.stat_cnt_type[i] = 0;
  1566. }
  1567. return 0;
  1568. }
  1569. int soe_info_printf(void)
  1570. {
  1571. int i;
  1572. rt_printf("事件记录:Num=%d,Index=%d,id=%d,ack=%d.\r\n",g_soe_info.wEvNumber,g_soe_info.wEvIndex,g_soe_info.wEvID,g_soe_info.wEvAck);
  1573. rt_printf("操作记录:Num=%d,Index=%d,id=%d.\r\n\r\n",g_soe_info.wOpNumber,g_soe_info.wOpIndex,g_soe_info.wOpID);
  1574. for(i=0;i<SOE_TYPE_NUM;i++)
  1575. {
  1576. rt_printf("事件统计[%02d]:%d.\r\n", i,g_soe_queue.stat_cnt_type[i]);
  1577. }
  1578. rt_printf("\r\n");
  1579. rt_printf("保存队列 :head=%d,eep=%d,eep_over=%d.\r\n",
  1580. g_soe_queue.head.n,g_soe_queue.tail_eep.n,g_soe_queue.stat_eep_over);
  1581. for(i=0;i<COMM_CHANNEL_NUM;i++)
  1582. {
  1583. rt_printf("通讯队列[%02d]:head=%d,send=%d,ack=%d,send_over=%d,ack_over=%d.\r\n",
  1584. i,g_soe_queue.head.n,g_soe_queue.tail_send[i].n,g_soe_queue.tail_ack[i].n,g_soe_queue.stat_send_over[i],g_soe_queue.stat_ack_over[i]);
  1585. }
  1586. return 0;
  1587. }
  1588. static u32 cnt_5ms;
  1589. static u32 cnt_act;
  1590. static u32 is_on;
  1591. void soe_test(void)
  1592. {
  1593. if(g_soe_test)
  1594. {
  1595. cnt_5ms++;
  1596. if(cnt_5ms == 10)
  1597. {
  1598. if(is_on == 0)
  1599. {
  1600. sw_do_pub(PUB_DO_08,SW_DO_TYPE_ON);
  1601. }
  1602. else
  1603. {
  1604. sw_do_pub(PUB_DO_08,SW_DO_TYPE_OFF);
  1605. cnt_act++;
  1606. if(cnt_act >= 100)
  1607. {
  1608. cnt_act = 0;
  1609. cnt_5ms =0;
  1610. g_soe_test = 0;
  1611. rt_printf("soe_test完成。\r\n");
  1612. }
  1613. }
  1614. is_on = !is_on;
  1615. cnt_5ms = 0;
  1616. }
  1617. }
  1618. }