cascade.c 67 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264
  1. #include "cascade.h"
  2. #include "common.h"
  3. #include "elog.h"
  4. #include "cfg.h"
  5. #include "thread.h"
  6. #include "switch_ctrl.h"
  7. #include "modbus_handle.h"
  8. #include "sqlite_handle.h"
  9. #include "paras.h"
  10. #include "modbus-rtu.h"
  11. #include "modbus-tcp.h"
  12. #include "sys.h"
  13. #if 1
  14. #define LOGD log_d
  15. #define LOGE log_e
  16. #define LOGW log_w
  17. #else
  18. #define LOGD printf
  19. #define LOGE printf
  20. #define LOGW printf
  21. #endif
  22. #define MB_MAX_LEN 250
  23. //#define MB_PARA_SIM
  24. //#define SLAVE_DATA_SIM
  25. #ifdef MB_PARA_SIM
  26. #define MB_MASTER 0
  27. #endif
  28. typedef struct {
  29. int inited;
  30. pthread_mutex_t mutex; //used for list lock
  31. pthread_mutex_t lock;
  32. Modbus_Manger m;
  33. int addr;
  34. slave_t slaves[CASCADE_MAX+1];
  35. ModbusInfo_t mInfo;
  36. modbus_mapping_t *map;
  37. cmd_data_t cmd;
  38. int scanAddr;
  39. slave_info_t sInfo; //current slave infomation
  40. // breaker_info_t sBreaker;
  41. pthread_cond_t cond;
  42. uint8_t scanner_flag;
  43. }cascade_handle_t;
  44. int cur_dev_addr=0;
  45. static cascade_handle_t casHandle={.inited=0};
  46. static cascade_handle_t casHandle_breaker={.inited=0};
  47. static void* cmd_thread(void *arg);
  48. static void* cmd_NF_thread(void *arg);
  49. static int master_cmd_addr(cascade_handle_t *cas, cmd_data_t *cmd,int saddr,int index);
  50. //////////////////////////////////////////////////
  51. static inline GlobalDeviceManager* get_dm(void)
  52. {
  53. return &__globalDeviceManage;
  54. }
  55. static inline GlobalDeviceManager* get_dm2(void)
  56. {
  57. return &__globalDeviceManage2;
  58. }
  59. static inline ModbusInfo_t *get_mb(void)
  60. {
  61. #ifdef MB_PARA_SIM
  62. static ModbusInfo_t mbinfo={
  63. #if (MB_MASTER==1)
  64. .product_modbus_type=0,
  65. #else
  66. .product_modbus_type=1,
  67. #endif
  68. .product_modbus_addr=1,
  69. .product_modbus_baud=115200,
  70. };
  71. return &mbinfo;
  72. #else
  73. return &get_dm()->_globalDevInfo._gmodbus_info;
  74. #endif
  75. }
  76. static int slave_init(cascade_handle_t *cas)
  77. {
  78. int i;
  79. for(i=0; i<=CASCADE_MAX; i++) {
  80. cas->slaves[i].addr = -1;
  81. cas->slaves[i].err = 0;
  82. }
  83. return 0;
  84. }
  85. static int slave_add(cascade_handle_t *cas, int addr)
  86. {
  87. if(addr<0 || addr>CASCADE_MAX) {
  88. return -1;
  89. }
  90. cas->slaves[addr].addr = addr;
  91. cas->slaves[addr].err = 0;
  92. return 0;
  93. }
  94. static int slave_rm(cascade_handle_t *cas, int addr)
  95. {
  96. if(addr<0 || addr>CASCADE_MAX) {
  97. return -1;
  98. }
  99. cas->slaves[addr].addr = -1;
  100. cas->slaves[addr].err = 0;
  101. return 0;
  102. }
  103. static int slave_cnt(cascade_handle_t *cas)
  104. {
  105. int i,cnt=0;
  106. for(i=0; i<=CASCADE_MAX; i++) {
  107. if(cas->slaves[i].addr>0) {
  108. cnt++;
  109. }
  110. }
  111. return cnt;
  112. }
  113. static slave_t* slave_get(cascade_handle_t *cas, int addr)
  114. {
  115. return &cas->slaves[addr];
  116. }
  117. static int slave_find(cascade_handle_t *cas, int addr)
  118. {
  119. if(cas->slaves[addr].addr>0) {
  120. return 1;
  121. }
  122. return 0;
  123. }
  124. static int slave_get_info(cascade_handle_t *cas)
  125. {
  126. int cnt=0,cnt2;
  127. netswitch_info_t swInfo;
  128. GlobalDeviceManager *dm=get_dm();
  129. GlobalPowerManger *tmp=NULL;
  130. GlobalTreeACManager* tmp3=NULL;
  131. slave_info_t *info=&cas->sInfo;
  132. info->cnt=0;
  133. info->prod.product_type = dm->_globalDevInfo.product_type;
  134. info->prod.product_pwr_type = dm->_globalDevInfo.product_pwr_type;
  135. info->prod.product_id = dm->_globalDevInfo.product_id;
  136. if(!list_empty(&dm->_globalPowerManger.list_Tree_AC)) {
  137. cnt2 = 0;
  138. list_for_each_entry(tmp3, &dm->_globalPowerManger.list_Tree_AC, list_Tree_AC)
  139. {
  140. if(tmp3->product_ph_type<0 || tmp3->product_ph_type>3) {
  141. continue;
  142. }
  143. if(cnt2<3) {
  144. info->all.power[cnt2++] = tmp3->_PowerInfo;
  145. }
  146. }
  147. }
  148. if(!list_empty(&dm->_globalPowerManger.list)) {
  149. cnt = 0;
  150. netswitch_get(&swInfo);
  151. list_for_each_entry(tmp, &dm->_globalPowerManger.list, list)
  152. {
  153. if(tmp->product_saddr==0) {
  154. continue;
  155. }
  156. tmp->_PowerInfo.port = swInfo.port[cnt];
  157. info->ch[cnt].product_saddr = tmp->product_saddr;
  158. info->ch[cnt].product_ch_type = tmp->product_ch_type;
  159. info->ch[cnt].product_ch_addr = tmp->product_ch_addr;
  160. info->ch[cnt].product_ch_id = tmp->product_ch_id;
  161. info->ch[cnt].product_ch_status = tmp->product_ch_status;
  162. info->ch[cnt].product_ch_NF_status = tmp->product_ch_NF_status;
  163. info->ch[cnt].start_delay = tmp->product_ch_start_delay;
  164. info->ch[cnt].stop_delay = tmp->product_ch_stop_delay;
  165. info->ch[cnt].chinfo = tmp->_PowerInfo;
  166. if (tmp->product_ch_type==TREE_AC_TYPE||dm->_globalDevInfo.product_pwr_type == SmartPDU_Tree_AC_One_B) {
  167. cnt2 = 0;
  168. list_for_each_entry(tmp3, &tmp->list_Tree_AC, list_Tree_AC)
  169. {
  170. info->ch[cnt].pinfo[cnt2].power = tmp3->_PowerInfo;
  171. info->ch[cnt].pinfo[cnt2].phase.product_ph_id = tmp3->product_ph_id;
  172. info->ch[cnt].pinfo[cnt2].phase.product_ph_type = tmp3->product_ph_type;
  173. info->ch[cnt].pinfo[cnt2].phase.product_ph_outputType = tmp3->product_ph_outputType;
  174. info->ch[cnt].pinfo[cnt2].phase.product_ph_outputStatus = tmp3->product_ph_outputStatus;
  175. cnt2++;
  176. }
  177. }
  178. cnt++;
  179. }
  180. }
  181. info->cnt = cnt;
  182. LOGD("___ slave_get_info, cnt: %d\n", info->cnt);
  183. return 0;
  184. }
  185. #if 0
  186. static int slave_breaker_info(cascade_handle_t *cas)
  187. {
  188. GlobalDeviceManager *dm=get_dm();
  189. GlobalBreakerManager *temp = NULL;
  190. breaker_info_t *breaker=&cas->sBreaker;
  191. int cnt = 0;
  192. //list_for_each_entry(temp, &__globalDeviceManage.g_new_global_breaker.list, list)
  193. pthread_mutex_lock(&dm->_breaker_mutex);
  194. if(!list_empty(&dm->g_new_global_breaker.list)) {
  195. printf("isnot empty!!!!!\n");
  196. list_for_each_entry(temp,&dm->g_new_global_breaker.list, list)
  197. {
  198. // printf("temp addr %ld temp->next = %ld temp->prev = %ld\n",tmp,tmp->list.prev,tmp->list.next);
  199. breaker ->breaker_chn[cnt].product_id = temp->product_id;
  200. breaker->breaker_chn[cnt].breaker_addrs = temp->breaker_gather_addr;
  201. breaker->breaker_chn[cnt].breaker_status = temp->breaker_status;
  202. breaker->breaker_chn[cnt].breaker_chn = temp->breaker_chn;
  203. breaker->breaker_chn[cnt].breaker_id = temp->breaker_id;
  204. strcpy(breaker->breaker_chn[cnt].breaker_gather_type, temp->breaker_gather_type);
  205. strcpy(breaker->breaker_chn[cnt].breaker_com, temp->breaker_com);
  206. strcpy(breaker->breaker_chn[cnt].breaker_switch_name, temp->breaker_switch_name);
  207. strcpy(breaker->breaker_chn[cnt].breaker_chns_name, temp->breaker_chns_name);
  208. cnt++;
  209. }
  210. }
  211. breaker->cnt = cnt;
  212. pthread_mutex_unlock(&dm->_breaker_mutex);
  213. LOGD("___ slave_breaker_info, breaker_all: saddr=0x%x %d\n",(uint32_t)dm,breaker->cnt);
  214. return 0;
  215. }
  216. #endif
  217. static int get_pwr_info(int chId, GlobalPowerManger *power)
  218. {
  219. int i;
  220. GlobalPowerManger *tmp=NULL;
  221. GlobalDeviceManager *dm=get_dm();
  222. list_for_each_entry(tmp, &dm->_globalPowerManger.list, list)
  223. {
  224. if(tmp->product_ch_id==chId) {
  225. power->product_id = dm->_globalDevInfo.product_id;
  226. power->product_ch_id = tmp->product_ch_id;
  227. strcpy(power->product_ch_name, tmp->product_ch_name);
  228. power->product_ch_type = tmp->product_ch_type;
  229. power->product_ch_status = tmp->product_ch_status;
  230. power->product_ch_NF_status = tmp->product_ch_NF_status;
  231. power->product_ch_start_delay = tmp->product_ch_start_delay;
  232. power->product_ch_stop_delay = tmp->product_ch_stop_delay;
  233. return 0;
  234. }
  235. }
  236. return -1;
  237. }
  238. #if 0
  239. static int slave_breaker_update(cascade_breaker_update_t *data)
  240. {
  241. int ret = -1;
  242. if(data)
  243. {
  244. GlobalDeviceManager *dm=get_dm();
  245. GlobalBreakerManager *temp= NULL;
  246. GlobalBreakerManager *pos= NULL;
  247. pthread_mutex_lock(&dm->_breaker_mutex);
  248. if(!list_empty(&dm->g_new_global_breaker.list)) {
  249. list_for_each_entry_safe(temp,pos,&dm->g_new_global_breaker.list,list)
  250. {
  251. if(temp->breaker_id == data->switch_id)
  252. {
  253. strcpy(temp->breaker_switch_name,data->switch_name);
  254. strcpy(temp->breaker_chns_name,data->breaker_chns);
  255. dev_update_breaker_genera_manage(dm->db,
  256. dm->_globalDevInfo.product_id,data->switch_id,temp);
  257. ret = 0;
  258. break;
  259. }
  260. }
  261. }
  262. pthread_mutex_unlock(&dm->_breaker_mutex);
  263. }
  264. return ret;
  265. }
  266. #endif
  267. #if 0
  268. static int slave_breaker_delete(cascade_braeker_delete_t *data)
  269. {
  270. int ret = -1;
  271. if(data)
  272. {
  273. GlobalDeviceManager *dm=get_dm();
  274. GlobalBreakerManager *temp= NULL;
  275. GlobalBreakerManager *pos= NULL;
  276. pthread_mutex_lock(&dm->_breaker_mutex);
  277. if(!list_empty(&dm->g_new_global_breaker.list)) {
  278. list_for_each_entry_safe(temp,pos,&dm->g_new_global_breaker.list,list)
  279. {
  280. printf("new data !!!!\n");
  281. if(temp == NULL)
  282. {
  283. continue;
  284. }
  285. if(temp->breaker_id == data->switch_id)
  286. {
  287. dev_delete_breaker_manage(dm->db,dm->_globalDevInfo.product_id,data->switch_id);
  288. list_del(&temp->list);
  289. free(temp);
  290. if(!list_empty(&dm->g_new_global_breaker.list))
  291. {
  292. printf("hellosda\n");
  293. }
  294. ret = 0;
  295. break;
  296. }
  297. }
  298. }
  299. pthread_mutex_unlock(&dm->_breaker_mutex);
  300. }
  301. return ret;
  302. }
  303. #endif
  304. #if 0
  305. static int slave_breaker_add(cascade_breaker_add_t *data)
  306. {
  307. int r = -1;
  308. if(!data)
  309. {
  310. goto quit;
  311. }
  312. GlobalDeviceManager *dm=get_dm();
  313. char buff[124] = {0};
  314. char id[MAX_BREAKER_ID] = {0};
  315. //bianli shujujiegou
  316. GlobalBreakerManager *temp = NULL;
  317. int i = 1;
  318. pthread_mutex_lock(&dm->_breaker_mutex);
  319. list_for_each_entry(temp, &dm->g_new_global_breaker.list, list)
  320. {
  321. id[temp->breaker_id] = 1;
  322. }
  323. pthread_mutex_unlock(&dm->_breaker_mutex);
  324. for(;i < MAX_BREAKER_ID;i++)
  325. {
  326. if(id[i] == 0)
  327. break;
  328. }
  329. if(i > MAX_BREAKER_ID)
  330. {
  331. goto quit;
  332. }
  333. GlobalBreakerManager *breakerManager = (GlobalBreakerManager*) malloc(sizeof(GlobalBreakerManager));
  334. memset(breakerManager,0,sizeof(GlobalBreakerManager));
  335. breakerManager->product_id = __globalDeviceManage._globalDevInfo.product_id;
  336. breakerManager->breaker_gather_addr = data->cjdz;
  337. strcpy(breakerManager->breaker_com,data->com);
  338. strcpy(breakerManager->breaker_gather_type,data->cjfs);
  339. strcpy(breakerManager->breaker_chns_name,data->breaker_chns);
  340. breakerManager->breaker_id = i;
  341. sprintf(buff,"Breaker_%d",breakerManager->breaker_id);
  342. strcpy(breakerManager->breaker_switch_name,buff);
  343. uint32_t jdh = data->jdh;
  344. if(jdh > MAX_BREAKER_CHN)
  345. {
  346. goto quit2;
  347. }
  348. char jdh_flag = 0;
  349. char chn[MAX_BREAKER_CHN] = {0};
  350. pthread_mutex_lock(&dm->_breaker_mutex);
  351. list_for_each_entry(temp, &dm->g_new_global_breaker.list, list)
  352. {
  353. if(temp->breaker_gather_addr == breakerManager->breaker_gather_addr)
  354. {
  355. chn[temp->breaker_chn-1] = 1;
  356. }
  357. }
  358. pthread_mutex_unlock(&dm->_breaker_mutex);
  359. if(chn[jdh-1] != 1)
  360. {
  361. breakerManager->breaker_chn = jdh;
  362. }else
  363. {
  364. jdh_flag = 1;
  365. }
  366. if(jdh_flag == 1)
  367. {
  368. goto quit2;
  369. }else{
  370. dev_insert_breaker_genera_manage(dm->db,breakerManager);
  371. pthread_mutex_lock(&dm->_breaker_mutex);
  372. list_add_tail(&breakerManager->list,&dm->g_new_global_breaker.list);
  373. pthread_mutex_unlock(&dm->_breaker_mutex);
  374. r = 0;
  375. }
  376. return r;
  377. quit2:
  378. free(breakerManager);
  379. breakerManager = NULL;
  380. quit:
  381. return r;
  382. }
  383. #endif
  384. static int slave_save(cascade_handle_t *cas)
  385. {
  386. int r;
  387. GlobalPowerManger power;
  388. GlobalDeviceManager *dm=get_dm();
  389. if(cas->cmd.obj!=OBJ_CHANNEL) {
  390. return -1;
  391. }
  392. r = get_pwr_info(cas->cmd.chId, &power);
  393. if(r) {
  394. LOGE("____ get_pwr_info failed\n");
  395. return -1;
  396. }
  397. r = dev_update_power_manage_genera_info(dm->db, dm->_globalDevInfo.product_id, cas->cmd.chId, &power);
  398. return r;
  399. }
  400. /////////////////////////////////////////////////////////////////////////////////////////
  401. static int mb_init(cascade_handle_t *cas, char *path, int type, int addr, uint32_t baud)
  402. {
  403. int r;
  404. r = g_modbus_init(&cas->m, path, baud, type, addr, (type>0)?"slave":"master", 1);
  405. if(r==0) {
  406. if(type>0) {
  407. LOGD("___ set slave addr: %d\n", addr);
  408. cas->addr = addr;
  409. g_modbus_set_slave(&cas->m, addr);
  410. // cascade_slave_init();
  411. }
  412. else {
  413. cas->addr = 0;
  414. }
  415. cas->inited = 1;
  416. }
  417. else {
  418. LOGE("___ mb init failed, %s\n", modbus_strerror(errno));
  419. }
  420. return r;
  421. }
  422. static int mb_deinit(cascade_handle_t *cas)
  423. {
  424. g_modbus_deinit(&cas->m);
  425. return 0;
  426. }
  427. static int _mb_scan(cascade_handle_t *cas, int addr)
  428. {
  429. int r;
  430. uint16_t tmp;
  431. //g_modbus_set_timeout(&cas->m, 200);
  432. //modbus_set_response_timeout(cas->m.mb, 0,200000);
  433. #if SURPPORT_OLD485
  434. r = g_modbus_read_x_reg(&cas->m, addr, 6000, 1, &tmp);
  435. #else
  436. r = g_modbus_read_x_reg(&cas->m, addr, CASCADE_REG_SCAN, 1, &tmp);
  437. #endif
  438. //g_modbus_set_timeout(&cas->m, 1000);
  439. //modbus_set_response_timeout(cas->m.mb, 0,800000);
  440. return r;
  441. }
  442. static int _mb_read(cascade_handle_t *cas, int addr, uint16_t reg, uint16_t *data, int cnt)
  443. {
  444. int r;
  445. r = g_modbus_read_x_reg(&cas->m, addr, reg, cnt, data);
  446. if(r<0) {
  447. cas->slaves[addr].err++;
  448. if(cas->slaves[addr].err>ERR_MAX) {
  449. slave_rm(cas, addr);
  450. }
  451. }
  452. else {
  453. cas->slaves[addr].err = 0;
  454. }
  455. return r;
  456. }
  457. static int _mb_write(cascade_handle_t *cas, int addr, uint16_t reg, uint16_t *data, int cnt)
  458. {
  459. int r;
  460. r = g_modbus_write_x_reg(&cas->m, addr, reg, cnt, data);
  461. if(r<0) {
  462. cas->slaves[addr].err++;
  463. if(cas->slaves[addr].err>ERR_MAX) {
  464. slave_rm(cas, addr);
  465. }
  466. }
  467. else {
  468. cas->slaves[addr].err = 0;
  469. }
  470. return r;
  471. }
  472. static int _mb_recv(cascade_handle_t *cas, uint8_t *buf)
  473. {
  474. return g_modbus_receive(&cas->m, buf);
  475. }
  476. static int _mb_reply(cascade_handle_t *cas, uint8_t *buff, int reqlen, modbus_mapping_t *map)
  477. {
  478. return g_modbus_reply(&cas->m, buff, reqlen, map);
  479. }
  480. ////////////////////////////////////////////////////////////
  481. static void print_data(uint8_t *data, int len)
  482. {
  483. int i;
  484. for(i=0; i<len; i++) {
  485. LOGD("0x%02x, ", data[i]);
  486. }
  487. LOGD("\n");
  488. }
  489. static void print_cmd(char *s, cmd_data_t *cmd)
  490. {
  491. int i;
  492. LOGD("__%s__ cmd.obj: %d\n", s, cmd->obj);
  493. LOGD("__%s__ cmd.cmd: %d\n", s, cmd->cmd);
  494. LOGD("__%s__ cmd.chId: %d\n", s, cmd->chId);
  495. //LOGD("__%s__ cmd.time_s: %s\n", s, cmd->time_s);
  496. //LOGD("__%s__ cmd.time_e: %s\n", s, cmd->time_e);
  497. LOGD("\n");
  498. }
  499. static void memswap(uint8_t *buf, int len)
  500. {
  501. int i;
  502. uint8_t tmp;
  503. for(i=0; i<len; i+=2) {
  504. tmp = buf[i];
  505. buf[i] = buf[i+1];
  506. buf[i+1] = tmp;
  507. }
  508. }
  509. static void memcpy_swap(uint8_t *dst, uint8_t *src, int len)
  510. {
  511. int i;
  512. for(i=0; i<len; i+=2) {
  513. dst[i] = src[i+1];
  514. dst[i+1] = src[i];
  515. }
  516. }
  517. static int print_hdr(char *s, mb_hdr_t *h)
  518. {
  519. LOGD("____%s___ h.addr: %d\n", s, h->addr);
  520. LOGD("____%s___ h.func: %d\n", s, h->func);
  521. LOGD("____%s___ h.reg: %d\n", s, h->reg);
  522. LOGD("____%s___ h.regcnt: %d\n", s, h->regcnt);
  523. LOGD("____%s___ h.dlen: %d\n", s, h->dlen);
  524. LOGD("____%s___ h.data: %d\n", s, (int)h->data);
  525. LOGD("\n");
  526. return 0;
  527. }
  528. static int mb_hdr(uint8_t *data, int datalen, mb_hdr_t *h)
  529. {
  530. h->addr = data[0];
  531. h->func = data[1];
  532. h->reg = data[2]<<8 | data[3];
  533. h->regcnt = data[4]<<8 | data[5];
  534. h->dlen = 0;
  535. h->data = NULL;
  536. if(datalen>8) {
  537. h->dlen = data[6];
  538. h->data = data+7;
  539. memswap(h->data, h->dlen+h->dlen%2);
  540. }
  541. //print_hdr("sss", h);
  542. return 0;
  543. }
  544. static int mb_read(cascade_handle_t *cas, int addr, data_t *d)
  545. {
  546. int r=0,finish=0;
  547. int xlen,rlen=0,oncelen=MB_MAX_LEN;
  548. uint16_t buff[MODBUS_RTU_MAX_ADU_LENGTH];
  549. if(d->dlen<=0) {
  550. //LOGE("___ mb_read dlen %d is wrong!\n", d->dlen);
  551. return -1;
  552. }
  553. //LOGD("___ mb_read dlen: %d\n", d->dlen);
  554. //LOGD("______cas->info.cnt4: %d\n", cas->sInfo.cnt);
  555. while(1) {
  556. if(rlen+oncelen>d->dlen) {
  557. xlen = d->dlen-rlen;
  558. }
  559. else {
  560. xlen = oncelen;
  561. }
  562. xlen += xlen%2;
  563. r = _mb_read(cas, addr, CASCADE_REG_READ, buff, xlen/2);
  564. //LOGD("______cas->info.cnt5: %d\n", cas->sInfo.cnt);
  565. if(r<0) {
  566. LOGE("___ _mb_read failed, %s, rlen: %d\n", modbus_strerror(errno), rlen);
  567. return -1;
  568. }
  569. if(rlen+r*2>=d->dlen) {
  570. xlen = d->dlen-rlen;
  571. finish = 1;
  572. }
  573. else {
  574. xlen = r*2;
  575. }
  576. memcpy((char*)d->data+rlen, buff, xlen);
  577. rlen += xlen;
  578. if(finish) {
  579. break;
  580. }
  581. }
  582. //LOGD("______cas->info.cnt6: %d\n", cas->sInfo.cnt);
  583. return 0;
  584. }
  585. static int mb_write(cascade_handle_t *cas, int addr, data_t *d)
  586. {
  587. int r=0;
  588. int xlen,wlen=0,oncelen=MB_MAX_LEN;
  589. uint16_t buff[MODBUS_RTU_MAX_ADU_LENGTH];
  590. if(d->dlen<=0) {
  591. //LOGE("___ mb_write dlen %d is wrong!\n", d->dlen);
  592. return -1;
  593. }
  594. //LOGD("___ mb_write dlen: %d\n", d->dlen);
  595. while(1) {
  596. if(wlen+oncelen>d->dlen) {
  597. xlen = d->dlen-wlen;
  598. }
  599. else {
  600. xlen = oncelen;
  601. }
  602. xlen += xlen%2;
  603. memcpy(buff, d->data+wlen, xlen);
  604. r = _mb_write(cas, addr, CASCADE_REG_WRITE, buff, xlen/2);
  605. if(r<0) {
  606. LOGE("___ _mb_write, addr: %d, reg: %d, cnt: %d, %s\n", addr, CASCADE_REG_WRITE, xlen/2, modbus_strerror(errno));
  607. return -1;
  608. }
  609. if(wlen+r*2>=d->dlen) {
  610. break;
  611. }
  612. else {
  613. xlen = r*2;
  614. }
  615. wlen += xlen;
  616. }
  617. return 0;
  618. }
  619. static int mb_write_read(cascade_handle_t *cas, int addr, data_t *wd, data_t *rd)
  620. {
  621. int r=0;
  622. r = mb_write(cas, addr, wd);
  623. //LOGD("______cas->info.cnt3: %d\n", cas->sInfo.cnt);
  624. if(r==0) {
  625. r = mb_read(cas, addr, rd);
  626. }
  627. return r;
  628. }
  629. static int mb_receive(cascade_handle_t *cas)
  630. {
  631. int r=-1,rc,rlen=0;
  632. mb_hdr_t h;
  633. uint8_t buff[MODBUS_RTU_MAX_ADU_LENGTH];
  634. static int sendlen=0;
  635. cmd_data_t *cmd=NULL;
  636. rc = _mb_recv(cas, buff);
  637. if(rc<0) {
  638. return -1;
  639. }
  640. mb_hdr(buff, rc, &h);
  641. #if 1
  642. //do not know why slave can receive all address data
  643. //LOGD("____mb_receive, %d\n", h.addr);
  644. if(h.addr>0 && h.addr!=cas->addr) {
  645. return -1;
  646. }
  647. #endif
  648. switch(h.reg) {
  649. case CASCADE_REG_SCAN:
  650. {
  651. r = _mb_reply(cas, buff, rc, cas->map);
  652. }
  653. break;
  654. case CASCADE_REG_WRITE:
  655. {
  656. if(h.data) {
  657. cmd = (cmd_data_t*)h.data;
  658. if(cmd->cmd>=CASCADE_CMD_GET_INFO) {
  659. cas->cmd = *cmd;
  660. }
  661. sendlen = 0;
  662. }
  663. else {
  664. return -1;
  665. }
  666. switch(cmd->cmd) {
  667. case CASCADE_CMD_OPEN:
  668. case CASCADE_CMD_CLOSE:
  669. {
  670. cmd_data_t *pcmd=malloc(sizeof(cmd_data_t));
  671. if(pcmd) {
  672. *pcmd = *cmd;
  673. thread_start_simp(cmd_thread, pcmd, 4*MB);
  674. }
  675. }
  676. break;
  677. case CASCADE_CMD_OPEN_NF:
  678. case CASCADE_CMD_CLOSE_NF:
  679. {
  680. cmd_data_t *pcmd=malloc(sizeof(cmd_data_t));
  681. if(pcmd) {
  682. *pcmd = *cmd;
  683. thread_start_simp(cmd_NF_thread, pcmd, 4*MB);
  684. }
  685. }
  686. break;
  687. case CASCADE_CMD_SAVE:
  688. case CASCADE_CMD_SAVE3:
  689. {
  690. slave_save(cas);
  691. }
  692. break;
  693. case CASCADE_CMD_BREAKER_SAVE_ADD:
  694. {
  695. //LOGD("_____ slave CASCADE_CMD_BREAKER_SAVE_ADD\n");
  696. //LOGD("%d %d %s %s %s\n",cmd->datas.data.jdh,cmd->datas.data.cjdz,cmd->datas.data.cjfs,cmd->datas.data.com,cmd->datas.data.breaker_chns);
  697. //slave_breaker_add(&cmd->datas.data);
  698. }
  699. break;
  700. case CASCADE_CMD_BREAKER_SAVE_UPDATE:
  701. {
  702. //LOGD("_____ slave CASCADE_CMD_BREAKER_SAVE_UPDATE\n");
  703. //LOGD("%d %s %s\n",cmd->datas.data1.switch_id,cmd->datas.data1.switch_name,cmd->datas.data1.breaker_chns);
  704. //slave_breaker_update(&cmd->datas.data1);
  705. }
  706. break;
  707. case CASCADE_CMD_BREAKER_SAVE_DELETE:
  708. {
  709. //LOGD("_____ slave CASCADE_CMD_BREAKER_SAVE_DELETE\n");
  710. // slave_breaker_delete(&cmd->datas.data2);
  711. }
  712. }
  713. r = _mb_reply(cas, buff, rc, cas->map);
  714. }
  715. break;
  716. case CASCADE_REG_READ:
  717. {
  718. cmd = &cas->cmd;
  719. //LOGD("____ CASCADE_REG_READ %d\n", cmd->cmd);
  720. switch(cmd->cmd) {
  721. case CASCADE_CMD_GET_INFO:
  722. {
  723. LOGD("_____ slave CASCADE_CMD_GET_INFO\n");
  724. slave_get_info(cas);
  725. memcpy(cas->map->tab_registers+(h.reg-CASCADE_REG_OFFSET), (char*)&cas->sInfo+sendlen, h.regcnt*2);
  726. }
  727. break;
  728. case CASCADE_CMD_BREAKER_QUERY:
  729. {
  730. LOGD("_____ slave CASCADE_CMD_GET_INFO\n");
  731. //slave_breaker_info(cas);
  732. //memcpy(cas->map->tab_registers+(h.reg-CASCADE_REG_OFFSET), ((char*)&cas->sBreaker)+sendlen, h.regcnt*2);
  733. }
  734. break;
  735. case CASCADE_CMD_QUERY_CH:
  736. {
  737. LOGD("___ slave CASCADE_CMD_QUERY_CH\n");
  738. slave_get_info(cas);
  739. memcpy(cas->map->tab_registers+(h.reg-CASCADE_REG_OFFSET), ((char*)&cas->sInfo)+sendlen, h.regcnt*2);
  740. }
  741. break;
  742. case CASCADE_CMD_QUERY_VOL:break;
  743. case CASCADE_CMD_QUERY_CUR:break;
  744. case CASCADE_CMD_QUERY_PWR:break;
  745. case CASCADE_CMD_QUERY_PWRQ:break;
  746. case CASCADE_CMD_QUERY_HIS:break;
  747. case CASCADE_CMD_QUERY_TOTAL:break;
  748. case CASCADE_CMD_QUERY_TOTAL_PWR:break;
  749. case CASCADE_CMD_GET_BREAKER_INFO:
  750. {
  751. // LOGD("_____ slave breaker CASCADE_CMD_GET_INFO\n");
  752. // slave_breaker_info(cas);
  753. // memcpy(cas->map->tab_registers+(h.reg-CASCADE_REG_OFFSET), ((char*)&cas->sBreaker)+sendlen, h.regcnt*2);
  754. }
  755. break;
  756. }
  757. r = _mb_reply(cas, buff, rc, cas->map);
  758. if(r>0) {
  759. sendlen += h.regcnt*2;
  760. //LOGD("____ slave sendlen: %d, h.dlen: %d, r: %d\n", sendlen, h.dlen, r);
  761. }
  762. }
  763. break;
  764. default:
  765. {
  766. Modbus_Manger *mm=&get_dm()->_globalRelaySampManger;
  767. LOGD("___ slave XXXXXXXXXXX\n");
  768. if(h.func==MODBUS_FC_READ_HOLDING_REGISTERS) {
  769. //cascade_slave_read(h.reg, h.regcnt);
  770. }
  771. else if(h.func==MODBUS_FC_WRITE_SINGLE_REGISTER) {
  772. //cascade_slave_write(h.reg, h.regcnt);
  773. }
  774. r = _mb_reply(cas, buff, rc,cascade_slave_map());
  775. }
  776. }
  777. return r;
  778. }
  779. /////////////////////////////////////////////////////////////////////
  780. static int new_master_scaner(cascade_handle_t *cas)
  781. {
  782. int r;
  783. g_modbus_set_timeout(&cas->m, 100);
  784. for(int i = 1 ; i <= CASCADE_MAX;i++)
  785. {
  786. cas->scanAddr = i;
  787. if(!slave_find(cas, cas->scanAddr)) {
  788. r = _mb_scan(cas, cas->scanAddr);
  789. if(r>0) {
  790. LOGD("____ find a slave, addr: %d\n", cas->scanAddr);
  791. slave_add(cas, cas->scanAddr);
  792. }
  793. else {
  794. LOGW("____ scan %d fail, %s\n", cas->scanAddr, modbus_strerror(errno));
  795. }
  796. }
  797. }
  798. g_modbus_set_timeout(&cas->m, 800);
  799. return r;
  800. }
  801. /////////////////////////////////////////////////////////////////////////
  802. static int master_scan(cascade_handle_t *cas)
  803. {
  804. int i,r=0 ;
  805. uint16_t tmp[10];
  806. cmd_data_t cmd={0};
  807. if(cas->scanAddr>CASCADE_MAX) {
  808. cas->scanAddr = 1;
  809. }
  810. if(!slave_find(cas, cas->scanAddr)) {
  811. r = _mb_scan(cas, cas->scanAddr);
  812. if(r>0) {
  813. LOGD("____ find a slave, addr: %d\n", cas->scanAddr);
  814. slave_add(cas, cas->scanAddr);
  815. }
  816. else {
  817. LOGW("____ scan %d fail, %s\n", cas->scanAddr, modbus_strerror(errno));
  818. }
  819. }
  820. cas->scanAddr++;
  821. //print_slave(cas);
  822. return 0;
  823. }
  824. ///////////////////////////////////////////////////////////////////////////////////////
  825. static int power_clear(cascade_handle_t *cas);
  826. static int power_init(cascade_handle_t *cas)
  827. {
  828. GlobalDeviceManager *dm=get_dm();
  829. GlobalDeviceManager *dm2=get_dm2();
  830. dm2->_globalDevInfo.product_pwr_type = dm->_globalDevInfo.product_pwr_type;
  831. dm2->_globalDevInfo.product_id = dm->_globalDevInfo.product_id;
  832. strcpy(dm2->_globalDevInfo.product_name, dm->_globalDevInfo.product_name);
  833. strcpy(dm2->_globalDevInfo.product_number, dm->_globalDevInfo.product_number);
  834. strcpy(dm2->_globalDevInfo.product_status, dm->_globalDevInfo.product_status);
  835. INIT_LIST_HEAD(&dm2->_globalPowerManger.list);
  836. INIT_LIST_HEAD(&dm2->_globalPowerManger.list_Tree_AC);
  837. return 0;
  838. }
  839. #if 0
  840. static int breaker_slave_init(void)
  841. {
  842. //GlobalDeviceManager *dm=get_dm();
  843. GlobalDeviceManager *dm2=get_dm2();
  844. INIT_LIST_HEAD(&dm2->g_new_global_breaker.list);
  845. pthread_mutex_init(&dm2->_breaker_mutex,NULL);
  846. return 0;
  847. }
  848. #endif
  849. static int power_deinit(cascade_handle_t *cas)
  850. {
  851. GlobalDeviceManager *dm2=get_dm2();
  852. power_clear(cas);
  853. return 0;
  854. }
  855. static int power_clear(cascade_handle_t *cas)
  856. {
  857. GlobalPowerManger *tmp,*pos;
  858. GlobalTreeACManager *tmp3,*pos3;
  859. GlobalDeviceManager *dm2=get_dm2();
  860. if(!list_empty(&dm2->_globalPowerManger.list_Tree_AC)) {
  861. list_for_each_entry_safe(tmp3,pos3,&dm2->_globalPowerManger.list_Tree_AC,list_Tree_AC)
  862. {
  863. if(tmp3==NULL) {
  864. continue;
  865. }
  866. list_del(&tmp3->list_Tree_AC);
  867. if(tmp3->global_over_manager) {
  868. free(tmp3->global_over_manager);
  869. }
  870. free(tmp3);
  871. }
  872. }
  873. if(!list_empty(&dm2->_globalPowerManger.list)) {
  874. list_for_each_entry_safe(tmp,pos,&dm2->_globalPowerManger.list,list)
  875. {
  876. if(tmp==NULL) {
  877. continue;
  878. }
  879. if (tmp->product_ch_type==TREE_AC_TYPE||__globalDeviceManage._globalDevInfo.product_pwr_type == SmartPDU_Tree_AC_One_B) {
  880. if(list_empty(&tmp->list_Tree_AC)) {
  881. continue;
  882. }
  883. list_for_each_entry_safe(tmp3,pos3,&tmp->list_Tree_AC,list_Tree_AC)
  884. {
  885. if(tmp3==NULL) {
  886. continue;
  887. }
  888. list_del(&tmp3->list_Tree_AC);
  889. free(tmp3);
  890. }
  891. }
  892. list_del(&tmp->list);
  893. free(tmp);
  894. }
  895. }
  896. return 0;
  897. }
  898. #if 0
  899. static int breaker_clear(cascade_handle_t *cas)
  900. {
  901. GlobalDeviceManager *dm2=get_dm2();
  902. GlobalBreakerManager *temp = NULL;
  903. GlobalBreakerManager *pos = NULL;
  904. pthread_mutex_lock(&dm2->_breaker_mutex);
  905. if(!list_empty(&dm2->g_new_global_breaker.list)) {
  906. list_for_each_entry_safe(temp,pos,&dm2->g_new_global_breaker.list,list)
  907. {
  908. if(temp == NULL)
  909. {
  910. continue;
  911. }
  912. list_del(&temp->list);
  913. free(temp);
  914. }
  915. }
  916. INIT_LIST_HEAD(&dm2->g_new_global_breaker.list);
  917. pthread_mutex_unlock(&dm2->_breaker_mutex);
  918. return 0;
  919. }
  920. #endif
  921. static int power_add(cascade_handle_t *cas)
  922. {
  923. int i,j,nTac_chn=0,r=-1;
  924. GlobalDeviceManager *dm1=get_dm();
  925. GlobalDeviceManager *dm2=get_dm2();
  926. GlobalPowerManger *tmp=NULL;
  927. GlobalTreeACManager *tmp3=NULL;
  928. slave_info_t *info=&cas->sInfo;
  929. LOGD("____ master add channel to the list, cnt: %d\n", info->cnt);
  930. cascade_lock();
  931. power_clear(cas);
  932. dm2->_globalDevInfo.product_id = cur_dev_addr;
  933. //插入总数据
  934. if(info->prod.product_pwr_type==SmartPDU_Tree_AC_Tree ||
  935. info->prod.product_pwr_type==SmartPDU_Tree_AC_One ||
  936. info->prod.product_pwr_type==SmartPDU_Tree_AC_One_B) {
  937. for (int TreeACindex = 0; TreeACindex < 3; TreeACindex++)
  938. {
  939. tmp3 = (GlobalTreeACManager*)malloc(sizeof(GlobalTreeACManager));
  940. if (tmp3 == NULL) {
  941. LOGE("tmp3 malloc error.\n");
  942. goto quit;
  943. }
  944. memset(tmp3, 0, sizeof(GlobalTreeACManager));
  945. tmp3->global_over_manager = (GlobalOverManager *)malloc(sizeof(GlobalOverManager));
  946. if (tmp3->global_over_manager == NULL) {
  947. log_e("tmp3->global_over_manager malloc error.\n");
  948. goto quit;
  949. }
  950. memset(tmp3->global_over_manager, 0, sizeof(GlobalOverManager));
  951. tmp3->product_ch_addr = TreeACindex + 1;
  952. tmp3->product_id = info->prod.product_id;
  953. tmp3->product_saddr = 0;
  954. tmp3->product_ch_id = 0;
  955. tmp3->product_ch_addr = TreeACindex + 1;
  956. tmp3->product_ph_id = nTac_chn;
  957. tmp3->product_ph_type = (TreeACindex + 3) % 3;
  958. list_add_tail(&tmp3->list_Tree_AC, &dm2->_globalPowerManger.list_Tree_AC);
  959. nTac_chn++;
  960. }
  961. }
  962. for(i=0; i<info->cnt; i++) {
  963. tmp = (GlobalPowerManger*)malloc(sizeof(GlobalPowerManger));
  964. if(!tmp) {
  965. LOGE("tmp malloc error.\n");
  966. goto quit;
  967. }
  968. memset(tmp, 0, sizeof(GlobalPowerManger));
  969. tmp->product_id = info->prod.product_id;
  970. tmp->product_saddr = info->ch[i].product_saddr;
  971. tmp->product_ch_id = info->ch[i].product_ch_id;
  972. tmp->product_ch_addr = info->ch[i].product_ch_addr;
  973. sprintf(tmp->product_ch_name, "CH%d", tmp->product_ch_id);
  974. tmp->product_ch_type = info->ch[i].product_ch_type;
  975. tmp->product_ch_status = info->ch[i].product_ch_status;
  976. tmp->product_ch_NF_status = info->ch[i].product_ch_NF_status;
  977. tmp->product_ch_start_delay = info->ch[i].start_delay;
  978. tmp->product_ch_stop_delay = info->ch[i].stop_delay;
  979. tmp->_PowerInfo = info->ch[i].chinfo;
  980. if(info->ch[i].product_ch_type==TREE_AC_TYPE||info->prod.product_pwr_type==SmartPDU_Tree_AC_One_B) {
  981. INIT_LIST_HEAD(&tmp->list_Tree_AC);
  982. for (j=0; j<3; j++) {
  983. tmp3 = (GlobalTreeACManager *)malloc(sizeof(GlobalTreeACManager));
  984. if (tmp3 == NULL) {
  985. LOGE("tmp3 malloc error.\n");
  986. goto quit;
  987. }
  988. memset(tmp3, 0, sizeof(GlobalTreeACManager));
  989. tmp3->product_id = info->prod.product_id;
  990. tmp3->product_saddr = info->ch[i].product_saddr;
  991. tmp3->product_ch_id = tmp->product_ch_id;
  992. tmp3->product_ch_addr = info->ch[i].product_ch_addr;
  993. tmp3->product_ph_id = info->ch[i].pinfo[j].phase.product_ph_id;
  994. tmp3->product_ph_type = info->ch[i].pinfo[j].phase.product_ph_type;
  995. tmp3->product_ph_outputType = info->ch[i].pinfo[j].phase.product_ph_outputType;
  996. tmp3->product_ph_outputStatus = info->ch[i].pinfo[j].phase.product_ph_outputStatus;
  997. tmp3->_PowerInfo = info->ch[i].pinfo[j].power;
  998. list_add_tail(&tmp3->list_Tree_AC, &tmp->list_Tree_AC);
  999. }
  1000. }
  1001. list_add_tail(&tmp->list,&dm2->_globalPowerManger.list);
  1002. }
  1003. cascade_unlock();
  1004. r = 0;
  1005. quit:
  1006. return r;
  1007. }
  1008. #if 0
  1009. static int breaker_add(cascade_handle_t *cas)
  1010. {
  1011. int i,j,r=-1;
  1012. //GlobalDeviceManager *dm1=get_dm();
  1013. GlobalDeviceManager *dm2=get_dm2();
  1014. GlobalBreakerManager *tmp=NULL;
  1015. breaker_info_t *info=&cas->sBreaker;
  1016. //cascade_lock();
  1017. breaker_clear(cas);
  1018. pthread_mutex_lock(&dm2->_breaker_mutex);
  1019. for(i=0; i<info->cnt; i++) {
  1020. tmp = (GlobalBreakerManager*) malloc(sizeof(GlobalBreakerManager));
  1021. if(!tmp) {
  1022. LOGE("tmp malloc error.\n");
  1023. goto quit;
  1024. }
  1025. memset(tmp, 0, sizeof(GlobalBreakerManager));
  1026. tmp->product_id = cur_dev_addr;
  1027. tmp->breaker_chn = info->breaker_chn[i].breaker_chn;
  1028. tmp->breaker_status = info->breaker_chn[i].breaker_status;
  1029. tmp->breaker_gather_addr = info->breaker_chn[i].breaker_addrs;
  1030. tmp->breaker_id = info->breaker_chn[i].breaker_id;
  1031. strcpy(tmp->breaker_gather_type, info->breaker_chn[i].breaker_gather_type);
  1032. strcpy(tmp->breaker_com, info->breaker_chn[i].breaker_com);
  1033. strcpy(tmp->breaker_chns_name, info->breaker_chn[i].breaker_chns_name);
  1034. strcpy(tmp->breaker_switch_name, info->breaker_chn[i].breaker_switch_name);
  1035. list_add_tail(&tmp->list,&dm2->g_new_global_breaker.list);
  1036. }
  1037. pthread_mutex_unlock(&dm2->_breaker_mutex);
  1038. //cascade_unlock();
  1039. r = 0;
  1040. quit:
  1041. return r;
  1042. }
  1043. static int breaker_update(cascade_handle_t *cas)
  1044. {
  1045. GlobalBreakerManager *tmp=NULL;
  1046. GlobalBreakerManager *tmp3=NULL;
  1047. GlobalDeviceManager *dm2=get_dm2();
  1048. breaker_info_t *info=&cas->sBreaker;
  1049. int cnt = 0;
  1050. LOGD("______ breaker_update, %d\n", info->cnt);
  1051. if(info->cnt==0) {
  1052. LOGE("___ sBreaker.cnt is 0\n");
  1053. return -1;
  1054. }
  1055. if(!list_empty(&dm2->g_new_global_breaker.list)) {
  1056. cnt = 0;
  1057. pthread_mutex_lock(&dm2->_breaker_mutex);
  1058. list_for_each_entry_safe(tmp,tmp3,&dm2->g_new_global_breaker.list,list)
  1059. {
  1060. tmp->breaker_id = info->breaker_chn[cnt].breaker_id;
  1061. tmp->breaker_status = info->breaker_chn[cnt].breaker_status;
  1062. tmp->breaker_gather_addr = info->breaker_chn[cnt].breaker_addrs;
  1063. strcpy(tmp->breaker_gather_type, info->breaker_chn[cnt].breaker_gather_type);
  1064. strcpy(tmp->breaker_com, info->breaker_chn[cnt].breaker_com);
  1065. strcpy(tmp->breaker_chns_name, info->breaker_chn[cnt].breaker_chns_name);
  1066. strcpy(tmp->breaker_switch_name, info->breaker_chn[cnt].breaker_switch_name);
  1067. cnt++;
  1068. }
  1069. pthread_mutex_unlock(&dm2->_breaker_mutex);
  1070. }
  1071. return 0;
  1072. }
  1073. #endif
  1074. static int power_update(cascade_handle_t *cas)
  1075. {
  1076. int cnt=0;
  1077. GlobalPowerManger *tmp=NULL;
  1078. GlobalTreeACManager *tmp3=NULL;
  1079. GlobalDeviceManager *dm2=get_dm2();
  1080. slave_info_t *info=&cas->sInfo;
  1081. //LOGD("______ power_update, %d\n", info->cnt);
  1082. if(info->cnt==0) {
  1083. LOGE("___ sInfo.cnt is 0\n");
  1084. return -1;
  1085. }
  1086. if(!list_empty(&dm2->_globalPowerManger.list_Tree_AC)) {
  1087. cnt = 0;
  1088. list_for_each_entry(tmp3,&dm2->_globalPowerManger.list_Tree_AC,list_Tree_AC)
  1089. {
  1090. if(tmp3==NULL) {
  1091. continue;
  1092. }
  1093. if(cnt<3) {
  1094. tmp3->_PowerInfo = info->all.power[cnt++];
  1095. }
  1096. }
  1097. }
  1098. if(!list_empty(&dm2->_globalPowerManger.list)) {
  1099. cnt = 0;
  1100. list_for_each_entry(tmp, &dm2->_globalPowerManger.list, list)
  1101. {
  1102. tmp->_PowerInfo = info->ch[cnt].chinfo;
  1103. if(tmp->product_ch_type==TREE_AC_TYPE||info->prod.product_pwr_type==SmartPDU_Tree_AC_One_B) {
  1104. if(list_empty(&tmp->list_Tree_AC)) {
  1105. continue;
  1106. }
  1107. int cnt2=0;
  1108. list_for_each_entry(tmp3,&tmp->list_Tree_AC,list_Tree_AC)
  1109. {
  1110. tmp3->_PowerInfo = info->ch[cnt].pinfo[cnt2++].power;
  1111. }
  1112. }
  1113. cnt++;
  1114. }
  1115. }
  1116. return 0;
  1117. }
  1118. static void print_sensor(char *s, sensor_data_t *ss)
  1119. {
  1120. LOGD("__%s__ ss.type: %d\n", s, ss->type);
  1121. LOGD("__%s__ ss.addr: %d\n", s, ss->addr);
  1122. LOGD("__%s__ ss.voltage: %f\n", s, ss->pwr.voltage);
  1123. LOGD("__%s__ ss.current: %f\n", s, ss->pwr.current);
  1124. LOGD("__%s__ ss.power: %f\n", s, ss->pwr.power);
  1125. LOGD("__%s__ ss.consumption: %f\n", s, ss->pwr.consumption);
  1126. LOGD("__%s__ ss.freq: %f\n", s, ss->pwr.freq);
  1127. LOGD("__%s__ ss.factor: %f\n", s, ss->pwr.factor);
  1128. LOGD("__%s__ ss.status: %d\n", s, ss->pwr.status);
  1129. LOGD("__%s__ ss.temprature: %f\n", s, ss->temprature);
  1130. LOGD("__%s__ ss.humidity: %f\n", s, ss->humidity);
  1131. LOGD("__%s__ ss.warning: %d\n", s, ss->warning);
  1132. LOGD("__%s__ ss.power_status: %d\n", s, ss->power_status);
  1133. LOGD("__%s__ ss.sensor_status: %d\n", s, ss->sensor_status);
  1134. LOGD("\n");
  1135. }
  1136. #define VALUE_OF(m,a,b) ((m[a]<<16)+m[b])
  1137. static int sensor_get(cascade_handle_t *cas, int addr, sensor_data_t *ss)
  1138. {
  1139. uint32_t offset = 6000;
  1140. uint32_t value = 0 ;
  1141. uint16_t temp[100];
  1142. int r,cnt = sizeof(sensor_ori_t)/2;
  1143. r = _mb_read(cas, addr, offset, temp, cnt);
  1144. if(r!=cnt) {
  1145. LOGE("___mbus_read slave %d failed, %s\n", addr, modbus_strerror(errno));
  1146. return -1;
  1147. }
  1148. ss->type = temp[0];
  1149. ss->addr = temp[1];
  1150. ss->pwr.voltage = VALUE_OF(temp,3,2)/1000.0;
  1151. ss->pwr.current = VALUE_OF(temp,5,4)/1000.0;
  1152. ss->pwr.power = VALUE_OF(temp,7,6)/1000.0;
  1153. ss->pwr.consumption = VALUE_OF(temp,9,8)/1000.0;
  1154. ss->pwr.freq = VALUE_OF(temp,11,10)/1000.0;
  1155. ss->pwr.factor = VALUE_OF(temp,13,12)/1000.0;
  1156. ss->pwr.status = temp[20];
  1157. ss->temprature = VALUE_OF(temp,15,14)/1000.0;
  1158. ss->humidity = VALUE_OF(temp,17,16)/1000.0;
  1159. ss->warning = VALUE_OF(temp,19,18)/1000.0;
  1160. ss->sensor_status = temp[21];
  1161. //print_sensor("11", ss);
  1162. return 0;
  1163. }
  1164. #define REGS(x) (((x)+(x)%2)/2)
  1165. static int master_cmd(cascade_handle_t *cas, cmd_data_t *cmd)
  1166. {
  1167. int i,r;
  1168. GlobalPowerManger *tmp=NULL;
  1169. GlobalDeviceManager *dm=get_dm();
  1170. GlobalDeviceManager *dm2=get_dm2();
  1171. GlobalDeviceInfo *dev=&dm2->_globalDevInfo;
  1172. data_t rdata,wdata;
  1173. if(cur_dev_addr==0) {
  1174. return -1;
  1175. }
  1176. switch(cmd->cmd) {
  1177. case CASCADE_CMD_OPEN:
  1178. case CASCADE_CMD_CLOSE:
  1179. case CASCADE_CMD_SAVE:
  1180. case CASCADE_CMD_SAVE3:
  1181. case CASCADE_CMD_OPEN_NF:
  1182. case CASCADE_CMD_CLOSE_NF:
  1183. {
  1184. LOGD("____ master CMD: %d\n", cmd->cmd);
  1185. wdata.dlen = sizeof(cmd_data_t);
  1186. wdata.data = (uint8_t*)cmd;
  1187. r = mb_write(cas, cur_dev_addr, &wdata);
  1188. }
  1189. break;
  1190. case CASCADE_CMD_GET_INFO:
  1191. {
  1192. #if SURPPORT_OLD485
  1193. //LOGD("_____ master send CASCADE_CMD_GET_INFO surport old 485 type!!!\n");
  1194. sensor_data_t sdat;
  1195. slave_t *sl=slave_get(cas, cur_dev_addr);
  1196. r = sensor_get(cas,cur_dev_addr,&sdat);
  1197. if(r==0) {
  1198. cas->sInfo.cnt = 1;
  1199. cas->sInfo.prod.product_id = cur_dev_addr;
  1200. cas->sInfo.ch[0].chinfo.current = sdat.pwr.current;
  1201. cas->sInfo.ch[0].chinfo.consumption = sdat.pwr.consumption;
  1202. cas->sInfo.ch[0].chinfo.power = sdat.pwr.power;
  1203. cas->sInfo.ch[0].chinfo.voltage = sdat.pwr.voltage;
  1204. cas->sInfo.ch[0].chinfo.status = sdat.pwr.status;
  1205. cas->sInfo.ch[0].chinfo.factor = sdat.pwr.factor;
  1206. cas->sInfo.ch[0].chinfo.freq = sdat.pwr.freq;
  1207. cas->sInfo.ch[0].chinfo.tempratue = sdat.pwr.tempratue;
  1208. cas->sInfo.ch[0].chinfo.humidity = sdat.pwr.humidity;
  1209. power_add(cas);
  1210. sl->err = 0;
  1211. }
  1212. else {
  1213. sl->err++;
  1214. }
  1215. #else
  1216. wdata.dlen = sizeof(cmd_data_t);
  1217. wdata.data = (uint8_t*)cmd;
  1218. rdata.dlen = sizeof(slave_info_t)-sizeof(channel_info_t)*CH_MAX;
  1219. rdata.data = (uint8_t*)&cas->sInfo;
  1220. //LOGD("_____ master send CASCADE_CMD_GET_INFO\n");
  1221. r = mb_write_read(cas, cur_dev_addr, &wdata, &rdata);
  1222. if(r==0) {
  1223. // LOGD("______cas->info.cnt: %d\n", cas->sInfo.cnt);
  1224. rdata.dlen = sizeof(slave_info_t)-sizeof(channel_info_t)*(CH_MAX-cas->sInfo.cnt);
  1225. rdata.data = (uint8_t*)&cas->sInfo;
  1226. //LOGD("______cas->info.cnt1: %d\n", cas->sInfo.cnt);
  1227. r = mb_write_read(cas, cur_dev_addr, &wdata, &rdata);
  1228. //LOGD("______cas->info.cnt2: %d\n", cas->sInfo.cnt);
  1229. if(r==0) {
  1230. power_add(cas);
  1231. }
  1232. }
  1233. else {
  1234. LOGE("_____ master CASCADE_CMD_GET_INFO failed\n");
  1235. }
  1236. #endif
  1237. }
  1238. break;
  1239. case CASCADE_CMD_GET_BREAKER_INFO:
  1240. {
  1241. #if 0
  1242. wdata.dlen = sizeof(cmd_data_t);
  1243. wdata.data = (uint8_t*)cmd;
  1244. rdata.dlen = sizeof(breaker_info_t)-sizeof(breaker_channel_info_t)*CH_MAX;
  1245. rdata.data = (uint8_t*)&cas->sBreaker;
  1246. LOGD("_____ master send CASCADE_CMD_GET_BREAKER_INFO\n");
  1247. r = mb_write_read(cas, cur_dev_addr, &wdata, &rdata);
  1248. if(r==0) {
  1249. LOGD("______cas->info.cnt: %d\n", cas->sBreaker.cnt);
  1250. rdata.dlen = sizeof(breaker_info_t)-sizeof(breaker_channel_info_t)*(CH_MAX-cas->sBreaker.cnt);
  1251. rdata.data = (uint8_t*)&cas->sBreaker;
  1252. r = mb_write_read(cas, cur_dev_addr, &wdata, &rdata);
  1253. if(r==0) {
  1254. breaker_add(cas);
  1255. }
  1256. }
  1257. #endif
  1258. }
  1259. break;
  1260. case CASCADE_CMD_BREAKER_SAVE_UPDATE:
  1261. case CASCADE_CMD_BREAKER_SAVE_DELETE:
  1262. case CASCADE_CMD_BREAKER_SAVE_ADD:
  1263. {
  1264. wdata.dlen = sizeof(cmd_data_t);
  1265. wdata.data = (uint8_t*)cmd;
  1266. r = mb_write(cas, cur_dev_addr, &wdata);
  1267. }
  1268. break;
  1269. default:
  1270. cas->cmd = *cmd;
  1271. r = 0;
  1272. }
  1273. return r;
  1274. }
  1275. static int master_cmd_addr(cascade_handle_t *cas, cmd_data_t *cmd,int saddr,int index)
  1276. {
  1277. int i,r;
  1278. GlobalDeviceManager *dm=get_dm();
  1279. data_t rdata,wdata;
  1280. switch(cmd->cmd) {
  1281. case CASCADE_CMD_GET_INFO:
  1282. {
  1283. #if SURPPORT_OLD485
  1284. //LOGD("_____ master send CASCADE_CMD_GET_INFO surport old 485 type!!!\n");
  1285. sensor_data_t sdat;
  1286. slave_t *sl=slave_get(cas, saddr);
  1287. r = sensor_get(cas,saddr,&sdat);
  1288. if(r==0) {
  1289. dm->mmp->data[index].saddr = saddr;
  1290. dm->mmp->data[index].current = sdat.pwr.current * 1000;
  1291. dm->mmp->data[index].consumer = sdat.pwr.consumption * 1000;
  1292. dm->mmp->data[index].power = sdat.pwr.power* 1000;
  1293. dm->mmp->data[index].voltage = sdat.pwr.voltage* 1000;
  1294. dm->mmp->data[index].status = sdat.pwr.status;
  1295. dm->mmp->data[index].factor = sdat.pwr.factor* 1000;
  1296. dm->mmp->data[index].freq = sdat.pwr.freq* 1000;
  1297. dm->mmp->data[index].temprature = sdat.temprature * 100;
  1298. dm->mmp->data[index].humidity = sdat.humidity * 100;
  1299. //power_add(cas);
  1300. sl->err = 0;
  1301. }
  1302. else {
  1303. sl->err++;
  1304. }
  1305. #else
  1306. wdata.dlen = sizeof(cmd_data_t);
  1307. wdata.data = (uint8_t*)cmd;
  1308. rdata.dlen = sizeof(slave_info_t)-sizeof(channel_info_t)*CH_MAX;
  1309. rdata.data = (uint8_t*)&cas->sInfo;
  1310. //LOGD("_____ master send CASCADE_CMD_GET_INFO\n");
  1311. r = mb_write_read(cas, saddr, &wdata, &rdata);
  1312. if(r==0) {
  1313. // LOGD("______cas->info.cnt: %d\n", cas->sInfo.cnt);
  1314. rdata.dlen = sizeof(slave_info_t)-sizeof(channel_info_t)*(CH_MAX-cas->sInfo.cnt);
  1315. rdata.data = (uint8_t*)&cas->sInfo;
  1316. //LOGD("______cas->info.cnt1: %d\n", cas->sInfo.cnt);
  1317. r = mb_write_read(cas, saddr, &wdata, &rdata);
  1318. //LOGD("______cas->info.cnt2: %d\n", cas->sInfo.cnt);
  1319. // if(r==0) {
  1320. // power_add(cas);
  1321. // }
  1322. for(int i = 0; i < cas->sInfo.cnt;i++)
  1323. {
  1324. dm->mmp->data[index].current = cas->sInfo.ch[i].chinfo.current * 1000;
  1325. dm->mmp->data[index].consumer = cas->sInfo.ch[i].chinfo.consumption * 1000;
  1326. dm->mmp->data[index].power = cas->sInfo.ch[i].chinfo.power* 1000;
  1327. dm->mmp->data[index].voltage = cas->sInfo.ch[i].chinfo.voltage* 1000;
  1328. dm->mmp->data[index].status = cas->sInfo.ch[i].chinfo.status;
  1329. dm->mmp->data[index].factor = cas->sInfo.ch[i].chinfo.factor* 1000;
  1330. dm->mmp->data[index].freq = cas->sInfo.ch[i].chinfo.freq* 1000;
  1331. dm->mmp->data[index].temprature = cas->sInfo.ch[i].chinfo.tempratue * 100;
  1332. dm->mmp->data[index].humidity = cas->sInfo.ch[i].chinfo.humidity * 100;
  1333. dm->mmp->data[index].saddr = saddr;
  1334. }
  1335. }
  1336. else {
  1337. LOGE("_____ master CASCADE_CMD_GET_INFO failed\n");
  1338. }
  1339. #endif
  1340. }
  1341. break;
  1342. default:
  1343. cas->cmd = *cmd;
  1344. r = 0;
  1345. }
  1346. return r;
  1347. }
  1348. static int master_query(cascade_handle_t *cas)
  1349. {
  1350. int i,r;
  1351. GlobalPowerManger *tmp=NULL;
  1352. GlobalDeviceManager *dm2=get_dm2();
  1353. GlobalDeviceInfo *dev=&dm2->_globalDevInfo;
  1354. cmd_data_t *cmd=&cas->cmd;
  1355. data_t rdata,wdata;
  1356. if(cur_dev_addr==0) {
  1357. return -1;
  1358. }
  1359. wdata.dlen = sizeof(cmd_data_t);
  1360. wdata.data = (uint8_t*)cmd;
  1361. switch(cmd->cmd) {
  1362. case CASCADE_CMD_QUERY_CH:
  1363. {
  1364. //LOGD("__00__ master query CASCADE_CMD_QUERY_CH, cnt: %d\n", cas->sInfo.cnt);
  1365. if(cas->scanner_flag == 1)
  1366. return -1;
  1367. if(cas->sInfo.cnt==0) {
  1368. return -1;
  1369. }
  1370. #if SURPPORT_OLD485
  1371. sensor_data_t sdat;
  1372. slave_t *sl=slave_get(cas, cur_dev_addr);
  1373. r = sensor_get(cas,cur_dev_addr,&sdat);
  1374. if(r==0) {
  1375. cas->sInfo.cnt = 1;
  1376. cas->sInfo.prod.product_id = cur_dev_addr;
  1377. cas->sInfo.ch[0].chinfo.current = sdat.pwr.current;
  1378. cas->sInfo.ch[0].chinfo.consumption = sdat.pwr.consumption;
  1379. cas->sInfo.ch[0].chinfo.power = sdat.pwr.power;
  1380. cas->sInfo.ch[0].chinfo.voltage = sdat.pwr.voltage;
  1381. cas->sInfo.ch[0].chinfo.status = sdat.pwr.status;
  1382. cas->sInfo.ch[0].chinfo.factor = sdat.pwr.factor;
  1383. cas->sInfo.ch[0].chinfo.freq = sdat.pwr.freq;
  1384. cas->sInfo.ch[0].chinfo.tempratue = sdat.pwr.tempratue;
  1385. cas->sInfo.ch[0].chinfo.humidity = sdat.pwr.humidity;
  1386. sl->err = 0;
  1387. }
  1388. else {
  1389. sl->err++;
  1390. }
  1391. #else
  1392. rdata.dlen = sizeof(slave_info_t)-sizeof(channel_info_t)*(CH_MAX-cas->sInfo.cnt);
  1393. rdata.data = (uint8_t*)&cas->sInfo;
  1394. r = mb_write_read(cas, cur_dev_addr, &wdata, &rdata);
  1395. #endif
  1396. if(r==0) {
  1397. power_update(cas);
  1398. // cmd->cmd = CASCADE_CMD_BREAKER_QUERY;
  1399. }
  1400. else {
  1401. LOGE("____ master query CASCADE_CMD_QUERY_CH failed\n");
  1402. }
  1403. //LOGD("__11__ master query CASCADE_CMD_QUERY_CH, cnt: %d\n", cas->sInfo.cnt);
  1404. }
  1405. break;
  1406. case CASCADE_CMD_BREAKER_QUERY:
  1407. {
  1408. #if 0
  1409. wdata.dlen = sizeof(cmd_data_t);
  1410. wdata.data = (uint8_t*)cmd;
  1411. rdata.dlen = sizeof(breaker_info_t)-sizeof(breaker_channel_info_t)*CH_MAX;
  1412. rdata.data = (uint8_t*)&cas->sBreaker;
  1413. r = mb_write_read(cas, cur_dev_addr, &wdata, &rdata);
  1414. LOGD("____ master query CASCADE_CMD_BREAKER_QUERY, cnt: %d\n", cas->sBreaker.cnt);
  1415. if(cas->sBreaker.cnt == 0)
  1416. {
  1417. breaker_clear(cas);
  1418. cmd->cmd = CASCADE_CMD_QUERY_CH;
  1419. return -1;
  1420. }
  1421. rdata.dlen = sizeof(breaker_info_t)-sizeof(breaker_channel_info_t)*(CH_MAX-cas->sBreaker.cnt);
  1422. rdata.data = (uint8_t*)&cas->sBreaker;
  1423. r = mb_write_read(cas, cur_dev_addr, &wdata, &rdata);
  1424. if(r == 0)
  1425. {
  1426. breaker_add(cas);
  1427. cmd->cmd = CASCADE_CMD_QUERY_CH;
  1428. }else
  1429. {
  1430. LOGE("____ master query CASCADE_CMD_BREAKER_QUERY failed\n");
  1431. }
  1432. #endif
  1433. }
  1434. break;
  1435. case CASCADE_CMD_QUERY_VOL:
  1436. {
  1437. if(cmd->obj==OBJ_CHANNEL) {
  1438. //rdata.dlen = sizeof(chInfo);
  1439. //rdata.data = (uint8_t*)&chInfo;
  1440. }
  1441. else if(cmd->obj==OBJ_OVERALL) {
  1442. //rdata.dlen = sizeof(chInfo);
  1443. //rdata.data = (uint8_t*)&chInfo;
  1444. }
  1445. else {
  1446. return -1;
  1447. }
  1448. }
  1449. break;
  1450. case CASCADE_CMD_QUERY_CUR:
  1451. {
  1452. if(cmd->obj==OBJ_CHANNEL) {
  1453. //rdata.dlen = sizeof(chInfo);
  1454. //rdata.data = (uint8_t*)&chInfo;
  1455. }
  1456. else if(cmd->obj==OBJ_OVERALL) {
  1457. //rdata.dlen = sizeof(chInfo);
  1458. //rdata.data = (uint8_t*)&chInfo;
  1459. }
  1460. else {
  1461. return -1;
  1462. }
  1463. }
  1464. break;
  1465. case CASCADE_CMD_QUERY_PWR:
  1466. {
  1467. if(cmd->obj==OBJ_CHANNEL) {
  1468. //rdata.dlen = sizeof(chInfo);
  1469. //rdata.data = (uint8_t*)&chInfo;
  1470. }
  1471. else if(cmd->obj==OBJ_OVERALL) {
  1472. //rdata.dlen = sizeof(chInfo);
  1473. //rdata.data = (uint8_t*)&chInfo;
  1474. }
  1475. else {
  1476. return -1;
  1477. }
  1478. }
  1479. break;
  1480. case CASCADE_CMD_QUERY_PWRQ:
  1481. {
  1482. if(cmd->obj==OBJ_CHANNEL) {
  1483. //rdata.dlen = sizeof(chInfo);
  1484. //rdata.data = (uint8_t*)&chInfo;
  1485. }
  1486. else if(cmd->obj==OBJ_OVERALL) {
  1487. //rdata.dlen = sizeof(chInfo);
  1488. //rdata.data = (uint8_t*)&chInfo;
  1489. }
  1490. else {
  1491. return -1;
  1492. }
  1493. }
  1494. break;
  1495. case CASCADE_CMD_QUERY_HIS:
  1496. {
  1497. if(cmd->obj==OBJ_CHANNEL) {
  1498. //rdata.dlen = sizeof(chInfo);
  1499. //rdata.data = (uint8_t*)&chInfo;
  1500. }
  1501. else if(cmd->obj==OBJ_OVERALL) {
  1502. //rdata.dlen = sizeof(chInfo);
  1503. //rdata.data = (uint8_t*)&chInfo;
  1504. }
  1505. else {
  1506. return -1;
  1507. }
  1508. }
  1509. break;
  1510. case CASCADE_CMD_QUERY_TOTAL:
  1511. {
  1512. if(cmd->obj==OBJ_CHANNEL) {
  1513. //rdata.dlen = sizeof(chInfo);
  1514. //rdata.data = (uint8_t*)&chInfo;
  1515. }
  1516. else if(cmd->obj==OBJ_OVERALL) {
  1517. //rdata.dlen = sizeof(chInfo);
  1518. //rdata.data = (uint8_t*)&chInfo;
  1519. }
  1520. else {
  1521. return -1;
  1522. }
  1523. }
  1524. break;
  1525. case CASCADE_CMD_QUERY_TOTAL_PWR:
  1526. {
  1527. if(cmd->obj==OBJ_CHANNEL) {
  1528. //rdata.dlen = sizeof(chInfo);
  1529. //rdata.data = (uint8_t*)&chInfo;
  1530. }
  1531. else if(cmd->obj==OBJ_OVERALL) {
  1532. //rdata.dlen = sizeof(chInfo);
  1533. //rdata.data = (uint8_t*)&chInfo;
  1534. }
  1535. else {
  1536. return -1;
  1537. }
  1538. }
  1539. break;
  1540. default:
  1541. //LOGD("____ master query cmd: %d\n", cmd->cmd);
  1542. return -1;
  1543. }
  1544. return r;
  1545. }
  1546. static int slave_receive(cascade_handle_t *cas)
  1547. {
  1548. return mb_receive(cas);
  1549. }
  1550. static void* cascade_thread(void *arg)
  1551. {
  1552. int r;
  1553. thread_handle_t *h=(thread_handle_t*)arg;
  1554. cascade_handle_t *cas=(cascade_handle_t*)h->arg;
  1555. ModbusInfo_t *info=&cas->mInfo;
  1556. LOGD("__ cascade %s\n", info->product_modbus_type?"slave":"master");
  1557. while(h->quit==0) {
  1558. //if(info->product_modbus_type==0) { //主模
  1559. cascade_lock();
  1560. r = master_query(cas);
  1561. cascade_unlock();
  1562. // }
  1563. // else { //从模式,等待主设备发起数据请�?
  1564. // cascade_lock();
  1565. // r = slave_receive(cas);
  1566. // cascade_unlock();
  1567. // }
  1568. usleep(100000);
  1569. }
  1570. pthread_exit(NULL);
  1571. }
  1572. static void* scan_thread(void *arg)
  1573. {
  1574. int r;
  1575. thread_handle_t *h=(thread_handle_t*)arg;
  1576. cascade_handle_t *cas=(cascade_handle_t*)h->arg;
  1577. ModbusInfo_t *info=&cas->mInfo;
  1578. int i = 1;
  1579. while(h->quit==0) {
  1580. //if(info->product_modbus_type==0) { //master
  1581. cascade_lock();
  1582. //r = new_master_scaner(cas);
  1583. master_scan(cas);
  1584. cascade_unlock();
  1585. //}
  1586. sleep(1);
  1587. }
  1588. pthread_exit(NULL);
  1589. }
  1590. static void* cmd_thread(void *arg)
  1591. {
  1592. int i,t=0;
  1593. char temp[100];
  1594. cascade_handle_t *cas=&casHandle;
  1595. slave_info_t *info=&cas->sInfo;
  1596. GlobalDeviceManager *dm=get_dm();
  1597. cmd_data_t *pcmd=(cmd_data_t*)arg;
  1598. if(pcmd->cmd==CASCADE_CMD_OPEN) {
  1599. LOGD("____ slave CASCADE_CMD_OPEN\n");
  1600. }
  1601. else {
  1602. LOGD("____ slave CASCADE_CMD_CLOSE\n");
  1603. }
  1604. int flag=((pcmd->cmd==CASCADE_CMD_OPEN)?1:0);
  1605. if(pcmd->chId == 0xff) {
  1606. int sendAddr = 0;
  1607. for(i=0; i<info->cnt; i++) {
  1608. if(info->ch[i].product_ch_addr>0) {
  1609. if(info->ch[i].product_ch_addr==sendAddr) {
  1610. continue;
  1611. }
  1612. else {
  1613. sendAddr = info->ch[i].product_ch_addr;
  1614. }
  1615. t = g_switch_set_all_ctrl(&dm->_globalRelaySampManger, info->ch[i].product_ch_type, info->ch[i].product_ch_addr, flag);
  1616. if(t<0) {
  1617. LOGE("___ %d %s failed\n", info->ch[i].product_ch_addr, (pcmd->cmd==CASCADE_CMD_OPEN)?"open":"close");
  1618. }
  1619. }
  1620. }
  1621. }
  1622. else {
  1623. GlobalPowerManger *tmp=NULL;
  1624. list_for_each_entry(tmp, &dm->_globalPowerManger.list, list)
  1625. {
  1626. if(tmp->product_ch_id==pcmd->chId) {
  1627. t = g_switch_set_all_chn_ctrl(&dm->_globalRelaySampManger, tmp, tmp->product_saddr, tmp->product_ch_addr, flag, false);
  1628. break;
  1629. }
  1630. }
  1631. }
  1632. if(pcmd->cmd==CASCADE_CMD_OPEN) {
  1633. sprintf(temp,"$开启$|$所有$|$通道$");
  1634. }
  1635. else {
  1636. sprintf(temp,"$关闭$|$所有$|$通道$");
  1637. }
  1638. dev_insert_alarm_ctrl(dm->db, dm->_globalDevInfo.product_id,3,temp);
  1639. free(pcmd);
  1640. pthread_exit(NULL);
  1641. }
  1642. static void* cmd_NF_thread(void *arg)
  1643. {
  1644. int i,t=0;
  1645. char temp[256];
  1646. cascade_handle_t *cas=&casHandle;
  1647. slave_info_t *info=&cas->sInfo;
  1648. GlobalDeviceManager *dm=get_dm();
  1649. cmd_data_t *pcmd=(cmd_data_t*)arg;
  1650. if(pcmd->cmd==CASCADE_CMD_OPEN_NF) {
  1651. LOGD("____ slave CASCADE_CMD_OPEN_NF\n");
  1652. }
  1653. else {
  1654. LOGD("____ slave CASCADE_CMD_CLOSE_NF\n");
  1655. }
  1656. int flag=(pcmd->cmd==CASCADE_CMD_OPEN_NF)?1:0;
  1657. if(pcmd->obj == OBJ_CHANNEL)
  1658. {
  1659. GlobalPowerManger *tmp=NULL;
  1660. list_for_each_entry(tmp, &dm->_globalPowerManger.list, list)
  1661. {
  1662. if(tmp->product_ch_id==pcmd->chId) {
  1663. t = g_switch_set_t_ac_chn_NF_ctrl(&dm->_globalRelaySampManger, tmp->product_saddr, tmp->product_ch_addr, flag);
  1664. break;
  1665. }
  1666. }
  1667. }
  1668. if(pcmd->cmd==CASCADE_CMD_OPEN_NF) {
  1669. sprintf(temp, "$开启$|$通道$|%d Naught wire!", pcmd->chId);
  1670. }
  1671. else {
  1672. sprintf(temp, "$关闭$|$通道$|%d Naught wire!", pcmd->chId);
  1673. }
  1674. dev_insert_alarm_ctrl(dm->db, dm->_globalDevInfo.product_id,3,temp);
  1675. free(pcmd);
  1676. pthread_exit(NULL);
  1677. }
  1678. static int set_modbus(cascade_handle_t *cas, ModbusInfo_t *info)
  1679. {
  1680. int r;
  1681. if(cas->inited) {
  1682. mb_deinit(cas);
  1683. }
  1684. cas->inited = 0;
  1685. cas->mInfo = *info;
  1686. //LOGD("master init modbus: port: %s, type: %d, baud: %d\n", CASCADE_MODBUS_PORT, info->product_modbus_type, info->product_modbus_baud);
  1687. r = mb_init(cas, CASCADE_MODBUS_PORT, 0,
  1688. 0, 115200);
  1689. if(r!=0) {
  1690. LOGE("cascade modbus init error.\n");
  1691. return -1;
  1692. }
  1693. cas->inited = 1;
  1694. cas->scanner_flag = 0;
  1695. // if (cas->mInfo.product_modbus_type)
  1696. // {
  1697. // for (size_t i = 1; i < CASCADE_MAX; i++)
  1698. // {
  1699. // slave_rm(cas,i);
  1700. // }
  1701. // }
  1702. return 0;
  1703. }
  1704. #include <net/if.h>
  1705. #include <ifaddrs.h>
  1706. static int get_ipaddr(int family, char *iface, char *addr, char *netmask)
  1707. {
  1708. struct ifaddrs *ifap, *ifa;
  1709. if (getifaddrs(&ifap) == -1) {
  1710. LOGE("___getifaddrs() error\n");
  1711. return -1;
  1712. }
  1713. for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) {
  1714. if (ifa->ifa_addr != NULL && ifa->ifa_addr->sa_family == family) {
  1715. if(family==AF_INET) {
  1716. struct sockaddr_in *sa,*msk;
  1717. sa = (struct sockaddr_in *) ifa->ifa_addr;
  1718. msk = (struct sockaddr_in *) ifa->ifa_netmask;
  1719. if(addr) {
  1720. inet_ntop(family, &sa->sin_addr, addr, INET6_ADDRSTRLEN);
  1721. printf("___addr: %s\n", addr);
  1722. }
  1723. if(netmask) {
  1724. inet_ntop(family, &msk->sin_addr, netmask, INET6_ADDRSTRLEN);
  1725. //printf("___netmask: %s\n", netmask);
  1726. }
  1727. }
  1728. else {
  1729. struct sockaddr_in6 *sa,*msk;
  1730. sa = (struct sockaddr_in6 *) ifa->ifa_addr;
  1731. msk = (struct sockaddr_in6 *) ifa->ifa_netmask;
  1732. if(addr) {
  1733. inet_ntop(family, &sa->sin6_addr, addr, INET6_ADDRSTRLEN);
  1734. //printf("___addr6: %s\n", addr);
  1735. }
  1736. if(netmask) {
  1737. inet_ntop(family, &msk->sin6_addr, netmask, INET6_ADDRSTRLEN);
  1738. //printf("___netmask6: %s\n", netmask);
  1739. }
  1740. }
  1741. }
  1742. }
  1743. freeifaddrs(ifap);
  1744. return 0;
  1745. }
  1746. int cascade_init(void)
  1747. {
  1748. int r=0;
  1749. cascade_handle_t *cas=&casHandle;
  1750. memset(cas, 0, sizeof(casHandle));
  1751. power_init(cas);
  1752. // breaker_slave_init();
  1753. slave_init(cas);
  1754. r = pthread_mutex_init(&cas->mutex, NULL);
  1755. if(r) {
  1756. LOGE("___ cascade mutex init failed\n");
  1757. }
  1758. r = pthread_mutex_init(&cas->lock, NULL);
  1759. if(r) {
  1760. LOGE("___ cascade lock init failed\n");
  1761. }
  1762. cas->scanAddr = 1;
  1763. cas->map = modbus_mapping_new_start_address(0,0,0,0,
  1764. CASCADE_REG_READ, MAX_READ_REGS2,
  1765. CASCADE_REG_WRITE, MAX_WRITE_REGS2);
  1766. set_modbus(cas, get_mb());
  1767. slave_add(cas, 0);
  1768. thread_start(THREAD_ID_CASCADE, cascade_thread, cas, 4*MB, 0);
  1769. thread_start(THREAD_ID_SCAN, scan_thread, cas, 4*MB, 0);
  1770. GlobalDeviceManager* dm =get_dm();
  1771. NetworkInfo_t net = {0};
  1772. //sys_get_net(&net,IP_V4);
  1773. int family = AF_INET;
  1774. r = get_ipaddr(family, "eth0", net.ip_address, net.mask);
  1775. uint8_t addr = 0;
  1776. if(dm->_globalDevInfo._gmodbus_info.product_modbus_type == 0)
  1777. {
  1778. addr = 0XFF;
  1779. }else
  1780. {
  1781. addr = dm->_globalDevInfo._gmodbus_info.product_modbus_addr;
  1782. }
  1783. dm->md_tcp = tcp_modbus_init(net.ip_address,CASCADE_SLAVE_PORT,addr,dm->_globalDevInfo.product_pwr_type);
  1784. thread_start(THREAD_ID_TCP, tcp_modbus_thread, cas, 4*MB, 0);
  1785. return 0;
  1786. }
  1787. int cascade_deinit(void)
  1788. {
  1789. cascade_handle_t *cas=&casHandle;
  1790. thread_stop(THREAD_ID_CASCADE);
  1791. thread_stop(THREAD_ID_SCAN);
  1792. pthread_mutex_destroy(&cas->mutex);
  1793. pthread_mutex_destroy(&cas->lock);
  1794. modbus_mapping_free(cas->map);
  1795. mb_deinit(cas);
  1796. power_deinit(cas);
  1797. return 0;
  1798. }
  1799. int cascade_set_modbus(ModbusInfo_t *info)
  1800. {
  1801. cascade_handle_t *cas=&casHandle;
  1802. if(!info || info->product_modbus_addr>CASCADE_MAX) {
  1803. return -1;
  1804. }
  1805. return set_modbus(cas, info);
  1806. }
  1807. int cascade_get_dlist(dev_list_t *dl)
  1808. {
  1809. int i,cnt=0;
  1810. slave_t *sl=NULL;
  1811. cascade_handle_t *cas=&casHandle;
  1812. if(!dl) {
  1813. return -1;
  1814. }
  1815. sl = (slave_t*)malloc(sizeof(slave_t)*(CASCADE_MAX+1));
  1816. if(!sl) {
  1817. return -1;
  1818. }
  1819. for(i=0; i<=CASCADE_MAX; i++) {
  1820. if(cas->slaves[i].addr>=0) {
  1821. sl[cnt++] = cas->slaves[i];
  1822. }
  1823. }
  1824. dl->slave = sl;
  1825. dl->cnt = cnt;
  1826. //LOGD("____dev cnt: %d\n", cnt);
  1827. return 0;
  1828. }
  1829. /**
  1830. * @brief 释放级联设备列表
  1831. *
  1832. * 释放给定的级联设备列表(dev_list_t)中的 slave 成员所指向的内存。
  1833. *
  1834. * @param dl 级联设备列表指针
  1835. *
  1836. * @return 成功返回 0,失败返回 -1
  1837. */
  1838. int cascade_free_dlist(dev_list_t *dl)
  1839. {
  1840. if(!dl) {
  1841. return -1;
  1842. }
  1843. free(dl->slave);
  1844. return 0;
  1845. }
  1846. /**
  1847. * @brief 级联请求
  1848. *
  1849. * 根据给定的命令数据执行级联请求,并返回执行结果。
  1850. *
  1851. * @param cmd 命令数据指针
  1852. *
  1853. * @return 执行结果,成功返回0,失败返回-1
  1854. */
  1855. int cascade_request(cmd_data_t *cmd)
  1856. {
  1857. int r=0;
  1858. cascade_handle_t *cas=&casHandle;
  1859. if(!cmd) {
  1860. return -1;
  1861. }
  1862. pthread_mutex_lock(&cas->lock);
  1863. cas->scanner_flag = 1;
  1864. r = master_cmd(cas, cmd);
  1865. cas->scanner_flag = 0;
  1866. pthread_mutex_unlock(&cas->lock);
  1867. return r;
  1868. }
  1869. int cascade_request_saddr(cmd_data_t *cmd,int saddr,int index)
  1870. {
  1871. int r=0;
  1872. cascade_handle_t *cas=&casHandle;
  1873. if(!cmd) {
  1874. return -1;
  1875. }
  1876. pthread_mutex_lock(&cas->lock);
  1877. cas->scanner_flag = 1;
  1878. r = master_cmd_addr(cas, cmd,saddr, index);
  1879. cas->scanner_flag = 0;
  1880. pthread_mutex_unlock(&cas->lock);
  1881. return 0;
  1882. }
  1883. int cascade_get_all(_OverAllPwrAckInfo *all)
  1884. {
  1885. return 0;
  1886. }
  1887. int cascade_get_ch(_OverChnPwrAckInfo *ch)
  1888. {
  1889. GlobalPowerManger *tmp=NULL;
  1890. GlobalTreeACManager *tmp3=NULL;
  1891. _OverChnPwrAckInfo *pch=NULL;
  1892. GlobalDeviceManager* dm2=get_dm2();
  1893. list_for_each_entry(tmp, &dm2->_globalPowerManger.list, list)
  1894. {
  1895. if (tmp->product_ch_type==TREE_AC_TYPE||dm2->_globalDevInfo.product_pwr_type == SmartPDU_Tree_AC_One_B){
  1896. int nStatus=-1;//-1则状态不变,0、1则是子状态
  1897. //判断是否三相单输出情况下
  1898. if(tmp->product_ch_type==TREE_AC_TYPE||dm2->_globalDevInfo.product_pwr_type == SmartPDU_Tree_AC_One_B) {
  1899. list_for_each_entry(tmp3, &tmp->list_Tree_AC, list_Tree_AC) {
  1900. if (2 == tmp3->product_ph_outputType &&1==tmp3->product_ph_outputStatus)
  1901. {//单项并且状态为输出
  1902. nStatus = tmp3->_PowerInfo.status;
  1903. }
  1904. }
  1905. }
  1906. list_for_each_entry(tmp3, &tmp->list_Tree_AC, list_Tree_AC)
  1907. {
  1908. pch = (_OverChnPwrAckInfo *)malloc(sizeof(_OverChnPwrAckInfo));
  1909. if (pch == NULL) {
  1910. LOGE("pch malloc err.\n");
  1911. return -1;
  1912. }
  1913. pch->product_name = dm2->_globalDevInfo.product_name;
  1914. pch->product_number = dm2->_globalDevInfo.product_number;
  1915. pch->product_id = dm2->_globalDevInfo.product_id;
  1916. pch->productChName = tmp->product_ch_name;
  1917. pch->productChId = tmp->product_ch_id;
  1918. pch->status = tmp->_PowerInfo.status;
  1919. pch->voltage = tmp->_PowerInfo.voltage;
  1920. pch->current = tmp->_PowerInfo.current;
  1921. pch->power = tmp->_PowerInfo.power;
  1922. pch->freq = tmp->_PowerInfo.freq;
  1923. pch->consumption = tmp->_PowerInfo.consumption;
  1924. pch->factor = tmp->_PowerInfo.factor;
  1925. pch->product_ch_start_delay = tmp->product_ch_start_delay;
  1926. pch->product_ch_stop_delay = tmp->product_ch_stop_delay;
  1927. pch->product_type=tmp->product_ch_type;
  1928. pch->product_phType = tmp3->product_ph_type;
  1929. pch->ph_voltage = tmp3->_PowerInfo.voltage;
  1930. pch->ph_current = tmp3->_PowerInfo.current;
  1931. pch->ph_power = tmp3->_PowerInfo.power;
  1932. pch->ph_consumption = tmp3->_PowerInfo.consumption;
  1933. pch->ph_outputType = tmp3->product_ph_outputType;
  1934. pch->ph_outputStatus = tmp3->product_ph_outputStatus;
  1935. if ((dm2->_globalDevInfo.product_pwr_type == SmartPDU_Tree_AC_One||dm2->_globalDevInfo.product_pwr_type == SmartPDU_Tree_AC_One_B) &&
  1936. tmp3->product_ph_outputType == 2 && tmp3->product_ph_outputStatus == 2) // 如果是单项输出并且则非输出通道数据为0
  1937. {
  1938. // 3-1模式 单项状态,不输出则数据为空
  1939. pch->ph_voltage = 0.0;
  1940. pch->ph_current = 0.0;
  1941. pch->ph_power = 0.0;
  1942. pch->ph_consumption = 0.0;
  1943. }
  1944. if (nStatus>=0)
  1945. {
  1946. pch->status = nStatus;
  1947. }else {
  1948. pch->status = tmp->_PowerInfo.status;
  1949. }
  1950. list_add_tail(&pch->list, &ch->list);
  1951. }
  1952. }
  1953. else {
  1954. pch = (_OverChnPwrAckInfo *)malloc(sizeof(_OverChnPwrAckInfo));
  1955. if (pch == NULL) {
  1956. log_e("_overChnPwrBackInfoTemp malloc err.");
  1957. return -1;
  1958. }
  1959. // 填数据
  1960. pch->product_name = dm2->_globalDevInfo.product_name;
  1961. pch->product_number = dm2->_globalDevInfo.product_number;
  1962. pch->product_id = dm2->_globalDevInfo.product_id;
  1963. pch->productChName = tmp->product_ch_name;
  1964. pch->productChId = tmp->product_ch_id;
  1965. pch->status = tmp->_PowerInfo.status;
  1966. pch->voltage = tmp->_PowerInfo.voltage;
  1967. pch->current = tmp->_PowerInfo.current;
  1968. pch->power = tmp->_PowerInfo.power;
  1969. pch->freq = tmp->_PowerInfo.freq;
  1970. pch->consumption = tmp->_PowerInfo.consumption;
  1971. pch->factor = tmp->_PowerInfo.factor;
  1972. pch->product_ch_start_delay = tmp->product_ch_start_delay;
  1973. pch->product_ch_stop_delay = tmp->product_ch_stop_delay;
  1974. list_add_tail(&pch->list, &ch->list);
  1975. }
  1976. }
  1977. return 0;
  1978. }
  1979. int cascade_lock(void)
  1980. {
  1981. cascade_handle_t *cas=&casHandle;
  1982. return pthread_mutex_lock(&cas->mutex);
  1983. }
  1984. int cascade_unlock(void)
  1985. {
  1986. cascade_handle_t *cas=&casHandle;
  1987. return pthread_mutex_unlock(&cas->mutex);
  1988. }