switch.c 109 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723
  1. /******************************************************************************
  2. 版权所有:
  3. 文件名称: switch.c
  4. 文件版本: 01.01
  5. 创建作者: sunxi
  6. 创建日期: 2013-04-15
  7. 功能说明: DTU核心处理程序以开关为单位,循环处理。
  8. 其它说明:
  9. 修改记录:
  10. */
  11. /*------------------------------- 头文件 --------------------------------------
  12. */
  13. #include "head.h"
  14. #ifdef CPU_FUXI
  15. #include "rt_clib.h"
  16. #include "fourier.h"
  17. #endif
  18. /*------------------------------- 宏定义 --------------------------------------
  19. */
  20. #ifdef CPU_FUXI
  21. #define AUTO_ADJUST_NUM 1 // 自动校准时平均的次数
  22. #else
  23. #define AUTO_ADJUST_NUM 50 // 自动校准时平均的次数
  24. #endif
  25. #define MEA_CAL_NUMBER 5 // 实际测量时平均的次数
  26. //#define MEA_CAL_HARMONIC 14 //(CFG_ADC_DOTS_PER_PERIOD/2) // 谐波计算的次数
  27. /*------------------------------ 全局变量 -------------------------------------
  28. */
  29. int g_sw_init; // SW是否初始化
  30. struct ui g_ui[UI_NUM]; // 电压电流模拟量计算的综合结构
  31. struct ui_jy g_ui_jy[3]; // 方向判断中的记忆电压
  32. struct ui120 Us1_120,Us2_120;
  33. struct ui_p0 g_ui_p0[SWITCH_NUM_MAX]; //零序功率
  34. int g_ui_angle0; // 角度计算时,作为参考电压通道在g_ui中的索引
  35. int g_prot_index; // 保护计算时,采样通道中采样点的索引
  36. struct sw g_sw[SWITCH_NUM_EXT]; // 开关综合结构
  37. struct sw_t g_sw_temp[SWITCH_NUM_EXT]; // 临时数据结构
  38. struct sw_public g_sw_pub; // 开关公共部分综合结构
  39. int g_mea_cnt = 0; // 测量计数
  40. int g_harmonic_num = 13; // 默认计算13次谐波
  41. // 谐波系数修正
  42. float g_harmonic_factor[CFG_ADC_DOTS_PER_PERIOD/2] =
  43. {
  44. 1.0,1.0,1.0,1.0,1.0,1.0,1.0,1.0,
  45. 1.0,1.0,1.0,1.0,1.0,1.0,1.0,1.0,
  46. };
  47. // 开关开入名称
  48. const s8 * g_sw_di_name[SW_DI_NUM] =
  49. {
  50. "合位开入", // 1
  51. "分位开入",// 2
  52. "隔离刀闸", // 3
  53. "接地刀闸", // 4
  54. #ifdef DISP_DOUBLE_CN
  55. "弹簧未储能", // 5
  56. "弹簧已储能", // 5
  57. #else
  58. "弹簧未储能", // 5
  59. #endif
  60. "气压低", // 6
  61. #ifndef GW_AREA_MAIN_2021
  62. "HQ开入", // 7
  63. "TQ开入", // 8
  64. #endif
  65. "电源侧瞬压", // 9
  66. "负荷侧瞬压", // 10
  67. "手动合闸", // 11
  68. "手动分闸", // 12
  69. #ifdef GW_AREA_MAIN_2021
  70. "开关远方",
  71. "保护压板",
  72. "重合闸压板",
  73. "就地FA压板",
  74. "控制回路报警",
  75. "板卡在线监测",
  76. #else
  77. //#ifdef GD_AREA_ECZD_2020//2020指导意见使用停用FA及保护
  78. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020//2020指导意见使用停用FA及保护
  79. "停用FA及保护",
  80. #else
  81. "保护总功能投入",
  82. #endif
  83. #ifdef GD_AREA_MAIN_2020
  84. "常规保护压板", //13
  85. "重合闸投入压板", // 14
  86. "馈线自动化压板", // 15
  87. "智能分布式压板", // 16
  88. #elif defined GD_AREA_ECZD_2020 && !defined GD_AREA_ZHONGSHAN_2020
  89. "常规保护压板", //13
  90. "重合闸投入压板", // 14
  91. "常规FA压板", // 15
  92. "智能分布式FA压板", // 16
  93. #else
  94. "常规保护压板", //13
  95. "重合闸投入压板", // 14
  96. "就地FA压板", // 15
  97. "智能FA压板", // 16
  98. #endif
  99. "联络/分段模式", // 17
  100. "开关远方", // 18
  101. "闭锁重合闸", // 19
  102. //#ifdef GD_AREA_ECZD_2020
  103. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020//2020指导意见使用停用FA及保护
  104. "停用同期压板", // 20
  105. #else
  106. "同期压板", // 20
  107. #endif
  108. "控制回路断线", // 21
  109. "脉冲计数1", // 22
  110. "脉冲计数2", // 23
  111. "就地FA闭锁压板",//"开入8",// 31
  112. #ifdef GD_AREA_ECZD_2020//2020指导意见使用停用解列压板
  113. "停用自动解列功能压板",
  114. #elif defined GD_AREA_MAIN_2020
  115. "停用解列功能压板",
  116. #else
  117. "频率电压解列压板",
  118. #endif
  119. #endif
  120. #ifdef TYTQ_DI_YB
  121. "停用检同期压板", // 24
  122. #else
  123. "开入1", // 24
  124. #endif
  125. #ifdef JZS_FUNCTION
  126. "集中式投退压板", //
  127. #else
  128. "开入2", // 25
  129. #endif
  130. #ifdef DO_KOUT_CHECK
  131. "开出自检",
  132. #else
  133. "开入3",// 26
  134. #endif
  135. //#ifdef GD_AREA_ZHUHAI_V2
  136. #if defined GD_AREA_ZHUHAI_V2 || defined GD_AREA_JIEYANG || defined GD_AREA_LIAONING_2021
  137. "对侧开关位置",
  138. #else
  139. "开入4",// 27
  140. #endif
  141. #ifndef GW_AREA_MAIN_2021
  142. "安全自动控制压板",
  143. #endif
  144. #ifdef BS_FAL_DI_YB
  145. "闭锁FA联络压板",
  146. #endif
  147. #ifdef CUSTOMIZE_BZT //备自投
  148. "备自投开入",
  149. "#1进线合位开入",
  150. "#1进线分位开入",
  151. "#2进线合位开入",
  152. "#2进线分位开入",
  153. "备自投-合位开入",
  154. "备自投-分位开入",
  155. "闭锁备自投",
  156. "备自投-失压分闸"
  157. #endif
  158. #ifdef GD_AREA_ECZD_QINGYUAN_2022
  159. "保护合闸出口",
  160. "保护跳闸出口",
  161. "遥控/电动合闸",
  162. "遥控/电动分闸",
  163. #endif
  164. };
  165. // 开关开出名称
  166. const s8 * g_sw_do_name[SW_DO_NUM] =
  167. {
  168. "合闸",
  169. "跳闸",
  170. "保护合闸",
  171. "保护分闸",
  172. "遥控合闸",
  173. "遥控分闸",
  174. "瞬压复归",
  175. "瞬压复归1",
  176. "瞬压闭锁",
  177. "储能信号",//"开出11",
  178. "保护动作开出",
  179. #ifdef GD_AREA_CHAOZHOU_CHAOAN_FUYANG
  180. "同期合闸开出-常闭",
  181. "同期合闸开出-常开",
  182. #else
  183. "同期合闸开出",
  184. #endif
  185. #ifdef CUSTOMIZE_BZT //备自投
  186. "备自投-#1进线合闸",
  187. "备自投-#1进线分闸",
  188. "备自投-#2进线合闸",
  189. "备自投-#2进线分闸",
  190. "备自投-分段合闸",
  191. "备自投-分段分闸",
  192. "备自投-进线1失压分闸",
  193. "备自投-进线2失压分闸",
  194. #endif
  195. #if defined GD_AREA_MAIN_2020 || defined SW_FAIL_SINGLE_OUT
  196. "开关失灵",
  197. #endif
  198. #ifdef GD_AREA_YUNAN_LP
  199. "电源消失开出",
  200. #else
  201. "开出14",
  202. #endif
  203. #ifdef GD_AREA_PROTECTOR
  204. "装置异常告警动作",
  205. #endif
  206. };
  207. const s8 * g_sw_led_name[SW_LED_NUM]=
  208. {
  209. "综合合位灯",
  210. "综合分位灯",
  211. "合位灯",
  212. "分位灯",
  213. "过流灯",
  214. "接地灯",
  215. "重合闸灯",
  216. "充电灯",
  217. "闭锁灯",
  218. "XT灯",
  219. "YT灯",
  220. "动作灯",
  221. "重合闭锁灯",
  222. #ifdef DISP_DOUBLE_CN
  223. "未储能灯",
  224. "已储能灯",
  225. #else
  226. "未储能指示灯",
  227. #endif
  228. #ifndef GW_AREA_MAIN_2021
  229. "联络灯",
  230. "分段灯",
  231. "重合+FA闭锁灯",
  232. #ifdef GD_AREA_MAIN_2020
  233. "常规保护模式灯",
  234. #else
  235. "保护模式灯",
  236. #endif
  237. "就地FA模式灯",
  238. "分布式模式灯",
  239. "X+Y灯",
  240. #endif
  241. #ifdef QYD_STATE_LED
  242. "气压低灯",
  243. #endif
  244. #ifdef CHZ_QUIT_LED
  245. "重合闸退出灯",//(硬件压板或软件压板退出灯亮)
  246. #endif
  247. #if defined GD_AREA_GUANGZHOU_FTU || defined GD_AREA_TEST_2020
  248. "故障告警灯",
  249. #elif defined GD_AREA_ZHUHAI_V2
  250. "告警灯",
  251. #endif
  252. #ifdef GD_AREA_ZHUHAI_V2
  253. "通讯异常灯" //珠海局针对的是智能分布式通信异常
  254. #endif
  255. //#ifdef GD_AREA_ECZD_2020
  256. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020
  257. "自动解列功能灯",
  258. "同期合闸功能灯",
  259. "停用保护及FA灯",
  260. "停用自动解列灯",
  261. "停用同期合闸灯",
  262. #endif
  263. #ifdef TZ_STATE_LED
  264. "跳闸灯",
  265. #endif
  266. #ifdef CHZ_CD_LED
  267. "重合闸充电灯",
  268. #endif
  269. #ifdef EQU_RUN_LED
  270. "装置工作指示灯",
  271. #endif
  272. #ifdef SWITCH_GLJD_LED
  273. "隔离刀闸灯",
  274. "接地刀闸灯",
  275. #endif
  276. #ifdef FUNC_DRIVE
  277. "开关传动灯",
  278. #endif
  279. #ifdef GW_AREA_MAIN_2021
  280. "线路故障灯",
  281. "远方指示灯",
  282. "操作指示灯",
  283. "隔离指示灯",
  284. "地刀指示灯",
  285. "控回指示灯",
  286. #endif
  287. };
  288. // 开关模拟量名称
  289. //!!!更改模拟量名称可能会对以下宏有影响,请注意
  290. //#define MEA_I_OFFSET 4 //用于判断英文‘I’起始位置
  291. //#define MEA_U_OFFSET 6 //用于判断英文‘U’起始位置
  292. const struct mea_desc g_sw_ac_desc[SW_AC_NUM_ALL] =
  293. {
  294. #ifdef DISP_MEA_CN
  295. {"保护IA",UNIT_A5,UNIT_ANG},
  296. {"保护IB",UNIT_A5,UNIT_ANG},
  297. {"保护IC",UNIT_A5,UNIT_ANG},
  298. {"保护I0",UNIT_A5,UNIT_ANG},
  299. #ifdef SW_AC_I0S_SAMPLE
  300. {"保护I0s",UNIT_A5,UNIT_ANG},
  301. #endif
  302. {"测量IA",UNIT_A5,UNIT_ANG},
  303. {"测量IB",UNIT_A5,UNIT_ANG},
  304. {"测量IC",UNIT_A5,UNIT_ANG},
  305. {"总有功",UNIT_W,UNIT_NULL},
  306. {"A相有功",UNIT_W,UNIT_NULL},
  307. {"B相有功",UNIT_W,UNIT_NULL},
  308. {"C相有功",UNIT_W,UNIT_NULL},
  309. {"总无功",UNIT_Var,UNIT_NULL},
  310. {"A相无功",UNIT_Var,UNIT_NULL},
  311. {"B相无功",UNIT_Var,UNIT_NULL},
  312. {"C相无功",UNIT_Var,UNIT_NULL},
  313. {"功率因素",UNIT_COS,UNIT_NULL},
  314. #else
  315. {"BIA",UNIT_A5,UNIT_ANG},
  316. {"BIB",UNIT_A5,UNIT_ANG},
  317. {"BIC",UNIT_A5,UNIT_ANG},
  318. #ifdef GD_TEST_2021
  319. {"I0",UNIT_I0A,UNIT_ANG},
  320. #else
  321. {"I0",UNIT_A5,UNIT_ANG},
  322. #endif
  323. #ifdef SW_AC_I0S_SAMPLE
  324. {"I0s",UNIT_A5,UNIT_ANG},
  325. #endif
  326. {"CIA",UNIT_A5,UNIT_ANG},
  327. {"CIB",UNIT_A5,UNIT_ANG},
  328. {"CIC",UNIT_A5,UNIT_ANG},
  329. {"P",UNIT_W,UNIT_NULL},
  330. {"Pa",UNIT_W,UNIT_NULL},
  331. {"Pb",UNIT_W,UNIT_NULL},
  332. {"Pc",UNIT_W,UNIT_NULL},
  333. {"Q",UNIT_Var,UNIT_NULL},
  334. {"Qa",UNIT_Var,UNIT_NULL},
  335. {"Qb",UNIT_Var,UNIT_NULL},
  336. {"Qc",UNIT_Var,UNIT_NULL},
  337. #ifdef FUN_YC_POWER_S
  338. {"S",UNIT_Var,UNIT_NULL},
  339. #endif
  340. {"COS",UNIT_COS,UNIT_NULL},
  341. #endif
  342. {"BI_UNB",UNIT_Per,UNIT_NULL},
  343. {"CI_UNB",UNIT_Per,UNIT_NULL},
  344. {"脉冲计数1",UNIT_GE,UNIT_NULL},
  345. {"脉冲计数2",UNIT_GE,UNIT_NULL},
  346. #ifndef GW_AREA_MAIN_2021
  347. {"速断电流定值",UNIT_NULL,UNIT_NULL},
  348. {"速断保护时间",UNIT_NULL,UNIT_NULL},
  349. {"过流电流定值",UNIT_NULL,UNIT_NULL},
  350. {"过流保护时间",UNIT_NULL,UNIT_NULL},
  351. {"零序电流定值",UNIT_NULL,UNIT_NULL},
  352. {"零序保护时间",UNIT_NULL,UNIT_NULL},
  353. {"零序保护模式",UNIT_NULL,UNIT_NULL},
  354. {"一次重合闸时间",UNIT_NULL,UNIT_NULL},
  355. {"二次重合闸时间",UNIT_NULL,UNIT_NULL},
  356. {"得电闭合时间",UNIT_NULL,UNIT_NULL},
  357. {"无压分闸闭锁时间",UNIT_NULL,UNIT_NULL},
  358. {"工作模式",UNIT_NULL,UNIT_NULL},
  359. #endif
  360. #ifdef METERING_ENERGY
  361. {"计量UAB",UNIT_V220,UNIT_NULL}, // yc 17
  362. {"计量UBC",UNIT_V220,UNIT_NULL},
  363. {"计量UCA",UNIT_V220,UNIT_NULL},
  364. {"计量UA",UNIT_V220,UNIT_NULL},
  365. {"计量UB",UNIT_V220,UNIT_NULL},
  366. {"计量UC",UNIT_V220,UNIT_NULL},
  367. {"计量IA",UNIT_A5,UNIT_NULL},
  368. {"计量IB",UNIT_A5,UNIT_NULL},
  369. {"计量IC",UNIT_A5,UNIT_NULL},
  370. {"计量I0",UNIT_A5,UNIT_NULL},
  371. {"计量有功功率",UNIT_W,UNIT_NULL},
  372. {"计量A相有功功率",UNIT_W,UNIT_NULL},
  373. {"计量B相有功功率",UNIT_W,UNIT_NULL},
  374. {"计量C相有功功率",UNIT_W,UNIT_NULL},
  375. {"计量无功功率",UNIT_Var,UNIT_NULL},
  376. {"计量A相无功功率",UNIT_Var,UNIT_NULL},
  377. {"计量B相无功功率",UNIT_Var,UNIT_NULL},
  378. {"计量C相无功功率",UNIT_Var,UNIT_NULL},
  379. {"计量视在功率",UNIT_Var,UNIT_NULL},
  380. {"计量A相视在功率",UNIT_Var,UNIT_NULL},
  381. {"计量B相视在功率",UNIT_Var,UNIT_NULL},
  382. {"计量C相视在功率",UNIT_Var,UNIT_NULL},
  383. {"计量功率因数",UNIT_COS,UNIT_NULL},
  384. {"计量A相功率因数",UNIT_COS,UNIT_NULL},
  385. {"计量B相功率因数",UNIT_COS,UNIT_NULL},
  386. {"计量C相功率因数",UNIT_COS,UNIT_NULL},
  387. {"计量频率",UNIT_Hz,UNIT_NULL},
  388. #else
  389. {"YC1",UNIT_NULL,UNIT_NULL}, // yc 17
  390. {"YC2",UNIT_NULL,UNIT_NULL},
  391. {"YC3",UNIT_NULL,UNIT_NULL},
  392. {"YC4",UNIT_NULL,UNIT_NULL},
  393. {"YC5",UNIT_NULL,UNIT_NULL},
  394. {"YC6",UNIT_NULL,UNIT_NULL},
  395. {"YC7",UNIT_NULL,UNIT_NULL},
  396. {"YC8",UNIT_NULL,UNIT_NULL},
  397. {"YC9",UNIT_NULL,UNIT_NULL},
  398. {"YC10",UNIT_NULL,UNIT_NULL},
  399. {"YC11",UNIT_NULL,UNIT_NULL},
  400. {"YC12",UNIT_NULL,UNIT_NULL},
  401. #endif
  402. };
  403. // 计量模块电度值
  404. const struct mea_desc g_dd_desc[SW_DD_NUM_ALL]=
  405. {
  406. {"当前正向有功", UNIT_kWh,UNIT_NULL}, //6401
  407. {"当前正向无功", UNIT_kVarh,UNIT_NULL}, //6402
  408. {"当前一象限无功", UNIT_kVarh,UNIT_NULL}, //6403
  409. {"当前四象限无功", UNIT_kVarh,UNIT_NULL}, //6404
  410. {"当前反向有功", UNIT_kWh,UNIT_NULL}, //6405
  411. {"当前反向无功", UNIT_kVarh,UNIT_NULL}, //6406
  412. {"当前二象限无功", UNIT_kVarh,UNIT_NULL}, //6407
  413. {"当前三象限无功", UNIT_kVarh,UNIT_NULL}, //6408
  414. {"15分冻结正向有功", UNIT_kWh,UNIT_NULL}, //6409
  415. {"15分冻结正向无功", UNIT_kVarh,UNIT_NULL}, //640A
  416. {"15分冻结一象限无功", UNIT_kVarh,UNIT_NULL}, //640B
  417. {"15分冻结四象限无功", UNIT_kVarh,UNIT_NULL}, //640C
  418. {"15分冻结反向有功", UNIT_kWh,UNIT_NULL}, //640D
  419. {"15分冻结反向无功", UNIT_kVarh,UNIT_NULL}, //640E
  420. {"15分冻结二象限无功", UNIT_kVarh,UNIT_NULL}, //640F
  421. {"15分冻结三象限无功", UNIT_kVarh,UNIT_NULL}, //6410
  422. {"日冻结正向有功", UNIT_kWh,UNIT_NULL}, //6411
  423. {"日冻结冻结正向无功", UNIT_kVarh,UNIT_NULL}, //6412
  424. {"日冻结一象限无功", UNIT_kVarh,UNIT_NULL}, //6413
  425. {"日冻结四象限无功", UNIT_kVarh,UNIT_NULL}, //6414
  426. {"日冻结反向有功", UNIT_kWh,UNIT_NULL}, //6415
  427. {"日冻结反向无功", UNIT_kVarh,UNIT_NULL}, //6416
  428. {"日冻结二象限无功", UNIT_kVarh,UNIT_NULL}, //6417
  429. {"日冻结三象限无功", UNIT_kVarh,UNIT_NULL}, //6418
  430. {"潮变冻结正向有功", UNIT_kWh,UNIT_NULL}, //6419
  431. {"潮变冻结正向无功", UNIT_kVarh,UNIT_NULL}, //641A
  432. {"潮变冻结一象限无功", UNIT_kVarh,UNIT_NULL}, //641B
  433. {"潮变冻结四象限无功", UNIT_kVarh,UNIT_NULL}, //641C
  434. {"潮变冻结反向有功", UNIT_kWh,UNIT_NULL}, //641D
  435. {"潮变冻结反向无功", UNIT_kVarh,UNIT_NULL}, //641E
  436. {"潮变冻结二象限无功", UNIT_kVarh,UNIT_NULL}, //641F
  437. {"潮变冻结三象限无功", UNIT_kVarh,UNIT_NULL}, //6420
  438. #ifdef METERING_ENERGY
  439. {"当前A相有功", UNIT_kWh, UNIT_NULL},
  440. {"当前B相有功", UNIT_kWh, UNIT_NULL},
  441. {"当前C相有功", UNIT_kWh, UNIT_NULL},
  442. {"当前A相正向有功", UNIT_kWh, UNIT_NULL},
  443. {"当前B相正向有功", UNIT_kWh, UNIT_NULL},
  444. {"当前C相正向有功", UNIT_kWh, UNIT_NULL},
  445. {"当前A相反向有功", UNIT_kWh, UNIT_NULL},
  446. {"当前B相反向有功", UNIT_kWh, UNIT_NULL},
  447. {"当前C相反向有功", UNIT_kWh, UNIT_NULL},
  448. {"当前总有功", UNIT_kWh, UNIT_NULL},
  449. {"当前总无功", UNIT_kWh, UNIT_NULL},
  450. #endif
  451. };
  452. // 开关公共开入名称
  453. const s8 * g_pub_di_name[PUB_DI_NUM] =
  454. {
  455. "远方", // 1
  456. "就地", // 2
  457. "柜门位置", // 3
  458. "信号复归", // 4
  459. "交流失电告警", // 5
  460. "电池电源故障", // 6
  461. "电池欠压", // 7
  462. "电池活化状态", // 8
  463. "电容器动作", // 9
  464. "FA解锁", // 10
  465. "装置复位", // 11
  466. "功能总压板", // 12
  467. //#ifdef GD_AREA_ECZD_2020
  468. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020
  469. "检修状态压板", // 13
  470. #else
  471. "遥信屏蔽压板", // 13
  472. #endif
  473. #ifndef GW_AREA_MAIN_2021
  474. "非电量1开入", // 14
  475. "非电量2开入", // 15
  476. "非电量3开入", // 16
  477. "非电量4开入", // 17
  478. "非电量5开入", // 18
  479. "非电量6开入", // 19
  480. "非电量7开入", // 20
  481. "非电量8开入", // 21
  482. #endif
  483. "开入1", // 22
  484. "开入2", // 23
  485. "开入3", // 24
  486. "开入4", // 25
  487. "开入5", // 26
  488. "开入6", // 27
  489. #ifdef YX_DI_ERROR
  490. "遥信自检",
  491. #else
  492. "开入7", // 28
  493. #endif
  494. #ifdef KZ_OUT_TT
  495. "控制出口压板",
  496. #else
  497. "开入8", // 29
  498. #endif
  499. "信号复归+FA解锁", // 30
  500. };
  501. // 开关公共开出名称
  502. const s8 * g_pub_do_name[PUB_DO_NUM] =
  503. {
  504. "电池活化",
  505. "活化退出",
  506. "开出03",
  507. "开出04",
  508. "开出05",
  509. "开出06",
  510. "开出07",
  511. "开出08",
  512. "开出09",
  513. #ifdef YK_ZZDY_KC
  514. "装置电源开出",
  515. #endif
  516. "电压合格率清零",
  517. "预控开出",
  518. "解除闭锁",
  519. "远方重启",
  520. "远方复归",
  521. #ifdef YK_FG_FAJS
  522. "远方复归&FA解锁", // 远方复归+FA解锁
  523. #endif
  524. #ifndef GW_AREA_MAIN_2021
  525. "重合软压板合",
  526. "重合软压板分",
  527. #endif
  528. #if defined BHFA_YB_YK || defined BHFAGS_YB_YK
  529. //#ifdef GD_AREA_ECZD_2020
  530. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020
  531. "停用保护总软压板合",
  532. "停用保护总软压板分",
  533. #else
  534. "功能总投入软压板合",
  535. "功能总投入软压板分",
  536. #endif
  537. "保护出口软压板合",
  538. "保护出口软压板分",
  539. #ifndef BH_FA_INONE_SW
  540. "常规保护软压板合",
  541. "常规保护软压板分",
  542. "馈线自动化软压板合",
  543. "馈线自动化软压板分",
  544. #ifdef BHFAGS_YB_YK
  545. "智能分布式软压板合",
  546. "智能分布式软压板分",
  547. #endif
  548. #endif
  549. #else
  550. #ifndef GW_AREA_MAIN_2021
  551. //#ifdef GD_AREA_ECZD_2020
  552. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020
  553. "停用保护总软压板合",
  554. "停用保护总软压板分",
  555. #else
  556. "自动功能软压板合",
  557. "自动功能软压板分",
  558. #endif
  559. "保护投入软压板合",
  560. "保护投入软压板分",
  561. #endif
  562. #endif
  563. #ifdef TQ_SOFT_YB
  564. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020
  565. "停用同期软压板合",
  566. "停用同期软压板分",
  567. #else
  568. "检同期软压板合",
  569. "检同期软压板分",
  570. #endif
  571. #endif
  572. #ifdef JZS_FUNCTION
  573. "集中式软压板-合",
  574. "集中式软压板-分",
  575. #endif
  576. #ifdef YK_SOFT_YB
  577. "遥控软压板-合",
  578. "遥控软压板-分",
  579. #endif
  580. #ifdef YK_FA_ENBLE
  581. "FA遥控闭锁-合",
  582. "FA遥控闭锁-分",
  583. #endif
  584. #ifdef YK_FA_S_L_ENBLE
  585. "分段/联络-合",
  586. "分段/联络-分",
  587. #endif
  588. #ifdef JL_SOFT_YB
  589. "停用解列软压板合",
  590. "停用解列软压板分",
  591. #endif
  592. #ifdef METERING_ENERGY
  593. "遥控电度清零",
  594. "遥控线损事件清零",
  595. #endif
  596. #ifdef FUNC_DRIVE
  597. "传动接收软压板合",
  598. "传动接收软压板分",
  599. "传动指令",
  600. #endif
  601. #ifdef FUNC_DRIVE_JY
  602. "不停电传动功能",
  603. #endif
  604. #ifdef FUNC_RESET_EQU
  605. "重启装置",
  606. #endif
  607. };
  608. const s8 * g_pub_led_name[PUB_LED_NUM]=
  609. {
  610. "电源灯",
  611. "运行灯",
  612. #ifdef COMM_STATUS_LED
  613. "通信数据灯",
  614. "通信状态灯",
  615. #else
  616. "通信灯",
  617. #endif
  618. "电池灯",
  619. "异常灯",
  620. //#ifdef GD_AREA_ECZD_2020
  621. #if defined GD_AREA_ECZD_2020 || defined GD_AREA_MAIN_2020
  622. "运行告警灯",
  623. #endif
  624. "动作灯",
  625. "远方灯",
  626. "就地灯",
  627. "232T1",
  628. "232R1",
  629. "232T2",
  630. "232R2",
  631. "232T3",
  632. "232R3",
  633. "485T1",
  634. "485R1",
  635. "485T2",
  636. "485R2",
  637. "485T3",
  638. "485R3",
  639. "网口1",
  640. "网口2",
  641. #if defined __GOOSE_USING_DOUBLE_ETH__ || defined NET3_IP5
  642. "网口3",
  643. #endif
  644. #ifdef BAT_STATE_LED
  645. "电池欠压灯",
  646. "电池活化灯",
  647. #endif
  648. #ifdef KZ_OUT_TT
  649. "控制闭锁灯",
  650. #endif
  651. #ifdef IEC_ERR_LED
  652. "规约通信异常灯",
  653. #endif
  654. #ifdef LINK_ERR_LED
  655. "级联异常灯",
  656. #endif
  657. #ifdef GW_AREA_MAIN_2021
  658. "A相指示灯",
  659. "B相指示灯",
  660. "C相指示灯",
  661. #endif
  662. };
  663. // 开关公共模拟量名称
  664. const struct mea_desc g_pub_ac_desc[PUB_AC_NUM_ALL] =
  665. {
  666. #ifdef DISP_MEA_CN
  667. #ifdef GD_AREA_ZHUHAI_V2
  668. {"电缆UA1",UNIT_V100,UNIT_ANG},
  669. {"电缆UB1",UNIT_V100,UNIT_ANG},
  670. {"电缆UC1",UNIT_V100,UNIT_ANG},
  671. {"电缆UAB1",UNIT_V100,UNIT_ANG},
  672. {"电缆UBC1",UNIT_V100,UNIT_ANG},
  673. {"电缆UCA1",UNIT_V100,UNIT_ANG},
  674. {"母线U0 ",UNIT_V100,UNIT_ANG},
  675. {"电缆US1",UNIT_V220,UNIT_ANG},
  676. {"母线UA2",UNIT_V100,UNIT_ANG},
  677. {"母线UB2",UNIT_V100,UNIT_ANG},
  678. {"母线UC2",UNIT_V100,UNIT_ANG},
  679. {"母线UAB2",UNIT_V100,UNIT_ANG},
  680. {"母线UBC2",UNIT_V100,UNIT_ANG},
  681. {"母线UCA2",UNIT_V100,UNIT_ANG},
  682. {"电缆U0 ",UNIT_V100,UNIT_ANG},
  683. {"母线US2",UNIT_V220,UNIT_ANG},
  684. #else
  685. {"母线UA1",UNIT_V100,UNIT_ANG},
  686. {"母线UB1",UNIT_V100,UNIT_ANG},
  687. {"母线UC1",UNIT_V100,UNIT_ANG},
  688. {"母线UAB1",UNIT_V100,UNIT_ANG},
  689. {"母线UBC1",UNIT_V100,UNIT_ANG},
  690. {"母线UCA1",UNIT_V100,UNIT_ANG},
  691. {"母线U01",UNIT_V100,UNIT_ANG},
  692. #ifdef GD_AREA_HUIZHOU_HUIDONG
  693. {"母线AB3",UNIT_V220,UNIT_ANG},
  694. #else
  695. {"母线US1",UNIT_V220,UNIT_ANG},
  696. #endif
  697. {"线路UA2",UNIT_V100,UNIT_ANG},
  698. {"线路UB2",UNIT_V100,UNIT_ANG},
  699. {"线路UC2",UNIT_V100,UNIT_ANG},
  700. {"线路UAB2",UNIT_V100,UNIT_ANG},
  701. {"线路UBC2",UNIT_V100,UNIT_ANG},
  702. {"线路UCA2",UNIT_V100,UNIT_ANG},
  703. {"线路U02",UNIT_V100,UNIT_ANG},
  704. #ifdef GD_AREA_HUIZHOU_HUIDONG
  705. {"母线BC3",UNIT_V220,UNIT_ANG},
  706. #else
  707. {"线路US2",UNIT_V220,UNIT_ANG},
  708. #endif
  709. #endif
  710. {"V_UNB1",UNIT_Per,UNIT_NULL},
  711. {"V_UNB2",UNIT_Per,UNIT_NULL},
  712. {"工频1",UNIT_Hz,UNIT_NULL},
  713. {"工频2",UNIT_Hz,UNIT_NULL},
  714. #else
  715. {"UA1",UNIT_V100,UNIT_ANG},
  716. {"UB1",UNIT_V100,UNIT_ANG},
  717. {"UC1",UNIT_V100,UNIT_ANG},
  718. {"UAB1",UNIT_V100,UNIT_ANG},
  719. {"UBC1",UNIT_V100,UNIT_ANG},
  720. {"UCA1",UNIT_V100,UNIT_ANG},
  721. {"U01",UNIT_V100,UNIT_ANG},
  722. {"US1",UNIT_V220,UNIT_ANG},
  723. {"UA2",UNIT_V100,UNIT_ANG},
  724. {"UB2",UNIT_V100,UNIT_ANG},
  725. {"UC2",UNIT_V100,UNIT_ANG},
  726. {"UAB2",UNIT_V100,UNIT_ANG},
  727. {"UBC2",UNIT_V100,UNIT_ANG},
  728. {"UCA2",UNIT_V100,UNIT_ANG},
  729. {"U02",UNIT_V100,UNIT_ANG},
  730. {"US2",UNIT_V220,UNIT_ANG},
  731. {"V_UNB1",UNIT_Per,UNIT_NULL},
  732. {"V_UNB2",UNIT_Per,UNIT_NULL},
  733. {"UF1",UNIT_Hz,UNIT_NULL},
  734. {"UF2",UNIT_Hz,UNIT_NULL},
  735. #endif
  736. {"直流电压1",UNIT_V050,UNIT_NULL},
  737. {"直流电压2",UNIT_V050,UNIT_NULL},
  738. #ifdef GD_AREA_YUNAN_LP // 云南涞浦
  739. {"DltUab",UNIT_V100,UNIT_NULL},
  740. {"DltUbc",UNIT_V100,UNIT_NULL},
  741. {"DltUca",UNIT_V100,UNIT_NULL},
  742. {"ArgUab",UNIT_ANG,UNIT_NULL},
  743. {"ArgUbc",UNIT_ANG,UNIT_NULL},
  744. {"ArgUca",UNIT_ANG,UNIT_NULL},
  745. #endif
  746. {"温度",UNIT_TEMP,UNIT_NULL},
  747. #ifdef TMP_CHIP_AHT20
  748. {"湿度",UNIT_HUMI,UNIT_NULL},
  749. #endif
  750. {"Ver",UNIT_NULL,UNIT_NULL},
  751. #ifdef BATTERY_WITH_COMM
  752. {"活化放电时长",UINT_Hour,UNIT_NULL},
  753. {"当前放电时长",UINT_Hour,UNIT_NULL},
  754. #endif
  755. #ifdef DEV_GPS_ATGM332D
  756. #ifndef GPS_JWD_SPLIT
  757. {"经度",UNIT_ANG,UNIT_NULL},
  758. {"纬度",UNIT_ANG,UNIT_NULL},
  759. #else
  760. {"经度-度",UNIT_ANG,UNIT_NULL},
  761. {"纬度-分",UNIT_ANG,UNIT_NULL},
  762. {"经度-秒",UNIT_ANG,UNIT_NULL},
  763. {"纬度-度",UNIT_ANG,UNIT_NULL},
  764. {"纬度-分",UNIT_ANG,UNIT_NULL},
  765. {"纬度-秒",UNIT_ANG,UNIT_NULL},
  766. #endif
  767. {"卫星个数",UNIT_GE,UNIT_NULL},
  768. #endif
  769. {"YC1",UNIT_NULL,UNIT_NULL},
  770. {"YC2",UNIT_NULL,UNIT_NULL},
  771. {"YC3",UNIT_NULL,UNIT_NULL},
  772. {"YC4",UNIT_NULL,UNIT_NULL},
  773. {"YC5",UNIT_NULL,UNIT_NULL},
  774. {"YC6",UNIT_NULL,UNIT_NULL},
  775. {"YC7",UNIT_NULL,UNIT_NULL},
  776. {"YC8",UNIT_NULL,UNIT_NULL},
  777. #ifdef FUNC_SEND_FAULT_CURRENT
  778. {"A相故障电流",UNIT_A5,UNIT_ANG},
  779. {"B相故障电流",UNIT_A5,UNIT_ANG},
  780. {"C相故障电流",UNIT_A5,UNIT_ANG},
  781. {"零序电流",UNIT_A5,UNIT_ANG},
  782. #else
  783. {"YC9",UNIT_NULL,UNIT_NULL},
  784. {"YC10",UNIT_NULL,UNIT_NULL},
  785. {"YC11",UNIT_NULL,UNIT_NULL},
  786. {"YC12",UNIT_NULL,UNIT_NULL},
  787. #endif
  788. #ifdef BATTERY_BP_L500
  789. {"电池内阻",UINT_mVperA,UNIT_NULL},
  790. {"电池温度",UNIT_TEMP,UNIT_NULL},
  791. {"电池实时电量",UNIT_Per,UNIT_NULL},
  792. {"电池放电电流",UINT_mA,UNIT_NULL},
  793. {"电池充电电流",UINT_mA,UNIT_NULL},
  794. #endif
  795. };
  796. /*------------------------------ 函数声明 -------------------------------------
  797. */
  798. int _sw_cal_mea(void);
  799. void _sw_cal_average(int cal_num);
  800. float _sw_ui_e_k(int index);
  801. void _sw_auto_adjust_pq(void);
  802. void _sw_get_dots(void);
  803. void _sw_cal_fft(void);
  804. void _sw_cal_effect(void);
  805. void _sw_cal_angle(void);
  806. void _sw_cal_ri_correct(void);
  807. void _sw_min_max(int ui_index,u32 *p_min,u32*p_max);
  808. void _fz_min_max(int ui_index1,int ui_index2,u32 *p_min,u32*p_max);
  809. float _sw_base_angle(int ui_index);
  810. int _sw_save_dc_factor(float dc1_H, float dc1_L,float dc2_H, float dc2_L);
  811. void _sw_temp_factor(void);
  812. /*------------------------------ 外部函数 -------------------------------------
  813. 外部函数供其它实体文件引用,必须仔细检查传入参数的合法性.
  814. */
  815. /******************************************************************************
  816. 函数名称: sw_init
  817. 函数版本: 01.01
  818. 创建作者: sunxi
  819. 创建日期: 2013-08-07
  820. 函数说明: 线路开关初始化
  821. 参数说明:
  822. 返回值:
  823. 0: 成功
  824. 其它: 失败
  825. 修改记录:
  826. */
  827. int sw_init(void)
  828. {
  829. int sw,i,type,ui;
  830. float f;
  831. // 初始化为固定默认值,只有上电初始化才运行一次
  832. if(g_sw_init == 0)
  833. {
  834. memset(&g_ui,0,sizeof(g_ui));
  835. memset(&g_sw_pub,0,sizeof(g_sw_pub));
  836. memset(&g_sw_pub.di,SW_DI_TYPE_OFF,sizeof(g_sw_pub.di));
  837. memset(&g_sw_pub.di_cfg_index,INDEX_INVALLID,sizeof(g_sw_pub.di_cfg_index));
  838. memset(&g_sw_pub.do_cfg_index,INDEX_INVALLID,sizeof(g_sw_pub.do_cfg_index));
  839. memset(&g_sw_pub.ac_cfg_index,INDEX_INVALLID,sizeof(g_sw_pub.ac_cfg_index));
  840. memset(&g_sw_pub.led_cfg_index,INDEX_INVALLID,sizeof(g_sw_pub.led_cfg_index));
  841. for(i=0; i< UI_NUM; i++)
  842. {
  843. g_ui[i].chn_index = CFG_ADC_CHANNEL_ZERO;
  844. g_ui[i].ui_base_make = -1;
  845. g_ui[i].e_factor0 = 1.0 ;
  846. // 使用理论默认值初始化m2_factor_k,防止初始化时使用此值的定值出错,
  847. // 导致保护逻辑出错(例如,跳位有流告警)
  848. if(i<PUB_AC_NUM)
  849. {
  850. g_ui[i].m2_factor_k = rt_round(factor_e_k(EQU_SCALE_PT_DEFAULT)*Q08_BASE);
  851. }
  852. else
  853. {
  854. g_ui[i].m2_factor_k = rt_round(factor_e_k(EQU_SCALE_CT_DEFAULT)*Q08_BASE);
  855. }
  856. g_ui[i].m2_factor_c = rt_round(1.0*Q16_BASE);
  857. }
  858. for(sw=0; sw<SWITCH_NUM_MAX; sw++)
  859. {
  860. memset(&g_sw[sw],0,sizeof(g_sw[i]));
  861. memset(&g_sw[sw].di,SW_DI_TYPE_OFF,sizeof(g_sw[sw].di));
  862. memset(&g_sw[sw].di_cfg_index,INDEX_INVALLID,sizeof(g_sw[sw].di_cfg_index));
  863. memset(&g_sw[sw].do_cfg_index,INDEX_INVALLID,sizeof(g_sw[sw].do_cfg_index));
  864. memset(&g_sw[sw].ac_cfg_index,INDEX_INVALLID,sizeof(g_sw[sw].ac_cfg_index));
  865. memset(&g_sw[sw].led_cfg_index,INDEX_INVALLID,sizeof(g_sw[sw].led_cfg_index));
  866. }
  867. }
  868. g_sw_init = 0;
  869. // 检查装置配置
  870. if(equ_config_null())
  871. {
  872. return -1;
  873. }
  874. // DI通道
  875. for(i=0; i< g_equ_config->di_num; i++)
  876. {
  877. if(g_equ_config_di[i].owner > SWITCH_NUM_MAX)
  878. {
  879. rt_printf("switch_init(own):i=%d,owner=%d,SWITCH_NUM_MAX=%d.\r\n",i, g_equ_config_di[i].owner,SWITCH_NUM_MAX);
  880. continue;
  881. }
  882. // 如果是其它类型(type == 0),不处理
  883. type = g_equ_config_di[i].type;
  884. if(type == 0)
  885. {
  886. continue;
  887. }
  888. type--;
  889. if(g_equ_config_di[i].owner == 0)
  890. {
  891. if(type < PUB_DI_NUM)
  892. {
  893. g_sw_pub.di_cfg_index[type] = i;
  894. }
  895. else
  896. {
  897. rt_printf("switch_init(di):i=%d,type=%d,DI_NUM=%d.\r\n",i, type,PUB_DI_NUM);
  898. }
  899. }
  900. else
  901. {
  902. sw = g_equ_config_di[i].owner - 1;
  903. if(type < SW_DI_NUM)
  904. {
  905. g_sw[sw].di_cfg_index[type] = i;
  906. }
  907. else
  908. {
  909. rt_printf("switch_init(di):i=%d,type=%d,DI_NUM=%d,sw=%d.\r\n",i, type,SW_DI_NUM,sw);
  910. }
  911. }
  912. }
  913. // DO通道
  914. for(i=0; i< g_equ_config->do_num; i++)
  915. {
  916. if(g_equ_config_do[i].owner > SWITCH_NUM_MAX)
  917. {
  918. rt_printf("switch_init(own):i=%d,owner=%d,SWITCH_NUM_MAX=%d.\r\n",i, g_equ_config_do[i].owner,SWITCH_NUM_MAX);
  919. continue;
  920. }
  921. // 如果是其它类型(type == 0),不处理
  922. type = g_equ_config_do[i].type;
  923. if(type == 0)
  924. {
  925. continue;
  926. }
  927. type--;
  928. if(g_equ_config_do[i].owner == 0)
  929. {
  930. if(type < PUB_DO_NUM)
  931. {
  932. g_sw_pub.do_cfg_index[type] = i;
  933. }
  934. else if(type < PUB_DO_NUM + PUB_LED_NUM)
  935. {
  936. s16 slot,index;
  937. g_sw_pub.led_cfg_index[type-PUB_DO_NUM] = i;
  938. slot = g_equ_config_do[i].slot;
  939. index = g_equ_config_do[i].index;
  940. g_led_slot[slot].sn[index].sw = 0;
  941. g_led_slot[slot].sn[index].no = type-PUB_DO_NUM;
  942. index++;
  943. if(index > g_led_slot[slot].num)
  944. {
  945. g_led_slot[slot].num = index;
  946. }
  947. }
  948. else
  949. {
  950. rt_printf("switch_init(do):i=%d,type=%d,PUB_DO_NUM + PUB_LED_NUM=%d.\r\n",i, type,PUB_DO_NUM + PUB_LED_NUM);
  951. }
  952. }
  953. else
  954. {
  955. sw = g_equ_config_do[i].owner - 1;
  956. if(type < SW_DO_NUM)
  957. {
  958. g_sw[sw].do_cfg_index[type] = i;
  959. }
  960. else if(type < SW_DO_LED_NUM)
  961. {
  962. s16 slot,index;
  963. g_sw[sw].led_cfg_index[type-SW_DO_NUM] = i;
  964. slot = g_equ_config_do[i].slot;
  965. index = g_equ_config_do[i].index;
  966. g_led_slot[slot].sn[index].sw = sw+1;
  967. g_led_slot[slot].sn[index].no = type-SW_DO_NUM;
  968. index++;
  969. if(index > g_led_slot[slot].num)
  970. {
  971. g_led_slot[slot].num = index;
  972. }
  973. }
  974. else
  975. {
  976. rt_printf("switch_init(do):i=%d,type=%d,SW_DO_LED_NUM=%d,sw=%d.\r\n",i, type,SW_DO_LED_NUM,sw);
  977. }
  978. }
  979. }
  980. // AC通道
  981. for(i=0; i< g_equ_config->ac_num; i++)
  982. {
  983. if(g_equ_config_ac[i].owner > SWITCH_NUM_MAX)
  984. {
  985. rt_printf("switch_init(own):i=%d,owner=%d,SWITCH_NUM_MAX=%d.\r\n",i, g_equ_config_ac[i].owner,SWITCH_NUM_MAX);
  986. continue;
  987. }
  988. // 如果是其它类型(type == 0),不处理
  989. type = g_equ_config_ac[i].type;
  990. if(type == 0)
  991. {
  992. continue;
  993. }
  994. type--;
  995. if(g_equ_config_ac[i].owner == 0)
  996. {
  997. if(type < PUB_AC_NUM)
  998. {
  999. // 索引
  1000. ui = type;
  1001. g_sw_pub.ac_cfg_index[type] = i;
  1002. }
  1003. else
  1004. {
  1005. rt_printf("switch_init(ac):i=%d,type=%d,AC_NUM=%d.\r\n",i, g_equ_config_ac[i].type,PUB_AC_NUM);
  1006. continue;
  1007. }
  1008. }
  1009. else
  1010. {
  1011. sw = g_equ_config_ac[i].owner - 1;
  1012. if(type < SW_AC_NUM)
  1013. {
  1014. ui = UI_SW_INDEX(sw,type);
  1015. // 索引
  1016. g_sw[sw].ac_cfg_index[type] = i;
  1017. }
  1018. else
  1019. {
  1020. rt_printf("switch_init(ac):i=%d,type=%d,AC_NUM=%d,sw=%d.\r\n",i, type,SW_AC_NUM,sw);
  1021. continue;
  1022. }
  1023. }
  1024. // 通道索引
  1025. g_ui[ui].chn_index = equ_get_ac_channel(g_equ_config_ac[i].slot,g_equ_config_ac[i].index);
  1026. // 系数
  1027. factor_e_c_get(g_equ_config_ac[i].slot,g_equ_config_ac[i].index,&f);
  1028. g_ui[ui].e_factor0 = f /factor_e_k(g_equ_config_ac[i].scale);
  1029. g_ui[ui].m2_factor_k = rt_round(factor_e_k(g_equ_config_ac[i].scale)*Q08_BASE);
  1030. #ifdef PROTECT_AC_ADJUST
  1031. factor_p_e_c_get(g_equ_config_ac[i].slot,g_equ_config_ac[i].index,&f); //保护校准系数
  1032. #endif
  1033. g_ui[ui].m2_factor_c = rt_round(f*Q16_BASE);
  1034. factor_p_c_get(g_equ_config_ac[i].slot,g_equ_config_ac[i].index,&f);
  1035. g_ui[ui].p_factor = f;
  1036. //一二变比
  1037. g_ui[ui].e_ps = factor_e_ps(equ_get_ac_scale(g_equ_config_ac[i].slot, g_equ_config_ac[i].index));
  1038. // 暂时屏蔽,看看不使用PQ校准的效果
  1039. //factor_pq_get(g_equ_config_ac[i].slot,g_equ_config_ac[i].index,g_ui[ui].pq_factor);
  1040. }
  1041. // 计算角度时的基准通道
  1042. if(g_ui[PUB_AC_UA1].chn_index != CFG_ADC_CHANNEL_ZERO)
  1043. {
  1044. g_ui_angle0 = PUB_AC_UA1;
  1045. }
  1046. else if(g_ui[PUB_AC_UAB1].chn_index != CFG_ADC_CHANNEL_ZERO)
  1047. {
  1048. g_ui_angle0 = PUB_AC_UAB1;
  1049. }
  1050. else if(g_ui[PUB_AC_UAB2].chn_index != CFG_ADC_CHANNEL_ZERO)
  1051. {
  1052. g_ui_angle0 = PUB_AC_UAB2;
  1053. }
  1054. else
  1055. {
  1056. g_ui_angle0 = -1;
  1057. }
  1058. // 相电压合成线电压标志
  1059. if( g_ui[PUB_AC_UA1].chn_index != CFG_ADC_CHANNEL_ZERO
  1060. && g_ui[PUB_AC_UB1].chn_index != CFG_ADC_CHANNEL_ZERO
  1061. && g_ui[PUB_AC_UC1].chn_index != CFG_ADC_CHANNEL_ZERO
  1062. && g_ui[PUB_AC_UAB1].chn_index == CFG_ADC_CHANNEL_ZERO
  1063. && g_ui[PUB_AC_UBC1].chn_index == CFG_ADC_CHANNEL_ZERO
  1064. && g_ui[PUB_AC_UCA1].chn_index == CFG_ADC_CHANNEL_ZERO)
  1065. {
  1066. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_LV1;
  1067. memcpy(&g_ui[PUB_AC_UAB1],&g_ui[PUB_AC_UA1],sizeof(g_ui[0]));
  1068. g_ui[PUB_AC_UAB1].chn_index = CFG_ADC_CHANNEL_ZERO;
  1069. g_ui[PUB_AC_UAB1].ui_base_make = PUB_AC_UA1;
  1070. g_ui[PUB_AC_UAB1].e_factor0 = (g_ui[PUB_AC_UA1].e_factor0 + g_ui[PUB_AC_UB1].e_factor0)/2;
  1071. memcpy(&g_ui[PUB_AC_UBC1],&g_ui[PUB_AC_UA1],sizeof(g_ui[0]));
  1072. g_ui[PUB_AC_UBC1].chn_index = CFG_ADC_CHANNEL_ZERO;
  1073. g_ui[PUB_AC_UBC1].ui_base_make = PUB_AC_UA1;
  1074. g_ui[PUB_AC_UBC1].e_factor0 = (g_ui[PUB_AC_UB1].e_factor0 + g_ui[PUB_AC_UC1].e_factor0)/2;
  1075. memcpy(&g_ui[PUB_AC_UCA1],&g_ui[PUB_AC_UA1],sizeof(g_ui[0]));
  1076. g_ui[PUB_AC_UCA1].chn_index = CFG_ADC_CHANNEL_ZERO;
  1077. g_ui[PUB_AC_UCA1].ui_base_make = PUB_AC_UA1;
  1078. g_ui[PUB_AC_UCA1].e_factor0 = (g_ui[PUB_AC_UC1].e_factor0 + g_ui[PUB_AC_UA1].e_factor0)/2;
  1079. }
  1080. if(g_ui[PUB_AC_UA2].chn_index != CFG_ADC_CHANNEL_ZERO
  1081. && g_ui[PUB_AC_UB2].chn_index != CFG_ADC_CHANNEL_ZERO
  1082. && g_ui[PUB_AC_UC2].chn_index != CFG_ADC_CHANNEL_ZERO
  1083. && g_ui[PUB_AC_UAB2].chn_index == CFG_ADC_CHANNEL_ZERO
  1084. && g_ui[PUB_AC_UBC2].chn_index == CFG_ADC_CHANNEL_ZERO
  1085. && g_ui[PUB_AC_UCA2].chn_index == CFG_ADC_CHANNEL_ZERO)
  1086. {
  1087. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_LV2;
  1088. memcpy(&g_ui[PUB_AC_UAB2],&g_ui[PUB_AC_UA2],sizeof(g_ui[0]));
  1089. g_ui[PUB_AC_UAB2].chn_index = CFG_ADC_CHANNEL_ZERO;
  1090. g_ui[PUB_AC_UAB2].ui_base_make = PUB_AC_UA2;
  1091. g_ui[PUB_AC_UAB2].e_factor0 = (g_ui[PUB_AC_UA2].e_factor0 + g_ui[PUB_AC_UB2].e_factor0)/2;
  1092. memcpy(&g_ui[PUB_AC_UBC2],&g_ui[PUB_AC_UA2],sizeof(g_ui[0]));
  1093. g_ui[PUB_AC_UBC2].chn_index = CFG_ADC_CHANNEL_ZERO;
  1094. g_ui[PUB_AC_UBC2].ui_base_make = PUB_AC_UA2;
  1095. g_ui[PUB_AC_UBC2].e_factor0 = (g_ui[PUB_AC_UB2].e_factor0 + g_ui[PUB_AC_UC2].e_factor0)/2;
  1096. memcpy(&g_ui[PUB_AC_UCA2],&g_ui[PUB_AC_UA2],sizeof(g_ui[0]));
  1097. g_ui[PUB_AC_UCA2].chn_index = CFG_ADC_CHANNEL_ZERO;
  1098. g_ui[PUB_AC_UCA2].ui_base_make = PUB_AC_UA2;
  1099. g_ui[PUB_AC_UCA2].e_factor0 = (g_ui[PUB_AC_UC2].e_factor0 + g_ui[PUB_AC_UA2].e_factor0)/2;
  1100. }
  1101. // 合成UCA标志
  1102. if( g_ui[PUB_AC_UAB1].chn_index != CFG_ADC_CHANNEL_ZERO
  1103. && g_ui[PUB_AC_UBC1].chn_index != CFG_ADC_CHANNEL_ZERO
  1104. && g_ui[PUB_AC_UCA1].chn_index == CFG_ADC_CHANNEL_ZERO)
  1105. {
  1106. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_UCA1;
  1107. memcpy(&g_ui[PUB_AC_UCA1],&g_ui[PUB_AC_UAB1],sizeof(g_ui[0]));
  1108. g_ui[PUB_AC_UCA1].chn_index = CFG_ADC_CHANNEL_ZERO;
  1109. g_ui[PUB_AC_UCA1].ui_base_make = PUB_AC_UAB1;
  1110. g_ui[PUB_AC_UCA1].e_factor0 = (g_ui[PUB_AC_UAB1].e_factor0 + g_ui[PUB_AC_UBC1].e_factor0)/2;
  1111. }
  1112. if( g_ui[PUB_AC_UAB2].chn_index != CFG_ADC_CHANNEL_ZERO
  1113. && g_ui[PUB_AC_UBC2].chn_index != CFG_ADC_CHANNEL_ZERO
  1114. && g_ui[PUB_AC_UCA2].chn_index == CFG_ADC_CHANNEL_ZERO)
  1115. {
  1116. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_UCA2;
  1117. memcpy(&g_ui[PUB_AC_UCA2],&g_ui[PUB_AC_UAB2],sizeof(g_ui[0]));
  1118. g_ui[PUB_AC_UCA2].chn_index = CFG_ADC_CHANNEL_ZERO;
  1119. g_ui[PUB_AC_UCA2].ui_base_make = PUB_AC_UAB2;
  1120. g_ui[PUB_AC_UCA2].e_factor0 = (g_ui[PUB_AC_UAB2].e_factor0 + g_ui[PUB_AC_UBC2].e_factor0)/2;
  1121. }
  1122. // U01 零序电压自产
  1123. if( g_ui[PUB_AC_UA1].chn_index != CFG_ADC_CHANNEL_ZERO
  1124. && g_ui[PUB_AC_UB1].chn_index != CFG_ADC_CHANNEL_ZERO
  1125. && g_ui[PUB_AC_UC1].chn_index != CFG_ADC_CHANNEL_ZERO
  1126. && g_ui[PUB_AC_U01].chn_index == CFG_ADC_CHANNEL_ZERO
  1127. &&pRunSet->bTT_U0ZC)
  1128. {
  1129. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_U01;
  1130. memcpy(&g_ui[PUB_AC_U01],&g_ui[PUB_AC_UA1],sizeof(g_ui[0]));
  1131. g_ui[PUB_AC_U01].chn_index = CFG_ADC_CHANNEL_ZERO;
  1132. g_ui[PUB_AC_U01].ui_base_make = PUB_AC_UA1;
  1133. g_ui[PUB_AC_U01].e_factor0 = (g_ui[PUB_AC_UA1].e_factor0 + g_ui[PUB_AC_UB1].e_factor0+g_ui[PUB_AC_UC1].e_factor0)/3;
  1134. }
  1135. // U02 零序电压自产
  1136. if( g_ui[PUB_AC_UA2].chn_index != CFG_ADC_CHANNEL_ZERO
  1137. && g_ui[PUB_AC_UB2].chn_index != CFG_ADC_CHANNEL_ZERO
  1138. && g_ui[PUB_AC_UC2].chn_index != CFG_ADC_CHANNEL_ZERO
  1139. && g_ui[PUB_AC_U02].chn_index == CFG_ADC_CHANNEL_ZERO
  1140. &&pRunSet->bTT_U0ZC)
  1141. {
  1142. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_U02;
  1143. memcpy(&g_ui[PUB_AC_U02],&g_ui[PUB_AC_UA2],sizeof(g_ui[0]));
  1144. g_ui[PUB_AC_U02].chn_index = CFG_ADC_CHANNEL_ZERO;
  1145. g_ui[PUB_AC_U02].ui_base_make = PUB_AC_UA2;
  1146. g_ui[PUB_AC_U02].e_factor0 = (g_ui[PUB_AC_UA2].e_factor0 + g_ui[PUB_AC_UB2].e_factor0+g_ui[PUB_AC_UC2].e_factor0)/3;
  1147. }
  1148. // 合成IB、I0标志
  1149. for(sw=0; sw<SWITCH_NUM_MAX; sw++)
  1150. {
  1151. if( g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index != CFG_ADC_CHANNEL_ZERO
  1152. && g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index != CFG_ADC_CHANNEL_ZERO
  1153. && g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index == CFG_ADC_CHANNEL_ZERO)
  1154. {
  1155. g_sw[sw].ui_flags |= UI_FLAGS_MAKE_IB;
  1156. memcpy(&g_ui[UI_SW_INDEX(sw,SW_AC_IB)],&g_ui[UI_SW_INDEX(sw,SW_AC_IA)],sizeof(g_ui[0]));
  1157. g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index = CFG_ADC_CHANNEL_ZERO;
  1158. g_ui[UI_SW_INDEX(sw,SW_AC_IB)].ui_base_make = UI_SW_INDEX(sw,SW_AC_IA);
  1159. g_ui[UI_SW_INDEX(sw,SW_AC_IB)].e_factor0 = (g_ui[UI_SW_INDEX(sw,SW_AC_IA)].e_factor0 + g_ui[UI_SW_INDEX(sw,SW_AC_IC)].e_factor0)/2;
  1160. }
  1161. if( g_ui[UI_SW_INDEX(sw,SW_AC_CIA)].chn_index != CFG_ADC_CHANNEL_ZERO
  1162. && g_ui[UI_SW_INDEX(sw,SW_AC_CIC)].chn_index != CFG_ADC_CHANNEL_ZERO
  1163. && g_ui[UI_SW_INDEX(sw,SW_AC_CIB)].chn_index == CFG_ADC_CHANNEL_ZERO)
  1164. {
  1165. g_sw[sw].ui_flags |= UI_FLAGS_MAKE_CIB;
  1166. memcpy(&g_ui[UI_SW_INDEX(sw,SW_AC_CIB)],&g_ui[UI_SW_INDEX(sw,SW_AC_CIA)],sizeof(g_ui[0]));
  1167. g_ui[UI_SW_INDEX(sw,SW_AC_CIB)].chn_index = CFG_ADC_CHANNEL_ZERO;
  1168. g_ui[UI_SW_INDEX(sw,SW_AC_CIB)].ui_base_make = UI_SW_INDEX(sw,SW_AC_CIA);
  1169. g_ui[UI_SW_INDEX(sw,SW_AC_CIB)].e_factor0 = (g_ui[UI_SW_INDEX(sw,SW_AC_CIA)].e_factor0 + g_ui[UI_SW_INDEX(sw,SW_AC_CIC)].e_factor0)/2;
  1170. }
  1171. if( g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index != CFG_ADC_CHANNEL_ZERO
  1172. && g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index != CFG_ADC_CHANNEL_ZERO
  1173. && g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index != CFG_ADC_CHANNEL_ZERO
  1174. && g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index == CFG_ADC_CHANNEL_ZERO)
  1175. {
  1176. g_sw[sw].ui_flags |= UI_FLAGS_MAKE_I0;
  1177. memcpy(&g_ui[UI_SW_INDEX(sw,SW_AC_I0)],&g_ui[UI_SW_INDEX(sw,SW_AC_IA)],sizeof(g_ui[0]));
  1178. g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index = CFG_ADC_CHANNEL_ZERO;
  1179. g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ui_base_make = UI_SW_INDEX(sw,SW_AC_IA);
  1180. g_ui[UI_SW_INDEX(sw,SW_AC_I0)].e_factor0 = (g_ui[UI_SW_INDEX(sw,SW_AC_IA)].e_factor0
  1181. + g_ui[UI_SW_INDEX(sw,SW_AC_IB)].e_factor0
  1182. + g_ui[UI_SW_INDEX(sw,SW_AC_IC)].e_factor0)/3;
  1183. }
  1184. }
  1185. #if 0 // 支持功率电压选择,计算方法等计算时再确定
  1186. // 确认是3表法还是2表法
  1187. for(sw=0; sw<SWITCH_NUM_MAX; sw++)
  1188. {
  1189. if(g_ui[PUB_AC_UA1].chn_index != CFG_ADC_CHANNEL_ZERO
  1190. && g_ui[PUB_AC_UB1].chn_index != CFG_ADC_CHANNEL_ZERO
  1191. && g_ui[PUB_AC_UC1].chn_index != CFG_ADC_CHANNEL_ZERO)
  1192. {
  1193. if( g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index != CFG_ADC_CHANNEL_ZERO
  1194. && g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index != CFG_ADC_CHANNEL_ZERO
  1195. && g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index != CFG_ADC_CHANNEL_ZERO)
  1196. {
  1197. g_sw[sw].ui_flags |= UI_FLAGS_3M;
  1198. }
  1199. }
  1200. }
  1201. #endif
  1202. //通道名称
  1203. for(i=0; i< UI_NUM; i++)
  1204. {
  1205. if(i< PUB_AC_NUM)
  1206. {
  1207. if(strlen(g_pub_ac_desc[i].name) < CFG_NAME_LEN)
  1208. strcpy(g_ui[i].name, g_pub_ac_desc[i].name);
  1209. else
  1210. strncpy(g_ui[i].name, g_pub_ac_desc[i].name,CFG_NAME_LEN);
  1211. }
  1212. else
  1213. {
  1214. sw = (i-PUB_AC_NUM)/SW_AC_NUM;
  1215. sprintf(g_ui[i].name,"%02d%s",sw+1,g_sw_ac_desc[(i-PUB_AC_NUM)%SW_AC_NUM].name);
  1216. }
  1217. }
  1218. // 复位统计数据
  1219. sw_stat_reset();
  1220. g_sw_init = 1;
  1221. return 0;
  1222. }
  1223. int sw_ext_init(void)
  1224. {
  1225. // U01 零序电压自产
  1226. if( g_ui[PUB_AC_UA1].chn_index != CFG_ADC_CHANNEL_ZERO
  1227. && g_ui[PUB_AC_UB1].chn_index != CFG_ADC_CHANNEL_ZERO
  1228. && g_ui[PUB_AC_UC1].chn_index != CFG_ADC_CHANNEL_ZERO
  1229. && g_ui[PUB_AC_U01].chn_index == CFG_ADC_CHANNEL_ZERO
  1230. &&pRunSet->bTT_U0ZC)
  1231. {
  1232. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_U01;
  1233. memcpy(&g_ui[PUB_AC_U01],&g_ui[PUB_AC_UA1],sizeof(g_ui[0]));
  1234. g_ui[PUB_AC_U01].chn_index = CFG_ADC_CHANNEL_ZERO;
  1235. g_ui[PUB_AC_U01].ui_base_make = PUB_AC_UA1;
  1236. g_ui[PUB_AC_U01].e_factor0 = (g_ui[PUB_AC_UA1].e_factor0 + g_ui[PUB_AC_UB1].e_factor0+g_ui[PUB_AC_UC1].e_factor0)/3;
  1237. }
  1238. // U02 零序电压自产
  1239. if( g_ui[PUB_AC_UA2].chn_index != CFG_ADC_CHANNEL_ZERO
  1240. && g_ui[PUB_AC_UB2].chn_index != CFG_ADC_CHANNEL_ZERO
  1241. && g_ui[PUB_AC_UC2].chn_index != CFG_ADC_CHANNEL_ZERO
  1242. && g_ui[PUB_AC_U02].chn_index == CFG_ADC_CHANNEL_ZERO
  1243. &&pRunSet->bTT_U0ZC)
  1244. {
  1245. g_sw_pub.ui_flags |= UI_FLAGS_MAKE_U02;
  1246. memcpy(&g_ui[PUB_AC_U02],&g_ui[PUB_AC_UA2],sizeof(g_ui[0]));
  1247. g_ui[PUB_AC_U02].chn_index = CFG_ADC_CHANNEL_ZERO;
  1248. g_ui[PUB_AC_U02].ui_base_make = PUB_AC_UA2;
  1249. g_ui[PUB_AC_U02].e_factor0 = (g_ui[PUB_AC_UA2].e_factor0 + g_ui[PUB_AC_UB2].e_factor0+g_ui[PUB_AC_UC2].e_factor0)/3;
  1250. }
  1251. return 0;
  1252. }
  1253. /******************************************************************************
  1254. 函数名称: sw_exit
  1255. 函数版本: 01.01
  1256. 创建作者: sunxi
  1257. 创建日期: 2013-08-07
  1258. 函数说明: 线路开关退出
  1259. 参数说明:
  1260. 返回值:
  1261. 0: 成功
  1262. 其它: 失败
  1263. 修改记录:
  1264. */
  1265. int sw_exit(void)
  1266. {
  1267. return 0;
  1268. }
  1269. int sw_di_get(u32 sw,u32 no)
  1270. {
  1271. u8 v;
  1272. if(no == 0)
  1273. {
  1274. return -1;
  1275. }
  1276. no--;
  1277. if(sw == 0)
  1278. {
  1279. v=g_sw_pub.di[no] ;
  1280. }
  1281. else
  1282. {
  1283. sw--;
  1284. v=g_sw[sw].di[no] ;
  1285. }
  1286. return v;
  1287. }
  1288. int sw_di_set(u32 sw,u32 no,u8 v)
  1289. {
  1290. if(no == 0)
  1291. {
  1292. return -1;
  1293. }
  1294. no--;
  1295. if(sw == 0)
  1296. {
  1297. g_sw_pub.di[no] = v;
  1298. }
  1299. else
  1300. {
  1301. sw--;
  1302. g_sw[sw].di[no] = v;
  1303. }
  1304. return 0;
  1305. }
  1306. /******************************************************************************
  1307. 函数名称: sw_do
  1308. 函数版本: 01.01
  1309. 创建作者: sunxi
  1310. 创建日期: 2013-08-07
  1311. 函数说明: 针对线路开关执行开出动作
  1312. 参数说明:
  1313. sw 开关序号
  1314. index 开出索引
  1315. type 开出类型
  1316. 返回值:
  1317. 0: 成功
  1318. 其它: 失败
  1319. 修改记录:
  1320. */
  1321. static int _sw_do(u32 slot,u32 index,int type)
  1322. {
  1323. int ret,do_num;
  1324. do_num = equ_get_do_num(slot);
  1325. if(do_num == 0)
  1326. {
  1327. return -1;
  1328. }
  1329. // 将辅助板的4个开出(64~67)映射到(0~3),
  1330. // 解决32位宽度不够的问题,这样LED灯不允许配置成开出。
  1331. // 其它板不存在这个问题,例如开出板只有16个开出可配
  1332. if((g_board_info[slot].type == BOARD_TYPE_AUX) || (g_board_info[slot].type == BOARD_TYPE_ZT))
  1333. {
  1334. index = index%32;
  1335. }
  1336. ret = 0;
  1337. switch(type)
  1338. {
  1339. case SW_DO_TYPE_OFF:
  1340. case SW_DO_TYPE_ON:
  1341. ret = dido_do(slot,(1<<index),type);
  1342. break;
  1343. case SW_DO_TYPE_SELECT_ON:
  1344. if(dido_do_have_select(slot,index))
  1345. {
  1346. ret = dido_do(slot,(1<<do_num),1);
  1347. }
  1348. break;
  1349. case SW_DO_TYPE_SELECT_OFF:
  1350. if(dido_do_have_select(slot,index))
  1351. {
  1352. ret = dido_do(slot,(1<<do_num),0);
  1353. }
  1354. break;
  1355. default:
  1356. ret = -3;
  1357. break;
  1358. }
  1359. return ret;
  1360. }
  1361. int sw_do(u32 sw,u32 index,int type)
  1362. {
  1363. int ret;
  1364. u32 slot;
  1365. TRELAY_T *pR=&g_tRelay[sw];
  1366. if((index == SW_DO_HZ || index == SW_DO_YKH || index == SW_DO_BHH) && (type == SW_DO_TYPE_ON))
  1367. {
  1368. if(pR->run_stu.sw==1)
  1369. {
  1370. pR->uRmtSW.bHz_Doing = 1;
  1371. #ifdef FUNC_DRIVE
  1372. gb_drive.bHz_Doing = 1;
  1373. #endif
  1374. }
  1375. pR->uRmtSW.bTz_Doing = 0;
  1376. #ifdef FUNC_DRIVE
  1377. gb_drive.bTz_Doing = 0;
  1378. #endif
  1379. }
  1380. if((index == SW_DO_FZ || index == SW_DO_YKT || index == SW_DO_BHT) && (type == SW_DO_TYPE_ON))
  1381. {
  1382. if(pR->run_stu.sw==2)
  1383. {
  1384. pR->uRmtSW.bTz_Doing = 1;
  1385. #ifdef FUNC_DRIVE
  1386. gb_drive.bTz_Doing = 1;
  1387. #endif
  1388. }
  1389. pR->uRmtSW.bHz_Doing = 0;
  1390. #ifdef FUNC_DRIVE
  1391. gb_drive.bHz_Doing = 0;
  1392. #endif
  1393. }
  1394. if(sw >= SWITCH_NUM_MAX || index >=SW_DO_NUM)
  1395. {
  1396. return -1;
  1397. }
  1398. // 气压低闭锁分合闸
  1399. if(pRunSet->tSwSet[sw].bTT_QYD_BS
  1400. && (g_sw[sw].di[SW_DI_QYD] == SW_DI_TYPE_ON)
  1401. && (index == SW_DO_HZ || index == SW_DO_FZ||index == SW_DO_YKH||index == SW_DO_YKT||index ==SW_DO_BHH||index ==SW_DO_BHT))
  1402. {
  1403. return -2;
  1404. }
  1405. // 需要通道有配置
  1406. index = g_sw[sw].do_cfg_index[index];
  1407. if(index == INDEX_INVALLID || index >= g_equ_config->do_num)
  1408. {
  1409. return -3;
  1410. }
  1411. slot = g_equ_config_do[index].slot;
  1412. index = g_equ_config_do[index].index;
  1413. ret = _sw_do(slot,index,type);
  1414. return ret;
  1415. }
  1416. /******************************************************************************
  1417. 函数名称: sw_do_pub
  1418. 函数版本: 01.01
  1419. 创建作者: sunxi
  1420. 创建日期: 2013-08-07
  1421. 函数说明: 针对线路开关公共部门执行开出动作
  1422. 参数说明:
  1423. index 开出索引
  1424. type 开出类型
  1425. 返回值:
  1426. 0: 成功
  1427. 其它: 失败
  1428. 修改记录:
  1429. */
  1430. int sw_do_pub(u32 index,int type)
  1431. {
  1432. int ret;
  1433. u32 slot;
  1434. if(index >=PUB_DO_NUM)
  1435. {
  1436. return -1;
  1437. }
  1438. index = g_sw_pub.do_cfg_index[index];
  1439. if(index == INDEX_INVALLID || index >= g_equ_config->do_num)
  1440. {
  1441. return -2;
  1442. }
  1443. slot = g_equ_config_do[index].slot;
  1444. index = g_equ_config_do[index].index;
  1445. ret = _sw_do(slot,index,type);
  1446. return ret;
  1447. }
  1448. /******************************************************************************
  1449. 函数名称: sw_do_yk
  1450. 函数版本: 01.01
  1451. 创建作者: sunxi
  1452. 创建日期: 2013-08-07
  1453. 函数说明: 预控继电器开出
  1454. 参数说明:
  1455. index 开出索引
  1456. type 开出类型
  1457. 返回值:
  1458. 0: 成功
  1459. 其它: 失败
  1460. 修改记录:
  1461. */
  1462. int sw_do_yuk(int type)
  1463. {
  1464. int ret;
  1465. u32 slot;
  1466. int index;
  1467. index = g_sw_pub.do_cfg_index[PUB_DO_YK];
  1468. if(index == INDEX_INVALLID || index >= g_equ_config->do_num)
  1469. {
  1470. return -2;
  1471. }
  1472. slot = g_equ_config_do[index].slot;
  1473. index = g_equ_config_do[index].index;
  1474. ret = _sw_do(slot,index,type);
  1475. return ret;
  1476. }
  1477. /******************************************************************************
  1478. 函数名称: sw_v_m2_factor_k
  1479. 函数版本: 01.01
  1480. 创建作者: sunxi
  1481. 创建日期: 2013-08-07
  1482. 函数说明: 得到一个保护定值计算用的理论转化系数。目前假设所有电压的系数都是一样,
  1483. 从第一组电压中取出一个。
  1484. 参数说明:
  1485. 返回值:
  1486. 修改记录:
  1487. */
  1488. float sw_v_m2_factor_k(int id)
  1489. {
  1490. if(id < PUB_AC_NUM)
  1491. {
  1492. if(id == PUB_AC_US1)
  1493. {
  1494. if((short)g_sw_pub.ac_cfg_index[PUB_AC_US1] == INDEX_INVALLID)
  1495. {
  1496. return g_ui[PUB_AC_UAB1].m2_factor_k;
  1497. }
  1498. else
  1499. {
  1500. if(g_ui[id].chn_index != CFG_ADC_CHANNEL_ZERO)
  1501. {
  1502. return g_ui[id].m2_factor_k;
  1503. }
  1504. }
  1505. }
  1506. else if(id == PUB_AC_US2)
  1507. {
  1508. if((short)g_sw_pub.ac_cfg_index[PUB_AC_US2] == INDEX_INVALLID)
  1509. {
  1510. return g_ui[PUB_AC_UBC2].m2_factor_k;
  1511. }
  1512. else
  1513. {
  1514. if(g_ui[id].chn_index != CFG_ADC_CHANNEL_ZERO)
  1515. {
  1516. return g_ui[id].m2_factor_k;
  1517. }
  1518. }
  1519. }
  1520. else if(id == PUB_AC_U01)
  1521. {
  1522. if(g_ui[id].chn_index == CFG_ADC_CHANNEL_ZERO)
  1523. {
  1524. return g_ui[PUB_AC_UA1].m2_factor_k;
  1525. }
  1526. else
  1527. {
  1528. if(g_ui[id].chn_index != CFG_ADC_CHANNEL_ZERO)
  1529. {
  1530. return g_ui[id].m2_factor_k;
  1531. }
  1532. }
  1533. }
  1534. else if(id == PUB_AC_U02)
  1535. {
  1536. if(g_ui[id].chn_index == CFG_ADC_CHANNEL_ZERO)
  1537. {
  1538. return g_ui[PUB_AC_UA2].m2_factor_k;
  1539. }
  1540. else
  1541. {
  1542. if(g_ui[id].chn_index != CFG_ADC_CHANNEL_ZERO)
  1543. {
  1544. return g_ui[id].m2_factor_k;
  1545. }
  1546. }
  1547. }
  1548. else
  1549. {
  1550. //if(g_ui[id].chn_index != CFG_ADC_CHANNEL_ZERO)
  1551. //{
  1552. return g_ui[id].m2_factor_k;
  1553. //}
  1554. }
  1555. }
  1556. return 1.0;
  1557. }
  1558. #ifdef FUNC_DRIVE_JY
  1559. static void drive_ui_proc(void)
  1560. {
  1561. int i=0,sw=0;
  1562. TSETSW *pSet = &pRunSet->tSwSet[sw];
  1563. if(!gb_drive.b_drive_on)
  1564. {
  1565. return;
  1566. }
  1567. for(i=0;i<1;i++)//保护遥测值
  1568. {
  1569. if(!gb_drive.tDriveUa1Time.boolTrip)
  1570. {
  1571. g_ui[PUB_AC_UA1].m2[i] = GetSetSQR(pSet->dU_drive_ua1,(pRunSet->dKU[PUB_AC_UA1]/256.0));
  1572. g_ui[PUB_AC_UB1].m2[i] = GetSetSQR(pSet->dU_drive_ua1,(pRunSet->dKU[PUB_AC_UB1]/256.0));
  1573. g_ui[PUB_AC_UC1].m2[i] = GetSetSQR(pSet->dU_drive_ua1,(pRunSet->dKU[PUB_AC_UC1]/256.0));
  1574. g_ui[PUB_AC_UAB1].m2[i] = GetSetSQR(pSet->dU_drive_ua1,(pRunSet->dKU[PUB_AC_UAB1]/256.0));
  1575. g_ui[PUB_AC_UBC1].m2[i] = GetSetSQR(pSet->dU_drive_ua1,(pRunSet->dKU[PUB_AC_UBC1]/256.0));
  1576. g_ui[PUB_AC_UCA1].m2[i] = GetSetSQR(pSet->dU_drive_ua1,(pRunSet->dKU[PUB_AC_UCA1]/256.0));
  1577. }
  1578. if(!gb_drive.tDriveUa2Time.boolTrip)
  1579. {
  1580. g_ui[PUB_AC_UA2].m2[i] = GetSetSQR(pSet->dU_drive_ua2,(pRunSet->dKU[PUB_AC_UA2]/256.0));
  1581. g_ui[PUB_AC_UB2].m2[i] = GetSetSQR(pSet->dU_drive_ua2,(pRunSet->dKU[PUB_AC_UB2]/256.0));
  1582. g_ui[PUB_AC_UC2].m2[i] = GetSetSQR(pSet->dU_drive_ua2,(pRunSet->dKU[PUB_AC_UC2]/256.0));
  1583. g_ui[PUB_AC_UAB2].m2[i] = GetSetSQR(pSet->dU_drive_ua2,(pRunSet->dKU[PUB_AC_UAB2]/256.0));
  1584. g_ui[PUB_AC_UBC2].m2[i] = GetSetSQR(pSet->dU_drive_ua2,(pRunSet->dKU[PUB_AC_UBC2]/256.0));
  1585. g_ui[PUB_AC_UCA2].m2[i] = GetSetSQR(pSet->dU_drive_ua2,(pRunSet->dKU[PUB_AC_UCA2]/256.0));
  1586. }
  1587. if(!gb_drive.tDriveU0Time.boolTrip)
  1588. {
  1589. g_ui[PUB_AC_U01].m2[i] = GetSetSQR(pSet->dU_drive_u0,(pRunSet->dKU[PUB_AC_U01]/256.0));
  1590. }
  1591. if(!gb_drive.tDriveITime.boolTrip)
  1592. {
  1593. g_ui[UI_SW_INDEX_BEGIN(sw)+SW_AC_IA].m2[i] = GetSetSQR(pSet->dU_drive_i,(g_ui[UI_SW_INDEX_BEGIN(sw)+SW_AC_IA].m2_factor_k/256.0));
  1594. }
  1595. if(!gb_drive.tDriveI0Time.boolTrip)
  1596. {
  1597. g_ui[UI_SW_INDEX_BEGIN(sw)+SW_AC_I0].m2[i] = GetSetSQR(pSet->dU_drive_i0,(g_ui[UI_SW_INDEX_BEGIN(sw)+SW_AC_I0].m2_factor_k/256.0));
  1598. }
  1599. }
  1600. #if 0
  1601. //测量显示遥测值
  1602. g_sw_pub.ac_in[PUB_AC_UA1] =(pSet->dU_drive_ua1*Q16_BASE);
  1603. g_sw_pub.ac_in[PUB_AC_UAB1] =(pSet->dU_drive_ua1*Q16_BASE);
  1604. g_sw_pub.ac_in[PUB_AC_UA2] =(pSet->dU_drive_ua2*Q16_BASE);
  1605. g_sw_pub.ac_in[PUB_AC_UAB2] =(pSet->dU_drive_ua2*Q16_BASE);
  1606. g_sw_pub.ac_in[PUB_AC_U01] = (qs16)(pSet->dU_drive_u0*Q16_BASE);
  1607. g_sw[sw].ac_in[SW_AC_IA] = (qs16)(pSet->dU_drive_i*Q16_BASE);
  1608. g_sw[sw].ac_in[SW_AC_I0] = (qs16)(pSet->dU_drive_i0*Q16_BASE);
  1609. #endif
  1610. }
  1611. #endif
  1612. /******************************************************************************
  1613. 函数名称: sw_cal_protect
  1614. 函数版本: 01.01
  1615. 创建作者: sunxi
  1616. 创建日期: 2013-08-07
  1617. 函数说明: 在保护5ms中断中计算基波的值。
  1618. 参数说明:
  1619. 返回值:
  1620. 修改记录:
  1621. */
  1622. void sw_cal_protect(void)
  1623. {
  1624. int sw,i,index ;
  1625. short *psam;
  1626. qs08 angle;
  1627. qs16 lncos,lnsin;
  1628. struct ri_s16 ri16;
  1629. struct ri_s16 ri16_2;
  1630. struct ri_s32 ri;
  1631. struct ri_s32 ri_2[2];
  1632. // 更新保护计算时采样点的索引
  1633. g_prot_index=g_adc_dots_index;
  1634. #ifdef FUN_HCBS
  1635. {
  1636. extern DWORD dTcounterrem;
  1637. dTcounterrem=dTCounter;
  1638. }
  1639. #endif
  1640. // 计算模值平方
  1641. for(i=0; i<UI_NUM; i++)
  1642. {
  1643. // 如果索引通道不存在,不需计算
  1644. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  1645. {
  1646. continue;
  1647. }
  1648. // 检查硬件通道是否正常,如果不正常,ri清零;否则计算出ri。
  1649. if(equ_ac_channel_is_ok(g_ui[i].chn_index) == 0)
  1650. {
  1651. ri16.r = 0;
  1652. ri16.i = 0;
  1653. ri16_2.r = 0;
  1654. ri16_2.i = 0;
  1655. }
  1656. else
  1657. {
  1658. psam = adc_fourier_address(g_ui[i].chn_index,g_prot_index);
  1659. // 基波FFT
  1660. fourier32(psam, &ri16, FOURIER_HARMONIC_1);
  1661. // 二次谐波FFT
  1662. if (i >= PUB_AC_NUM)
  1663. {
  1664. fourier32(psam, &ri16_2, FOURIER_HARMONIC_2);
  1665. }
  1666. }
  1667. //基波计算
  1668. ri.r = _MulFac_S(ri16.r,g_ui[i].m2_factor_c); // 电压电流实部
  1669. ri.i = _MulFac_S(ri16.i,g_ui[i].m2_factor_c); // 电压电流虚部
  1670. angle = rt_round((g_ui[i].p_factor + factor_p_k(g_ui[i].chn_index))*256);
  1671. lncos = mCos(angle);
  1672. lnsin = mSin(angle);
  1673. g_ui[i].ri.r = _MulFac_S(ri.r,lncos) - _MulFac_S(ri.i,lnsin);
  1674. g_ui[i].ri.i = _MulFac_S(ri.r,lnsin) + _MulFac_S(ri.i,lncos);
  1675. g_ui[i].m2[0] = SQR(g_ui[i].ri.r,g_ui[i].ri.i); // 电压电流平方和
  1676. rt_stat_in(&g_ui[i].m2_stat,g_ui[i].m2[0]);
  1677. //二次谐波计算
  1678. if (i >= PUB_AC_NUM)
  1679. {
  1680. ri_2[0].r = _MulFac_S(ri16_2.r,g_ui[i].m2_factor_c); // 电压电流实部
  1681. ri_2[0].i = _MulFac_S(ri16_2.i,g_ui[i].m2_factor_c); // 电压电流虚部
  1682. #if 0
  1683. angle = rt_round(g_ui[i].p_factor*256);
  1684. lncos = mCos(angle);
  1685. lnsin = mSin(angle);
  1686. #endif
  1687. ri_2[1].r = _MulFac_S(ri_2[0].r,lncos) - _MulFac_S(ri_2[0].i,lnsin);
  1688. ri_2[1].i = _MulFac_S(ri_2[0].r,lnsin) + _MulFac_S(ri_2[0].i,lncos);
  1689. g_ui[i].m2[1] = SQR(ri_2[1].r,ri_2[1].i); // 电压电流平方和
  1690. }
  1691. }
  1692. #ifdef GD_AREA_ECZD_2020
  1693. //计算正序和负序电压
  1694. //US1
  1695. if((g_ui[PUB_AC_UA1].chn_index != CFG_ADC_CHANNEL_ZERO)&&(g_ui[PUB_AC_UB1].chn_index != CFG_ADC_CHANNEL_ZERO)&&(g_ui[PUB_AC_UC1].chn_index != CFG_ADC_CHANNEL_ZERO))
  1696. {
  1697. _sw_cal_Xfl120(PUB_AC_UA1, &Us1_120);
  1698. }
  1699. else
  1700. {
  1701. Us2_120.vect1=0;
  1702. Us2_120.vect2=0;
  1703. }
  1704. //US2
  1705. if((g_ui[PUB_AC_UA2].chn_index != CFG_ADC_CHANNEL_ZERO)&&(g_ui[PUB_AC_UB2].chn_index != CFG_ADC_CHANNEL_ZERO)&&(g_ui[PUB_AC_UC2].chn_index != CFG_ADC_CHANNEL_ZERO))
  1706. {
  1707. _sw_cal_Xfl120(PUB_AC_UA2, &Us2_120);
  1708. }
  1709. else
  1710. {
  1711. Us2_120.vect1=0;
  1712. Us2_120.vect2=0;
  1713. }
  1714. #endif
  1715. // 合成线电压1
  1716. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_LV1)
  1717. {
  1718. g_ui[PUB_AC_UAB1].ri.r = g_ui[PUB_AC_UA1].ri.r - g_ui[PUB_AC_UB1].ri.r;
  1719. g_ui[PUB_AC_UAB1].ri.i = g_ui[PUB_AC_UA1].ri.i - g_ui[PUB_AC_UB1].ri.i;
  1720. g_ui[PUB_AC_UAB1].m2[0] = SQR(g_ui[PUB_AC_UAB1].ri.r,g_ui[PUB_AC_UAB1].ri.i);
  1721. rt_stat_in(&g_ui[PUB_AC_UAB1].m2_stat,g_ui[PUB_AC_UAB1].m2[0]);
  1722. g_ui[PUB_AC_UBC1].ri.r = g_ui[PUB_AC_UB1].ri.r - g_ui[PUB_AC_UC1].ri.r;
  1723. g_ui[PUB_AC_UBC1].ri.i = g_ui[PUB_AC_UB1].ri.i - g_ui[PUB_AC_UC1].ri.i;
  1724. g_ui[PUB_AC_UBC1].m2[0] = SQR(g_ui[PUB_AC_UBC1].ri.r,g_ui[PUB_AC_UBC1].ri.i);
  1725. rt_stat_in(&g_ui[PUB_AC_UBC1].m2_stat,g_ui[PUB_AC_UBC1].m2[0]);
  1726. g_ui[PUB_AC_UCA1].ri.r = g_ui[PUB_AC_UC1].ri.r - g_ui[PUB_AC_UA1].ri.r;
  1727. g_ui[PUB_AC_UCA1].ri.i = g_ui[PUB_AC_UC1].ri.i - g_ui[PUB_AC_UA1].ri.i;
  1728. g_ui[PUB_AC_UCA1].m2[0] = SQR(g_ui[PUB_AC_UCA1].ri.r,g_ui[PUB_AC_UCA1].ri.i);
  1729. rt_stat_in(&g_ui[PUB_AC_UCA1].m2_stat,g_ui[PUB_AC_UCA1].m2[0]);
  1730. }
  1731. // 合成线电压2
  1732. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_LV2)
  1733. {
  1734. g_ui[PUB_AC_UAB2].ri.r = g_ui[PUB_AC_UA2].ri.r - g_ui[PUB_AC_UB2].ri.r;
  1735. g_ui[PUB_AC_UAB2].ri.i = g_ui[PUB_AC_UA2].ri.i - g_ui[PUB_AC_UB2].ri.i;
  1736. g_ui[PUB_AC_UAB2].m2[0] = SQR(g_ui[PUB_AC_UAB2].ri.r,g_ui[PUB_AC_UAB2].ri.i);
  1737. rt_stat_in(&g_ui[PUB_AC_UAB2].m2_stat,g_ui[PUB_AC_UAB2].m2[0]);
  1738. g_ui[PUB_AC_UBC2].ri.r = g_ui[PUB_AC_UB2].ri.r - g_ui[PUB_AC_UC2].ri.r;
  1739. g_ui[PUB_AC_UBC2].ri.i = g_ui[PUB_AC_UB2].ri.i - g_ui[PUB_AC_UC2].ri.i;
  1740. g_ui[PUB_AC_UBC2].m2[0] = SQR(g_ui[PUB_AC_UBC2].ri.r,g_ui[PUB_AC_UBC2].ri.i);
  1741. rt_stat_in(&g_ui[PUB_AC_UBC2].m2_stat,g_ui[PUB_AC_UBC2].m2[0]);
  1742. g_ui[PUB_AC_UCA2].ri.r = g_ui[PUB_AC_UC2].ri.r - g_ui[PUB_AC_UA2].ri.r;
  1743. g_ui[PUB_AC_UCA2].ri.i = g_ui[PUB_AC_UC2].ri.i - g_ui[PUB_AC_UA2].ri.i;
  1744. g_ui[PUB_AC_UCA2].m2[0] = SQR(g_ui[PUB_AC_UCA2].ri.r,g_ui[PUB_AC_UCA2].ri.i);
  1745. rt_stat_in(&g_ui[PUB_AC_UCA2].m2_stat,g_ui[PUB_AC_UCA2].m2[0]);
  1746. }
  1747. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_UCA1) // 合成线电压UCA1
  1748. {
  1749. g_ui[PUB_AC_UCA1].ri.r =- g_ui[PUB_AC_UAB1].ri.r - g_ui[PUB_AC_UBC1].ri.r;
  1750. g_ui[PUB_AC_UCA1].ri.i =- g_ui[PUB_AC_UAB1].ri.i - g_ui[PUB_AC_UBC1].ri.i;
  1751. g_ui[PUB_AC_UCA1].m2[0] = SQR(g_ui[PUB_AC_UCA1].ri.r,g_ui[PUB_AC_UCA1].ri.i);
  1752. rt_stat_in(&g_ui[PUB_AC_UCA1].m2_stat,g_ui[PUB_AC_UCA1].m2[0]);
  1753. }
  1754. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_UCA2) // 合成线电压UCA1
  1755. {
  1756. g_ui[PUB_AC_UCA2].ri.r =- g_ui[PUB_AC_UAB2].ri.r - g_ui[PUB_AC_UBC2].ri.r;
  1757. g_ui[PUB_AC_UCA2].ri.i =- g_ui[PUB_AC_UAB2].ri.i - g_ui[PUB_AC_UBC2].ri.i;
  1758. g_ui[PUB_AC_UCA2].m2[0] = SQR(g_ui[PUB_AC_UCA2].ri.r,g_ui[PUB_AC_UCA2].ri.i);
  1759. rt_stat_in(&g_ui[PUB_AC_UCA1].m2_stat,g_ui[PUB_AC_UCA2].m2[0]);
  1760. }
  1761. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_U01)
  1762. {
  1763. g_ui[PUB_AC_U01].ri.r = g_ui[PUB_AC_UA1].ri.r + g_ui[PUB_AC_UB1].ri.r+ g_ui[PUB_AC_UC1].ri.r;
  1764. g_ui[PUB_AC_U01].ri.i = g_ui[PUB_AC_UA1].ri.i + g_ui[PUB_AC_UB1].ri.i+ g_ui[PUB_AC_UC1].ri.i;
  1765. g_ui[PUB_AC_U01].m2[0] = SQR(g_ui[PUB_AC_U01].ri.r,g_ui[PUB_AC_U01].ri.i);
  1766. rt_stat_in(&g_ui[PUB_AC_U01].m2_stat,g_ui[PUB_AC_U01].m2[0]);
  1767. }
  1768. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_U02)
  1769. {
  1770. g_ui[PUB_AC_U02].ri.r = g_ui[PUB_AC_UA2].ri.r + g_ui[PUB_AC_UB2].ri.r+ g_ui[PUB_AC_UC2].ri.r;
  1771. g_ui[PUB_AC_U02].ri.i = g_ui[PUB_AC_UA2].ri.i + g_ui[PUB_AC_UB2].ri.i+ g_ui[PUB_AC_UC2].ri.i;
  1772. g_ui[PUB_AC_U02].m2[0] = SQR(g_ui[PUB_AC_U02].ri.r,g_ui[PUB_AC_U02].ri.i);
  1773. rt_stat_in(&g_ui[PUB_AC_U02].m2_stat,g_ui[PUB_AC_U02].m2[0]);
  1774. }
  1775. // 合成电流
  1776. for(sw=0; sw<g_sw_num; sw++)
  1777. {
  1778. // IB
  1779. if(g_sw[sw].ui_flags&UI_FLAGS_MAKE_IB)
  1780. {
  1781. index = UI_SW_INDEX(sw,SW_AC_IB);
  1782. g_ui[index].ri.r = -g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.r - g_ui[UI_SW_INDEX(sw,SW_AC_IC)].ri.r;
  1783. g_ui[index].ri.i = -g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.i - g_ui[UI_SW_INDEX(sw,SW_AC_IC)].ri.i;
  1784. g_ui[index].m2[0] = SQR(g_ui[index].ri.r,g_ui[index].ri.i);
  1785. rt_stat_in(&g_ui[index].m2_stat,g_ui[index].m2[0]);
  1786. }
  1787. // I0
  1788. if(g_sw[sw].ui_flags&UI_FLAGS_MAKE_I0)
  1789. {
  1790. index = UI_SW_INDEX(sw,SW_AC_I0);
  1791. g_ui[index].ri.r = g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.r + g_ui[UI_SW_INDEX(sw,SW_AC_IB)].ri.r + g_ui[UI_SW_INDEX(sw,SW_AC_IC)].ri.r;
  1792. g_ui[index].ri.i = g_ui[UI_SW_INDEX(sw,SW_AC_IA)].ri.i + g_ui[UI_SW_INDEX(sw,SW_AC_IB)].ri.i + g_ui[UI_SW_INDEX(sw,SW_AC_IC)].ri.i;
  1793. g_ui[index].m2[0] = SQR(g_ui[index].ri.r,g_ui[index].ri.i);
  1794. rt_stat_in(&g_ui[index].m2_stat,g_ui[index].m2[0]);
  1795. }
  1796. #ifdef FUN_JDXX
  1797. //计算零序有功无功
  1798. if(pRunSet->tSwSet[sw].bTT_Power_v2 == 0)
  1799. {
  1800. if(g_ui[PUB_AC_U01].chn_index != CFG_ADC_CHANNEL_ZERO)
  1801. {
  1802. if(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index != CFG_ADC_CHANNEL_ZERO)
  1803. {
  1804. g_ui_p0[sw].p= _sw_p2(g_ui[PUB_AC_U01].ri.r,g_ui[PUB_AC_U01].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.i,g_ui[PUB_AC_U01].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].e_factor);
  1805. g_ui_p0[sw].q= _sw_q2(g_ui[PUB_AC_U01].ri.r,g_ui[PUB_AC_U01].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.i,g_ui[PUB_AC_U01].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].e_factor);
  1806. }
  1807. if(g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].chn_index != CFG_ADC_CHANNEL_ZERO)
  1808. {
  1809. g_ui_p0[sw].ps= _sw_p2(g_ui[PUB_AC_U01].ri.r,g_ui[PUB_AC_U01].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.i,g_ui[PUB_AC_U01].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].e_factor);
  1810. g_ui_p0[sw].qs= _sw_q2(g_ui[PUB_AC_U01].ri.r,g_ui[PUB_AC_U01].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.i,g_ui[PUB_AC_U01].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].e_factor);
  1811. }
  1812. }
  1813. else
  1814. {
  1815. g_ui_p0[sw].p=0;g_ui_p0[sw].q=0;
  1816. g_ui_p0[sw].ps=0;g_ui_p0[sw].qs=0;
  1817. }
  1818. }
  1819. else
  1820. {
  1821. if(g_ui[PUB_AC_U02].chn_index != CFG_ADC_CHANNEL_ZERO)
  1822. {
  1823. if(g_ui[UI_SW_INDEX(sw,SW_AC_I0)].chn_index != CFG_ADC_CHANNEL_ZERO)
  1824. {
  1825. g_ui_p0[sw].p= _sw_p2(g_ui[PUB_AC_U02].ri.r,g_ui[PUB_AC_U02].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.i,g_ui[PUB_AC_U02].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].e_factor);
  1826. g_ui_p0[sw].q= _sw_q2(g_ui[PUB_AC_U02].ri.r,g_ui[PUB_AC_U02].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].ri.i,g_ui[PUB_AC_U02].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0)].e_factor);
  1827. }
  1828. if(g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].chn_index != CFG_ADC_CHANNEL_ZERO)
  1829. {
  1830. g_ui_p0[sw].ps= _sw_p2(g_ui[PUB_AC_U02].ri.r,g_ui[PUB_AC_U02].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.i,g_ui[PUB_AC_U02].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].e_factor);
  1831. g_ui_p0[sw].qs= _sw_q2(g_ui[PUB_AC_U02].ri.r,g_ui[PUB_AC_U02].ri.i,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.r,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].ri.i,g_ui[PUB_AC_U02].e_factor,g_ui[UI_SW_INDEX(sw,SW_AC_I0s)].e_factor);
  1832. }
  1833. }
  1834. else
  1835. {
  1836. g_ui_p0[sw].p=0;g_ui_p0[sw].q=0;
  1837. g_ui_p0[sw].ps=0;g_ui_p0[sw].qs=0;
  1838. }
  1839. }
  1840. #endif
  1841. }
  1842. // 仅线电压需计算幅值
  1843. for(i=PUB_AC_UA1; i<PUB_AC_NUM; i++)
  1844. {
  1845. g_ui[i].fz = _AmXY(g_ui[i].ri.r,g_ui[i].ri.i);
  1846. }
  1847. #ifdef FUNC_DRIVE_JY
  1848. drive_ui_proc();
  1849. #endif
  1850. // 计算最大最小值
  1851. _sw_min_max(PUB_AC_UA1,&g_sw_pub.m2_min[0],&g_sw_pub.m2_max[0]);
  1852. _sw_min_max(PUB_AC_UAB1,&g_sw_pub.m2_min[2],&g_sw_pub.m2_max[2]);
  1853. _sw_min_max(PUB_AC_UAB2,&g_sw_pub.m2_min[3],&g_sw_pub.m2_max[3]);
  1854. _fz_min_max(PUB_AC_UAB1,PUB_AC_UCA1,&g_sw_pub.fz_min[0],&g_sw_pub.fz_max[0]);
  1855. _fz_min_max(PUB_AC_UAB2,PUB_AC_UCA2,&g_sw_pub.fz_min[1],&g_sw_pub.fz_max[1]);
  1856. for(sw=0; sw<g_sw_num; sw++)
  1857. {
  1858. for(i=UI_SW_INDEX(sw,SW_AC_IA); i<=UI_SW_INDEX(sw,SW_AC_IC); i++)
  1859. {
  1860. g_ui[i].fz = _AmXY(g_ui[i].ri.r,g_ui[i].ri.i);
  1861. }
  1862. _sw_min_max(UI_SW_INDEX_BEGIN(sw),&g_sw[sw].m2_min,&g_sw[sw].m2_max);
  1863. _fz_min_max(UI_SW_INDEX(sw,SW_AC_IA),UI_SW_INDEX(sw,SW_AC_IC),&g_sw[sw].fz_min,&g_sw[sw].fz_max);
  1864. }
  1865. return;
  1866. }
  1867. /******************************************************************************
  1868. 函数名称: sw_cal_app
  1869. 函数版本: 01.01
  1870. 创建作者: sunxi
  1871. 创建日期: 2013-08-07
  1872. 函数说明: 在测量线程中计算测量值
  1873. 参数说明:
  1874. 返回值:
  1875. 修改记录:
  1876. */
  1877. void _sw_cal_zl(void);
  1878. int sw_cal_app(void )
  1879. {
  1880. _sw_temp_factor();
  1881. if(_sw_cal_mea() != 0)
  1882. {
  1883. return 0;
  1884. }
  1885. // 如果没有达到累计次数,直接返回。
  1886. g_mea_cnt++;
  1887. if(g_mea_cnt < MEA_CAL_NUMBER)
  1888. {
  1889. return 0;
  1890. }
  1891. g_mea_cnt = 0;
  1892. _sw_cal_average(MEA_CAL_NUMBER);
  1893. return 0;
  1894. }
  1895. void sw_factor_cp(void) //保存校正的系数,根据第一路电流的配置,是按CT默认100A校正还是51欧校正
  1896. {
  1897. bool b100A=false;
  1898. bool b50A=false;
  1899. bool b20A=false;
  1900. bool b10A=false;
  1901. int i;
  1902. for(i=0; i< g_equ_config->ac_num; i++)
  1903. {
  1904. if(g_equ_config_ac[i].owner ==1&&g_equ_config_ac[i].type==(SW_AC_IA+1)) // 根据开关1 IA的配置,保存相关的参数
  1905. {
  1906. if(g_equ_config_ac[i].scale==EQU_SCALE_CT_DEFAULT)
  1907. {
  1908. b100A=true;
  1909. }
  1910. if(g_equ_config_ac[i].scale==EQU_SCALE_CT_10A_51)
  1911. {
  1912. b50A=true;
  1913. }
  1914. if(g_equ_config_ac[i].scale==EQU_SCALE_CT_10A_249)
  1915. {
  1916. b20A=true;
  1917. }
  1918. if(g_equ_config_ac[i].scale==EQU_SCALE_CT_10A_120)
  1919. {
  1920. b10A=true;
  1921. }
  1922. if(b100A)
  1923. {
  1924. rt_file_cp("/app/data/acfactor.bin","/app/data/acfactor_100A.bin");
  1925. }
  1926. if(b50A)
  1927. {
  1928. rt_file_cp("/app/data/acfactor.bin","/app/data/acfactor_50A.bin");
  1929. }
  1930. if(b20A)
  1931. {
  1932. rt_file_cp("/app/data/acfactor.bin","/app/data/acfactor_20A.bin");
  1933. }
  1934. if(b10A)
  1935. {
  1936. rt_file_cp("/app/data/acfactor.bin","/app/data/acfactor_10A.bin");
  1937. }
  1938. return;
  1939. }
  1940. }
  1941. }
  1942. /******************************************************************************
  1943. 函数名称: sw_auto_adjust
  1944. 函数版本: 01.01
  1945. 创建作者: sunxi
  1946. 创建日期: 2013-08-07
  1947. 函数说明: 自动校准程序
  1948. U 100V,I 5A,
  1949. 参数说明:
  1950. 返回值:
  1951. 0: 成功
  1952. 其它: 失败
  1953. 修改记录:
  1954. */
  1955. struct pq_factor
  1956. {
  1957. int cfg_index;
  1958. float pq[2];
  1959. };
  1960. struct pq_factor g_pq_factor[SWITCH_NUM_MAX][3];
  1961. int sw_auto_adjust(int ui_angle0)
  1962. {
  1963. float baseAng;
  1964. int ret,i,j,sw;
  1965. int cfg_index;
  1966. float factor;
  1967. float fv;
  1968. float minfv,maxfv;
  1969. float baseValue ;
  1970. u16 base_v=0,base_i=0;
  1971. #ifdef PROTECT_AC_ADJUST
  1972. float fv_p;
  1973. #endif
  1974. g_mea_cnt= 0;
  1975. // 如果是单板测试,可能需要使用PUB_AC_UA2作为角度0参考
  1976. if(ui_angle0 != -1)
  1977. {
  1978. g_ui_angle0 = ui_angle0;
  1979. }
  1980. // 测量值复位
  1981. g_factor_version = ACFACTOR_FILE_VERSION;
  1982. for(i=0; i<UI_NUM; i++)
  1983. {
  1984. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  1985. {
  1986. continue;
  1987. }
  1988. g_ui[i].e_acc = 0;
  1989. g_ui[i].e = 0;
  1990. g_ui[i].p_acc = 0;
  1991. g_ui[i].p = 0;
  1992. g_ui[i].p_mark = 0;
  1993. g_ui[i].e_factor = 1.0/_sw_ui_e_k(i);
  1994. g_ui[i].p_factor = 0;
  1995. }
  1996. for(sw=0; sw<g_sw_num; sw++)
  1997. {
  1998. for(j=0; j<3; j++)
  1999. {
  2000. g_pq_factor[sw][j].cfg_index = -1;
  2001. g_pq_factor[sw][j].pq[0] = 0;
  2002. g_pq_factor[sw][j].pq[1] = 0;
  2003. }
  2004. }
  2005. sw_stat_reset();
  2006. // 测量AUTO_ADJUST_NUM次
  2007. for(i=0;i<AUTO_ADJUST_NUM;i++) // 计算多次幅值
  2008. {
  2009. watchdog_feed_mainloop();
  2010. // 得到采样点
  2011. _sw_get_dots();
  2012. // fft
  2013. _sw_cal_fft();
  2014. _sw_cal_ri_correct();
  2015. // 计算有效值
  2016. _sw_cal_effect();
  2017. // 计算角度
  2018. _sw_cal_angle();
  2019. // 延时20ms,并喂狗
  2020. #ifdef CPU_FUXI
  2021. msleep(30);
  2022. #else
  2023. ustimer_delay(20*USTIMER_MS);
  2024. #endif
  2025. watchdog_feed_mainloop();
  2026. }
  2027. _sw_cal_average(AUTO_ADJUST_NUM);
  2028. #if 0 //def PROTECT_AC_ADJUST
  2029. factor_restore_default();
  2030. ustimer_delay(20*USTIMER_MS);
  2031. #endif
  2032. for(i=0; i<UI_NUM; i++)
  2033. {
  2034. // 如果索引通道不存在,不需计算
  2035. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  2036. {
  2037. continue;
  2038. }
  2039. fv = (float)g_ui[i].e/Q16_BASE;
  2040. #ifdef PROTECT_AC_ADJUST
  2041. fv_p = (float)_Mul_Div_U(sqrt_32fix(g_ui[i].m2[0]), 256, g_ui[i].m2_factor_k)/(float)Q16_BASE;
  2042. #endif
  2043. // 确定通道配置索引和基本值
  2044. if(i<PUB_AC_NUM)
  2045. {
  2046. cfg_index = g_sw_pub.ac_cfg_index[i];
  2047. //if(g_equ_config_ac[cfg_index].scale == EQU_SCALE_EVT_3V25_100V)
  2048. //{
  2049. // 电子式相电压
  2050. // baseValue = 57.735;
  2051. //}
  2052. /*
  2053. else if(g_equ_config_ac[cfg_index].scale == EQU_SCALE_EVT_6V50_100V)
  2054. {
  2055. // 电子式零序电压,为了校验方便,使用C相电压,换算零序为此值。
  2056. baseValue = 28.86751346;
  2057. }
  2058. */
  2059. // 自适应电压校准
  2060. if(fv > 200) // 220
  2061. {
  2062. // 220V额定电压
  2063. baseValue = 220; //
  2064. }
  2065. else if (fv > (120.0*1.732)) // 207.84
  2066. {
  2067. // 130V相电压合成线电压校准
  2068. // 因为罩式控制器在用100V校准时,PT切换不断的响,
  2069. // 130V相电压可得到225V电源,可避免PT切换的异响
  2070. baseValue = 130*1.732; // 225.16
  2071. }
  2072. else if(fv > 90*1.732) // 155.88
  2073. {
  2074. // 100V相电压合成线电压校准
  2075. baseValue = 100*1.732; // 173.2
  2076. }
  2077. else if (fv > 120.0) // 120
  2078. {
  2079. // 130V 相电压校准
  2080. baseValue = 130; // 130
  2081. }
  2082. else if(fv > 90.0)
  2083. {
  2084. // 100V 相电压校准
  2085. baseValue = 100; // 100
  2086. }
  2087. else if(fv > 50.0)
  2088. {
  2089. // 100V 相电压校准
  2090. baseValue = 57.735; // 57.735
  2091. }
  2092. else if(fv > 16.0)
  2093. {
  2094. // 100V 相电压校准
  2095. baseValue = 20; // 20
  2096. }
  2097. else if(fv > 8.0)
  2098. {
  2099. // 10V 相电压校准
  2100. baseValue = 10; // 10
  2101. }
  2102. else if(fv > 6.0)
  2103. {
  2104. baseValue =6.5;
  2105. }
  2106. else if(fv > 2.0)
  2107. {
  2108. // 10V 相电压校准
  2109. baseValue = 3; // 10
  2110. }
  2111. else if(fv > 1.5)
  2112. {
  2113. baseValue = 1.8763875;
  2114. }
  2115. else
  2116. {
  2117. // 57.735V 相电压校准
  2118. baseValue = 57.735; // 57.735
  2119. }
  2120. }
  2121. else
  2122. {
  2123. sw = (i - PUB_AC_NUM)/SW_AC_NUM;
  2124. j = (i - PUB_AC_NUM)%SW_AC_NUM;
  2125. cfg_index = g_sw[sw].ac_cfg_index[j];
  2126. // 电子式互感器I0使用5A校准
  2127. // if(g_equ_config_ac[cfg_index].scale == EQU_SCALE_ECT_1V_1A
  2128. // || g_equ_config_ac[cfg_index].scale == EQU_SCALE_ECT_0V2_1A)
  2129. if(g_equ_config_ac[cfg_index].scale == EQU_SCALE_ECT_1V_1A)
  2130. {
  2131. // 电子式CT使用1A。
  2132. baseValue = 1;
  2133. }
  2134. else if(g_equ_config_ac[cfg_index].scale == EQU_SCALE_CT_10A_249)
  2135. {
  2136. // 高精度零序电流互感器,小信号校正值
  2137. baseValue = 0.5;
  2138. }
  2139. else if(fv > 4)
  2140. {
  2141. baseValue=5;
  2142. }
  2143. else if(fv > 2)
  2144. {
  2145. // 大容量校准时,例如16回路,标准源可能带不动5A负载。
  2146. baseValue=3;
  2147. }
  2148. else
  2149. {
  2150. baseValue=1;
  2151. }
  2152. }
  2153. minfv=baseValue*0.9;
  2154. maxfv=baseValue*1.1;
  2155. // 检查幅值是否超范围
  2156. if(fv<minfv)
  2157. {
  2158. rt_printf("sw_auto_adjust(invalid):i=%d,fv=%f,minfv=%f\r\n",i,fv ,minfv);
  2159. continue;
  2160. }
  2161. else if(fv>maxfv)
  2162. {
  2163. rt_printf("sw_auto_adjust(err):i=%d,fv=%f,maxfv=%f\r\n",i,fv ,maxfv);
  2164. return -1;
  2165. }
  2166. // 得到并检查校正系数
  2167. factor=baseValue/fv;
  2168. if(CheckFloatSet(&factor,MAX_FACTOR,MIN_FACTOR)>0)
  2169. {
  2170. rt_printf("sw_auto_adjust(err):i=%d,fv=%f,factor=%f.\r\n",i,fv ,factor);
  2171. return -2;
  2172. }
  2173. // 保存校正系数
  2174. factor_e_c_set(g_equ_config_ac[cfg_index].slot,g_equ_config_ac[cfg_index].index,factor);
  2175. #ifdef PROTECT_AC_ADJUST
  2176. factor=baseValue/fv_p;
  2177. rt_printf("fv_p=%f,baseValue=%f,factor=%f\r\n",fv_p, baseValue, factor);
  2178. if(CheckFloatSet(&factor,MAX_FACTOR,MIN_FACTOR)>0)
  2179. {
  2180. rt_printf("sw_auto_adjust(err) protect ac:i=%d,fv=%f,factor_p=%f.\r\n",i,fv ,factor);
  2181. return -2;
  2182. }
  2183. // 保存校正系数
  2184. factor_p_e_c_set(g_equ_config_ac[cfg_index].slot,g_equ_config_ac[cfg_index].index,factor);
  2185. #endif
  2186. // 保存校正成功配置通道值
  2187. if(i >= PUB_AC_NUM)
  2188. {
  2189. g_pq_factor[sw][j].cfg_index = cfg_index;
  2190. }
  2191. // 角度校准
  2192. baseAng =_sw_base_angle(i);
  2193. fv = (float)g_ui[i].p/Q16_BASE;
  2194. if(baseAng == 360.0)
  2195. {
  2196. factor = 0;
  2197. }
  2198. else
  2199. {
  2200. factor = baseAng - fv;
  2201. }
  2202. // 确保角度在正负180内。
  2203. if(factor > 180.0)
  2204. {
  2205. factor -= 360.0;
  2206. }
  2207. if(factor < -180.0)
  2208. {
  2209. factor += 360.0;
  2210. }
  2211. rt_printf("sw_auto_adjust(ang):i=%d,fv=%f,factor=%f.\r\n",i,fv ,factor);
  2212. if(factor<MIN_PHASE)
  2213. {
  2214. return -3;
  2215. }
  2216. else if(factor>MAX_PHASE)
  2217. {
  2218. return -4;
  2219. }
  2220. if(CheckFloatSet(&factor,MAX_PHASE,MIN_PHASE)>0)
  2221. {
  2222. return -5;
  2223. }
  2224. // 如果是基准通道,就不更新角度校准值。
  2225. if(i != g_ui_angle0)
  2226. {
  2227. factor_p_c_set(g_equ_config_ac[cfg_index].slot,g_equ_config_ac[cfg_index].index,factor);
  2228. }
  2229. // 保存校正温度和基准值
  2230. factor_temp_set(g_equ_config_ac[cfg_index].slot,
  2231. #if defined TMP_CHIP_DS18B20
  2232. ds18b20_get_temp()
  2233. #elif defined TMP_CHIP_GX21M15
  2234. gx21m15_get_temp()
  2235. #elif defined TMP_CHIP_AHT20
  2236. aht20_get_temp()
  2237. #endif
  2238. );
  2239. if(i < PUB_AC_NUM)
  2240. {
  2241. base_v = baseValue;
  2242. }
  2243. else
  2244. {
  2245. base_i = baseValue;
  2246. }
  2247. }
  2248. // 重新初始化
  2249. sw_init();
  2250. //保存校正系数
  2251. ret = factor_write_all(base_v,base_i);
  2252. if(ret != 0)
  2253. {
  2254. return -6;
  2255. }
  2256. sw_factor_cp();
  2257. soe_record_opt(EV_CHNZJS, 0);
  2258. return 0;
  2259. }
  2260. float g_dc_factor[2][2]=
  2261. {
  2262. {1.0,1.0},
  2263. {1.0,1.0},
  2264. };
  2265. int sw_adjust_dc_0(void)
  2266. {
  2267. int i;
  2268. float dc;
  2269. #ifdef DC_NUM_SET
  2270. for(i=0;i<pRunSet->dDc_num;i++)
  2271. #else
  2272. for(i=0;i<DC_NUM;i++)
  2273. #endif
  2274. {
  2275. dc = dc_get(i);
  2276. if(dc < 0.5*dc_adjust[0])
  2277. {
  2278. return -1;
  2279. }
  2280. if(dc > 1.5*dc_adjust[0])
  2281. {
  2282. return -2;
  2283. }
  2284. g_dc_factor[i][0] = dc;
  2285. }
  2286. return 0;
  2287. }
  2288. int sw_adjust_dc_1(void)
  2289. {
  2290. int i;
  2291. float dc;
  2292. #ifdef DC_NUM_SET
  2293. for(i=0;i<pRunSet->dDc_num;i++)
  2294. #else
  2295. for(i=0;i<DC_NUM;i++)
  2296. #endif
  2297. {
  2298. dc = dc_get(i);
  2299. if(dc < 0.5*dc_adjust[1])
  2300. {
  2301. return -1;
  2302. }
  2303. if(dc > 1.5*dc_adjust[1])
  2304. {
  2305. return -2;
  2306. }
  2307. g_dc_factor[i][1] = dc;
  2308. }
  2309. _sw_save_dc_factor(g_dc_factor[0][1], g_dc_factor[0][0], g_dc_factor[1][1], g_dc_factor[1][0]);
  2310. return 0;
  2311. }
  2312. /*------------------------------ 内部函数 -------------------------------------
  2313. 内部函数以下划线‘_’开头,不需要检查参数的合法性.
  2314. */
  2315. /******************************************************************************
  2316. 函数名称: _sw_get_dots
  2317. 函数版本: 01.01
  2318. 创建作者: sunxi
  2319. 创建日期: 2013-08-07
  2320. 函数说明: 获取采样点,供测量计算用
  2321. 参数说明:
  2322. 返回值:
  2323. 修改记录:
  2324. */
  2325. void xdl_smooth3 ( short in[], short out[], int N );
  2326. void xdl_smooth5 ( short in[], short out[], int N );
  2327. int _sw_check_tb_dots(unsigned long dot_index)
  2328. {
  2329. int i,j;
  2330. if(pRunSet->dSmoothZero==0)return 0;
  2331. for(i=0;i<CFG_ADC_CHANNEL;i++)
  2332. {
  2333. short pnSam[3] = {0};
  2334. long laaa;
  2335. DWORD daaa;
  2336. int caulp;
  2337. if(!g_equ_adc_config[i]) // 通道无配置
  2338. {
  2339. continue;
  2340. }
  2341. for(j=0;j<CFG_ADC_DOTS_PER_PERIOD;j++)
  2342. {
  2343. caulp = (dot_index+j)&CFG_ADC_DOTS_MASK;
  2344. // 取出连续三周波的同一对应点
  2345. pnSam[0] = g_adc_dots[i][(caulp - 1) & SAMLENGTH];
  2346. pnSam[1] = g_adc_dots[i][(caulp - SAMFREQ -1) & SAMLENGTH];
  2347. pnSam[2] = g_adc_dots[i][(caulp - 2*SAMFREQ -1) & SAMLENGTH];
  2348. // 计算突变量并取绝对值,i(k)-2*i(k-N)+i(K-2N)
  2349. laaa = ( pnSam[0] - pnSam[1]*2 + pnSam[2]);
  2350. if(laaa < 0)
  2351. {
  2352. daaa = -laaa;//
  2353. }
  2354. else
  2355. {
  2356. daaa = laaa;
  2357. }
  2358. // 检查是否超过突变量门槛,且需满足3次,即对应相电流突变量满足要求
  2359. if(daaa > pRunSet->dSmoothZero)
  2360. {
  2361. rt_printf("\r\n chnel=%d zero=%d set=%d",i,daaa,pRunSet->dSmoothZero);
  2362. return -1;
  2363. }
  2364. }
  2365. }
  2366. return 0;
  2367. }
  2368. void _sw_get_dots(void)
  2369. {
  2370. unsigned long i,loop,dots_index ,dots_count_old;
  2371. int cnt;
  2372. int ret=0;
  2373. loop =0;
  2374. do
  2375. {
  2376. // 获取采样点的位置,如果最后一个周波跨界,调整采样点的位置。
  2377. #ifdef CPU_FUXI
  2378. dots_count_old = g_adc_dots_index - CFG_ADC_DOTS_PER_PERIOD; //jack.liu 20200921 获取最后一个周波的采样点
  2379. #else
  2380. dots_count_old = g_adc_dots_count - CFG_ADC_DOTS_PER_PERIOD; // 最后一个周波的采样点
  2381. #endif
  2382. cnt = (dots_count_old&CFG_ADC_DOTS_MASK) - (CFG_ADC_DOTS_PER_CHANNEL - CFG_ADC_DOTS_PER_PERIOD);
  2383. if(cnt > 0)
  2384. {
  2385. dots_count_old -= cnt;
  2386. }
  2387. dots_index = dots_count_old&CFG_ADC_DOTS_MASK;
  2388. ret=_sw_check_tb_dots(dots_index);
  2389. if(ret<0)return; // 波形判断有突变,不处理采样
  2390. for(i=0;i<CFG_ADC_CHANNEL;i++)
  2391. {
  2392. #if 0
  2393. if(g_equ_adc_config[i])
  2394. {
  2395. xdl_smooth3(&g_adc_dots[i][dots_index],&g_adc_dots[i][CFG_ADC_DOTS_PER_CHANNEL],CFG_ADC_DOTS_PER_PERIOD);
  2396. }
  2397. #else
  2398. memcpy(&g_adc_dots[i][CFG_ADC_DOTS_PER_CHANNEL],&g_adc_dots[i][dots_index],CFG_ADC_DOTS_PER_PERIOD*2);
  2399. #endif
  2400. }
  2401. loop++;
  2402. if(loop > 5)
  2403. {
  2404. rt_printf("sw_get_dots:i=%d\r\n",loop);
  2405. }
  2406. }
  2407. #ifdef CPU_FUXI
  2408. while((g_adc_dots_index - dots_count_old) > CFG_ADC_DOTS_PER_CHANNEL);
  2409. #else
  2410. while((g_adc_dots_count - dots_count_old) > CFG_ADC_DOTS_PER_CHANNEL);
  2411. #endif
  2412. }
  2413. /******************************************************************************
  2414. 函数名称: _sw_fft
  2415. 函数版本: 01.01
  2416. 创建作者: sunxi
  2417. 创建日期: 2013-08-07
  2418. 函数说明: 计算FFT,一次计算两个通道
  2419. 参数说明:
  2420. ch0 通道0索引
  2421. ch1 通道1索引
  2422. p0 通道0结果,所有谐波的复数表示。
  2423. p1 通道1结果,所有谐波的复数表示。
  2424. 返回值:
  2425. 修改记录:
  2426. */
  2427. void _sw_fft(int ch0,int ch1,complex * p0,complex * p1)
  2428. {
  2429. static complex k[CFG_ADC_DOTS_PER_PERIOD];
  2430. int i;
  2431. // 初始化点
  2432. for(i=0; i<CFG_ADC_DOTS_PER_PERIOD; i++)
  2433. {
  2434. k[i].r = g_adc_dots[ch0][CFG_ADC_DOTS_PER_CHANNEL + i];
  2435. k[i].i = g_adc_dots[ch1][CFG_ADC_DOTS_PER_CHANNEL + i];
  2436. }
  2437. // 计算
  2438. fft(CFG_ADC_DOTS_PER_PERIOD, &k[0]);
  2439. // 整理
  2440. for (i=1;i<=g_harmonic_num;i++)
  2441. {
  2442. if(p0)
  2443. {
  2444. p0[i].r = (k[i].r+k[CFG_ADC_DOTS_PER_PERIOD-i].r)/CFG_ADC_DOTS_PER_PERIOD;
  2445. p0[i].i = (k[i].i-k[CFG_ADC_DOTS_PER_PERIOD-i].i)/CFG_ADC_DOTS_PER_PERIOD;
  2446. }
  2447. if(p1)
  2448. {
  2449. p1[i].r = (k[i].i+k[CFG_ADC_DOTS_PER_PERIOD-i].i)/CFG_ADC_DOTS_PER_PERIOD;
  2450. p1[i].i = (k[CFG_ADC_DOTS_PER_PERIOD-i].r-k[i].r)/CFG_ADC_DOTS_PER_PERIOD;
  2451. }
  2452. }
  2453. }
  2454. /******************************************************************************
  2455. 函数名称: _sw_cal_fft
  2456. 函数版本: 01.01
  2457. 创建作者: sunxi
  2458. 创建日期: 2013-08-07
  2459. 函数说明: 计算所有通道的FFT
  2460. 参数说明:
  2461. 返回值:
  2462. 修改记录:
  2463. */
  2464. void _sw_cal_fft(void)
  2465. {
  2466. s32 i,index0;
  2467. // fft
  2468. index0 = UI_NUM;
  2469. for(i=0;i<UI_NUM;i++)
  2470. {
  2471. // 如果索引通道不存在,不需计算
  2472. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  2473. {
  2474. continue;
  2475. }
  2476. // 检查硬件通道是否正常,如果不正常,ri清零;否则计算出ri。
  2477. if(equ_ac_channel_is_ok(g_ui[i].chn_index) == 0)
  2478. {
  2479. memset(&g_ui[i].h,0,sizeof(g_ui[i].h));
  2480. continue;
  2481. }
  2482. if(index0 == UI_NUM)
  2483. {
  2484. index0 = i;
  2485. }
  2486. else
  2487. {
  2488. _sw_fft(g_ui[index0].chn_index,g_ui[i].chn_index,g_ui[index0].h,g_ui[i].h);
  2489. index0 = UI_NUM;
  2490. }
  2491. }
  2492. if(index0 != UI_NUM)
  2493. {
  2494. _sw_fft(g_ui[index0].chn_index,g_ui[index0].chn_index,g_ui[index0].h,NULL);
  2495. }
  2496. return;
  2497. }
  2498. /******************************************************************************
  2499. 函数名称: _sw_cal_h_sub
  2500. 函数版本: 01.01
  2501. 创建作者: sunxi
  2502. 创建日期: 2013-08-07
  2503. 函数说明: 2个谐波向量减
  2504. 参数说明:
  2505. r 结果
  2506. a 向量a的g_ui索引
  2507. b 向量b的g_ui索引
  2508. 返回值:
  2509. 修改记录:
  2510. */
  2511. void _sw_cal_h_sub(int r,int a,int b)
  2512. {
  2513. int i;
  2514. for(i=1;i<=g_harmonic_num;i++)
  2515. {
  2516. g_ui[r].h[i].r = g_ui[a].h[i].r - g_ui[b].h[i].r;
  2517. g_ui[r].h[i].i = g_ui[a].h[i].i - g_ui[b].h[i].i;
  2518. }
  2519. return;
  2520. }
  2521. /******************************************************************************
  2522. 函数名称: _sw_cal_h_sub2
  2523. 函数版本: 01.01
  2524. 创建作者: sunxi
  2525. 创建日期: 2013-08-07
  2526. 函数说明: 谐波向量减,求Ib
  2527. 参数说明:
  2528. r 结果
  2529. o 向量o的g_ui索引
  2530. a 向量a的g_ui索引
  2531. b 向量b的g_ui索引
  2532. 返回值:
  2533. 修改记录:
  2534. */
  2535. void _sw_cal_h_sub2(int r,int o,int a,int b)
  2536. {
  2537. int i;
  2538. float factor_i0_ia=1.0;
  2539. if((g_ui[o].m2_factor_k!=0)&&(g_ui[o].m2_factor_k!=g_ui[a].m2_factor_k))
  2540. {
  2541. factor_i0_ia=(float)g_ui[a].m2_factor_k/g_ui[o].m2_factor_k;
  2542. }
  2543. for(i=1;i<=g_harmonic_num;i++)
  2544. {
  2545. g_ui[r].h[i].r = g_ui[o].h[i].r*factor_i0_ia - g_ui[a].h[i].r - g_ui[b].h[i].r;
  2546. g_ui[r].h[i].i = g_ui[o].h[i].i *factor_i0_ia- g_ui[a].h[i].i - g_ui[b].h[i].i;
  2547. }
  2548. return;
  2549. }
  2550. /******************************************************************************
  2551. 函数名称: _sw_cal_h_add
  2552. 函数版本: 01.01
  2553. 创建作者: sunxi
  2554. 创建日期: 2013-08-07
  2555. 函数说明: 3个谐波向量加
  2556. 参数说明:
  2557. r 结果
  2558. a 向量a的g_ui索引
  2559. b 向量b的g_ui索引
  2560. c 向量c的g_ui索引
  2561. 返回值:
  2562. 修改记录:
  2563. */
  2564. void _sw_cal_h_add(int r,int a,int b,int c)
  2565. {
  2566. int i;
  2567. for(i=1;i<=g_harmonic_num;i++)
  2568. {
  2569. g_ui[r].h[i].r = g_ui[a].h[i].r + g_ui[b].h[i].r + g_ui[c].h[i].r;
  2570. g_ui[r].h[i].i = g_ui[a].h[i].i + g_ui[b].h[i].i + g_ui[c].h[i].i;
  2571. }
  2572. return;
  2573. }
  2574. /******************************************************************************
  2575. 函数名称: _sw_cal_ri_correct
  2576. 函数版本: 01.01
  2577. 创建作者: sunxi
  2578. 创建日期: 2013-08-07
  2579. 函数说明: 根据角度误差校正向量值
  2580. 参数说明:
  2581. 返回值:
  2582. 修改记录:
  2583. */
  2584. void _sw_cal_ri_correct(void)
  2585. {
  2586. s32 i,j;
  2587. qs08 angle;
  2588. qs16 lncos,lnsin,v;
  2589. struct ri_s32 ri;
  2590. for(i=0;i<UI_NUM;i++)
  2591. {
  2592. // 如果索引通道不存在,不需计算
  2593. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  2594. {
  2595. continue;
  2596. }
  2597. // 根据频率修正角度校正值,提高频率变化时的功率精度。
  2598. angle = rt_round((g_ui[i].p_factor + factor_p_k(g_ui[i].chn_index))*256);
  2599. for(j=1;j<=g_harmonic_num;j++)
  2600. {
  2601. lncos = mCos(angle*j);
  2602. lnsin = mSin(angle*j);
  2603. ri.r = rt_round(g_ui[i].h[j].r * Q16_BASE);
  2604. ri.i = rt_round(g_ui[i].h[j].i * Q16_BASE);
  2605. v = _MulFac_S(ri.r,lncos) - _MulFac_S(ri.i,lnsin);
  2606. g_ui[i].h[j].r = (float)v/Q16_BASE;
  2607. v = _MulFac_S(ri.r,lnsin) + _MulFac_S(ri.i,lncos);
  2608. g_ui[i].h[j].i = (float)v/Q16_BASE;
  2609. }
  2610. }
  2611. }
  2612. /******************************************************************************
  2613. 函数名称: _sw_cal_unbalance
  2614. 函数版本: 01.01
  2615. 创建作者: sunxi
  2616. 创建日期: 2013-08-07
  2617. 函数说明: 不平衡度计算
  2618. 参数说明:
  2619. 返回值:
  2620. 修改记录:
  2621. */
  2622. #ifdef asdfadasdfa
  2623. void CalcuIx120( struct UI *pI, struct UI120 *pII )
  2624. {
  2625. long labc,lbc;
  2626. labc = pI->lIaR - (( pI->lIbR + pI->lIcR )>>1);
  2627. lbc = pI->lIbI - pI->lIcI;
  2628. lbc =_MulFac_S(lbc, 56756);//(1.732/2)*2^16=56756
  2629. pII->l1Cos = labc - lbc;
  2630. pII->l2Cos = labc + lbc;
  2631. labc = pI->lIaI - ( (pI->lIbI + pI->lIcI )>>1);
  2632. lbc = pI->lIbR - pI->lIcR;
  2633. lbc =_MulFac_S(lbc,56756);//(1.732/2)*2^16=56756
  2634. pII->l1Sin = labc + lbc;
  2635. pII->l2Sin = labc - lbc;
  2636. pII->l0Cos = pI->lIaR + pI->lIbR + pI->lIcR;
  2637. pII->l0Sin = pI->lIaI + pI->lIbI + pI->lIcI;
  2638. pII->d1Modu = SQR( pII->l1Cos, pII->l1Sin );
  2639. pII->d2Modu = SQR( pII->l2Cos, pII->l2Sin );
  2640. pII->d0Modu = SQR( pII->l0Cos, pII->l0Sin );
  2641. }
  2642. #endif
  2643. float _sw_cal_unbalance(int ui_index)
  2644. {
  2645. float abc,bc;
  2646. float r1,r2,i1,i2;
  2647. abc = g_ui[ui_index].h[1].r - (g_ui[ui_index+1].h[1].r + g_ui[ui_index+2].h[1].r)/2;
  2648. bc = g_ui[ui_index+1].h[1].i - g_ui[ui_index+2].h[1].i;
  2649. bc = bc * (1.7320508/2);
  2650. r1 = abc - bc;
  2651. r2 = abc + bc;
  2652. abc = g_ui[ui_index].h[1].i - (g_ui[ui_index+1].h[1].i + g_ui[ui_index+2].h[1].i)/2;
  2653. bc = g_ui[ui_index+1].h[1].r - g_ui[ui_index+2].h[1].r;
  2654. bc = bc * (1.7320508/2);
  2655. i1 = abc + bc;
  2656. i2 = abc - bc;
  2657. abc = sqrtf(r1*r1 + i1*i1);
  2658. bc = sqrtf(r2*r2 + i2*i2);
  2659. //rt_printf("%s\tabc=%f,\tbc=%f.\r\n",g_ui[ui_index].name,abc*g_ui[ui_index].e_factor,bc*g_ui[ui_index].e_factor);
  2660. if(abc == 0.0)
  2661. {
  2662. return 100;
  2663. }
  2664. return bc/abc*100;
  2665. }
  2666. /******************************************************************************
  2667. 函数名称: _sw_cal_unbalance
  2668. 函数版本: 01.01
  2669. 创建作者: sunxi
  2670. 创建日期: 2013-08-07
  2671. 函数说明: 正负序计算
  2672. 参数说明:
  2673. 返回值:
  2674. 修改记录:
  2675. */
  2676. void _sw_cal_Xfl120( int ui_index, struct ui120 *pII )
  2677. {
  2678. float abc,bc;
  2679. float r1,r2,i1,i2;
  2680. abc = g_ui[ui_index].ri.r - (g_ui[ui_index+1].ri.r + g_ui[ui_index+2].ri.r)/2;
  2681. bc = g_ui[ui_index+1].ri.i - g_ui[ui_index+2].ri.i;
  2682. bc = bc * (1.7320508/2);
  2683. r1 = abc - bc;
  2684. r2 = abc + bc;
  2685. abc = g_ui[ui_index].ri.i - (g_ui[ui_index+1].ri.i + g_ui[ui_index+2].ri.i)/2;
  2686. bc = g_ui[ui_index+1].ri.r - g_ui[ui_index+2].ri.r;
  2687. bc = bc * (1.7320508/2);
  2688. i1 = abc + bc;
  2689. i2 = abc - bc;
  2690. pII->vect1 = (r1*r1 + i1*i1)/9;
  2691. pII->vect2 = (r2*r2 + i2*i2)/9;
  2692. }
  2693. /******************************************************************************
  2694. 函数名称: _sw_cal_make
  2695. 函数版本: 01.01
  2696. 创建作者: sunxi
  2697. 创建日期: 2013-08-07
  2698. 函数说明: 测量合成通道向量值
  2699. 参数说明:
  2700. 返回值:
  2701. 修改记录:
  2702. */
  2703. void _sw_cal_make(void)
  2704. {
  2705. int sw ;
  2706. // 合成电压
  2707. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_LV1)
  2708. {
  2709. _sw_cal_h_sub(PUB_AC_UAB1,PUB_AC_UA1,PUB_AC_UB1);
  2710. _sw_cal_h_sub(PUB_AC_UBC1,PUB_AC_UB1,PUB_AC_UC1);
  2711. _sw_cal_h_sub(PUB_AC_UCA1,PUB_AC_UC1,PUB_AC_UA1);
  2712. }
  2713. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_LV2)
  2714. {
  2715. _sw_cal_h_sub(PUB_AC_UAB2,PUB_AC_UA2,PUB_AC_UB2);
  2716. _sw_cal_h_sub(PUB_AC_UBC2,PUB_AC_UB2,PUB_AC_UC2);
  2717. _sw_cal_h_sub(PUB_AC_UCA2,PUB_AC_UC2,PUB_AC_UA2);
  2718. }
  2719. // 合成UCA
  2720. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_UCA1)
  2721. {
  2722. {
  2723. int i;
  2724. for(i=1;i<=g_harmonic_num;i++)
  2725. {
  2726. g_ui[PUB_AC_UCA1].h[i].r = -g_ui[PUB_AC_UAB1].h[i].r - g_ui[PUB_AC_UBC1].h[i].r;
  2727. g_ui[PUB_AC_UCA1].h[i].i = -g_ui[PUB_AC_UAB1].h[i].i - g_ui[PUB_AC_UBC1].h[i].i;
  2728. }
  2729. }
  2730. }
  2731. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_UCA2)
  2732. {
  2733. {
  2734. int i;
  2735. for(i=1;i<=g_harmonic_num;i++)
  2736. {
  2737. g_ui[PUB_AC_UCA2].h[i].r = -g_ui[PUB_AC_UAB2].h[i].r - g_ui[PUB_AC_UBC2].h[i].r;
  2738. g_ui[PUB_AC_UCA2].h[i].i = -g_ui[PUB_AC_UAB2].h[i].i - g_ui[PUB_AC_UBC2].h[i].i;
  2739. }
  2740. }
  2741. }
  2742. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_U01)
  2743. {
  2744. {
  2745. int i;
  2746. for(i=1;i<=g_harmonic_num;i++)
  2747. {
  2748. g_ui[PUB_AC_U01].h[i].r = g_ui[PUB_AC_UA1].h[i].r + g_ui[PUB_AC_UB1].h[i].r+ g_ui[PUB_AC_UC1].h[i].r;
  2749. g_ui[PUB_AC_U01].h[i].i = g_ui[PUB_AC_UA1].h[i].i + g_ui[PUB_AC_UB1].h[i].i+ g_ui[PUB_AC_UC1].h[i].i;
  2750. }
  2751. }
  2752. }
  2753. if(g_sw_pub.ui_flags&UI_FLAGS_MAKE_U02)
  2754. {
  2755. {
  2756. int i;
  2757. for(i=1;i<=g_harmonic_num;i++)
  2758. {
  2759. g_ui[PUB_AC_U02].h[i].r = g_ui[PUB_AC_UA2].h[i].r + g_ui[PUB_AC_UB2].h[i].r+ g_ui[PUB_AC_UC2].h[i].r;
  2760. g_ui[PUB_AC_U02].h[i].i = g_ui[PUB_AC_UA2].h[i].i + g_ui[PUB_AC_UB2].h[i].i+ g_ui[PUB_AC_UC2].h[i].i;
  2761. }
  2762. }
  2763. }
  2764. // 电压不平衡计算
  2765. g_sw_pub.ac_in_acc[PUB_AC_IN_V_UNBALANCE1] += _sw_cal_unbalance(PUB_AC_UA1);
  2766. g_sw_pub.ac_in_acc[PUB_AC_IN_V_UNBALANCE2] += _sw_cal_unbalance(PUB_AC_UA2);
  2767. // 开关电流
  2768. for(sw=0; sw<g_sw_num; sw++)
  2769. {
  2770. // 合成电流IB
  2771. if(g_sw[sw].ui_flags&UI_FLAGS_MAKE_IB)
  2772. {
  2773. _sw_cal_h_sub2(UI_SW_INDEX(sw,SW_AC_IB),UI_SW_INDEX(sw,SW_AC_I0),UI_SW_INDEX(sw,SW_AC_IA),UI_SW_INDEX(sw,SW_AC_IC));
  2774. }
  2775. // 合成电流IB
  2776. if(g_sw[sw].ui_flags&UI_FLAGS_MAKE_CIB)
  2777. {
  2778. _sw_cal_h_sub2(UI_SW_INDEX(sw,SW_AC_CIB),UI_SW_INDEX(sw,SW_AC_I0),UI_SW_INDEX(sw,SW_AC_CIA),UI_SW_INDEX(sw,SW_AC_CIC));
  2779. }
  2780. // 合成电流I0
  2781. if(g_sw[sw].ui_flags&UI_FLAGS_MAKE_I0)
  2782. {
  2783. _sw_cal_h_add(UI_SW_INDEX(sw,SW_AC_I0),UI_SW_INDEX(sw,SW_AC_IA),UI_SW_INDEX(sw,SW_AC_IB),UI_SW_INDEX(sw,SW_AC_IC));
  2784. }
  2785. // 电流不平衡计算
  2786. g_sw[sw].ac_in_acc[SW_AC_IN_BI_UNBALANCE] += _sw_cal_unbalance(UI_SW_INDEX(sw,SW_AC_IA));
  2787. // 电流不平衡计算
  2788. g_sw[sw].ac_in_acc[SW_AC_IN_CI_UNBALANCE] += _sw_cal_unbalance(UI_SW_INDEX(sw,SW_AC_CIA));
  2789. }
  2790. }
  2791. /******************************************************************************
  2792. 函数名称: _sw_cal_effect
  2793. 函数版本: 01.01
  2794. 创建作者: sunxi
  2795. 创建日期: 2013-08-07
  2796. 函数说明: 测量计算有效值,累加结果。
  2797. 参数说明:
  2798. 返回值:
  2799. 修改记录:
  2800. */
  2801. void _sw_cal_effect(void)
  2802. {
  2803. int i,j;
  2804. float f,re,im,sum;
  2805. for(i=0;i<UI_NUM;i++)
  2806. {
  2807. // 如果索引通道不存在,不需计算
  2808. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO && g_ui[i].ui_base_make == -1)
  2809. {
  2810. continue;
  2811. }
  2812. sum = 0.0;
  2813. for(j=1;j<=g_harmonic_num;j++)
  2814. {
  2815. re = g_ui[i].h[j].r;
  2816. im = g_ui[i].h[j].i;
  2817. f = sqrtf(re*re+im*im);
  2818. f *= g_harmonic_factor[j]; // 谐波系数修正
  2819. sum += f*f;
  2820. #if 0
  2821. if(i>=UI_SW_INDEX(1,SW_AC_IA) && i<=UI_SW_INDEX(1,SW_AC_I0))
  2822. {
  2823. rt_printf("%s[%02d]:e=%f,p=%f.\r\n",g_ui[i].name,j,f*g_ui[i].e_factor,_sw_cal_angle0(re,im));
  2824. }
  2825. #endif
  2826. }
  2827. f = sqrtf(sum);
  2828. g_ui[i].e_acc += f*g_ui[i].e_factor ;
  2829. }
  2830. return ;
  2831. }
  2832. /******************************************************************************
  2833. 函数名称: _sw_cal_angle0
  2834. 函数版本: 01.01
  2835. 创建作者: sunxi
  2836. 创建日期: 2013-08-07
  2837. 函数说明: 计算向量角度
  2838. 参数说明:
  2839. re 向量实部
  2840. im 向量虚部
  2841. 返回值:
  2842. 修改记录:
  2843. */
  2844. #if 1
  2845. float _sw_cal_angle0(float re, float im)
  2846. {
  2847. float p;
  2848. p = atan2f(im,re);
  2849. p = p*180/pi;
  2850. return p;
  2851. }
  2852. #else
  2853. const int Angle_const[7] =
  2854. {
  2855. 0,267,577,1000,1732,3732,57400
  2856. };
  2857. float _sw_cal_angle0(float re, float im)
  2858. {
  2859. float angle_arttg;
  2860. float angle = 0;
  2861. uint8 quad;
  2862. if (re >=0)
  2863. {
  2864. if (im >=0)
  2865. quad = 1;
  2866. else
  2867. {
  2868. quad = 4;
  2869. im = im*(-1);
  2870. }
  2871. }
  2872. else
  2873. {
  2874. re = re*(-1);
  2875. if (im >= 0)
  2876. quad = 2;
  2877. else
  2878. {
  2879. im = im*(-1);
  2880. quad = 3;
  2881. }
  2882. }
  2883. if (re <=2)
  2884. {
  2885. switch (quad)
  2886. {
  2887. case 1:angle = 90;break;
  2888. case 2:angle = 90;break;
  2889. case 3:angle = 270;break;
  2890. case 4:angle = 270;break;
  2891. }
  2892. }
  2893. else
  2894. {
  2895. angle_arttg = (im*1000)/re;
  2896. if (angle_arttg <= Angle_const[1])
  2897. {
  2898. angle = 0 + (angle_arttg-Angle_const[0])*57/(1000+Angle_const[0]*angle_arttg/1000);
  2899. }
  2900. else if (angle_arttg <= Angle_const[2])
  2901. {
  2902. angle = 15 + (angle_arttg-Angle_const[1])*57/(1000+Angle_const[1]*angle_arttg/1000);
  2903. }
  2904. else if (angle_arttg <= Angle_const[3])
  2905. {
  2906. angle = 30 + (angle_arttg-Angle_const[2])*57/(1000+Angle_const[2]*angle_arttg/1000);
  2907. }
  2908. else if (angle_arttg <= Angle_const[4])
  2909. {
  2910. angle = 45 + (angle_arttg-Angle_const[3])*57/(1000+Angle_const[3]*angle_arttg/1000);
  2911. }
  2912. else if (angle_arttg <= Angle_const[5])
  2913. {
  2914. angle = 60 + (angle_arttg-Angle_const[4])*57/(1000+Angle_const[4]*angle_arttg/1000);
  2915. }
  2916. else if (angle_arttg <= Angle_const[6])
  2917. {
  2918. angle = 75 + (angle_arttg-Angle_const[5])*57/(1000+Angle_const[5]*angle_arttg/1000);
  2919. }
  2920. else
  2921. {
  2922. angle = 90;
  2923. }
  2924. switch (quad)
  2925. {
  2926. case 1: angle = angle;break;
  2927. case 2: angle = 180 - angle;break;
  2928. case 3: angle = 180 + angle;break;
  2929. case 4: angle = 360 - angle;break;
  2930. }
  2931. }
  2932. if((re < 5) && (im < 5)) angle = 0;
  2933. return(angle);
  2934. }
  2935. #endif
  2936. /******************************************************************************
  2937. 函数名称: _sw_cal_angle_correct
  2938. 函数版本: 01.01
  2939. 创建作者: sunxi
  2940. 创建日期: 2013-08-07
  2941. 函数说明: 测量计算角度时对角度进行校正,保证累加时不会出现计算错误。
  2942. 参数说明:
  2943. 返回值:
  2944. 修改记录:
  2945. */
  2946. void _sw_cal_angle_correct(qs16 *angle,int *mark)
  2947. {
  2948. if(*angle > ANGF180)
  2949. {
  2950. *angle -= ANG360;
  2951. }
  2952. if(*angle < ANGN180)
  2953. {
  2954. *angle += ANG360;
  2955. }
  2956. if(*mark == 0)
  2957. {
  2958. if(abs(*angle)< 90*Q16_BASE)
  2959. {
  2960. *mark = 1;
  2961. }
  2962. else
  2963. {
  2964. *mark = -1;
  2965. }
  2966. }
  2967. if(*mark == -1)
  2968. {
  2969. if(*angle >= 0)
  2970. {
  2971. *angle = 180*Q16_BASE - *angle;
  2972. }
  2973. else
  2974. {
  2975. *angle = (-180)*Q16_BASE - *angle;
  2976. }
  2977. }
  2978. }
  2979. /******************************************************************************
  2980. 函数名称: _sw_cal_angle
  2981. 函数版本: 01.01
  2982. 创建作者: sunxi
  2983. 创建日期: 2013-08-07
  2984. 函数说明: 测量计算角度,每次调用累加计算值。
  2985. 参数说明:
  2986. 返回值:
  2987. 修改记录:
  2988. */
  2989. void _sw_cal_angle(void)
  2990. {
  2991. int i;
  2992. qs16 qs;
  2993. float angle,angle0;
  2994. // 检查是否有基准通道
  2995. if(g_ui_angle0 == -1)
  2996. {
  2997. return;
  2998. }
  2999. // 计算基准通道的角度
  3000. angle0 = _sw_cal_angle0(g_ui[g_ui_angle0].h[1].r,g_ui[g_ui_angle0].h[1].i);
  3001. // angle0 += g_ui[g_ui_angle0].p_factor;
  3002. // 计算相对角度
  3003. for(i=0;i<UI_NUM;i++)
  3004. {
  3005. // 如果索引通道不存在,不需计算
  3006. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO && g_ui[i].ui_base_make == -1)
  3007. {
  3008. continue;
  3009. }
  3010. angle = _sw_cal_angle0(g_ui[i].h[1].r,g_ui[i].h[1].i);
  3011. // angle += g_ui[i].p_factor;
  3012. angle -= angle0;
  3013. qs = rt_round(angle*Q16_BASE);
  3014. _sw_cal_angle_correct(&qs,&g_ui[i].p_mark);
  3015. g_ui[i].p_acc += qs;
  3016. }
  3017. return ;
  3018. }
  3019. /******************************************************************************
  3020. 函数名称: _sw_p2
  3021. 函数版本: 01.01
  3022. 创建作者: sunxi
  3023. 创建日期: 2013-08-07
  3024. 函数说明: 根据电压电流向量计算p值
  3025. 参数说明:
  3026. ur 电压实部
  3027. ui 电压虚部
  3028. ir 电流实部
  3029. ii 电流虚部
  3030. k1 电压系数
  3031. k2 电流系数
  3032. 返回值: p值
  3033. 修改记录:
  3034. */
  3035. float _sw_p2( float Ur, float Ui,float Ir, float Ii, float k1, float k2)
  3036. {
  3037. float p ;
  3038. p = Ur*Ir + Ui*Ii;
  3039. p = p * k1 *k2;
  3040. return p;
  3041. }
  3042. /******************************************************************************
  3043. 函数名称: _sw_q2
  3044. 函数版本: 01.01
  3045. 创建作者: sunxi
  3046. 创建日期: 2013-08-07
  3047. 函数说明: 根据电压电流向量计算q值
  3048. 参数说明:
  3049. ur 电压实部
  3050. ui 电压虚部
  3051. ir 电流实部
  3052. ii 电流虚部
  3053. k1 电压系数
  3054. k2 电流系数
  3055. 返回值: q值
  3056. 修改记录:
  3057. */
  3058. float _sw_q2( float Ur, float Ui,float Ir,float Ii,float k1, float k2)
  3059. {
  3060. float q ;
  3061. q =Ui*Ir - Ur*Ii;
  3062. q = q * k1* k2;
  3063. return q;
  3064. }
  3065. /******************************************************************************
  3066. 函数名称: _sw_cal_pq_3m
  3067. 函数版本: 01.01
  3068. 创建作者: sunxi
  3069. 创建日期: 2013-08-07
  3070. 函数说明: 3表法计算一个开关的pq,每次调用累加计算值。
  3071. 参数说明:
  3072. sw 开关序号
  3073. 返回值:
  3074. 修改记录:
  3075. */
  3076. void _sw_cal_pq_3m(u32 sw)
  3077. {
  3078. u32 i,j,U,I,baseI;
  3079. float p,q,pz,qz;
  3080. if(g_ui[UI_SW_INDEX(sw,SW_AC_CIA)].chn_index != CFG_ADC_CHANNEL_ZERO)baseI=SW_AC_CIA;
  3081. else baseI=0;
  3082. U = pRunSet->tSwSet[sw].bTT_Power_v2 ? PUB_AC_UA2 : PUB_AC_UA1;
  3083. for(j=0; j<3; j++)
  3084. {
  3085. I = UI_SW_INDEX(sw,j+baseI);
  3086. p = 0;
  3087. q = 0;
  3088. pz=0;
  3089. qz=0;
  3090. for(i=1; i<=g_harmonic_num;i++)
  3091. {
  3092. p += _sw_p2(g_ui[U].h[i].r,g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3093. q += _sw_q2(g_ui[U].h[i].r,g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3094. }
  3095. pz=p*(1 + g_ui[I].pq_factor[0]) - q*g_ui[I].pq_factor[1];
  3096. qz=q*(1 + g_ui[I].pq_factor[0]) + p*g_ui[I].pq_factor[1];
  3097. g_sw[sw].ac_in_acc[SW_AC_IN_P] += pz;
  3098. g_sw[sw].ac_in_acc[SW_AC_IN_Q] += qz;
  3099. if(j==0)
  3100. {
  3101. g_sw[sw].ac_in_acc[SW_AC_IN_Pa] += pz;
  3102. g_sw[sw].ac_in_acc[SW_AC_IN_Qa] += qz;
  3103. }
  3104. else if(j==1)
  3105. {
  3106. g_sw[sw].ac_in_acc[SW_AC_IN_Pb] += pz;
  3107. g_sw[sw].ac_in_acc[SW_AC_IN_Qb] += qz;
  3108. }
  3109. else if(j==2)
  3110. {
  3111. g_sw[sw].ac_in_acc[SW_AC_IN_Pc] += pz;
  3112. g_sw[sw].ac_in_acc[SW_AC_IN_Qc] += qz;
  3113. }
  3114. U++;
  3115. }
  3116. return;
  3117. }
  3118. /******************************************************************************
  3119. 函数名称: _sw_cal_pq_2m
  3120. 函数版本: 01.01
  3121. 创建作者: sunxi
  3122. 创建日期: 2013-08-07
  3123. 函数说明: 2表法计算一个开关的pq,每次调用累加计算值。
  3124. 参数说明:
  3125. sw 开关序号
  3126. 返回值:
  3127. 修改记录:
  3128. */
  3129. void _sw_cal_pq_2m(u32 sw)
  3130. {
  3131. u32 i,U,I,baseI;
  3132. float p,q,pz,qz;
  3133. // IA
  3134. U = PUB_AC_UAB1;
  3135. if(g_ui[UI_SW_INDEX(sw,SW_AC_CIA)].chn_index != CFG_ADC_CHANNEL_ZERO)baseI=SW_AC_CIA;
  3136. else baseI=0;
  3137. if(pRunSet->tSwSet[sw].bTT_Power_v2)
  3138. {
  3139. U = PUB_AC_UAB2;
  3140. }
  3141. else if ((g_ui[PUB_AC_UAB1].chn_index == CFG_ADC_CHANNEL_ZERO)
  3142. && (g_ui[PUB_AC_UAB2].chn_index != CFG_ADC_CHANNEL_ZERO))
  3143. {
  3144. U = PUB_AC_UAB2;
  3145. }
  3146. I = UI_SW_INDEX(sw,baseI);
  3147. p = 0;
  3148. q = 0;
  3149. for(i=1; i<=g_harmonic_num;i++)
  3150. {
  3151. p += _sw_p2(g_ui[U].h[i].r,g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3152. q += _sw_q2(g_ui[U].h[i].r,g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3153. }
  3154. pz=p*(1 + g_ui[I].pq_factor[0]) - q*g_ui[I].pq_factor[1];
  3155. qz=q*(1 + g_ui[I].pq_factor[0]) + p*g_ui[I].pq_factor[1];;
  3156. g_sw[sw].ac_in_acc[SW_AC_IN_P] += pz;
  3157. g_sw[sw].ac_in_acc[SW_AC_IN_Q] += qz;
  3158. g_sw[sw].ac_in_acc[SW_AC_IN_Pa] += pz;
  3159. g_sw[sw].ac_in_acc[SW_AC_IN_Qa] += qz;
  3160. // IC
  3161. U = PUB_AC_UBC1;
  3162. if(pRunSet->tSwSet[sw].bTT_Power_v2)
  3163. {
  3164. U = PUB_AC_UBC2;
  3165. }
  3166. else if ((g_ui[PUB_AC_UBC1].chn_index == CFG_ADC_CHANNEL_ZERO)
  3167. && (g_ui[PUB_AC_UBC2].chn_index != CFG_ADC_CHANNEL_ZERO))
  3168. {
  3169. U = PUB_AC_UBC2;
  3170. }
  3171. I = UI_SW_INDEX(sw,2+baseI);
  3172. p = 0;
  3173. q = 0;
  3174. for(i=1; i<=g_harmonic_num;i++)
  3175. {
  3176. p += _sw_p2(-g_ui[U].h[i].r,-g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3177. q += _sw_q2(-g_ui[U].h[i].r,-g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3178. }
  3179. pz=p*(1 + g_ui[I].pq_factor[0]) - q*g_ui[I].pq_factor[1];
  3180. qz=q*(1 + g_ui[I].pq_factor[0]) + p*g_ui[I].pq_factor[1];;
  3181. g_sw[sw].ac_in_acc[SW_AC_IN_P] += pz;
  3182. g_sw[sw].ac_in_acc[SW_AC_IN_Q] += qz;
  3183. g_sw[sw].ac_in_acc[SW_AC_IN_Pc] += pz;
  3184. g_sw[sw].ac_in_acc[SW_AC_IN_Qc] += qz;
  3185. g_sw[sw].ac_in_acc[SW_AC_IN_Pb] = 0;
  3186. g_sw[sw].ac_in_acc[SW_AC_IN_Qb] = 0;
  3187. return;
  3188. }
  3189. /******************************************************************************
  3190. 函数名称: _sw_cal_pq
  3191. 函数版本: 01.01
  3192. 创建作者: sunxi
  3193. 创建日期: 2013-08-07
  3194. 函数说明: 测量计算pq,区分3表法和2表法,每次调用累加计算值。
  3195. 参数说明:
  3196. 返回值:
  3197. 修改记录:
  3198. */
  3199. void _sw_cal_pq(void)
  3200. {
  3201. u32 sw,U;
  3202. for(sw=0; sw<g_sw_num; sw++)
  3203. {
  3204. bool b3U,b3I=false;
  3205. U = pRunSet->tSwSet[sw].bTT_Power_v2 ? PUB_AC_UA2 : PUB_AC_UA1;
  3206. b3U= (g_ui[U+0].chn_index != CFG_ADC_CHANNEL_ZERO
  3207. && g_ui[U+1].chn_index != CFG_ADC_CHANNEL_ZERO
  3208. && g_ui[U+2].chn_index != CFG_ADC_CHANNEL_ZERO);
  3209. b3I|= (g_ui[UI_SW_INDEX(sw,SW_AC_IA)].chn_index != CFG_ADC_CHANNEL_ZERO
  3210. && g_ui[UI_SW_INDEX(sw,SW_AC_IB)].chn_index != CFG_ADC_CHANNEL_ZERO
  3211. && g_ui[UI_SW_INDEX(sw,SW_AC_IC)].chn_index != CFG_ADC_CHANNEL_ZERO
  3212. &&g_ui[UI_SW_INDEX(sw,SW_AC_CIA)].chn_index == CFG_ADC_CHANNEL_ZERO); //测量电流未配置
  3213. b3I|= (g_ui[UI_SW_INDEX(sw,SW_AC_CIA)].chn_index != CFG_ADC_CHANNEL_ZERO
  3214. && g_ui[UI_SW_INDEX(sw,SW_AC_CIB)].chn_index != CFG_ADC_CHANNEL_ZERO
  3215. && g_ui[UI_SW_INDEX(sw,SW_AC_CIC)].chn_index != CFG_ADC_CHANNEL_ZERO);
  3216. if(b3U&&b3I) //有三相电压,且有三相测量电流或无AC 测量电流有三相保护电流,用三表法
  3217. {
  3218. _sw_cal_pq_3m(sw);
  3219. }
  3220. else
  3221. {
  3222. _sw_cal_pq_2m(sw);
  3223. }
  3224. }
  3225. }
  3226. /******************************************************************************
  3227. 函数名称: _sw_cal_mea
  3228. 函数版本: 01.01
  3229. 创建作者: sunxi
  3230. 创建日期: 2013-08-07
  3231. 函数说明: 测量计算,每次调用累加计算值
  3232. 参数说明:
  3233. 返回值:
  3234. 修改记录:
  3235. */
  3236. int _sw_cal_mea(void)
  3237. {
  3238. static int g_cal_step = 0;
  3239. uint64_t us0;
  3240. us0 = bsp_ustimer_get_origin();
  3241. if(g_cal_step == 0)
  3242. {
  3243. // 得到采样点
  3244. _sw_get_dots();
  3245. // fft
  3246. _sw_cal_fft();
  3247. _sw_cal_ri_correct();
  3248. g_cal_step = 1;
  3249. rt_stat_other_in(3,bsp_ustimer_get_duration(us0)/USTIMER_US);
  3250. }
  3251. else
  3252. {
  3253. // 得到合成通道的向量值
  3254. _sw_cal_make();
  3255. // 计算有效值
  3256. _sw_cal_effect();
  3257. // 计算角度
  3258. _sw_cal_angle();
  3259. // 计算PQ
  3260. _sw_cal_pq();
  3261. g_cal_step = 0;
  3262. rt_stat_other_in(4,bsp_ustimer_get_duration(us0)/USTIMER_US);
  3263. }
  3264. return g_cal_step;
  3265. }
  3266. #ifdef FUN_JDXX
  3267. /*********************************************************
  3268. 函数名称:isTakeIsVal
  3269. 函数版本:v1.0
  3270. 作 者: Xzy
  3271. 日 期:2021.10.30
  3272. 函数说明:是否取Is通道的值
  3273. 参数说明:sw:开关号
  3274. I_chn:常规通道号
  3275. Is_chn:小值范围通道号
  3276. 返 回 值:true:取Is的值 false:不取Is的值
  3277. **********************************************************/
  3278. static bool isTakeIsVal(int sw,int I_chn,int Is_chn)
  3279. {
  3280. float I_val,Is_val,err_val;
  3281. if(g_ui[UI_SW_INDEX(sw,I_chn)].chn_index == CFG_ADC_CHANNEL_ZERO || g_ui[UI_SW_INDEX(sw,Is_chn)].chn_index == CFG_ADC_CHANNEL_ZERO){
  3282. return false;
  3283. }
  3284. I_val = (float)g_sw[sw].ac_in[I_chn]/65536;
  3285. Is_val = (float)g_sw[sw].ac_in[Is_chn]/65536;
  3286. if(Is_val == 0)
  3287. err_val = 1;
  3288. else
  3289. err_val = ((float)abs(I_val*1000-Is_val*1000))/(Is_val*1000);
  3290. if(Is_val > 0.5 || err_val >= 0.05)
  3291. return false;
  3292. return true;
  3293. }
  3294. #endif
  3295. /******************************************************************************
  3296. 函数名称: _sw_cal_average
  3297. 函数版本: 01.01
  3298. 创建作者: sunxi
  3299. 创建日期: 2013-08-07
  3300. 函数说明: 测量计算平均值
  3301. 参数说明:
  3302. cal_num 平均的次数
  3303. 返回值:
  3304. 修改记录:
  3305. */
  3306. void _sw_cal_average(int cal_num)
  3307. {
  3308. s32 i,sw;
  3309. s32 temp;
  3310. // 平均幅值和角度
  3311. for(i=0;i<UI_NUM;i++)
  3312. {
  3313. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO && g_ui[i].ui_base_make == -1)
  3314. {
  3315. continue;
  3316. }
  3317. // 幅值
  3318. g_ui[i].e = rt_round(g_ui[i].e_acc/cal_num*Q16_BASE);
  3319. rt_stat_in(&g_ui[i].e_stat,g_ui[i].e);
  3320. if(i<PUB_AC_NUM)
  3321. {
  3322. g_sw_pub.ac_in[i] = g_ui[i].e;
  3323. }
  3324. else
  3325. {
  3326. g_sw[(i-PUB_AC_NUM)/SW_AC_NUM].ac_in[(i-PUB_AC_NUM)%SW_AC_NUM] = g_ui[i].e;
  3327. }
  3328. // 角度
  3329. temp = (g_ui[i].p_acc + (cal_num/2))/cal_num;
  3330. if(g_ui[i].p_mark == -1)
  3331. {
  3332. if(temp >= 0)
  3333. {
  3334. temp = 180*Q16_BASE - temp;
  3335. }
  3336. else
  3337. {
  3338. temp = (-180)*Q16_BASE - temp;
  3339. }
  3340. }
  3341. g_ui[i].p = temp;
  3342. rt_stat_in(&g_ui[i].p_stat,g_ui[i].p);
  3343. g_ui[i].e_acc = 0;
  3344. g_ui[i].p_acc = 0;
  3345. g_ui[i].p_mark = 0;
  3346. }
  3347. #ifdef FUN_JDXX
  3348. // 电流值小于0.5A,取Is的,因为在这个范围I0s准确度高
  3349. for(sw=0;sw<g_sw_num;sw++){
  3350. if(isTakeIsVal(sw,SW_AC_I0,SW_AC_I0s)){
  3351. g_sw[sw].ac_in[SW_AC_I0] = g_sw[sw].ac_in[SW_AC_I0s];
  3352. }
  3353. }
  3354. #endif
  3355. // 角度清除
  3356. for(i=0;i<UI_NUM;i++)
  3357. {
  3358. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO && g_ui[i].ui_base_make == -1)
  3359. {
  3360. continue;
  3361. }
  3362. #ifdef MIN_SIGNAL_SAMPLE
  3363. if(g_ui_angle0 == -1 || g_ui[g_ui_angle0].e < 0.1*Q16_BASE)
  3364. #else
  3365. if(g_ui_angle0 == -1 || g_ui[g_ui_angle0].e < 10*Q16_BASE)
  3366. #endif
  3367. {
  3368. g_ui[i].p = ANGEL_INVALID;
  3369. }
  3370. }
  3371. // 平均开关内部测量值:P,Q,COS,电流不平衡度
  3372. for(sw=0;sw<g_sw_num;sw++)
  3373. {
  3374. #ifdef FUN_YC_POWER_S
  3375. float p,q;
  3376. p = g_sw[sw].ac_in_acc[SW_AC_IN_P]/cal_num;
  3377. q = g_sw[sw].ac_in_acc[SW_AC_IN_Q]/cal_num;
  3378. g_sw[sw].ac_in[SW_AC_IN_S] = sqrtf(p*p+q*q)*Q16_BASE;
  3379. #endif
  3380. g_sw[sw].ac_in[SW_AC_IN_P] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_P]/cal_num*Q16_BASE);
  3381. g_sw[sw].ac_in[SW_AC_IN_Q] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_Q]/cal_num*Q16_BASE);
  3382. g_sw[sw].ac_in[SW_AC_IN_Pa] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_Pa]/cal_num*Q16_BASE);
  3383. g_sw[sw].ac_in[SW_AC_IN_Pb] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_Pb]/cal_num*Q16_BASE);
  3384. g_sw[sw].ac_in[SW_AC_IN_Pc] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_Pc]/cal_num*Q16_BASE);
  3385. g_sw[sw].ac_in[SW_AC_IN_Qa] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_Qa]/cal_num*Q16_BASE);
  3386. g_sw[sw].ac_in[SW_AC_IN_Qb] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_Qb]/cal_num*Q16_BASE);
  3387. g_sw[sw].ac_in[SW_AC_IN_Qc] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_Qc]/cal_num*Q16_BASE);
  3388. // 如果电流反向,功率反向
  3389. if(pRunSet->tSwSet[sw].bTT_Current_Inv)
  3390. {
  3391. g_sw[sw].ac_in[SW_AC_IN_P] = -g_sw[sw].ac_in[SW_AC_IN_P];
  3392. g_sw[sw].ac_in[SW_AC_IN_Q] = -g_sw[sw].ac_in[SW_AC_IN_Q];
  3393. g_sw[sw].ac_in[SW_AC_IN_Pa] = -g_sw[sw].ac_in[SW_AC_IN_Pa];
  3394. g_sw[sw].ac_in[SW_AC_IN_Pb] = -g_sw[sw].ac_in[SW_AC_IN_Pb];
  3395. g_sw[sw].ac_in[SW_AC_IN_Pc] = -g_sw[sw].ac_in[SW_AC_IN_Pc];
  3396. g_sw[sw].ac_in[SW_AC_IN_Qa] = -g_sw[sw].ac_in[SW_AC_IN_Qa];
  3397. g_sw[sw].ac_in[SW_AC_IN_Qb] = -g_sw[sw].ac_in[SW_AC_IN_Qb];
  3398. g_sw[sw].ac_in[SW_AC_IN_Qc] = -g_sw[sw].ac_in[SW_AC_IN_Qc];
  3399. }
  3400. if( g_ui[UI_SW_INDEX(sw,SW_AC_IA)].e > g_unit[g_sw_ac_desc[SW_AC_IA].unit].zero
  3401. || g_ui[UI_SW_INDEX(sw,SW_AC_IB)].e > g_unit[g_sw_ac_desc[SW_AC_IB].unit].zero
  3402. || g_ui[UI_SW_INDEX(sw,SW_AC_IC)].e > g_unit[g_sw_ac_desc[SW_AC_IC].unit].zero)
  3403. {
  3404. g_sw[sw].ac_in[SW_AC_IN_BI_UNBALANCE] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_BI_UNBALANCE]/cal_num*Q16_BASE);
  3405. }
  3406. else
  3407. {
  3408. g_sw[sw].ac_in[SW_AC_IN_BI_UNBALANCE] = 0;
  3409. }
  3410. if( g_ui[UI_SW_INDEX(sw,SW_AC_CIA)].e > g_unit[g_sw_ac_desc[SW_AC_CIA].unit].zero
  3411. || g_ui[UI_SW_INDEX(sw,SW_AC_CIB)].e > g_unit[g_sw_ac_desc[SW_AC_CIB].unit].zero
  3412. || g_ui[UI_SW_INDEX(sw,SW_AC_CIC)].e > g_unit[g_sw_ac_desc[SW_AC_CIC].unit].zero)
  3413. {
  3414. g_sw[sw].ac_in[SW_AC_IN_CI_UNBALANCE] = rt_round(g_sw[sw].ac_in_acc[SW_AC_IN_CI_UNBALANCE]/cal_num*Q16_BASE);
  3415. }
  3416. else
  3417. {
  3418. g_sw[sw].ac_in[SW_AC_IN_CI_UNBALANCE] = 0;
  3419. }
  3420. // TODO:
  3421. // 功率因数,I1/I*COSφ1=COSφ ,I1基波电流有效值,I总电流有效值,COSφ1基波功率因数,COSφ含谐波电网的实际功率因数
  3422. if(_AbsL(g_sw[sw].ac_in[SW_AC_IN_Q]) > g_unit[g_sw_ac_desc[SW_AC_IN_Q].unit].zero)
  3423. {
  3424. g_sw[sw].ac_in[SW_AC_IN_COS] =_CosPQ((g_sw[sw].ac_in[SW_AC_IN_P]>>14),(g_sw[sw].ac_in[SW_AC_IN_Q]>>14));
  3425. }
  3426. else if(g_sw[sw].ac_in[SW_AC_IN_P]>=Q16_BASE)
  3427. {
  3428. g_sw[sw].ac_in[SW_AC_IN_COS]=Q16_BASE;
  3429. }
  3430. else if(g_sw[sw].ac_in[SW_AC_IN_P]<=-Q16_BASE)
  3431. {
  3432. g_sw[sw].ac_in[SW_AC_IN_COS]=-Q16_BASE;
  3433. }
  3434. else
  3435. {
  3436. g_sw[sw].ac_in[SW_AC_IN_COS]=0;
  3437. }
  3438. g_sw[sw].ac_in_acc[SW_AC_IN_P] = 0;
  3439. g_sw[sw].ac_in_acc[SW_AC_IN_Q] = 0;
  3440. g_sw[sw].ac_in_acc[SW_AC_IN_Pa] = 0;
  3441. g_sw[sw].ac_in_acc[SW_AC_IN_Pb] = 0;
  3442. g_sw[sw].ac_in_acc[SW_AC_IN_Pc] = 0;
  3443. g_sw[sw].ac_in_acc[SW_AC_IN_Qa] = 0;
  3444. g_sw[sw].ac_in_acc[SW_AC_IN_Qb] = 0;
  3445. g_sw[sw].ac_in_acc[SW_AC_IN_Qc] = 0;
  3446. g_sw[sw].ac_in_acc[SW_AC_IN_BI_UNBALANCE] = 0;
  3447. #if 0
  3448. //电子电流互感器小信号电压值
  3449. for(i=0;i<4;i++)
  3450. {
  3451. s16 cfg,scale;
  3452. cfg = g_sw[sw].ac_cfg_index[SW_AC_IA+i];
  3453. if(cfg != INDEX_INVALLID)
  3454. {
  3455. scale = equ_get_ac_scale(g_equ_config_ac[cfg].slot,g_equ_config_ac[cfg].index);
  3456. if(scale == EQU_SCALE_ECT_1V_1A || scale == EQU_SCALE_ECT_0V2_1A)
  3457. {
  3458. g_sw[sw].ac_in[SW_AC_IN_IA_ECT+i] = g_ui[UI_SW_INDEX(sw,SW_AC_IA+i)].e*g_e_k_ECVT[scale];
  3459. }
  3460. }
  3461. }
  3462. #endif
  3463. }
  3464. // 其它测量值
  3465. // 频率
  3466. g_sw_pub.ac_in[PUB_AC_IN_F1] = (qs16)(freq_get(0)*Q16_BASE); //第1路频率
  3467. g_sw_pub.ac_in[PUB_AC_IN_F2] = (qs16)(freq_get(1)*Q16_BASE); //第2路频率
  3468. // 直流、温度
  3469. {
  3470. float factor,t,f0,f1;
  3471. #ifdef TMP_CHIP_AHT20
  3472. float h=0.0;
  3473. #endif
  3474. #if defined TMP_CHIP_DS18B20
  3475. t = ds18b20_get_temp();
  3476. #elif defined TMP_CHIP_GX21M15
  3477. t = gx21m15_get_temp();
  3478. #elif defined TMP_CHIP_AHT20
  3479. t = aht20_get_temp();
  3480. h = aht20_get_humi();
  3481. #endif
  3482. #ifdef DC_TEST_ONE
  3483. f0 = (dc_get(0)-g_dcfactor[0].f_dcL)*g_dcfactor[0].f_dc+dc_adjust[0];
  3484. f1 = 0;
  3485. #else
  3486. f0 = (dc_get(0)-g_dcfactor[0].f_dcL)*g_dcfactor[0].f_dc+dc_adjust[0];
  3487. f1 = (dc_get(1)-g_dcfactor[1].f_dcL)*g_dcfactor[1].f_dc+dc_adjust[0];
  3488. #endif
  3489. factor = 1.0;
  3490. if(t > -80.0 && t < 125.0)
  3491. {
  3492. factor += (t - g_dc_temp)* pRunSet->f_temp_factor_dc/1000000;
  3493. }
  3494. f0 /= factor;
  3495. f1 /= factor;
  3496. #ifdef DC_NUM_SET
  3497. if(pRunSet->dDc_num==1)
  3498. f1=0;//只有一个通道,将第二个直流通道强制=0
  3499. #endif
  3500. #ifdef CPU_FUXI
  3501. if(f0 < tRunPara.wDC_ZERO)
  3502. {
  3503. f0 = 0.0;
  3504. }
  3505. if(f1 < tRunPara.wDC_ZERO)
  3506. {
  3507. f1 = 0.0;
  3508. }
  3509. #endif
  3510. #ifdef TMP_CHIP_AHT20
  3511. g_sw_pub.ac_in[PUB_AC_IN_HUMI] = (qs16)(h*Q16_BASE);
  3512. #endif
  3513. g_sw_pub.ac_in[PUB_AC_IN_TEMP] = (qs16)(t*Q16_BASE);
  3514. g_sw_pub.ac_in[PUB_AC_IN_UZ1] = (qs16)(f0*Q16_BASE);
  3515. g_sw_pub.ac_in[PUB_AC_IN_UZ2] = (qs16)(f1*Q16_BASE);
  3516. if(g_sw_pub.ac_in[PUB_AC_IN_UZ1]<0)
  3517. g_sw_pub.ac_in[PUB_AC_IN_UZ1]=0;
  3518. if(g_sw_pub.ac_in[PUB_AC_IN_UZ2]<0)
  3519. g_sw_pub.ac_in[PUB_AC_IN_UZ2]=0;
  3520. }
  3521. // 电压不平衡度
  3522. if( g_ui[PUB_AC_UA1].e > g_unit[g_pub_ac_desc[PUB_AC_UA1].unit].zero
  3523. || g_ui[PUB_AC_UB1].e > g_unit[g_pub_ac_desc[PUB_AC_UB1].unit].zero
  3524. || g_ui[PUB_AC_UC1].e > g_unit[g_pub_ac_desc[PUB_AC_UC1].unit].zero)
  3525. {
  3526. g_sw_pub.ac_in[PUB_AC_IN_V_UNBALANCE1] = rt_round(g_sw_pub.ac_in_acc[PUB_AC_IN_V_UNBALANCE1]/cal_num*Q16_BASE);
  3527. }
  3528. else
  3529. {
  3530. g_sw_pub.ac_in[PUB_AC_IN_V_UNBALANCE1] = 0;
  3531. }
  3532. if( g_ui[PUB_AC_UA2].e > g_unit[g_pub_ac_desc[PUB_AC_UA2].unit].zero
  3533. || g_ui[PUB_AC_UB2].e > g_unit[g_pub_ac_desc[PUB_AC_UB2].unit].zero
  3534. || g_ui[PUB_AC_UC2].e > g_unit[g_pub_ac_desc[PUB_AC_UC2].unit].zero)
  3535. {
  3536. g_sw_pub.ac_in[PUB_AC_IN_V_UNBALANCE2] = rt_round(g_sw_pub.ac_in_acc[PUB_AC_IN_V_UNBALANCE2]/cal_num*Q16_BASE);
  3537. }
  3538. else
  3539. {
  3540. g_sw_pub.ac_in[PUB_AC_IN_V_UNBALANCE2] = 0;
  3541. }
  3542. g_sw_pub.ac_in_acc[PUB_AC_IN_V_UNBALANCE1] = 0;
  3543. g_sw_pub.ac_in_acc[PUB_AC_IN_V_UNBALANCE2] = 0;
  3544. #ifdef GD_AREA_YUNAN_LP // 云南涞浦
  3545. g_sw_pub.ac_in[PUB_AC_IN_DLTUAB] =_AbsL(g_ui[PUB_AC_UAB1].e -g_ui[PUB_AC_UAB2].e);
  3546. g_sw_pub.ac_in[PUB_AC_IN_DLTUBC] =_AbsL(g_ui[PUB_AC_UBC1].e -g_ui[PUB_AC_UBC2].e);
  3547. g_sw_pub.ac_in[PUB_AC_IN_DLTUCA] =_AbsL(g_ui[PUB_AC_UCA1].e -g_ui[PUB_AC_UCA2].e);
  3548. if(g_ui[PUB_AC_UAB1].e>10*Q16_BASE&&g_ui[PUB_AC_UAB2].e>10*Q16_BASE)
  3549. {
  3550. g_sw_pub.ac_in[PUB_AC_IN_ARGUAB] =_AbsL(CalcAngSub(g_ui[PUB_AC_UAB1].ri.r,g_ui[PUB_AC_UAB1].ri.i,g_ui[PUB_AC_UAB2].ri.r,g_ui[PUB_AC_UAB2].ri.i));
  3551. }
  3552. else
  3553. {
  3554. g_sw_pub.ac_in[PUB_AC_IN_ARGUAB]=0;
  3555. }
  3556. if(g_ui[PUB_AC_UBC1].e>10*Q16_BASE&&g_ui[PUB_AC_UBC2].e>10*Q16_BASE)
  3557. {
  3558. g_sw_pub.ac_in[PUB_AC_IN_ARGUBC] =_AbsL(CalcAngSub(g_ui[PUB_AC_UBC1].ri.r,g_ui[PUB_AC_UBC1].ri.i,g_ui[PUB_AC_UBC2].ri.r,g_ui[PUB_AC_UBC2].ri.i));
  3559. }
  3560. else
  3561. {
  3562. g_sw_pub.ac_in[PUB_AC_IN_ARGUBC]=0;
  3563. }
  3564. if(g_ui[PUB_AC_UCA1].e>10*Q16_BASE&&g_ui[PUB_AC_UCA2].e>10*Q16_BASE)
  3565. {
  3566. g_sw_pub.ac_in[PUB_AC_IN_ARGUCA] =_AbsL(CalcAngSub(g_ui[PUB_AC_UCA1].ri.r,g_ui[PUB_AC_UCA1].ri.i,g_ui[PUB_AC_UCA2].ri.r,g_ui[PUB_AC_UCA2].ri.i));
  3567. }
  3568. else
  3569. {
  3570. g_sw_pub.ac_in[PUB_AC_IN_ARGUCA]=0;
  3571. }
  3572. #endif
  3573. //版本号0x00010104
  3574. {
  3575. g_sw_pub.ac_in[PUB_AC_IN_VER] =((BYTE)((VER_NUM>>0)&0x0f)
  3576. +((BYTE)(VER_NUM>>4)&0x0f)*10
  3577. +((BYTE)(VER_NUM>>8)&0x0f)*100
  3578. +((BYTE)(VER_NUM>>12)&0x0f)*1000
  3579. +((BYTE)(VER_NUM>>16)&0x0f)*10000)*Q16_BASE;
  3580. }
  3581. #if 0
  3582. //电子电压互感器小信号电压值
  3583. for(i=0;i<8;i++)
  3584. {
  3585. u8 evt[8]={PUB_AC_UA1,PUB_AC_UB1,PUB_AC_UC1,PUB_AC_U01,PUB_AC_UA2,PUB_AC_UB2,PUB_AC_UC2,PUB_AC_U02};
  3586. s16 cfg,scale;
  3587. cfg = g_sw_pub.ac_cfg_index[evt[i]];
  3588. if(cfg != INDEX_INVALLID)
  3589. {
  3590. scale = equ_get_ac_scale(g_equ_config_ac[cfg].slot,g_equ_config_ac[cfg].index);
  3591. if(scale == EQU_SCALE_EVT_3V25_100V || scale == EQU_SCALE_EVT_6V50_100V)
  3592. {
  3593. g_sw_pub.ac_in[PUB_AC_IN_UA1_EVT+i] = g_ui[evt[i]].e*g_e_k_ECVT[scale];
  3594. }
  3595. }
  3596. }
  3597. #endif
  3598. }
  3599. void _sw_cal_zl(void)
  3600. {
  3601. // 直流、温度
  3602. {
  3603. float factor,t,f0,f1;
  3604. #if defined TMP_CHIP_DS18B20
  3605. t = ds18b20_get_temp();
  3606. #elif defined TMP_CHIP_GX21M15
  3607. t = gx21m15_get_temp();
  3608. #elif defined TMP_CHIP_AHT20
  3609. t = aht20_get_temp();
  3610. #endif
  3611. f0 = (dc_get(0)-g_dcfactor[0].f_dcL)*g_dcfactor[0].f_dc+dc_adjust[0];
  3612. f1 = (dc_get(1)-g_dcfactor[1].f_dcL)*g_dcfactor[1].f_dc+dc_adjust[0];
  3613. factor = 1.0;
  3614. if(t > -80.0 && t < 125.0)
  3615. {
  3616. factor += (t - g_dc_temp)* pRunSet->f_temp_factor_dc/1000000;
  3617. }
  3618. f0 /= factor;
  3619. f1 /= factor;
  3620. g_sw_pub.ac_in[PUB_AC_IN_TEMP] = (qs16)(t*Q16_BASE);
  3621. g_sw_pub.ac_in[PUB_AC_IN_UZ1] = (qs16)(f0*Q16_BASE);
  3622. g_sw_pub.ac_in[PUB_AC_IN_UZ2] = (qs16)(f1*Q16_BASE);
  3623. }
  3624. }
  3625. /******************************************************************************
  3626. 函数名称: _sw_auto_adjust_pq
  3627. 函数版本: 01.01
  3628. 创建作者: sunxi
  3629. 创建日期: 2013-08-07
  3630. 函数说明: 自动校正PQ,累加校正系数
  3631. 参数说明:
  3632. 返回值:
  3633. 修改记录:
  3634. */
  3635. void _sw_auto_adjust_pq(void)
  3636. {
  3637. float RateP;
  3638. float RateQ;
  3639. u32 sw,i,j,U,I;
  3640. float pp[3],qq[3];
  3641. RateP = (float)100*5*0.5; //U*I*COS60
  3642. RateQ = (float)100*5*0.866; //U*I*SIN60
  3643. for(sw=0; sw<g_sw_num; sw++)
  3644. {
  3645. for(j=0; j<3; j++)
  3646. {
  3647. U = PUB_AC_UA1+j;
  3648. I = UI_SW_INDEX(sw,j);
  3649. pp[j] = 0;
  3650. qq[j] = 0;
  3651. for(i=1; i<=g_harmonic_num;i++)
  3652. {
  3653. pp[j] += _sw_p2(g_ui[U].h[i].r,g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3654. qq[j] += _sw_q2(g_ui[U].h[i].r,g_ui[U].h[i].i,g_ui[I].h[i].r,g_ui[I].h[i].i,g_ui[U].e_factor,g_ui[I].e_factor) ;
  3655. }
  3656. g_pq_factor[sw][j].pq[0] += (RateQ*qq[j] + RateP*pp[j])/(pp[j]*pp[j] + qq[j]*qq[j]) - 1;
  3657. g_pq_factor[sw][j].pq[1] += (RateQ*pp[j] - RateP*qq[j])/(pp[j]*pp[j] + qq[j]*qq[j]);
  3658. }
  3659. }
  3660. return;
  3661. }
  3662. /******************************************************************************
  3663. 函数名称: _sw_ui_e_k
  3664. 函数版本: 01.01
  3665. 创建作者: sunxi
  3666. 创建日期: 2013-08-07
  3667. 函数说明: 通过g_ui的索引得到对应通道的理论比例系数。
  3668. 参数说明:
  3669. ui_index 通道在g_ui中的索引值
  3670. 返回值: 对应通道的理论比例系数。
  3671. 修改记录:
  3672. */
  3673. float _sw_ui_e_k(int ui_index)
  3674. {
  3675. int sw,i;
  3676. if(ui_index < PUB_AC_NUM)
  3677. {
  3678. i = g_sw_pub.ac_cfg_index[ui_index];
  3679. }
  3680. else
  3681. {
  3682. sw = (ui_index - PUB_AC_NUM)/SW_AC_NUM;
  3683. i = (ui_index - PUB_AC_NUM)%SW_AC_NUM;
  3684. i = g_sw[sw].ac_cfg_index[i];
  3685. }
  3686. return factor_e_k(g_equ_config_ac[i].scale);
  3687. }
  3688. /******************************************************************************
  3689. 函数名称: _sw_min_max
  3690. 函数版本: 01.01
  3691. 创建作者: sunxi
  3692. 创建日期: 2013-08-07
  3693. 函数说明: 计算g_ui中连续三个通道中的m2的最小值,最大值,供保护算法使用
  3694. 参数说明:
  3695. ui_index 通道在g_ui中的索引值
  3696. p_min 返回的最小值
  3697. p_max 返回的最大值
  3698. 返回值:
  3699. 修改记录:
  3700. */
  3701. void _sw_min_max(int ui_index,u32 *p_min,u32*p_max)
  3702. {
  3703. u32 min,max,m2;
  3704. int i;
  3705. min = -1;
  3706. max = 0;
  3707. for(i=0;i<3;i++)
  3708. {
  3709. if(g_ui[ui_index].chn_index == CFG_ADC_CHANNEL_ZERO && g_ui[ui_index].ui_base_make == -1)
  3710. {
  3711. ui_index++;
  3712. continue;
  3713. }
  3714. m2 = g_ui[ui_index].m2[0];
  3715. if(m2 < min)
  3716. {
  3717. min = m2;
  3718. }
  3719. if(m2 > max)
  3720. {
  3721. max = m2;
  3722. }
  3723. ui_index++;
  3724. }
  3725. *p_min = min;
  3726. *p_max = max;
  3727. return;
  3728. }
  3729. /******************************************************************************
  3730. 函数名称: _fz_min_max
  3731. 函数版本: 01.01
  3732. 创建作者: xxxxxx
  3733. 创建日期: 2013-08-07
  3734. 函数说明: 计算g_ui中连续通道中的幅值的最小值,最大值,供保护算法使用
  3735. 参数说明:
  3736. ui_index1 起始通道在g_ui中的索引值
  3737. ui_index2 结束通道在g_ui中的索引值
  3738. p_min 返回的最小值
  3739. p_max 返回的最大值
  3740. 返回值:
  3741. 修改记录:
  3742. */
  3743. void _fz_min_max(int ui_index1,int ui_index2,u32 *p_min,u32*p_max)
  3744. {
  3745. u32 min,max,m2;
  3746. int i;
  3747. min = -1;
  3748. max = 0;
  3749. for(i=ui_index1;i<ui_index2+1;i++)
  3750. {
  3751. if(g_ui[ui_index1].chn_index == CFG_ADC_CHANNEL_ZERO && g_ui[ui_index1].ui_base_make == -1)
  3752. {
  3753. ui_index1++;
  3754. continue;
  3755. }
  3756. m2 = g_ui[ui_index1].fz;
  3757. if(m2 < min)
  3758. {
  3759. min = m2;
  3760. }
  3761. if(m2 > max)
  3762. {
  3763. max = m2;
  3764. }
  3765. ui_index1++;
  3766. }
  3767. *p_min = min;
  3768. *p_max = max;
  3769. return;
  3770. }
  3771. /******************************************************************************
  3772. 函数名称: _sw_base_angle
  3773. 函数版本: 01.01
  3774. 创建作者: sunxi
  3775. 创建日期: 2013-08-07
  3776. 函数说明: 自动校准时,通道的基本参考角度
  3777. 参数说明:
  3778. ui_index 通道在g_ui中的索引值
  3779. 返回值: 参考的角度
  3780. 修改记录:
  3781. */
  3782. float _sw_base_angle(int ui_index)
  3783. {
  3784. static float angle_v[8] = {0,-120,120,0,-120,120,120,120}; // U0、US使用UC角度
  3785. #ifdef SW_AC_I0S_SAMPLE
  3786. static float angle_a [SW_AC_NUM] = {0,-120,120,-120,-120,0,-120,120}; // I0使用IB值
  3787. #else
  3788. static float angle_a [SW_AC_NUM] = {0,-120,120,-120,0,-120,120}; // I0使用IB值
  3789. #endif
  3790. float angle;
  3791. if(ui_index < PUB_AC_NUM)
  3792. {
  3793. // 电压
  3794. // 将第2组电压映射到第一组上面
  3795. ui_index = ui_index%(PUB_AC_NUM/2);
  3796. // 得到基准电压
  3797. angle = angle_v[ui_index];
  3798. // 如果配置不是相电压,U01、US1减30度。
  3799. if((g_ui[PUB_AC_UA1].chn_index == CFG_ADC_CHANNEL_ZERO)
  3800. && (ui_index == PUB_AC_U01 || ui_index == PUB_AC_US1))
  3801. {
  3802. angle -= 30;
  3803. }
  3804. }
  3805. else
  3806. {
  3807. // 电流
  3808. ui_index = (ui_index - PUB_AC_NUM)%SW_AC_NUM;
  3809. angle = angle_a[ui_index];
  3810. // 如果配置不是相电压,电流减30度。
  3811. if(g_ui[PUB_AC_UA1].chn_index == CFG_ADC_CHANNEL_ZERO)
  3812. {
  3813. angle -= 30;
  3814. }
  3815. }
  3816. return angle;
  3817. }
  3818. /******************************************************************************
  3819. 函数名称: _sw_save_dc_factor
  3820. 函数版本: 01.01
  3821. 创建作者: sunxi
  3822. 创建日期: 2013-08-07
  3823. 函数说明: 将直流量校正系数保存到内部定值
  3824. 参数说明:
  3825. dc1 直流量1的校正系数
  3826. dc2 只流量2的校正系数
  3827. 返回值:
  3828. 0: 成功
  3829. 其它: 失败
  3830. 修改记录:
  3831. */
  3832. int _sw_save_dc_factor(float dc1_H, float dc1_L,float dc2_H, float dc2_L)
  3833. {
  3834. struct dc_factor_save factor[2];
  3835. u8 id[8];
  3836. if(dc1_H != 0.0)
  3837. {
  3838. factor[0].dc_h = dc1_H;
  3839. factor[0].adjust_set = DC_ADJUST;
  3840. }
  3841. if(dc1_L!= 0.0)
  3842. {
  3843. factor[0].dc_l= dc1_L;
  3844. factor[0].adjust_set = DC_ADJUST;
  3845. }
  3846. if(dc2_H != 0.0)
  3847. {
  3848. factor[1].dc_h = dc2_H;
  3849. factor[1].adjust_set = DC_ADJUST;
  3850. }
  3851. if(dc2_L!= 0.0)
  3852. {
  3853. factor[1].dc_l = dc2_L;
  3854. factor[1].adjust_set = DC_ADJUST;
  3855. }
  3856. memcpy(id, g_auth_id, 8);
  3857. if(dcfactor_createfile(&id[0], (u8*)&factor) != 0)
  3858. {
  3859. rt_printf("直流系数文件保存失败\r\n");
  3860. return -1;
  3861. }
  3862. return 0;
  3863. }
  3864. float g_temp_factor[EQU_SLOT_AC_NUM];
  3865. void _sw_temp_factor(void)
  3866. {
  3867. int i;
  3868. float t;
  3869. #if defined TMP_CHIP_DS18B20
  3870. t = ds18b20_get_temp();
  3871. #elif defined TMP_CHIP_GX21M15
  3872. t = gx21m15_get_temp();
  3873. #elif defined TMP_CHIP_AHT20
  3874. t = aht20_get_temp();
  3875. #endif
  3876. if(t < -80.0 || t > 125.0)
  3877. {
  3878. // 温度超范围,可能温度传感器坏,使用默认值
  3879. for(i=0; i<EQU_SLOT_AC_NUM; i++)
  3880. {
  3881. g_temp_factor[i] = 1.0;
  3882. }
  3883. }
  3884. else
  3885. {
  3886. //在正常范围内,使用温度校正
  3887. for(i=0; i<EQU_SLOT_AC_NUM; i++)
  3888. {
  3889. factor_temp_get(equ_ac_index_to_slot(i),&g_temp_factor[i]);
  3890. g_temp_factor[i] = t - g_temp_factor[i];
  3891. g_temp_factor[i] *= pRunSet->f_temp_factor_ac/1000000;
  3892. g_temp_factor[i] += 1.0;
  3893. }
  3894. }
  3895. for(i=0;i<UI_NUM;i++)
  3896. {
  3897. if(g_ui[i].chn_index != CFG_ADC_CHANNEL_ZERO)
  3898. {
  3899. g_ui[i].e_factor = g_ui[i].e_factor0*g_temp_factor[g_ui[i].chn_index/16];
  3900. }
  3901. else if(g_ui[i].ui_base_make != -1)
  3902. {
  3903. g_ui[i].e_factor = g_ui[i].e_factor0*g_temp_factor[g_ui[g_ui[i].ui_base_make].chn_index/16];
  3904. }
  3905. }
  3906. return;
  3907. }
  3908. int sw_get_chnl_ps(int index,bool prim)
  3909. {
  3910. int owner,type;
  3911. owner=g_equ_config_ac[index].owner;
  3912. type=g_equ_config_ac[index].type;
  3913. if(owner==0)
  3914. {
  3915. type-=1;
  3916. if(type==PUB_AC_U01||type==PUB_AC_U02) //零序 PT变比为默认10000/100
  3917. {
  3918. if(prim) return 10000;
  3919. else return 100;
  3920. }
  3921. else if(PUB_AC_UA2||PUB_AC_UB2||PUB_AC_UC2||PUB_AC_UAB2||PUB_AC_UBC2||PUB_AC_UCA2)
  3922. { //采用PT2变比 dlj 2019-6-5
  3923. if(prim)return 10000;
  3924. else return pRunSet->pt2_two;
  3925. }
  3926. else if(type<PUB_AC_NUM)
  3927. {
  3928. if(prim)return 10000;
  3929. else return pRunSet->pt1_two;
  3930. }
  3931. }
  3932. else
  3933. {
  3934. owner-=1;
  3935. type-=1;
  3936. if(type==SW_AC_I0) //零序 CT变比
  3937. {
  3938. if(prim) return pRunSet->ct0_one;
  3939. else return pRunSet->ct0_two;
  3940. }
  3941. else if(type==SW_AC_IA||type==SW_AC_IB||type==SW_AC_IC)
  3942. {
  3943. if(prim) return pRunSet->ct_one;
  3944. else return pRunSet->ct_two;
  3945. }
  3946. }
  3947. return 1;
  3948. }
  3949. /*------------------------------ 测试函数 -------------------------------------
  3950. 一个实体文件必须带一个本模块的测试函数来进行单元测试,如果的确不方便在本模块中
  3951. 进行单元测试,必须在此注明实际的测试位置(例如在哪个实体文件中使用哪个测试函数).
  3952. */
  3953. int sw_stat_reset(void)
  3954. {
  3955. int i;
  3956. for(i=0; i< UI_NUM; i++)
  3957. {
  3958. rt_stat_init(&g_ui[i].m2_stat,g_ui[i].name);
  3959. rt_stat_init(&g_ui[i].e_stat,g_ui[i].name);
  3960. rt_stat_init(&g_ui[i].p_stat,g_ui[i].name);
  3961. }
  3962. return 0;
  3963. }
  3964. int sw_pub_printf(void)
  3965. {
  3966. return 0;
  3967. }
  3968. int sw_pub_printf_v(void)
  3969. {
  3970. int i;
  3971. // rt_printf("PUB AC通道模值:\r\n");
  3972. // rt_printf("name\t\t\tmin\tmax\tavg\tsum\t\tcnt\r\n");
  3973. rt_printf("PUB AC通道有效值:\r\n");
  3974. rt_printf("name\t\t\tmin\tmax\tavg\tsum\t\tcnt\r\n");
  3975. for(i=0; i<PUB_AC_NUM; i++)
  3976. {
  3977. rt_stat_printf_q16(&g_ui[i].e_stat);
  3978. }
  3979. #if 1
  3980. rt_printf("PUB AC通道角度:\r\n");
  3981. rt_printf("name\t\t\tmin\tmax\tavg\tsum\t\tcnt\r\n");
  3982. for(i=0; i<PUB_AC_NUM; i++)
  3983. {
  3984. rt_stat_printf_q16(&g_ui[i].p_stat);
  3985. }
  3986. #endif
  3987. return 0;
  3988. }
  3989. int sw_printf(void)
  3990. {
  3991. return 0;
  3992. }
  3993. int sw_printf_v(void)
  3994. {
  3995. int i,sw;
  3996. rt_printf("SW AC通道有效值:\r\n");
  3997. rt_printf("name\t\t\tmin\tmax\tavg\tsum\t\tcnt\r\n");
  3998. for(sw=0; sw<SWITCH_NUM_MAX; sw++)
  3999. {
  4000. rt_printf("sw%02d\r\n",sw);
  4001. for(i=0; i<SW_AC_NUM; i++)
  4002. {
  4003. rt_stat_printf_q16(&g_ui[PUB_AC_NUM + sw*SW_AC_NUM + i].e_stat);
  4004. }
  4005. for(i=SW_AC_NUM; i<SW_AC_NUM_ALL; i++)
  4006. {
  4007. rt_printf("%s:%s.\r\n",g_sw_ac_desc[i].name,q16_to_str((long)g_sw[sw].ac_in[i]));
  4008. }
  4009. }
  4010. #if 0
  4011. rt_printf("SW AC通道角度:\r\n");
  4012. rt_printf("name\t\t\tmin\tmax\tavg\tsum\t\tcnt\r\n");
  4013. for(sw=0; sw<SWITCH_NUM_MAX; sw++)
  4014. {
  4015. for(i=0; i<SW_AC_NUM; i++)
  4016. {
  4017. rt_stat_printf_q16(&g_sw[sw].I.i_stat_p[i]);
  4018. }
  4019. }
  4020. #endif
  4021. return 0;
  4022. }
  4023. int sw_ui_printf(void)
  4024. {
  4025. int i;
  4026. rt_printf("谐波次数:%d\r\n",g_harmonic_num);
  4027. rt_printf("UI通道:\r\n");
  4028. rt_printf("\t\tm2_factor_k\tm2_factor_c\te_factor\tp_factor\te_ps\r\n");
  4029. for(i=0; i<UI_NUM; i++)
  4030. {
  4031. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  4032. {
  4033. // continue;
  4034. }
  4035. rt_printf("%s(%02d,%02d):\t%f\t%f\t%f\t%f\t%f\r\n",
  4036. g_ui[i].name,
  4037. g_ui[i].chn_index ,
  4038. g_ui[i].ui_base_make ,
  4039. (float)g_ui[i].m2_factor_k/Q08_BASE,
  4040. (float)g_ui[i].m2_factor_c/Q16_BASE,
  4041. g_ui[i].e_factor ,
  4042. g_ui[i].p_factor ,
  4043. g_ui[i].e_ps);
  4044. }
  4045. return 0;
  4046. }
  4047. #if 1
  4048. void rt_stat_printf_m2(int i,struct rt_stat *stat)
  4049. {
  4050. uint32_t avg = 0;
  4051. qs16 qs;
  4052. if(stat->cnt)
  4053. {
  4054. avg = stat->sum/stat->cnt;
  4055. }
  4056. rt_printf("%-24s",stat->name);
  4057. qs = _Mul_Div_U(sqrt_32fix(stat->min), 256, g_ui[i].m2_factor_k);
  4058. rt_printf("%f\t", (float)qs/Q16_BASE);
  4059. qs = _Mul_Div_U(sqrt_32fix(stat->max), 256, g_ui[i].m2_factor_k);
  4060. rt_printf("%f\t", (float)qs/Q16_BASE);
  4061. qs = _Mul_Div_U(sqrt_32fix(avg), 256, g_ui[i].m2_factor_k);
  4062. rt_printf("%f\t", (float)qs/Q16_BASE);
  4063. rt_printf("%-016d%d\r\n",stat->sum,stat->cnt);
  4064. return;
  4065. }
  4066. #else
  4067. void rt_stat_printf_m2(int i,struct rt_stat *stat)
  4068. {
  4069. uint32_t avg = 0;
  4070. float k;
  4071. if(stat->cnt)
  4072. {
  4073. avg = stat->sum/stat->cnt;
  4074. }
  4075. k = _sw_ui_e_k(i);
  4076. rt_printf("%-24s",stat->name);
  4077. rt_printf("%f\t", sqrtf((float)stat->min)/k);
  4078. rt_printf("%f\t", sqrtf((float)stat->max)/k);
  4079. rt_printf("%f\t", sqrtf((float)avg)/k);
  4080. rt_printf("%-016d%d\r\n",stat->sum,stat->cnt);
  4081. return;
  4082. }
  4083. #endif
  4084. int sw_ui_printf_e(void)
  4085. {
  4086. int i;
  4087. rt_printf("UI通道:\r\n");
  4088. rt_printf("name\t\t\tmin\t\tmax\t\tavg\t\tsum\t\tcnt\r\n");
  4089. for(i=0; i<UI_NUM; i++)
  4090. {
  4091. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  4092. {
  4093. // continue;
  4094. }
  4095. // rt_stat_printf_m2(i,&g_ui[i].m2_stat);
  4096. rt_stat_printf_q16(&g_ui[i].e_stat);
  4097. // rt_stat_printf_q16(&g_ui[i].p_stat);
  4098. }
  4099. return 0;
  4100. }
  4101. int sw_ui_printf_m(void)
  4102. {
  4103. int i;
  4104. rt_printf("UI通道:\r\n");
  4105. rt_printf("name\t\t\tmin\t\tmax\t\tavg\t\tsum\t\tcnt\r\n");
  4106. for(i=0; i<UI_NUM; i++)
  4107. {
  4108. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  4109. {
  4110. // continue;
  4111. }
  4112. rt_stat_printf_m2(i,&g_ui[i].m2_stat);
  4113. }
  4114. return 0;
  4115. }
  4116. int sw_ui_printf_p(void)
  4117. {
  4118. int i;
  4119. rt_printf("UI通道:\r\n");
  4120. rt_printf("name\t\t\tmin\t\tmax\t\tavg\t\tsum\t\tcnt\r\n");
  4121. for(i=0; i<UI_NUM; i++)
  4122. {
  4123. if(g_ui[i].chn_index == CFG_ADC_CHANNEL_ZERO)
  4124. {
  4125. // continue;
  4126. }
  4127. rt_stat_printf_q16(&g_ui[i].p_stat);
  4128. }
  4129. return 0;
  4130. }
  4131. int sw_ui_temp(void)
  4132. {
  4133. int i;
  4134. float t;
  4135. rt_printf("温度校正系数[当前温度:%f]:\r\n",
  4136. #if defined TMP_CHIP_DS18B20
  4137. ds18b20_get_temp()
  4138. #elif defined TMP_CHIP_GX21M15
  4139. gx21m15_get_temp()
  4140. #elif defined TMP_CHIP_AHT20
  4141. aht20_get_temp()
  4142. #endif
  4143. );
  4144. for(i=0; i<EQU_SLOT_AC_NUM;i++)
  4145. {
  4146. factor_temp_get(equ_ac_index_to_slot(i),&t);
  4147. rt_printf("%d[slot=%02d,temp=%f]:%f.\r\n",i,equ_ac_index_to_slot(i),t,g_temp_factor[i]);
  4148. }
  4149. rt_printf("谐波校正系数[次数=%d]:\r\n",g_harmonic_num);
  4150. for(i=0; i<CFG_ADC_DOTS_PER_PERIOD/2;i++)
  4151. {
  4152. rt_printf("%02d\t%f.\r\n",i,g_harmonic_factor[i]);
  4153. }
  4154. return 0;
  4155. }
  4156. /*------------------------------ 文件结束 -------------------------------------
  4157. */