power.c 60 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930
  1. #include "mb.h"
  2. #include "cfg.h"
  3. #include "web.h"
  4. #include "lock.h"
  5. #include "list.h"
  6. #include "paras.h"
  7. #include "power.h"
  8. #include "thread.h"
  9. #include "datadef.h"
  10. #define LIMIT_HOF(x) (x*1.1f)
  11. #define LIMIT_LOF(x) (x*0.9f)
  12. typedef struct {
  13. lock_t lck;
  14. uint8_t cur_addr;
  15. uint8_t chs; //所有控制板的总通道数
  16. power_ch_t **pch; //动态指针
  17. power_ch_t ch0;
  18. uint8_t cnt; //实际扫到的板子个数,不可大于POWER_
  19. uint8_t brd_max;
  20. board_data_t *pbrd[POWER_BOARD_MAX+1]; //通过modbus地址索引
  21. board_key_t key[POWER_BOARD_MAX+1];
  22. power_total_t ttl;
  23. uint8_t flag[POWER_CH_MAX];
  24. product_data_t *prod;
  25. power_all_t all;
  26. }power_handle_t;
  27. static int get_power(power_ch_t *pch)
  28. {
  29. return power_get_ch(pch->info.ch, pch);
  30. }
  31. static int get_alarm(power_ch_t *pch)
  32. {
  33. power_ch_t pc;
  34. int r = power_get_ch(pch->info.ch, &pc);
  35. if(r==0) {
  36. pch->alarm = pc.alarm;
  37. }
  38. return r;
  39. }
  40. static int set_ch(power_ch_t *pch)
  41. {
  42. return power_set_ch_sw(pch->info.ch, pch->power[0].status);
  43. }
  44. static int set_open_delay(power_ch_t *pch)
  45. {
  46. return power_set_open_delay(pch);
  47. }
  48. static int set_close_delay(power_ch_t *pch)
  49. {
  50. return power_set_close_delay(pch);
  51. }
  52. static int set_kb_value(power_ch_t *pch)
  53. {
  54. return 0;//power_set_kb_val(pch);
  55. }
  56. static int set_threshold(power_ch_t *pch)
  57. {
  58. return power_set_threshold(pch);
  59. }
  60. static int reset_consump(power_ch_t *pch)
  61. {
  62. return power_reset();
  63. }
  64. static int do_detect(uint8_t addr)
  65. {
  66. return 0;
  67. }
  68. static int get_info(uint8_t addr, board_info_t *info)
  69. {
  70. return 0;
  71. }
  72. static int get_board(board_data_t *pbrd)
  73. {
  74. return 0;
  75. }
  76. static int set_board(uint8_t addr, uint8_t on)
  77. {
  78. return power_set_board_sw(addr, on);
  79. }
  80. static int set_all(uint8_t on)
  81. {
  82. return power_set_all_sw(on);
  83. }
  84. static board_fn_t board_fn={
  85. .get_power = get_power,
  86. .get_alarm = get_alarm,
  87. .set_ch = set_ch,
  88. .set_open_delay = set_open_delay,
  89. .set_close_delay = set_close_delay,
  90. .set_kb_value = set_kb_value,
  91. .set_threshold = set_threshold,
  92. .reset_consump = reset_consump,
  93. .detect = do_detect,
  94. .get_info = get_info,
  95. //.get_board = get_board,
  96. .set_board = set_board,
  97. .set_all = set_all,
  98. };
  99. static power_handle_t pwrHandle={0};
  100. static int get_flag(power_handle_t *h, uint8_t ch, uint8_t thr)
  101. {
  102. return (h->flag[ch]&(1<<thr))?1:0;
  103. }
  104. static void set_flag(power_handle_t *h, uint8_t ch, uint8_t thr, int flag)
  105. {
  106. if(flag) {
  107. h->flag[ch] |= 1<<thr;
  108. }
  109. else {
  110. h->flag[ch] &= ~(1<<thr);
  111. }
  112. }
  113. static int alarm_evt_handle(power_handle_t *h, power_ch_t *pch)
  114. {
  115. alarm_data_t ad;
  116. ad.ch = pch->info.ch;
  117. ad.alarm = pch->alarm;
  118. ad.time = pch->time;
  119. web_post(PKT_TYPE_ALARM, &ad, sizeof(ad));
  120. return 0;
  121. }
  122. static void memswap(uint8_t *buf, int len)
  123. {
  124. int i;
  125. uint8_t tmp;
  126. for(i=0; i<len; i+=2) {
  127. tmp = buf[i];
  128. buf[i] = buf[i+1];
  129. buf[i+1] = tmp;
  130. }
  131. }
  132. static int read_reg(power_handle_t *h, uint8_t addr, uint16_t reg, uint16_t *data, int cnt)
  133. {
  134. int i,r=0;
  135. for(i=0; i<POWER_RETRY_TIMES; i++) {
  136. r = mb_read(MB_ID_POWER, addr, reg, data, cnt, POWER_BOARD_TIMEOUT);
  137. if(r==cnt) {
  138. break;
  139. }
  140. }
  141. return (r==cnt)?0:-1;
  142. }
  143. static int write_reg(power_handle_t *h, uint8_t addr, uint16_t reg, uint16_t *data, int cnt)
  144. {
  145. int i,r=0;
  146. for(i=0; i<POWER_RETRY_TIMES; i++) {
  147. r = mb_write(MB_ID_POWER, addr, reg, data, cnt);
  148. if(r==cnt) break;
  149. }
  150. return (r==cnt)?0:-1;
  151. }
  152. ////////////////////////////////////////////////////////////////////
  153. static int get_key(power_handle_t *h, uint8_t addr, board_key_t *key)
  154. {
  155. int i,r;
  156. uint16_t tmp[2];
  157. if(h->prod->type==PDU_AC_I1O1 || h->prod->type==PDU_AC_I3O1_H) {
  158. r = read_reg(h, addr, POWER_AC_GET_INFO, tmp, 1);
  159. if(r==0) {
  160. key->type = (tmp[0]>>8)&0xFF;
  161. key->chs = tmp[0]&0xFF;
  162. }
  163. }
  164. else {
  165. r = read_reg(h, addr, POWER_DC_INFO, tmp, 2);
  166. if(r==0) {
  167. key->type = (tmp[0]>>8)&0xFF;
  168. key->chs = tmp[0]&0xFF;
  169. if(h->prod->type == PDU_AC_I3O3)
  170. {
  171. key->chs /= 3;
  172. }
  173. return 0;
  174. }
  175. }
  176. return r;
  177. }
  178. ////////////////////////////////////////////////////////////////
  179. int power_set_kb_value(power_handle_t *h, int type, int addr, kb_val_t *kv)
  180. {
  181. switch(type) {
  182. case AC_SINGLE_S_TYPE:
  183. {
  184. /*
  185. unsigned int offset = 0;
  186. unsigned int rval = 0 ;
  187. unsigned short data_temp[8] = {0};
  188. if(chn>=8)
  189. return -1;
  190. offset = _SWITCH_AC_SINGLE_S_KB_VAL+chn*8;
  191. data_temp[0] = (unsigned short)_kb_val->voltage_k;
  192. data_temp[1] = (unsigned short)((_kb_val->voltage_k-data_temp[0])*1000);
  193. data_temp[2] = (unsigned short)_kb_val->voltage_b;
  194. data_temp[3] = (unsigned short)((_kb_val->voltage_b-data_temp[2])*1000);
  195. data_temp[4] = (unsigned short)_kb_val->current_k;
  196. data_temp[5] = (unsigned short)((_kb_val->current_k-data_temp[4])*1000);
  197. data_temp[6] = (unsigned short)_kb_val->current_b;
  198. data_temp[7] = (unsigned short)((_kb_val->current_b-data_temp[6])*1000);
  199. g_modbus_write_x_reg(manger,saddr,offset,8,data_temp);
  200. */
  201. }
  202. break;
  203. case AC_SINGLE_B_TYPE:
  204. {
  205. /*
  206. unsigned int offset = 0;
  207. unsigned int rval = 0 ;
  208. unsigned short data_temp[8] = {0};
  209. if(pch->info.>=4)
  210. return -1;
  211. offset = _SWITCH_AC_SINGLE_B_KB_VAL+chn*8;
  212. data_temp[0] = (unsigned short)_kb_val->voltage_k;
  213. data_temp[1] = (unsigned short)((_kb_val->voltage_k-data_temp[0])*1000);
  214. data_temp[2] = (unsigned short)_kb_val->voltage_b;
  215. data_temp[3] = (unsigned short)((_kb_val->voltage_b-data_temp[2])*1000);
  216. data_temp[4] = (unsigned short)_kb_val->current_k;
  217. data_temp[5] = (unsigned short)((_kb_val->current_k-data_temp[4])*1000);
  218. data_temp[6] = (unsigned short)_kb_val->current_b;
  219. data_temp[7] = (unsigned short)((_kb_val->current_b-data_temp[6])*1000);
  220. g_modbus_write_x_reg(manger,saddr,offset,8,data_temp);
  221. */
  222. }
  223. break;
  224. case DCPDU_TYPE:
  225. {/*
  226. unsigned short offset = 0;
  227. unsigned short data_temp[8] = {0};
  228. offset = _SWITCH_DC_KB_VAL;
  229. data_temp[0] = (unsigned short)_kb_val->voltage_k;
  230. data_temp[1] = (unsigned short)((_kb_val->voltage_k-data_temp[0])*1000);
  231. data_temp[2] = (unsigned short)_kb_val->voltage_b;
  232. data_temp[3] = (unsigned short)((_kb_val->voltage_b-data_temp[2])*1000);
  233. data_temp[4] = (unsigned short)_kb_val->current_k;
  234. data_temp[5] = (unsigned short)((_kb_val->current_k-data_temp[4])*1000);
  235. data_temp[6] = (unsigned short)_kb_val->current_b;
  236. data_temp[7] = (unsigned short)((_kb_val->current_b-data_temp[6])*1000);
  237. g_modbus_write_x_reg(manger,saddr,offset,8, data_temp);
  238. */
  239. }
  240. break;
  241. case TREE_AC_TYPE:
  242. {
  243. }
  244. break;
  245. case AC_MULTI_S_TYPE:
  246. case AC_MULTI_B_TYPE:
  247. case DC_OUT_TYPE:
  248. case DC_IN_TYPE:
  249. default:
  250. return -1;
  251. }
  252. }
  253. //////////////////////////////////////////////////////////////////
  254. static uint8_t get_ch_idx(board_data_t *pbrd, uint8_t sch)
  255. {
  256. uint8_t ch=0;
  257. uint8_t pwr_type=paras_get()->prod.type;
  258. if(pbrd->type==TREE_AC_TYPE) {
  259. if(pwr_type == PDU_AC_I3O3) {
  260. ch = pbrd->ch0 + sch/3;
  261. }
  262. else {
  263. ch = pbrd->ch0 + sch;
  264. }
  265. }
  266. else {
  267. ch = pbrd->ch0 + sch;
  268. }
  269. return ch;
  270. }
  271. static int threshold_proc(power_handle_t *h, board_data_t *pbrd)
  272. {
  273. int i,j,r=-1,times=1;
  274. power_ch_t *pch=NULL;
  275. for (i=0; i<pbrd->chs; i++) {
  276. pch = &pbrd->pch[i];
  277. if(h->prod->type==PDU_AC_I3O3) {
  278. times = 3;
  279. //设置为输出三相且三相有缺失则报警
  280. if(pch->info.ph_val && pbrd->ph_loss && get_flag(h, pch->info.ch, ALARM_PH_LOSS)==0) {
  281. set_flag(h, pch->info.ch, ALARM_PH_LOSS, 1);
  282. alarm_evt_handle(h, pch);
  283. }
  284. else {
  285. set_flag(h, pch->info.ch, ALARM_PH_LOSS, 0);
  286. }
  287. }
  288. for(j=0; j<times; j++) {
  289. if(pch->thr.v_upper.en) {
  290. if(pch->power[j].voltage>pch->thr.v_upper.val) {
  291. if(pch->alarm.v_upper && get_flag(h, pch->info.ch, ALARM_V_UPPER)==0) {
  292. set_flag(h, pch->info.ch, ALARM_V_UPPER, 1);
  293. alarm_evt_handle(h, pch);
  294. }
  295. }
  296. else if(pch->power[j].voltage<pch->thr.v_lower.val) {
  297. if(pch->alarm.v_lower && get_flag(h, pch->info.ch, ALARM_V_LOWER)==0) {
  298. set_flag(h, pch->info.ch, ALARM_V_LOWER, 1);
  299. alarm_evt_handle(h, pch);
  300. }
  301. }
  302. else {
  303. set_flag(h, pch->info.ch, ALARM_V_UPPER, 0);
  304. set_flag(h, pch->info.ch, ALARM_V_LOWER, 0);
  305. }
  306. }
  307. if(pch->thr.c_upper.en) {
  308. if(pch->power[j].current>pch->thr.c_upper.val) {
  309. if(pch->alarm.c_upper && get_flag(h, pch->info.ch, ALARM_C_UPPER)==0) {
  310. set_flag(h, pch->info.ch, ALARM_C_UPPER, 1);
  311. alarm_evt_handle(h, pch);
  312. }
  313. else {
  314. set_flag(h, pch->info.ch, ALARM_C_UPPER, 0);
  315. }
  316. }
  317. }
  318. if(pch->thr.p_upper.en) {
  319. if(pch->power[j].power>pch->thr.p_upper.val) {
  320. if(pch->alarm.p_upper && get_flag(h, pch->info.ch, ALARM_P_UPPER)==0) {
  321. set_flag(h, pch->info.ch, ALARM_P_UPPER, 0);
  322. alarm_evt_handle(h, pch);
  323. }
  324. }
  325. else {
  326. set_flag(h, pch->info.ch, ALARM_P_UPPER, 0);
  327. }
  328. }
  329. if(pch->thr.w_upper.en) {
  330. if(pch->power[j].current>pch->thr.w_upper.val) {
  331. if(pch->alarm.w_upper==1 && get_flag(h, pch->info.ch, ALARM_W_UPPER)==0) {
  332. set_flag(h, pch->info.ch, ALARM_W_UPPER, 1);
  333. alarm_evt_handle(h, pch);
  334. }
  335. }
  336. else {
  337. set_flag(h, pch->info.ch, ALARM_C_UPPER, 0);
  338. }
  339. }
  340. }
  341. }
  342. return 0;
  343. }
  344. static int total_proc(power_handle_t *h)
  345. {
  346. total_t tmp[3]={0};
  347. int i,j,k,r=-1,times=1;
  348. power_ch_t *pch=NULL;
  349. board_data_t *pbrd=NULL;
  350. lock_on(h->lck);
  351. if(h->prod->type==PDU_AC_I3O3) times = 3;
  352. for(i=0; i<h->brd_max; i++) {
  353. if(h->pbrd[i]) {
  354. for (j=0; i<h->pbrd[i]->chs; i++) {
  355. pch = &h->pbrd[i]->pch[j];
  356. for(k=0; k<times; k++) {
  357. tmp[k].voltage = pch->power[j].voltage;
  358. tmp[k].current += pch->power[j].current;
  359. tmp[k].power += pch->power[j].power;
  360. tmp[k].freq = pch->power[j].freq;
  361. tmp[k].consump += pch->power[j].consump;
  362. tmp[k].active = pch->power[j].active;
  363. tmp[k].reactive = pch->power[j].reactive;
  364. }
  365. }
  366. }
  367. }
  368. h->ttl.type = h->prod->type;
  369. for(k=0; k<times; k++) {
  370. h->ttl.total[k].voltage = tmp[k].voltage;
  371. h->ttl.total[k].current = tmp[k].current;
  372. h->ttl.total[k].power = tmp[k].power;
  373. h->ttl.total[k].freq = tmp[k].freq;
  374. h->ttl.total[k].consump = tmp[k].consump;
  375. h->ttl.total[k].factor = tmp[k].active/tmp[k].power;
  376. h->ttl.total[k].active = tmp[k].active;
  377. h->ttl.total[k].reactive = tmp[k].reactive;
  378. }
  379. lock_off(h->lck);
  380. return 0;
  381. }
  382. static int board_read(power_handle_t *h, board_data_t *pbrd)
  383. {
  384. int i,j,r=-1;
  385. power_t *pwr,power;
  386. uint16_t offset,tmp[144];
  387. power_ch_t *pch=NULL;
  388. lock_on(h->lck);
  389. if(pbrd) {
  390. time_t tm = mktime(localtime(NULL));
  391. switch(pbrd->type) {
  392. case AC_SINGLE_S_TYPE:
  393. case AC_SINGLE_B_TYPE:
  394. {
  395. uint32_t val;
  396. offset = POWER_AC_CUR_INFO_L;
  397. r = read_reg(h, pbrd->addr, offset, tmp, pbrd->chs*12);
  398. if (r<0) {
  399. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, pbrd->chs*12);
  400. break;
  401. }
  402. for (i=0; i<pbrd->chs; i++) {
  403. int idx = i * 12;
  404. pwr = &pbrd->pch[i].power[0];
  405. val = (tmp[1 + idx] << 16) | tmp[0 + idx];
  406. pwr->voltage = val / 1000.0;
  407. val = (tmp[3 + idx] << 16) | tmp[2 + idx];
  408. pwr->current = val / 1000.0;
  409. val = (tmp[5 + idx] << 16) | tmp[4 + idx];
  410. pwr->power = val / 1000.0;
  411. val = (tmp[7 + idx] << 16) | tmp[6 + idx];
  412. pwr->freq = val / 1000.0;
  413. val = (tmp[9 + idx] << 16) | tmp[8 + idx];
  414. pwr->consump = val / 1000.0;
  415. val = (tmp[11 + idx] << 16) | tmp[10 + idx];
  416. pwr->factor = val / 1000.0;
  417. pbrd->pch[i].time = tm;
  418. }
  419. offset = POWER_AC_STAT_INFO_L;
  420. memset(tmp,0,sizeof(tmp));
  421. r = read_reg(h, pbrd->addr, offset, tmp, pbrd->chs);
  422. if (r<0) {
  423. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, pbrd->chs);
  424. break;
  425. }
  426. for (i=0; i<pbrd->chs; i++) {
  427. pch = &pbrd->pch[i];
  428. pch->power[0].status = tmp[i] & (0x01);
  429. pch->alarm.v_upper = (tmp[i] & BIT(2))?1:0;
  430. pch->alarm.v_lower = (tmp[i] & BIT(4))?1:0;
  431. pch->alarm.c_upper = (tmp[i] & BIT(6))?1:0;
  432. pch->alarm.p_upper = (tmp[i] & BIT(8))?1:0;
  433. pch->alarm.w_upper = (tmp[i] & BIT(10))?1:0;
  434. pch->alarm.ph_loss = 0;
  435. }
  436. offset = POWER_AC_BREAKER_INFO;
  437. r = read_reg(h, pch->info.addr, offset, tmp, 1);
  438. if (r < 0) {
  439. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, pbrd->chs);
  440. break;
  441. }
  442. pbrd->brk[0].samp.sw = (tmp[0]&BIT(0))?1:0;
  443. pbrd->brk[0].samp.time = tm;
  444. pbrd->brk[1].samp.sw = (tmp[0]&BIT(1))?1:0;
  445. pbrd->brk[1].samp.time = tm;
  446. uint16_t buffer[16] = {0};
  447. for (i=0; i<pbrd->chs; i++) {
  448. pch = &pbrd->pch[i];
  449. offset = POWER_AC_THRESHOLD_L+i*16;
  450. r = read_reg(h, pch->info.addr, offset, buffer, 16);
  451. if(r) break;
  452. pch->thr.v_upper.val = ((buffer[1]<<16)|buffer[0])/1000;
  453. pch->thr.v_lower.val = ((buffer[3]<<16)|buffer[2])/1000;
  454. pch->thr.c_upper.val = ((buffer[5]<<16)|buffer[4])/1000;
  455. pch->thr.p_upper.val = ((buffer[9]<<16)|buffer[8])/1000;
  456. pch->thr.w_upper.val = ((buffer[13]<<16)|buffer[12])/1000;
  457. }
  458. }
  459. break;
  460. case DCPDU_TYPE:
  461. {
  462. uint32_t flag;
  463. uint16_t *ptmp = tmp + 32;
  464. offset = POWER_DC_OUT_INFO + 16;
  465. r = read_reg(h, pbrd->addr, offset, ptmp, 32);
  466. if (r<0) {
  467. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, 32);
  468. break;
  469. }
  470. for (i = 0; i < pbrd->chs; i++) {
  471. int Index = i * 8;
  472. pwr = &pbrd->pch[i].power[0];
  473. float value = (tmp[1 + Index] << 16) + tmp[0 + Index];
  474. pwr->voltage = value / 1000.0;
  475. value = (tmp[3 + Index] << 16) + tmp[2 + Index];
  476. pwr->current = value / 1000.0;
  477. value = (tmp[5 + Index] << 16) + tmp[4 + Index];
  478. pwr->power = value / 1000.0;
  479. value = (tmp[7 + Index] << 16) + tmp[6 + Index];
  480. pwr->consump = value / 1000.0;
  481. pwr->freq = 0;
  482. pwr->factor = 1;
  483. pbrd->pch[i].time = tm;
  484. }
  485. offset = POWER_DC_STAT_INFO;
  486. r = read_reg(h, pbrd->addr, offset, tmp, 2);
  487. if (r<0) {
  488. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, 2);
  489. break;
  490. }
  491. for (i = 0; i < pbrd->chs; i++) {
  492. flag = (tmp[1] << 16) + tmp[0];
  493. pbrd->pch[i].power[0].status = (flag >> i) & 0x1;
  494. }
  495. // 获取报警状态
  496. offset = POWER_DC_WARNING;
  497. r = read_reg(h, pbrd->addr, offset, tmp, 16);
  498. if (r<0) {
  499. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, 16);
  500. break;
  501. }
  502. for (i = 0; i < pbrd->chs; i++) {
  503. int Index = i * 2;
  504. pch = &pbrd->pch[i];
  505. pch->alarm.v_upper = (tmp[0+Index] & BIT(0))?1:0;
  506. pch->alarm.v_lower = (tmp[0+Index] & BIT(1))?1:0;
  507. pch->alarm.c_upper = (tmp[0+Index] & BIT(2))?1:0;
  508. pch->alarm.p_upper = (tmp[0+Index] & BIT(3))?1:0;
  509. pch->alarm.w_upper = (tmp[0+Index] & BIT(4))?1:0;
  510. }
  511. }
  512. break;
  513. case TREE_AC_TYPE:
  514. {
  515. uint8_t v=0;
  516. offset = POWER_AC3_OUT_INFO;
  517. r = read_reg(h, pbrd->addr, offset, tmp, 80);
  518. if (r < 0) {
  519. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, 80);
  520. break;
  521. }
  522. offset = POWER_AC3_OUT_INFO+40;
  523. uint16_t* ptmp=tmp+80;
  524. r = read_reg(h, pbrd->addr, offset, ptmp, 64);
  525. if (r < 0) {
  526. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, 64);
  527. break;
  528. }
  529. for (i=0; i<pbrd->chs; i++) {
  530. if(h->prod->type==PDU_AC_I3O3) {
  531. int index_2 = 0;
  532. for(int j = 0; j < 3;j++)
  533. {
  534. pwr = &pbrd->pch[i].power[j];
  535. index_2 = (j*16) + (48*i);
  536. pwr->voltage = ((tmp[1+index_2] << 16) + tmp[0+index_2])/1000.0f;
  537. pwr->current = ((tmp[3+index_2] << 16) + tmp[2+index_2])/1000.0f;
  538. pwr->power = ((tmp[5+index_2] << 16) + tmp[4+index_2])/1000.0f;
  539. pwr->freq = ((tmp[11+index_2] << 16) + tmp[10+index_2])/1000.0f;
  540. pwr->consump = ((tmp[13+index_2] << 16) + tmp[12+index_2])/1000.0f;
  541. pwr->factor = ((tmp[15+index_2] << 16) + tmp[14+index_2])/1000.0f;
  542. }
  543. }else{
  544. int Index = i * 16;
  545. pwr = &pbrd->pch[i].power[0];
  546. float value = (tmp[1+Index] << 16) + tmp[0+Index];
  547. pwr->voltage = value / 1000.0f;
  548. value = (tmp[3+Index] << 16) + tmp[2+Index];
  549. pwr->current = value / 1000.0f;
  550. value = (tmp[5+Index] << 16) + tmp[4+Index];
  551. pwr->power = value / 1000.0f;
  552. value = (tmp[7+Index] << 16) + tmp[6+Index];
  553. value = (tmp[9+Index] << 16) + tmp[8+Index];
  554. value = (tmp[11+Index] << 16) + tmp[10+Index];
  555. pwr->freq = value / 1000.0f;
  556. value = (tmp[13+Index] << 16) + tmp[12+Index];
  557. pwr->consump = value / 1000.0f;
  558. value = (tmp[15+Index] << 16) + tmp[14+Index];
  559. pwr->factor = value / 1023.0f;
  560. pbrd->pch[i].time = tm;
  561. }
  562. }
  563. //获取通道开关状态及零线状态
  564. offset = POWER_AC3_OUT_ENABLE;
  565. r = read_reg(h, pbrd->addr, offset, tmp, 20);
  566. if (r < 0) {
  567. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, 20);
  568. break;
  569. }
  570. for (i=0; i<pbrd->chs; i++) {
  571. if(h->prod->type==PDU_AC_I3O3) {
  572. for(int j = 0; j < 3;j++)
  573. pbrd->pch[i].power[j].status = tmp[0+(j*2)+ (i*6)] & 0x01;
  574. pbrd->pch[i].power[0].nwire = tmp[18] & 0x01;
  575. }else {
  576. int Index = i * 2;
  577. pbrd->pch[i].power[0].status = tmp[0+Index] & 0x01;
  578. pbrd->pch[i].power[0].nwire = tmp[18] & 0x01;
  579. }
  580. }
  581. //获取故障状态
  582. offset = POWER_AC3_OUT_ERROR;
  583. r = read_reg(h, pbrd->addr, offset, tmp, 18);
  584. if (r < 0) {
  585. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, 18);
  586. break;
  587. }
  588. for (i=0; i<pbrd->chs; i++) {
  589. int Index = i * 2;
  590. pch = &pbrd->pch[i];
  591. pch->alarm.v_upper = (tmp[0+Index] & BIT(0))?1:0;
  592. pch->alarm.v_lower = (tmp[0+Index] & BIT(1))?1:0;
  593. pch->alarm.c_upper = (tmp[0+Index] & BIT(2))?1:0;
  594. pch->alarm.p_upper = (tmp[0+Index] & BIT(3))?1:0;
  595. pch->alarm.w_upper = (tmp[0+Index] & BIT(4))?1:0;
  596. }
  597. offset = POWER_AC3_ALARM_MISSING_PH;
  598. r = read_reg(h, pbrd->addr, offset, tmp, pbrd->chs);
  599. if (r < 0) {
  600. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, pbrd->chs);
  601. break;
  602. }
  603. v = 0;
  604. for(i = 0; i < 3; i++) {
  605. if(tmp[i * 2]>0) {
  606. v |= 1<<i;
  607. }
  608. }
  609. pbrd->ph_loss = v;
  610. offset = POWER_AC3_BREAKER_INFO;
  611. r = read_reg(h, pch->info.addr, offset, tmp, 1);
  612. if (r < 0) {
  613. LOGE("read_reg failed, addr:%d reg:0x%04x/%d cnt:%d\n", pbrd->addr, offset, offset, pbrd->chs);
  614. break;
  615. }
  616. pbrd->brk[0].samp.sw = (tmp[0]&BIT(0))?1:0;
  617. pbrd->brk[0].samp.time = tm;
  618. // read v max
  619. offset = POWER_AC3_THRESHOLD_VOL_MAX;
  620. r = read_reg(h, pch->info.addr, offset, tmp, 18);
  621. for (i=0; i<pbrd->chs; i++)
  622. {
  623. if(h->prod->type==PDU_AC_I3O3) {
  624. int Index = i * 3;
  625. int ch_idx = pbrd->ch0-1+i/3;
  626. pch = &pbrd->pch[ch_idx];
  627. pch->thr.v_upper.val = ((tmp[Index+1] << 16) + (tmp[Index+0])) / 1000;
  628. }
  629. else {
  630. pch = &pbrd->pch[i];
  631. pch->thr.v_upper.val = ((tmp[i+1] << 16) + (tmp[i+0])) / 1000;
  632. }
  633. }
  634. offset = POWER_AC3_THRESHOLD_VOL_MIN;
  635. r = read_reg(h, pch->info.addr, offset, tmp, 18);
  636. for (i=0; i<pbrd->chs; i++)
  637. {
  638. if(h->prod->type==PDU_AC_I3O3) {
  639. int Index = i * 3;
  640. int ch_idx = pbrd->ch0-1+i/3;
  641. pch = &pbrd->pch[ch_idx];
  642. pch->thr.v_lower.val = ((tmp[Index+1] << 16) + (tmp[Index+0])) / 1000;
  643. }
  644. else {
  645. pch = &pbrd->pch[i];
  646. pch->thr.v_lower.val = ((tmp[i+1] << 16) + (tmp[i+0])) / 1000;
  647. }
  648. }
  649. offset = POWER_AC3_THRESHOLD_CUR_MAX;
  650. r = read_reg(h, pch->info.addr, offset, tmp, 18);
  651. for (i=0; i<pbrd->chs; i++)
  652. {
  653. if(h->prod->type==PDU_AC_I3O3) {
  654. int Index = i * 3;
  655. int ch_idx = pbrd->ch0-1+i/3;
  656. pch = &pbrd->pch[ch_idx];
  657. pch->thr.c_upper.val = ((tmp[Index+1] << 16) + (tmp[Index+0])) / 1000;
  658. }
  659. else {
  660. pch = &pbrd->pch[i];
  661. pch->thr.c_upper.val = ((tmp[i+1] << 16) + (tmp[i+0])) / 1000;
  662. }
  663. }
  664. offset = POWER_AC3_THRESHOLD_PWR_MAX;
  665. r = read_reg(h, pch->info.addr, offset, tmp, 18);
  666. for (i=0; i<pbrd->chs; i++)
  667. {
  668. if(h->prod->type==PDU_AC_I3O3) {
  669. int Index = i * 3;
  670. int ch_idx = pbrd->ch0-1+i/3;
  671. pch = &pbrd->pch[ch_idx];
  672. pch->thr.p_upper.val = ((tmp[Index+1] << 16) + (tmp[Index+0])) / 1000;
  673. }
  674. else {
  675. pch = &pbrd->pch[i];
  676. pch->thr.p_upper.val = ((tmp[i+1] << 16) + (tmp[i+0])) / 1000;
  677. }
  678. }
  679. offset = POWER_AC3_THRESHOLD_PWRCON_MAX;
  680. r = read_reg(h, pch->info.addr, offset, tmp, 18);
  681. for (i=0; i<pbrd->chs; i++)
  682. {
  683. if(h->prod->type==PDU_AC_I3O3) {
  684. int Index = i * 3;
  685. int ch_idx = pbrd->ch0-1+i/3;
  686. pch = &pbrd->pch[ch_idx];
  687. pch->thr.w_upper.val = ((tmp[Index+1] << 16) + (tmp[Index+0])) / 1000;
  688. }
  689. else {
  690. pch = &pbrd->pch[i];
  691. pch->thr.w_upper.val = ((tmp[i+1] << 16) + (tmp[i+0])) / 1000;
  692. }
  693. }
  694. }
  695. break;
  696. case AC_MULTI_S_TYPE:
  697. case AC_MULTI_B_TYPE:
  698. case DC_OUT_TYPE:
  699. case DC_IN_TYPE:
  700. default:
  701. r = -1;
  702. break;
  703. }
  704. if(r==0) {
  705. threshold_proc(h, pbrd);
  706. }
  707. }
  708. lock_off(h->lck);
  709. return r;
  710. }
  711. static int power_copy(power_handle_t *h)
  712. {
  713. int i,r=-1;
  714. power_all_t *pd=&h->all;
  715. if(h->chs>0) {
  716. if(!pd->pch || pd->chs!=h->chs) {
  717. if(pd->pch) free(pd->pch);
  718. pd->chs = 0;
  719. pd->pch = malloc(sizeof(power_ch_t)*h->chs);
  720. }
  721. if(pd->pch) {
  722. pd->chs = h->chs;
  723. for(i=0; i<pd->chs; i++) {
  724. pd->pch[i] = *h->pch[i];
  725. }
  726. }
  727. }
  728. pd->ttl = h->ttl;
  729. return 0;
  730. }
  731. static int board_query(power_handle_t *h)
  732. {
  733. int i,r;
  734. for(i=0; i<h->brd_max; i++) {
  735. r = board_read(h, h->pbrd[i]);
  736. }
  737. total_proc(h);
  738. power_copy(h);
  739. return r;
  740. }
  741. static void power_thread(void *arg)
  742. {
  743. int r;
  744. board_data_t *pbrd=NULL;
  745. thread_handle_t *th=(thread_handle_t*)arg;
  746. power_handle_t *h=(power_handle_t*)th->attr->arg;;
  747. while(th->quit==0) {
  748. board_query(h);
  749. sleep(1);
  750. }
  751. }
  752. int power_init(void)
  753. {
  754. power_handle_t *h=&pwrHandle;
  755. paras_data_t *p=paras_get();
  756. mb_para_t para={
  757. .mode = MB_MODE_MASTER,
  758. .type = MB_TYPE_RTU,
  759. .para = {
  760. .rtu = {
  761. .dev = POWER_PORT, //设备名
  762. .baudrate = 115200, //波特率
  763. .parity = 0, //校验位
  764. .pin = -1, //收发控制引脚, <0 表示不使用
  765. .lvl = 0, //发送控制电平
  766. }
  767. }
  768. };
  769. memset(h, 0, sizeof(power_handle_t));
  770. h->lck = lock_init();
  771. h->cur_addr = 0;
  772. h->brd_max = POWER_BOARD_MAX;
  773. h->prod = &p->prod;
  774. power_scan();
  775. thread_start(THREAD_ID_POWER, power_thread, h);
  776. return 0;
  777. }
  778. int power_deinit(void)
  779. {
  780. power_handle_t *h=&pwrHandle;
  781. lock_deinit(h->lck);
  782. return 0;
  783. }
  784. static power_ch_t* get_ch(power_handle_t *h, uint8_t ch)
  785. {
  786. if(!h->pch || !h->chs || !h->pch[ch]) {
  787. return NULL;
  788. }
  789. return h->pch[ch];
  790. }
  791. int power_get_ch(uint8_t ch, power_ch_t *pch)
  792. {
  793. int r=-1;
  794. power_ch_t *p=NULL;
  795. power_handle_t *h=&pwrHandle;
  796. lock_on(h->lck);
  797. p = get_ch(h, ch);
  798. if(p && pch) {
  799. *pch = *p;
  800. r = 0;
  801. }
  802. lock_off(h->lck);
  803. return r;
  804. }
  805. int power_get_board(board_data_t *pbrd)
  806. {
  807. power_handle_t *h=&pwrHandle;
  808. lock_on(h->lck);
  809. if(!pbrd || !h->pch || !h->cnt || !h->pbrd[pbrd->addr]) {
  810. lock_off(h->lck);
  811. return -1;
  812. }
  813. *pbrd = *h->pbrd[pbrd->addr];
  814. lock_off(h->lck);
  815. return 0;
  816. }
  817. int power_set(int ch, power_ch_t *pch)
  818. {
  819. power_handle_t *h=&pwrHandle;
  820. lock_on(h->lck);
  821. if(!pch || !h->pch || !h->chs || !h->pch[pch->info.ch]) {
  822. lock_off(h->lck);
  823. return -1;
  824. }
  825. *h->pch[pch->info.ch] = *pch;
  826. lock_off(h->lck);
  827. return 0;
  828. }
  829. static int power_map(power_handle_t *h, int chs)
  830. {
  831. int i,j,r,idx=1;
  832. board_data_t *pbrd=NULL;
  833. uint8_t pwr_type=paras_get()->prod.type;
  834. if(chs>0) {
  835. h->chs = 0;
  836. h->pch = (power_ch_t**)calloc(1, sizeof(power_ch_t*)*chs);
  837. if(h->pch) {
  838. h->chs = chs;
  839. h->pch[0] = &h->ch0;
  840. strcpy(h->pch[0]->info.name, "ALL");
  841. for(i=1; i<=h->brd_max; i++) {
  842. pbrd = h->pbrd[i];
  843. if(pbrd) {
  844. for(j=0; j<pbrd->chs; j++) {
  845. h->pch[idx] = &h->pbrd[i]->pch[j];
  846. h->pch[idx]->pbrd = h->pbrd[i];
  847. sprintf(h->pch[idx]->info.name, "CH%d", idx);
  848. idx++;
  849. }
  850. }
  851. }
  852. }
  853. }
  854. return 0;
  855. }
  856. static int power_clear(power_handle_t *h)
  857. {
  858. int i,j;
  859. memset(&h->ch0, 0, sizeof(h->ch0));
  860. for(i=0; i<=h->brd_max; i++) {
  861. if(h->pbrd[i]) {
  862. for(j=0; j<h->pbrd[i]->chs; j++) {
  863. if(h->pbrd[i]->pch) {
  864. free(h->pbrd[i]->pch);
  865. h->pbrd[i]->pch = NULL;
  866. }
  867. h->pbrd[i]->chs = 0;
  868. }
  869. free(h->pbrd[i]);
  870. h->pbrd[i] = NULL;
  871. }
  872. }
  873. memset(h->key, 0, sizeof(h->key));
  874. h->cnt = 0;
  875. h->cur_addr = 0;
  876. return 0;
  877. }
  878. int power_scan(void)
  879. {
  880. int r,i,j,total_chs=1;
  881. int ch_idx=1,brd_idx=0;
  882. power_ch_t *pch=NULL;
  883. board_key_t *pkey=NULL;
  884. board_data_t *pbrd=NULL;
  885. power_handle_t *h=&pwrHandle;
  886. uint16_t times,nGroups=h->prod->ch_delay;
  887. lock_on(h->lck);
  888. power_clear(h);
  889. pch = &h->ch0;
  890. pch->info.addr = 0;
  891. pch->info.ch = 0;
  892. for(i=1; i<=h->brd_max; i++) {
  893. r = get_key(h, i, &h->key[i]);
  894. if(r==0) {
  895. LOGD("___ power_scan addr %d ok, type: %d, chs: %d\n", i, h->key[i].type, h->key[i].chs);
  896. h->cnt++;
  897. }
  898. else {
  899. LOGE("___ power_scan addr %d failed\n", i);
  900. }
  901. }
  902. for(i=1; i<h->brd_max; i++) {
  903. pkey = &h->key[i];
  904. if(pkey->chs>0) {
  905. pbrd = (board_data_t*)calloc(1, sizeof(board_data_t));
  906. if(!pbrd) {
  907. LOGE("___ power_scan, calloc pbrd %d failed\n", i);
  908. return -1;
  909. }
  910. pbrd->fn = board_fn;
  911. pbrd->type = pkey->type;
  912. pbrd->chs = pkey->chs;
  913. pbrd->addr = i;
  914. pbrd->ch0 = ch_idx;
  915. pch = (power_ch_t*)calloc(1, sizeof(power_ch_t)*pkey->chs);
  916. if(!pch) {
  917. LOGE("___ power_scan, calloc pch failed\n");
  918. return -1;
  919. }
  920. for(j=0; j<pkey->chs; j++) {
  921. pch[j].info.addr = i;
  922. pch[j].info.sch = j; //序号从0开始
  923. pch[j].info.type = pkey->type;
  924. if(h->prod->type==PDU_AC_I3O3) {
  925. pch[j].info.ch = ch_idx+j/3; //序号从1开始, 发给控制板需从0开始
  926. pch[j].info.ph_id = j%3;
  927. }
  928. else {
  929. pch[j].info.ch = ch_idx+j; //序号从1开始, 发给控制板需从0开始
  930. pch[j].info.ph_id = 0;
  931. }
  932. times = (pch[j].info.ch%nGroups)?pch[j].info.ch:nGroups;
  933. pch[j].info.open_delay = 1000*times;
  934. pch[j].info.close_delay = 1000*times;
  935. }
  936. if(pbrd->type==AC_SINGLE_S_TYPE || pbrd->type==AC_SINGLE_B_TYPE) {
  937. pbrd->brk[0].info.addr = pbrd->brk[1].info.addr = pbrd->addr;
  938. }
  939. else if(pbrd->type==TREE_AC_TYPE) {
  940. pbrd->brk[0].info.addr = pbrd->addr;
  941. }
  942. if(h->prod->type==PDU_AC_I3O3) {
  943. ch_idx += pkey->chs/3;
  944. }
  945. else {
  946. ch_idx += pkey->chs;
  947. }
  948. brd_idx++;
  949. pbrd->pch = pch;
  950. h->pbrd[i] = pbrd;
  951. total_chs += pkey->chs;
  952. }
  953. }
  954. power_map(h, total_chs);
  955. lock_off(h->lck);
  956. return 0;
  957. }
  958. int power_reset(void)
  959. {
  960. int i,r=-1;
  961. uint16_t offset = 0;
  962. power_handle_t *h=&pwrHandle;
  963. board_data_t *pbrd=NULL;
  964. lock_on(h->lck);
  965. for(i=0; i<=h->brd_max; i++) {
  966. pbrd = h->pbrd[i];
  967. if(pbrd) {
  968. switch(pbrd->type) {
  969. case AC_SINGLE_S_TYPE:
  970. case AC_SINGLE_B_TYPE:
  971. {
  972. uint16_t tmp[8];
  973. offset = POWER_AC_CH_STAT_L;
  974. for(i=1; i<=pbrd->chs; i++) {
  975. tmp[i] = pbrd->pch[i].power[0].status;
  976. }
  977. r = write_reg(h, pbrd->addr, offset, tmp+1, pbrd->chs-1);
  978. }
  979. break;
  980. case DCPDU_TYPE:
  981. {
  982. offset = POWER_DC_ALARM_CTRL_TOTAL;
  983. }
  984. break;
  985. case TREE_AC_TYPE:
  986. {
  987. uint16_t data_temp[20];
  988. offset = POWER_AC3_RESET_CONSUMP;
  989. data_temp[0] = data_temp[1] = data_temp[2] = 1;
  990. r = write_reg(h, pbrd->addr, offset, data_temp, 3);
  991. if (r<0) {
  992. break;
  993. }
  994. //初始化报警阈值
  995. uint32_t value = 0;
  996. memset(data_temp, 0, sizeof(data_temp));
  997. offset = POWER_AC3_THRESHOLD_VOL_MAX;
  998. r = write_reg(h, pbrd->addr, offset, data_temp, 18);
  999. if (r<0) {
  1000. break;
  1001. }
  1002. offset = POWER_AC3_THRESHOLD_VOL_MIN;
  1003. r = write_reg(h, pbrd->addr, offset, data_temp, 18);
  1004. if (r<0) {
  1005. break;
  1006. }
  1007. offset = POWER_AC3_THRESHOLD_CUR_MAX;
  1008. r = write_reg(h, pbrd->addr, offset, data_temp, 18);
  1009. if (r<0) {
  1010. break;
  1011. }
  1012. offset = POWER_AC3_THRESHOLD_PWR_MAX;
  1013. r = write_reg(h, pbrd->addr, offset, data_temp, 18);
  1014. if (r<0) {
  1015. break;
  1016. }
  1017. offset = POWER_AC3_THRESHOLD_PWRCON_MAX;
  1018. r = write_reg(h, pbrd->addr, offset, data_temp, 18);
  1019. if (r<0) {
  1020. break;
  1021. }
  1022. for (i=1; i<=pbrd->chs; i++) {
  1023. memset(data_temp, 0, sizeof(data_temp));
  1024. offset = POWER_AC3_OUT_ENABLE + i;
  1025. data_temp[0] = pbrd->pch[i].power[0].status;
  1026. r = write_reg(h, pbrd->addr, offset, data_temp, 2);
  1027. }
  1028. }
  1029. break;
  1030. }
  1031. }
  1032. }
  1033. lock_off(h->lck);
  1034. return r;
  1035. }
  1036. int power_set_ch_sw_n(power_ch_t *pch)
  1037. {
  1038. int r;
  1039. uint16_t st= pch->power[0].status,offset,tmp[2]={0};
  1040. power_handle_t *h=&pwrHandle;
  1041. lock_on(h->lck);
  1042. if (pch->thr.v_upper.en == 1)
  1043. st |= ENABLE_AC3_V_UP;
  1044. if (pch->thr.v_lower.en == 1)
  1045. st |= ENABLE_AC3_V_DOWN;
  1046. if (pch->thr.c_upper.en == 1)
  1047. st |= ENABLE_AC3_C_UP;
  1048. if (pch->thr.p_upper.en == 1)
  1049. st |= ENABLE_AC3_P_UP;
  1050. if (pch->thr.w_upper.en == 1)
  1051. st |= ENABLE_AC3_W_UP;
  1052. switch(pch->info.type) {
  1053. case AC_SINGLE_S_TYPE:
  1054. case AC_SINGLE_B_TYPE:
  1055. {
  1056. offset = POWER_AC_CH_STAT_L + pch->info.ch-1;
  1057. tmp[0] = st;
  1058. r = write_reg(h, pch->info.addr, offset, tmp, 1);
  1059. }
  1060. break;
  1061. case DCPDU_TYPE:
  1062. {
  1063. uint16_t mask;
  1064. offset = POWER_DC_STAT_INFO+pch->info.ch-1;
  1065. mask = ~(1 << (pch->info.ch-1));
  1066. tmp[0] &= mask;
  1067. tmp[0] |= (st << (pch->info.ch-1));
  1068. r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1069. }
  1070. break;
  1071. case TREE_AC_TYPE:
  1072. {
  1073. uint16_t reg;
  1074. uint8_t type=paras_get()->prod.type;
  1075. if(type==PDU_AC_I3O3 || type==PDU_AC_I3O1) {
  1076. reg = POWER_AC3_CH_OUT_ENABLE;
  1077. }
  1078. else {
  1079. reg = POWER_AC3_OUT_ENABLE;
  1080. }
  1081. tmp[0] = st;
  1082. offset = reg+pch->info.ch-1;
  1083. r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1084. }
  1085. break;
  1086. }
  1087. lock_off(h->lck);
  1088. }
  1089. int power_set_ch_sw(uint8_t ch, uint8_t on)
  1090. {
  1091. int r;
  1092. power_ch_t *pch;
  1093. power_handle_t *h=&pwrHandle;
  1094. uint16_t offset,tmp[2]={0},st=on;
  1095. lock_on(h->lck);
  1096. pch = get_ch(h, ch);
  1097. if(!pch) {
  1098. lock_off(h->lck);
  1099. return -1;
  1100. }
  1101. if (pch->thr.v_upper.en == 1)
  1102. st |= ENABLE_AC3_V_UP;
  1103. if (pch->thr.v_lower.en == 1)
  1104. st |= ENABLE_AC3_V_DOWN;
  1105. if (pch->thr.c_upper.en == 1)
  1106. st |= ENABLE_AC3_C_UP;
  1107. if (pch->thr.p_upper.en == 1)
  1108. st |= ENABLE_AC3_P_UP;
  1109. if (pch->thr.w_upper.en == 1)
  1110. st |= ENABLE_AC3_W_UP;
  1111. switch(pch->info.type) {
  1112. case AC_SINGLE_S_TYPE:
  1113. case AC_SINGLE_B_TYPE:
  1114. {
  1115. offset = POWER_AC_CH_STAT_L + pch->info.ch-1;
  1116. tmp[0] = st;;
  1117. r = write_reg(h, pch->info.addr, offset, tmp, 1);
  1118. }
  1119. break;
  1120. case DCPDU_TYPE:
  1121. {
  1122. uint16_t mask;
  1123. offset = POWER_DC_STAT_INFO+pch->info.ch-1;
  1124. mask = ~(1 << (pch->info.ch-1));
  1125. tmp[0] &= mask;
  1126. tmp[0] |= (st << (pch->info.ch-1));
  1127. r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1128. }
  1129. break;
  1130. case TREE_AC_TYPE:
  1131. {
  1132. uint16_t reg;
  1133. uint8_t type=paras_get()->prod.type;
  1134. if(type==PDU_AC_I3O3 || type==PDU_AC_I3O1) {
  1135. reg = POWER_AC3_CH_OUT_ENABLE;
  1136. }
  1137. else {
  1138. reg = POWER_AC3_OUT_ENABLE;
  1139. }
  1140. tmp[0] = st;
  1141. offset = reg + +pch->info.ch-1;
  1142. r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1143. }
  1144. break;
  1145. }
  1146. lock_off(h->lck);
  1147. return r;
  1148. }
  1149. int power_set_board_sw(uint8_t addr, uint8_t on)
  1150. {
  1151. int i,r;
  1152. power_ch_t *pch;
  1153. board_data_t *pbrd;
  1154. power_handle_t *h=&pwrHandle;
  1155. pbrd = h->pbrd[addr];
  1156. if(!pbrd) {
  1157. return -1;
  1158. }
  1159. for(i=0; i<pbrd->chs; i++) {
  1160. power_set_ch_sw(pbrd->pch[i].info.ch, on);
  1161. }
  1162. return 0;
  1163. }
  1164. int power_set_all_sw(uint8_t on)
  1165. {
  1166. int i,r;
  1167. power_handle_t *h=&pwrHandle;
  1168. for(i=1; i<=h->chs; i++) {
  1169. power_set_ch_sw(i, on);
  1170. }
  1171. return 0;
  1172. }
  1173. int power_set_alarm(power_ch_t *pch)
  1174. {
  1175. int r=0;
  1176. uint16_t offset = 0;
  1177. uint16_t nStatus = 0;
  1178. power_handle_t *h=&pwrHandle;
  1179. lock_on(h->lck);
  1180. switch(pch->info.type) {
  1181. case AC_SINGLE_S_TYPE:
  1182. case AC_SINGLE_B_TYPE:
  1183. {
  1184. if (pch->info.ch==0) {
  1185. offset = POWER_AC_ALARM_CTRL_TOTAL;
  1186. }
  1187. else {
  1188. offset = POWER_AC_ALARM_CTRL + pch->info.ch-1;
  1189. }
  1190. }
  1191. break;
  1192. case DCPDU_TYPE:
  1193. {
  1194. if (pch->info.ch==0) {
  1195. offset = POWER_DC_ALARM_CTRL_TOTAL;
  1196. }
  1197. else {
  1198. offset = POWER_DC_ALARM_CTRL + pch->info.ch-1;
  1199. }
  1200. }
  1201. break;
  1202. case TREE_AC_TYPE:
  1203. {
  1204. if (pch->info.ch==0) {
  1205. offset = POWER_AC3_ALARM_CTRL_TOTAL;
  1206. }
  1207. else {
  1208. offset = POWER_AC3_ALARM_CTRL + pch->info.ch-1;
  1209. }
  1210. }
  1211. break;
  1212. default:
  1213. r = -1;
  1214. }
  1215. if(r==0) {
  1216. if(pch->thr.v_upper.act==ALARM_ACT_CLOSE_CH) nStatus |= BIT(1);
  1217. if(pch->thr.v_lower.act==ALARM_ACT_CLOSE_CH) nStatus |= BIT(2);
  1218. if(pch->thr.c_upper.act==ALARM_ACT_CLOSE_CH) nStatus |= BIT(0);
  1219. if(pch->thr.p_upper.act==ALARM_ACT_CLOSE_CH) nStatus |= BIT(3);
  1220. if(pch->thr.w_upper.act==ALARM_ACT_CLOSE_CH) nStatus |= BIT(4);
  1221. r = write_reg(h, pch->info.addr, offset, &nStatus, 1);
  1222. }
  1223. lock_off(h->lck);
  1224. return r;
  1225. }
  1226. int power_get_threshold(power_ch_t *pch)
  1227. {
  1228. int i,r=0;
  1229. uint16_t offset;
  1230. power_ch_t *pch2=NULL;
  1231. power_handle_t *h=&pwrHandle;
  1232. lock_on(h->lck);
  1233. pch2 = get_ch(h, pch->info.ch);
  1234. pch2->thr = pch->thr;
  1235. switch(pch->info.type) {
  1236. case AC_SINGLE_S_TYPE:
  1237. case AC_SINGLE_B_TYPE:
  1238. {
  1239. uint16_t offset = 0;
  1240. uint32_t temp = 0 ;
  1241. uint16_t buffer[16] = {0};
  1242. if(pch->info.ch==0) {
  1243. offset = POWER_AC_TOTAL_THRESHOLD;
  1244. }
  1245. else {
  1246. offset = POWER_AC_THRESHOLD_L+(pch->info.ch-1)*16;
  1247. }
  1248. r = read_reg(h, pch->info.addr, offset, buffer, 16);
  1249. if(r) break;
  1250. pch->thr.v_upper.val = ((buffer[1]<<16)|buffer[0])/1000;
  1251. pch->thr.v_lower.val = ((buffer[3]<<16)|buffer[2])/1000;
  1252. pch->thr.c_upper.val = ((buffer[5]<<16)|buffer[4])/1000;
  1253. pch->thr.p_upper.val = ((buffer[9]<<16)|buffer[8])/1000;
  1254. pch->thr.w_upper.val = ((buffer[13]<<16)|buffer[12])/1000;
  1255. }
  1256. break;
  1257. case DCPDU_TYPE:
  1258. {
  1259. uint16_t temp[4];
  1260. uint32_t value;
  1261. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_VOL_MAX:POWER_DC_THRESHOLD_VOL_MAX;
  1262. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1263. if(r) break;
  1264. pch->thr.v_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1265. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_VOL_MIN:POWER_DC_THRESHOLD_VOL_MIN;
  1266. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1267. if(r) break;
  1268. pch->thr.v_lower.val = ((temp[1]<<16)|temp[0])/1000;
  1269. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_CUR_MAX:POWER_DC_THRESHOLD_CUR_MAX;
  1270. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1271. if(r) break;
  1272. pch->thr.c_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1273. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_PWR_MAX:POWER_DC_THRESHOLD_POWER_MAX;
  1274. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1275. if(r) break;
  1276. pch->thr.p_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1277. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_PWRCON_MAX:POWER_DC_THRESHOLD_POWERCON_MAX;
  1278. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1279. if(r) break;
  1280. pch->thr.w_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1281. }
  1282. break;
  1283. case TREE_AC_TYPE:
  1284. {
  1285. uint16_t temp[4];
  1286. uint32_t value;
  1287. if(pch->info.ch==0) {
  1288. offset = POWER_AC3_THRESHOLD_IN;
  1289. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1290. if(r) break;
  1291. pch->thr.v_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1292. r = read_reg(h, pch->info.addr, offset+1, temp, 2);
  1293. if(r) break;
  1294. pch->thr.v_lower.val = ((temp[1]<<16)|temp[0])/1000;
  1295. r = read_reg(h, pch->info.addr, offset+2, temp, 2);
  1296. if(r) break;
  1297. pch->thr.c_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1298. r = read_reg(h, pch->info.addr, offset+3, temp, 2);
  1299. if(r) break;
  1300. pch->thr.p_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1301. r = read_reg(h, pch->info.addr, offset+4, temp, 2);
  1302. pch->thr.w_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1303. }
  1304. else {
  1305. offset = POWER_AC3_THRESHOLD_VOL_MAX;
  1306. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1307. if(r) break;
  1308. pch->thr.v_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1309. offset = POWER_AC3_THRESHOLD_VOL_MIN;
  1310. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1311. if(r) break;
  1312. pch->thr.v_lower.val = ((temp[1]<<16)|temp[0])/1000;
  1313. offset = POWER_AC3_THRESHOLD_CUR_MAX;
  1314. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1315. if(r) break;
  1316. pch->thr.c_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1317. offset = POWER_AC3_THRESHOLD_PWR_MAX;
  1318. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1319. if(r) break;
  1320. pch->thr.p_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1321. offset = POWER_AC3_THRESHOLD_VOL_MAX;
  1322. r = read_reg(h, pch->info.addr, offset, temp, 2);
  1323. if(r) break;
  1324. pch->thr.p_upper.val = ((temp[1]<<16)|temp[0])/1000;
  1325. }
  1326. }
  1327. break;
  1328. default:
  1329. r = -1;
  1330. break;
  1331. }
  1332. lock_off(h->lck);
  1333. return r;
  1334. }
  1335. int power_set_threshold(power_ch_t *pch)
  1336. {
  1337. int r=0;
  1338. uint16_t offset;
  1339. power_ch_t *pch2=NULL;
  1340. power_handle_t *h=&pwrHandle;
  1341. lock_on(h->lck);
  1342. pch2 = get_ch(h, pch->info.ch);
  1343. pch2->thr = pch->thr;
  1344. switch(pch->info.type) {
  1345. case AC_SINGLE_S_TYPE:
  1346. case AC_SINGLE_B_TYPE:
  1347. {
  1348. uint16_t offset = 0;
  1349. uint32_t data_temp = 0 ;
  1350. uint16_t data_buf[16] = {0};
  1351. //电压上限
  1352. data_temp = (pch->thr.v_upper.val*1000);
  1353. data_buf[0] = data_temp;
  1354. data_buf[1] = data_temp>>16;
  1355. //电压下限
  1356. data_temp = (pch->thr.v_lower.val*1000);
  1357. data_buf[2] = data_temp;
  1358. data_buf[3] = data_temp>>16;
  1359. //电流上限
  1360. data_temp = (pch->thr.c_upper.val*1000);
  1361. data_buf[4] = data_temp;
  1362. data_buf[5] = data_temp>>16;
  1363. //电流下限
  1364. data_temp = (0);
  1365. data_buf[6] = data_temp;
  1366. data_buf[7] = data_temp>>16;
  1367. //功率上限
  1368. data_temp = (pch->thr.p_upper.val*1000);
  1369. data_buf[8] = data_temp;
  1370. data_buf[9] = data_temp>>16;
  1371. //功率下限
  1372. data_temp = 0;
  1373. data_buf[10] = data_temp;
  1374. data_buf[11] = data_temp>>16;
  1375. //电能上限
  1376. data_temp = (pch->thr.w_upper.val*1000);
  1377. data_buf[12] = data_temp;
  1378. data_buf[13] = data_temp>>16;
  1379. //电能下限
  1380. data_temp = 0;
  1381. data_buf[14] = data_temp;
  1382. data_buf[15] = data_temp>>16;
  1383. if(pch->info.ch==0) {
  1384. offset = POWER_AC_TOTAL_THRESHOLD;
  1385. }
  1386. else {
  1387. offset = POWER_AC_THRESHOLD_L+(pch->info.ch-1)*16;
  1388. }
  1389. r = write_reg(h, pch->info.addr, offset, data_buf, 16);
  1390. if(r==0) {
  1391. r = power_set_alarm(pch);
  1392. }
  1393. }
  1394. break;
  1395. case DCPDU_TYPE:
  1396. {
  1397. uint16_t data_temp[4];
  1398. uint32_t value;
  1399. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_VOL_MAX:POWER_DC_THRESHOLD_VOL_MAX;
  1400. value = pch->thr.v_upper.val * 1000;
  1401. data_temp[0] = value & 0XFFFF;
  1402. data_temp[1] = (value >> 16) & 0xFFFF;
  1403. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1404. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_VOL_MIN:POWER_DC_THRESHOLD_VOL_MIN;
  1405. value = pch->thr.v_lower.val * 1000;
  1406. data_temp[0] = value & 0XFFFF;
  1407. data_temp[1] = (value >> 16) & 0xFFFF;
  1408. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1409. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_CUR_MAX:POWER_DC_THRESHOLD_CUR_MAX;
  1410. value = pch->thr.c_upper.val * 1000;
  1411. data_temp[0] = value & 0XFFFF;
  1412. data_temp[1] = (value >> 16) & 0xFFFF;
  1413. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1414. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_PWR_MAX:POWER_DC_THRESHOLD_POWER_MAX;
  1415. value = pch->thr.p_upper.val * 1000;
  1416. data_temp[0] = value & 0XFFFF;
  1417. data_temp[1] = (value >> 16) & 0xFFFF;
  1418. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1419. offset = (pch->info.ch==0)?POWER_DC_THRESHOLD_TOTAL_PWRCON_MAX:POWER_DC_THRESHOLD_POWERCON_MAX;
  1420. value = pch->thr.w_upper.val * 1000;
  1421. data_temp[0] = value & 0XFFFF;
  1422. data_temp[1] = (value >> 16) & 0xFFFF;
  1423. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1424. if(r==0) {
  1425. r = power_set_alarm(pch);
  1426. }
  1427. }
  1428. break;
  1429. case TREE_AC_TYPE:
  1430. {
  1431. uint16_t data_temp[4];
  1432. uint32_t value;
  1433. if(pch->info.ch<0) {
  1434. offset = POWER_AC3_THRESHOLD_IN;
  1435. value = pch->thr.v_upper.val * 1000;
  1436. data_temp[0] = value & 0XFFFF;
  1437. data_temp[1] = (value >> 16) & 0xFFFF;
  1438. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1439. value = pch->thr.v_upper.val * 1000;
  1440. data_temp[0] = value & 0XFFFF;
  1441. data_temp[1] = (value >> 16) & 0xFFFF;
  1442. r = write_reg(h, pch->info.addr, offset+1, data_temp, 2);
  1443. value = pch->thr.c_upper.val * 1000;
  1444. data_temp[0] = value & 0XFFFF;
  1445. data_temp[1] = (value >> 16) & 0xFFFF;
  1446. r = write_reg(h, pch->info.addr, offset+2, data_temp, 2);
  1447. value = pch->thr.p_upper.val * 1000;
  1448. data_temp[0] = value & 0XFFFF;
  1449. data_temp[1] = (value >> 16) & 0xFFFF;
  1450. r = write_reg(h, pch->info.addr, offset+3, data_temp, 2);
  1451. value = pch->thr.w_upper.val * 1000;
  1452. data_temp[0] = value & 0XFFFF;
  1453. data_temp[1] = (value >> 16) & 0xFFFF;
  1454. r = write_reg(h, pch->info.addr, offset+4, data_temp, 2);
  1455. }
  1456. else
  1457. {
  1458. offset = POWER_AC3_THRESHOLD_VOL_MAX;
  1459. value = pch->thr.v_upper.val * 1000;
  1460. data_temp[0] = value & 0XFFFF;
  1461. data_temp[1] = (value >> 16) & 0xFFFF;
  1462. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1463. if(h->prod->type==PDU_AC_I3O3) {
  1464. offset +=1;
  1465. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1466. offset +=1;
  1467. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1468. }
  1469. offset = POWER_AC3_THRESHOLD_VOL_MIN;
  1470. value = pch->thr.v_lower.val * 1000;
  1471. data_temp[0] = value & 0XFFFF;
  1472. data_temp[1] = (value >> 16) & 0xFFFF;
  1473. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1474. if(h->prod->type==PDU_AC_I3O3) {
  1475. offset +=1;
  1476. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1477. offset +=1;
  1478. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1479. }
  1480. offset = POWER_AC3_THRESHOLD_CUR_MAX;
  1481. value = pch->thr.c_upper.val * 1000;
  1482. data_temp[0] = value & 0XFFFF;
  1483. data_temp[1] = (value >> 16) & 0xFFFF;
  1484. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1485. if(h->prod->type==PDU_AC_I3O3) {
  1486. offset +=1;
  1487. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1488. offset +=1;
  1489. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1490. }
  1491. offset = POWER_AC3_THRESHOLD_PWR_MAX;
  1492. value = pch->thr.p_upper.val * 1000;
  1493. data_temp[0] = value & 0XFFFF;
  1494. data_temp[1] = (value >> 16) & 0xFFFF;
  1495. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1496. if(h->prod->type==PDU_AC_I3O3) {
  1497. offset +=1;;
  1498. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1499. offset +=1;
  1500. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1501. }
  1502. offset = POWER_AC3_THRESHOLD_PWRCON_MAX;
  1503. value = pch->thr.w_upper.val * 1000;
  1504. data_temp[0] = value & 0XFFFF;
  1505. data_temp[1] = (value >> 16) & 0xFFFF;
  1506. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1507. if(h->prod->type==PDU_AC_I3O3) {
  1508. offset +=1;
  1509. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1510. offset +=1;
  1511. r = write_reg(h, pch->info.addr, offset, data_temp, 2);
  1512. }
  1513. if(r==0) {
  1514. r = power_set_alarm(pch);
  1515. }
  1516. }
  1517. }
  1518. break;
  1519. default:
  1520. r = -1;
  1521. break;
  1522. }
  1523. lock_off(h->lck);
  1524. return r;
  1525. }
  1526. int power_set_open_delay(power_ch_t *pch)
  1527. {
  1528. int r=-1;
  1529. uint16_t tmp[2],reg,offset;
  1530. power_handle_t *h=&pwrHandle;
  1531. lock_on(h->lck);
  1532. switch(pch->info.type) {
  1533. case AC_SINGLE_S_TYPE:
  1534. case AC_SINGLE_B_TYPE:
  1535. {
  1536. tmp[0] = pch->info.open_delay;
  1537. offset = POWER_AC_OPEN_DELAY_TIME_L+pch->info.ch-1;
  1538. r = write_reg(h, pch->info.addr, offset, tmp, 1);
  1539. }
  1540. break;
  1541. case DCPDU_TYPE:
  1542. {
  1543. uint32_t time=pch->info.open_delay/1000;
  1544. tmp[0] = time & 0xffff;
  1545. tmp[1] = (time >> 16) & 0xffff;
  1546. offset = POWER_DC_SET_OPEN_DELAY+pch->info.ch-1;
  1547. r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1548. }
  1549. break;
  1550. case TREE_AC_TYPE:
  1551. {
  1552. uint32_t time=pch->info.open_delay/1000;
  1553. tmp[0] = time & 0xffff;
  1554. tmp[1] = (time >> 16) & 0xffff;
  1555. if(h->prod->type==PDU_AC_I3O3) {
  1556. offset = POWER_AC3_OPEN_DELAY_TIME+pch->info.sch*3;
  1557. r = write_reg(h, pch->info.addr, offset+0, tmp, 2);
  1558. if(r) break;
  1559. r = write_reg(h, pch->info.addr, offset+1, tmp, 2);
  1560. if(r) break;
  1561. r = write_reg(h, pch->info.addr, offset+2, tmp, 2);
  1562. if(r) break;
  1563. }
  1564. else {
  1565. offset = POWER_AC3_OPEN_DELAY_TIME+pch->info.sch;
  1566. r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1567. }
  1568. }
  1569. break;
  1570. case AC_MULTI_S_TYPE:
  1571. case AC_MULTI_B_TYPE:
  1572. case DC_OUT_TYPE:
  1573. case DC_IN_TYPE:
  1574. default:
  1575. r = -1;
  1576. }
  1577. lock_off(h->lck);
  1578. return r;
  1579. }
  1580. int power_set_close_delay(power_ch_t *pch)
  1581. {
  1582. int r=-1;
  1583. uint16_t tmp[2],reg,offset;
  1584. power_handle_t *h=&pwrHandle;
  1585. lock_on(h->lck);
  1586. switch(pch->info.type) {
  1587. case AC_SINGLE_S_TYPE:
  1588. case AC_SINGLE_B_TYPE:
  1589. {
  1590. tmp[0] = pch->info.close_delay;
  1591. offset = POWER_AC_CLOSE_DELAY_TIME_L+pch->info.ch-1;
  1592. r = write_reg(h, pch->info.addr, offset, tmp, 1);
  1593. }
  1594. break;
  1595. case DCPDU_TYPE:
  1596. {
  1597. uint32_t time=pch->info.close_delay/1000;
  1598. tmp[0] = time & 0xffff;
  1599. tmp[1] = (time >> 16) & 0xffff;
  1600. offset = POWER_DC_SET_CLOSE_DELAY+pch->info.ch-1;
  1601. //r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1602. }
  1603. break;
  1604. case TREE_AC_TYPE:
  1605. {
  1606. uint32_t time=pch->info.close_delay/1000;
  1607. if(h->prod->type==PDU_AC_I3O3) {
  1608. offset = POWER_AC3_CLOSE_DELAY_TIME+pch->info.sch*3;
  1609. r = write_reg(h, pch->info.addr, offset+0, tmp, 2);
  1610. if(r) break;
  1611. r = write_reg(h, pch->info.addr, offset+1, tmp, 2);
  1612. if(r) break;
  1613. r = write_reg(h, pch->info.addr, offset+2, tmp, 2);
  1614. if(r) break;
  1615. }
  1616. else {
  1617. offset = POWER_AC3_CLOSE_DELAY_TIME+pch->info.sch;
  1618. r = write_reg(h, pch->info.addr, offset, tmp, 2);
  1619. }
  1620. }
  1621. break;
  1622. case AC_MULTI_S_TYPE:
  1623. case AC_MULTI_B_TYPE:
  1624. case DC_OUT_TYPE:
  1625. case DC_IN_TYPE:
  1626. default:
  1627. r = -1;
  1628. break;
  1629. }
  1630. lock_off(h->lck);
  1631. return r;
  1632. }
  1633. int power_data_get(power_all_t *all)
  1634. {
  1635. power_handle_t *h=&pwrHandle;
  1636. if(!all) {
  1637. return -1;
  1638. }
  1639. *all = h->all;
  1640. return 0;
  1641. }
  1642. int power_breaker_get(breaker_all_t *all)
  1643. {
  1644. int i,j,idx=0;
  1645. power_handle_t *h=&pwrHandle;
  1646. if(!all) {
  1647. return -1;
  1648. }
  1649. lock_on(h->lck);
  1650. all->cnt = 0;
  1651. for(i=1; i<=h->cnt; i++) {
  1652. if(h->pbrd[i]) {
  1653. all->cnt += h->pbrd[i]->chs;
  1654. }
  1655. }
  1656. if(all->cnt>0) {
  1657. all->data = (breaker_data_t*)malloc(sizeof(breaker_data_t)*all->cnt);
  1658. if(all->data) {
  1659. for(i=1; i<=h->cnt; i++) {
  1660. if(h->pbrd[i]) {
  1661. for(j=0; j<2; j++) {
  1662. if(h->pbrd[i]->brk[j].info.addr>0) {
  1663. all->data[idx++] = h->pbrd[i]->brk[j];
  1664. }
  1665. }
  1666. }
  1667. }
  1668. }
  1669. else {
  1670. all->cnt = 0;
  1671. }
  1672. }
  1673. lock_off(h->lck);
  1674. return 0;
  1675. }