SOE.c 58 KB

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