net_104.c 67 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231
  1. /******************************************************************************
  2. 版权所有:
  3. 文件名称: net_104.c
  4. 文件版本: 01.01
  5. 创建作者: sunxi
  6. 创建日期: 2012-11-07
  7. 功能说明: 网络104接口
  8. 其它说明:
  9. 修改记录:
  10. */
  11. #ifdef CPU_FUXI
  12. /*------------------------------- 头文件 --------------------------------------
  13. */
  14. #include "head.h"
  15. #include <pthread.h>
  16. #include <errno.h>
  17. #include <sys/prctl.h>
  18. /*------------------------------- 宏定义 --------------------------------------
  19. */
  20. #define NET_104_BUF_SIZE 16384
  21. /*------------------------------ 类型结构 -------------------------------------
  22. */
  23. /*------------------------------ 全局变量 -------------------------------------
  24. */
  25. // static struct task_struct * g_ts_104[IEC104_TOTAL_SOCKETS];
  26. static pthread_t g_ts_104[IEC104_TOTAL_SOCKETS] = {0x00};
  27. static SOCKET g_104_client[IEC104_TOTAL_SOCKETS];
  28. static unsigned char g_net_104_buf_frame[IEC104_TOTAL_SOCKETS][NET_RECV_MAX]; // 以太网接收缓冲区
  29. static unsigned char g_net_104_buf[IEC104_TOTAL_SOCKETS][NET_104_BUF_SIZE]; // 以太网接收缓冲区
  30. static struct rt_fifo g_net_104_fifo[IEC104_TOTAL_SOCKETS];
  31. static volatile int g_net_reinit[CFG_ETH_MAX_LOGIC] = {NET_SOCKET_INIT}; // 网络重新初始化标志.0表示不用重新初始化,1表示需要重新初始化
  32. // static struct semaphore net_r_lock[CFG_ETH_MAX_LOGIC]; //接收锁
  33. // static struct semaphore net_s_lock[CFG_ETH_MAX_LOGIC]; //发送锁
  34. static pthread_mutex_t net_r_lock[CFG_ETH_MAX_LOGIC]; // 接收锁
  35. static pthread_mutex_t net_s_lock[CFG_ETH_MAX_LOGIC]; // 发送锁
  36. static int g_net_104_close_flag[CFG_ETH_MAX_LOGIC];
  37. static int g_net_104_exit_flag[CFG_ETH_MAX_LOGIC];
  38. // static struct completion g_exit_completion_net_104[CFG_ETH_MAX_LOGIC];
  39. extern u32 g_ip_net_maintain; // 104维护工具调试客户端地址
  40. /*------------------------------ 函数声明 -------------------------------------
  41. */
  42. int _net_104_thread(IEC104_DEF *pt104);
  43. // 设置socket关闭标志并等待socket关闭完成
  44. void net_104_set_sock_closing(int no)
  45. {
  46. // if(no >= g_net_num) return;
  47. g_net_reinit[no] = NET_SOCKET_CLOSING; // 置关闭标志
  48. if (!tRunPara.b104Client)
  49. {
  50. int count = 0;
  51. // 等待关闭完成
  52. while (g_net_reinit[no] != NET_SOCKET_CLOSED)
  53. {
  54. msleep(20);
  55. if (++count > 150)
  56. {
  57. rt_printf("104 client socket close fail!!!\r\n");
  58. return;
  59. }
  60. }
  61. }
  62. }
  63. // 设置socket重新创建标志
  64. void net_104_set_sock_initflag(int no)
  65. {
  66. // if(no >= g_net_num) return;
  67. if (g_net_reinit[no] == NET_SOCKET_CLOSED)
  68. {
  69. g_net_reinit[no] = NET_SOCKET_REINIT;
  70. }
  71. }
  72. /**************************************************************************
  73. 函数名称:Net_Init
  74. 函数版本:1.00
  75. 作者:
  76. 创建日期:2009.1.8
  77. 函数功能说明:以太网初始化
  78. 输入参数:
  79. 输出参数:
  80. 返回值:
  81. 更新信息:
  82. 更新日志1:
  83. 日期:
  84. 修改者:
  85. 修改内容:
  86. 修改原因:
  87. ***************************************************************************/
  88. void Net_Init(void)
  89. {
  90. unsigned char mac[6];
  91. unsigned char ip[4];
  92. unsigned char mask[4];
  93. unsigned char gw[4];
  94. unsigned char routenet[4];
  95. unsigned char routenetmask[4];
  96. unsigned char routegate[4];
  97. // char * acteth;
  98. int i, j;
  99. // char tmp[16];
  100. int ret = 0;
  101. int gateflag = 0;
  102. if (tRunPara.w104K == 0)
  103. {
  104. if (pRunSet->bTT_SoeResumeComm || pRunSet->bTT_SoeResumePower)
  105. {
  106. rt_printf("定值参数错误:SOE通讯续传、SOE上电续传时参数104 K值不能为0.\r\n");
  107. rt_err_set(ERR_CODE_INIT_SOFTWARE, 0);
  108. }
  109. }
  110. #if 0
  111. int debug_port;
  112. acteth = env_get_info(ENV_ETHACT);
  113. if(acteth != NULL)
  114. {
  115. if(strcmp(acteth,"eth0") == 0)
  116. {
  117. debug_port = 0;
  118. }
  119. else if(strcmp(acteth,"eth1") == 0)
  120. {
  121. debug_port = 1;
  122. }
  123. else if(strcmp(acteth,"eth2") == 0)
  124. {
  125. debug_port = 2;
  126. }
  127. else
  128. {
  129. debug_port = 2;
  130. }
  131. }
  132. else
  133. {
  134. debug_port = 2;
  135. }
  136. #endif
  137. for (i = 0; i < CFG_ETH_MAX_LOGIC; i++)
  138. {
  139. // 没有改变参数,不用初始化
  140. if (!tRunPara.tNetPara[i].bInit)
  141. {
  142. // 104配置参数有修改,需关闭socket重新初始化
  143. if (tRunPara.sock_104_flag)
  144. {
  145. net_104_set_sock_initflag(i);
  146. }
  147. continue;
  148. }
  149. gateflag = 1;
  150. tRunPara.tNetPara[i].bInit = false;
  151. // 设置接口MAC地址
  152. // if(rt_if_sz2mac(env_get_info(ENV_NET1MAC+i),mac)< 0)
  153. mac[0] = 'H';
  154. mac[1] = 'G';
  155. mac[2] = (BYTE)((tRunPara.tNetPara[i].wIp >> 24) & 0xff);
  156. mac[3] = (BYTE)((tRunPara.tNetPara[i].wIp >> 16) & 0xff);
  157. mac[4] = (BYTE)((tRunPara.tNetPara[i].wIp >> 8) & 0xff);
  158. mac[5] = (BYTE)((tRunPara.tNetPara[i].wIp >> 0) & 0xff);
  159. // 设置IP
  160. memset(ip, 0, sizeof(ip));
  161. ip[3] = (BYTE)((tRunPara.tNetPara[i].wIp >> 0) & 0xff); // 低
  162. ip[2] = (BYTE)((tRunPara.tNetPara[i].wIp >> 8) & 0xff);
  163. ip[1] = (BYTE)((tRunPara.tNetPara[i].wIp >> 16) & 0xff);
  164. ip[0] = (BYTE)((tRunPara.tNetPara[i].wIp >> 24) & 0xff); // 高 192
  165. // 设置MASK
  166. memset(mask, 0, sizeof(mask));
  167. mask[3] = (BYTE)((tRunPara.tNetPara[i].wMask >> 0) & 0xff);
  168. mask[2] = (BYTE)((tRunPara.tNetPara[i].wMask >> 8) & 0xff);
  169. mask[1] = (BYTE)((tRunPara.tNetPara[i].wMask >> 16) & 0xff);
  170. mask[0] = (BYTE)((tRunPara.tNetPara[i].wMask >> 24) & 0xff);
  171. // 检查是否需要关闭虚拟网卡
  172. if ((int)tRunPara.tNetPara[i].old_index > 0)
  173. {
  174. rt_if_down2(tRunPara.tNetPara[i].old_ethid, tRunPara.tNetPara[i].old_index);
  175. }
  176. // 获取配置相同的ethid有多少个
  177. ret = get_ethcnt(i, tRunPara.tNetPara[i].ethid);
  178. // 没有的话,使用物理的
  179. if (ret == 0)
  180. {
  181. // 设置网络参数
  182. net_if_set((int)tRunPara.tNetPara[i].ethid, mac, ip, mask);
  183. tRunPara.tNetPara[i].index = 0;
  184. // rt_printf_time("ret = %d, ethID = %d\r\n",ret,tRunPara.tNetPara[i].ethid);
  185. }
  186. else // 有的话使用虚拟的
  187. {
  188. #if (1)
  189. net_if_set2((int)tRunPara.tNetPara[i].ethid, ret + 1, 0, ip, mask);
  190. tRunPara.tNetPara[i].index = ret + 1;
  191. #else
  192. net_if_set2((int)tRunPara.tNetPara[i].ethid, i + 1, 0, ip, mask);
  193. tRunPara.tNetPara[i].index = i + 1;
  194. #endif
  195. // rt_printf_time("Xnet = %d,ip=%x, ethID = %d, ret = %d\r\n",tRunPara.tNetPara[i].index,ip[3],tRunPara.tNetPara[i].ethid,ret);
  196. }
  197. tRunPara.tNetPara[i].old_ethid = tRunPara.tNetPara[i].ethid;
  198. tRunPara.tNetPara[i].old_index = tRunPara.tNetPara[i].index;
  199. #if 0
  200. // 如果是调试串口,不初始化
  201. if(i == debug_port)
  202. //if(i==(CFG_ETH_MAX_LOGIC-1))
  203. {
  204. //设置IP环境变量
  205. if(tRunPara.tNetPara[i].changed & 0x01)
  206. {
  207. sprintf(tmp, "%lu.%lu.%lu.%lu",( tRunPara.tNetPara[i].wIp>>24)&0xff, (tRunPara.tNetPara[i].wIp>>16)&0xff, (tRunPara.tNetPara[i].wIp>>8)&0xff, (tRunPara.tNetPara[i].wIp&0xff));
  208. env_setenv("ipaddr", tmp);
  209. }
  210. //设置Gate环境变量
  211. if(tRunPara.tNetPara[i].changed & 0x02)
  212. {
  213. sprintf(tmp, "%lu.%lu.%lu.%lu", ( tRunPara.tNetPara[i].wGate>>24)&0xff, (tRunPara.tNetPara[i].wGate>>16)&0xff, (tRunPara.tNetPara[i].wGate>>8)&0xff, (tRunPara.tNetPara[i].wGate&0xff));
  214. if(tRunPara.tNetPara[i].wGate)
  215. env_setenv("gatewayip", tmp);
  216. }
  217. //设置Mask环境变量
  218. if(tRunPara.tNetPara[i].changed & 0x04)
  219. {
  220. sprintf(tmp, "%lu.%lu.%lu.%lu", ( tRunPara.tNetPara[i].wMask>>24)&0xff, (tRunPara.tNetPara[i].wMask>>16)&0xff, (tRunPara.tNetPara[i].wMask>>8)&0xff, (tRunPara.tNetPara[i].wMask&0xff));
  221. env_setenv("netmask", tmp);
  222. }
  223. //设置ethact环境变量
  224. if(tRunPara.tNetPara[i].changed & 0x40)
  225. {
  226. if(tRunPara.tNetPara[i].ethid >= 2)
  227. {
  228. sprintf(tmp, "%s", "eth2");
  229. }
  230. else
  231. {
  232. sprintf(tmp, "eth%d", (int)tRunPara.tNetPara[i].ethid);
  233. }
  234. env_setenv("ethact", tmp);
  235. }
  236. //continue;
  237. }
  238. #endif
  239. // 网段
  240. routenet[0] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 24) & 0xff);
  241. routenet[1] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 16) & 0xff);
  242. routenet[2] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 8) & 0xff);
  243. routenet[3] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 0) & 0xff);
  244. // 网段掩码
  245. routenetmask[0] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 24) & 0xff);
  246. routenetmask[1] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 16) & 0xff);
  247. routenetmask[2] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 8) & 0xff);
  248. routenetmask[3] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 0) & 0xff);
  249. // 网关
  250. routegate[0] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 24) & 0xff);
  251. routegate[1] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 16) & 0xff);
  252. routegate[2] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 8) & 0xff);
  253. routegate[3] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 0) & 0xff);
  254. net_route_set(routenet, routenetmask, routegate);
  255. // g_net_reinit[i] = 1;//置重新初始化标志
  256. net_104_set_sock_initflag(i);
  257. net_debug_set_sock_initflag();
  258. net_maintain_set_sock_initflag();
  259. #if 0
  260. // 得到并打印新的网络参数
  261. // net_if_get(i,mac,ip,mask);
  262. dp_info_nt("new mac: %02x:%02x:%02x:%02x:%02x:%02x", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
  263. dp_info_nt("new ip: %d.%d.%d.%d", ip[0], ip[1], ip[2], ip[3]);
  264. dp_info_nt("new mask: %d.%d.%d.%d", mask[0], mask[1], mask[2], mask[3]);
  265. dp_info_nt("new gw: %d.%d.%d.%d", gw[0], gw[1], gw[2], gw[3]);
  266. printf("\r\n");
  267. #endif
  268. }
  269. ret = 0;
  270. // 查找是否关闭物理网卡
  271. for (i = 0; i < g_net_num; i++)
  272. {
  273. for (j = 0; j < CFG_ETH_MAX_LOGIC; j++)
  274. {
  275. if (tRunPara.tNetPara[j].ethid == i)
  276. {
  277. ret++; // 虚拟网卡使用物理网卡计数
  278. }
  279. }
  280. // 没有虚拟网卡使用物理网卡
  281. if (ret == 0)
  282. {
  283. rt_if_down(i);
  284. }
  285. ret = 0;
  286. }
  287. // 设置网关
  288. gw[0] = (BYTE)((tRunPara.tNetPara[0].wGate >> 24) & 0xff);
  289. gw[1] = (BYTE)((tRunPara.tNetPara[0].wGate >> 16) & 0xff);
  290. gw[2] = (BYTE)((tRunPara.tNetPara[0].wGate >> 8) & 0xff);
  291. gw[3] = (BYTE)((tRunPara.tNetPara[0].wGate >> 0) & 0xff);
  292. // 如果地址是默认的0.0.0.0,说明用户不需要网关,
  293. // 不重设网关,使uboot环境变量中的网关有效,方便调试。
  294. if (gw[0] == 0 && gw[1] == 0 && gw[2] == 0 && gw[3] == 0)
  295. {
  296. return;
  297. }
  298. if (gateflag)
  299. {
  300. net_gateway_set(gw);
  301. }
  302. // noted by sunxi: 20230105 eth0需要重新设置mac才能成功。
  303. for (i = 0; i < 1; i++)
  304. {
  305. mac[0] = 'H';
  306. mac[1] = 'G';
  307. mac[2] = (BYTE)((tRunPara.tNetPara[i].wIp >> 24) & 0xff);
  308. mac[3] = (BYTE)((tRunPara.tNetPara[i].wIp >> 16) & 0xff);
  309. mac[4] = (BYTE)((tRunPara.tNetPara[i].wIp >> 8) & 0xff);
  310. mac[5] = (BYTE)((tRunPara.tNetPara[i].wIp >> 0) & 0xff);
  311. rt_if_down(i);
  312. net_if_set((int)tRunPara.tNetPara[i].ethid, mac, NULL, NULL);
  313. rt_if_up(i);
  314. }
  315. return;
  316. }
  317. /*------------------------------ 外部函数 -------------------------------------
  318. 外部函数供其它实体文件引用,必须仔细检查传入参数的合法性.
  319. */
  320. int net_104_init(void)
  321. {
  322. int net;
  323. char buf[32];
  324. // struct sched_param sp;
  325. // pid_t pid;
  326. int ret;
  327. pthread_attr_t attr;
  328. IEC104_Init();
  329. for (net = 0; net < CFG_ETH_MAX_LOGIC; net++)
  330. // for(net=0; net<1; net++)
  331. {
  332. g_104_client[net] = RT_SOCKET_ERR;
  333. // init_completion(&g_exit_completion_net_104[net]);
  334. g_net_reinit[net] = 0; // 初始化标志
  335. // init_MUTEX(&net_r_lock[net]);//初始化接收锁
  336. // init_MUTEX(&net_s_lock[net]);//初始化发送锁
  337. pthread_mutex_init(&net_r_lock[net], NULL);
  338. pthread_mutex_init(&net_s_lock[net], NULL);
  339. // 如果接口不正常,不初始化
  340. #if 0
  341. if(tRunPara.tNetPara[net].index == 0)
  342. {
  343. if(rt_if_ip_get(tRunPara.tNetPara[net].ethid, buf)!=0)
  344. {
  345. continue;
  346. }
  347. }
  348. else
  349. {
  350. if(rt_if_ip_get2(tRunPara.tNetPara[net].ethid, tRunPara.tNetPara[net].index, buf)!=0)
  351. {
  352. continue;
  353. }
  354. }
  355. // 运行应用104线程
  356. sprintf(buf,"net_104_%d",net);
  357. pid = kernel_thread((int (*)(void *))_net_104_thread,&g_t104[net],CLONE_FS | CLONE_FILES | CLONE_SIGHAND);
  358. g_ts_104[net] = find_task_by_vpid(pid);
  359. if(IS_ERR(g_ts_104[net]))
  360. {
  361. rt_printf("ts=%p\r\n",g_ts_104[net]);
  362. g_ts_104[net] = NULL;
  363. return -1;
  364. }
  365. // 设置调度策略和优先级
  366. sp.sched_priority = 8;
  367. sched_setscheduler(g_ts_104[net],SCHED_FIFO,&sp);
  368. // 设置进程名字
  369. set_task_comm(g_ts_104[net], buf);
  370. #endif
  371. // rt_printf("----------net = %d\r\n", net);
  372. // 运行应用104线程
  373. sprintf(buf, "net_104_%d", net);
  374. // 设置调度策略和优先级
  375. pthread_attr_init(&attr);
  376. pthread_attr_setschedpolicy(&attr, SCHED_FIFO); // 调度
  377. struct sched_param s_parm;
  378. // s_parm.sched_priority = sched_get_priority_max(SCHED_FIFO);
  379. s_parm.sched_priority = 8;
  380. pthread_attr_setschedparam(&attr, &s_parm); // 优先级
  381. // attr.__schedpolicy = SCHED_FIFO;
  382. // attr.__schedparam.sched_priority = 8;
  383. ret = pthread_create(&g_ts_104[net], &attr, (void *)_net_104_thread, &g_t104[net]);
  384. if (ret != 0)
  385. {
  386. printf("can not create thread _net_104_thread(net=%d): %d\r\n", net, errno);
  387. return -1;
  388. }
  389. }
  390. return 0;
  391. }
  392. int net_104_exit(void)
  393. {
  394. int net;
  395. for (net = 0; net < CFG_ETH_MAX_LOGIC; net++)
  396. {
  397. if (g_ts_104[net])
  398. {
  399. // kthread_stop(g_ts_104[net]);
  400. g_net_104_exit_flag[net] = 1;
  401. // wait_for_completion(&g_exit_completion_net_104[net]);
  402. pthread_join(g_ts_104[net], NULL);
  403. g_ts_104[net] = 0;
  404. }
  405. }
  406. return 0;
  407. }
  408. int net_104_send_ext(int net, unsigned char *buf, int len)
  409. {
  410. int ret = 0;
  411. int ch = net + CFG_UART_NUM_MAX;
  412. if (g_print_comm_raw && (g_print_port & (1 << ch)))
  413. {
  414. char sz[16];
  415. sprintf(sz, "\r\nTX[%d]:", ch);
  416. print_mem(sz, buf, len);
  417. rt_printf("\r\n");
  418. }
  419. // down(&net_s_lock[net]);
  420. if (g_104_client[net] != RT_SOCKET_ERR)
  421. {
  422. ret = rt_send(g_104_client[net], buf, len, 0);
  423. }
  424. // up(&net_s_lock[net]);
  425. if (ret < 0)
  426. {
  427. rt_printf("net_104_send:ret=%d.\r\n", ret);
  428. }
  429. return ret;
  430. }
  431. int net_104_send(int net, unsigned char *buf, int len)
  432. {
  433. int ret = 0;
  434. u8 ti, cot, se;
  435. u8 *out;
  436. if (pRunSet->bTT_ESAM)
  437. {
  438. iec_GetMsgInfo(buf, len, &ti, &cot, &se, false);
  439. len = sec_encrpt_iec(ti, cot, se, buf, len, &out);
  440. if (len > 0)
  441. {
  442. ret = net_104_send_ext(net, out, len);
  443. }
  444. }
  445. else
  446. {
  447. ret = net_104_send_ext(net, buf, len);
  448. }
  449. return ret;
  450. }
  451. static int net_104_recv(int net, unsigned char *buf, int len)
  452. {
  453. int ret = 0;
  454. // down(&net_r_lock[net]);
  455. pthread_mutex_lock(&net_r_lock[net]);
  456. if (g_104_client[net] != RT_SOCKET_ERR)
  457. {
  458. ret = rt_recv(g_104_client[net], (void *)buf, NET_RECV_MAX, 0);
  459. }
  460. // up(&net_r_lock[net]);
  461. pthread_mutex_unlock(&net_r_lock[net]);
  462. return ret;
  463. }
  464. void net_104_close(int net)
  465. {
  466. // down(&net_r_lock[net]);
  467. // down(&net_s_lock[net]);
  468. pthread_mutex_lock(&net_r_lock[net]);
  469. pthread_mutex_lock(&net_s_lock[net]);
  470. if (g_104_client[net] != RT_SOCKET_ERR)
  471. {
  472. rt_socket_close(g_104_client[net]);
  473. g_104_client[net] = RT_SOCKET_ERR;
  474. }
  475. g_net_104_close_flag[net] = 0;
  476. // up(&net_s_lock[net]);
  477. // up(&net_r_lock[net]);
  478. pthread_mutex_unlock(&net_s_lock[net]);
  479. pthread_mutex_unlock(&net_r_lock[net]);
  480. }
  481. void net_104_close_flag(int net)
  482. {
  483. // down(&net_r_lock[net]);
  484. // down(&net_s_lock[net]);
  485. pthread_mutex_lock(&net_r_lock[net]);
  486. pthread_mutex_lock(&net_s_lock[net]);
  487. if (g_104_client[net] != RT_SOCKET_ERR)
  488. {
  489. g_net_104_close_flag[net] = 1;
  490. }
  491. // up(&net_s_lock[net]);
  492. // up(&net_r_lock[net]);
  493. pthread_mutex_unlock(&net_s_lock[net]);
  494. pthread_mutex_unlock(&net_r_lock[net]);
  495. }
  496. int net_104_is_connect(int net)
  497. {
  498. if ((g_104_client[net] == RT_SOCKET_ERR) || g_net_104_close_flag[net])
  499. {
  500. return 0;
  501. }
  502. return 1;
  503. }
  504. /*------------------------------ 内部函数 -------------------------------------
  505. 内部函数以下划线‘_’开头,不需要检查参数的合法性.
  506. */
  507. extern int _net_104Client_thread(int net);
  508. int _net_104_thread(IEC104_DEF *pt104)
  509. {
  510. struct sockaddr_in server_addr;
  511. struct sockaddr_in client_addr;
  512. struct timeval timeout;
  513. struct linger ling;
  514. SOCKET sk_server, sk_tmp;
  515. int net;
  516. int sin_size;
  517. int len, ret;
  518. unsigned char *ip;
  519. unsigned int ip_server;
  520. int recv_timeout, recv_timeout_set;
  521. int link_timeout = 0;
  522. unsigned char buf;
  523. unsigned char tmpbuf[32];
  524. u16 w104Port;
  525. /*
  526. rt_printf("tRunPara.b104Client = %d \r\n",tRunPara.b104Client);
  527. tRunPara.b104Client = 0;
  528. if(tRunPara.b104Client) // 104采用客户端
  529. {
  530. //net = pt104->cNetIndex;
  531. net = 1;
  532. _net_104Client_thread(net);
  533. //return 0;
  534. }
  535. */
  536. #if 1
  537. NET_BEGIN:
  538. net = pt104->cNetIndex;
  539. // 服务器端开始建立socket描述符
  540. sk_server = rt_socket(AF_INET, SOCK_STREAM, 0);
  541. if (sk_server == RT_SOCKET_ERR)
  542. {
  543. RT_PRINTF_POSITION();
  544. g_ts_104[net] = 0;
  545. return -1;
  546. }
  547. // 服务器端填充sockaddr结构
  548. memset(&server_addr, 0, sizeof(struct sockaddr_in));
  549. server_addr.sin_family = AF_INET;
  550. // rt_if_ip_get(net,(unsigned char *)&ip_server);
  551. // ret=get_ethcnt(net, tRunPara.tNetPara[net].ethid);
  552. // IP在物理网卡上
  553. if (tRunPara.tNetPara[net].index == 0)
  554. {
  555. rt_if_ip_get(tRunPara.tNetPara[net].ethid, (unsigned char *)&ip_server);
  556. w104Port = tRunPara.w104Port; // 网络1、2使用可变端口,保证级联时不冲突。
  557. }
  558. else // IP在虚拟网卡上
  559. {
  560. // 从虚拟网卡获取IP地址
  561. rt_if_ip_get2(tRunPara.tNetPara[net].ethid, tRunPara.tNetPara[net].index, (unsigned char *)&ip_server);
  562. w104Port = NET_104_PORT; // 调试网络使用固定的2404端口,保证维护工具可以连接。
  563. }
  564. server_addr.sin_addr.s_addr = htonl(ip_server);
  565. server_addr.sin_port = htons(w104Port);
  566. // printf("-------Server ip:%s\n",inet_ntoa(server_addr.sin_addr));
  567. // 捆绑sockfd描述符
  568. ret = rt_bind(sk_server, (struct sockaddr *)(&server_addr), sizeof(struct sockaddr));
  569. if (ret < 0)
  570. {
  571. // RT_PRINTF_POSITION();
  572. rt_socket_close(sk_server);
  573. g_ts_104[net] = 0;
  574. return -2;
  575. }
  576. // 监听sockfd描述符
  577. ret = rt_listen(sk_server, 1);
  578. if (ret < 0)
  579. {
  580. // RT_PRINTF_POSITION();
  581. rt_socket_close(sk_server);
  582. g_ts_104[net] = 0;
  583. return -3;
  584. }
  585. // 设置接收超时
  586. timeout.tv_sec = 0;
  587. timeout.tv_usec = 100000;
  588. rt_setsockopt(sk_server, SOL_SOCKET, SO_RCVTIMEO, (char *)&timeout, sizeof(struct timeval));
  589. // 设置关闭延时
  590. ling.l_onoff = 1;
  591. ling.l_linger = 0;
  592. rt_setsockopt(sk_server, SOL_SOCKET, SO_LINGER, (char *)&ling, sizeof(struct linger));
  593. ip = (unsigned char *)&ip_server;
  594. // rt_printf("应用104线程已启动(IP:%d.%d.%d.%d,PORT:%d)。\r\n",ip[0],ip[1],ip[2],ip[3],NET_104_PORT);
  595. #ifdef CPU_FUXI
  596. sprintf(tmpbuf, "net_104_%d", net);
  597. prctl(PR_SET_NAME, tmpbuf);
  598. #endif
  599. while (1)
  600. {
  601. // 服务器阻塞,直到客户程序建立连接
  602. sin_size = sizeof(struct sockaddr_in);
  603. sk_tmp = rt_accept(sk_server, (struct sockaddr *)(&client_addr), &sin_size);
  604. // 检查是否退出
  605. if (g_net_104_exit_flag[net])
  606. {
  607. // 关闭客户端
  608. net_104_close(net);
  609. // 关闭服务器
  610. rt_socket_close(sk_server);
  611. // complete_and_exit(&g_exit_completion_net_104[net], 0);
  612. return 0;
  613. }
  614. // 是否重新初始化
  615. if (g_net_reinit[net] == NET_SOCKET_CLOSING)
  616. {
  617. // 关闭客户端
  618. net_104_close(net);
  619. // 关闭服务器
  620. rt_socket_close(sk_server);
  621. // 置已经关闭标志
  622. g_net_reinit[net] = NET_SOCKET_CLOSED;
  623. // 等待IP修改完成
  624. while (g_net_reinit[net] != NET_SOCKET_REINIT)
  625. {
  626. msleep(100);
  627. }
  628. // 置为初始化
  629. g_net_reinit[net] = NET_SOCKET_INIT;
  630. goto NET_BEGIN;
  631. }
  632. // 注意,用指针类型的socket接口,失败是返回NULL
  633. // 而整数类型的socket接口,失败返回的是负数
  634. // #ifdef RT_SOCKET_FD
  635. #if 1
  636. if (sk_tmp < 0)
  637. {
  638. msleep(100);
  639. // 超时.
  640. continue;
  641. }
  642. #else
  643. if (sk_tmp == RT_SOCKET_ACCEPT_RST)
  644. {
  645. msleep(100);
  646. // 超时
  647. continue;
  648. }
  649. #endif
  650. g_104_client[net] = sk_tmp;
  651. ip = (unsigned char *)&client_addr.sin_addr.s_addr;
  652. rt_printf("104 client[net=%d,s=%d] connect(ip=%d.%d.%d.%d)!\r\n", net, sk_tmp, ip[0], ip[1], ip[2], ip[3]);
  653. #if 0
  654. // 检查是否主站IP
  655. if(tRunPara.ip104Master1 || tRunPara.ip104Master2 || tRunPara.ip104Master3 || tRunPara.ip104Master4)
  656. {
  657. u32 network0,network1;
  658. network0 = client_addr.sin_addr.s_addr & tRunPara.tNetPara[CFG_ETH_MAX_LOGIC-1].wMask;
  659. network1 = tRunPara.tNetPara[CFG_ETH_MAX_LOGIC-1].wIp & tRunPara.tNetPara[CFG_ETH_MAX_LOGIC-1].wMask;
  660. if( (client_addr.sin_addr.s_addr != tRunPara.ip104Master1)
  661. && (client_addr.sin_addr.s_addr != tRunPara.ip104Master2)
  662. && (client_addr.sin_addr.s_addr != tRunPara.ip104Master3)
  663. && (client_addr.sin_addr.s_addr != tRunPara.ip104Master4)
  664. && (g_ip_net_maintain == 0) // 如果维护工具已连接,任意104主站可以接入。
  665. &&(network0 != network1)) // 运行维护网络的104连接进来
  666. {
  667. net_104_close(net);
  668. rt_printf("主站IP不在允许范围内!\r\n");
  669. ip = (unsigned char *)&tRunPara.ip104Master1;
  670. rt_printf("允许IP1:%d.%d.%d.%d)!\r\n",ip[0],ip[1],ip[2],ip[3]);
  671. ip = (unsigned char *)&tRunPara.ip104Master2;
  672. rt_printf("允许IP2:%d.%d.%d.%d)!\r\n",ip[0],ip[1],ip[2],ip[3]);
  673. ip = (unsigned char *)&tRunPara.ip104Master3;
  674. rt_printf("允许IP3:%d.%d.%d.%d)!\r\n",ip[0],ip[1],ip[2],ip[3]);
  675. ip = (unsigned char *)&tRunPara.ip104Master4;
  676. rt_printf("允许IP4:%d.%d.%d.%d)!\r\n",ip[0],ip[1],ip[2],ip[3]);
  677. ip = (unsigned char *)&g_ip_net_maintain;
  678. rt_printf("允许IP5:%d.%d.%d.%d)!\r\n",ip[0],ip[1],ip[2],ip[3]);
  679. msleep(500);
  680. continue;
  681. }
  682. }
  683. #endif
  684. // 客户端已连接,处理客户端命令
  685. // 初始化接收FIFO
  686. rt_fifo_init(&g_net_104_fifo[net], g_net_104_buf[net], NET_104_BUF_SIZE);
  687. IEC104_Recv_Reset(&g_t104[net]);
  688. memcpy(g_t104[net].ip, (unsigned char *)&client_addr.sin_addr.s_addr, 4);
  689. g_t104[net].LinkCountNet++;
  690. // 接收帧超时初始化,超时设置为测试超时加确认超时后的2倍。
  691. recv_timeout = 0;
  692. recv_timeout_set = (tRunPara.w104TestTime + tRunPara.w104AckTime) * 2 * 10;
  693. // 循环处理接收数据
  694. while (1)
  695. {
  696. len = net_104_recv(net, g_net_104_buf_frame[net], NET_RECV_MAX);
  697. // 检查是否退出
  698. if (g_net_104_exit_flag[net])
  699. {
  700. // 关闭客户端
  701. net_104_close(net);
  702. // 关闭服务器
  703. rt_socket_close(sk_server);
  704. // complete_and_exit(&g_exit_completion_net_104[net], 0);
  705. return 0;
  706. }
  707. // 是否重新初始化
  708. if (g_net_reinit[net] == NET_SOCKET_CLOSING)
  709. {
  710. // 关闭客户端
  711. net_104_close(net);
  712. // 关闭服务器
  713. rt_socket_close(sk_server);
  714. // 置已经关闭标志
  715. g_net_reinit[net] = NET_SOCKET_CLOSED;
  716. // 等待IP修改完成
  717. while (g_net_reinit[net] != NET_SOCKET_REINIT)
  718. {
  719. msleep(100);
  720. }
  721. // 置为初始化
  722. g_net_reinit[net] = NET_SOCKET_INIT;
  723. rt_printf("net_104_thread:链路重新初始化!\r\n");
  724. goto NET_BEGIN;
  725. }
  726. if (g_net_104_close_flag[net])
  727. {
  728. break;
  729. }
  730. if ((len == -EAGAIN) || (len == -1))
  731. {
  732. if (rt_get_net_linkstatus(rt_get_netcard_id_from_socket(g_104_client[net])) == 1)
  733. {
  734. link_timeout++;
  735. if (link_timeout > RT_LINK_TIMEOUT * 10) // 100ms超时
  736. {
  737. rt_printf("net_104_thread: link down\r\n");
  738. link_timeout = 0;
  739. break;
  740. }
  741. }
  742. else
  743. {
  744. link_timeout = 0;
  745. }
  746. // 接收帧超时
  747. recv_timeout++;
  748. if (recv_timeout > recv_timeout_set)
  749. {
  750. rt_printf("net_104_thread:接收帧超时(value=%d,set=%d)\r\n", recv_timeout, recv_timeout_set);
  751. break;
  752. }
  753. }
  754. else if ((len == 0) || (len < -1))
  755. {
  756. // 调用recv时,如果返回0,则表示对端关闭;返回负数,表示出错
  757. rt_printf("net_104_thread:rt_recv(ret=%d)\r\n", len);
  758. // TODO:以下休眠语句必须屏蔽,否则net_104_close会延时调用,
  759. // 导致主循环可以在此断开的socket上继续发送数据,引起系统异常。
  760. // msleep(100);
  761. break;
  762. }
  763. else
  764. {
  765. int space;
  766. space = rt_fifo_space(&g_net_104_fifo[net]);
  767. if (space > len)
  768. {
  769. rt_fifo_put(&g_net_104_fifo[net], g_net_104_buf_frame[net], len);
  770. if (tRunPara.tNetPara[net].ethid < CFG_ETH_NUM_MAX)
  771. g_run_stu.led[CFG_UART_NUM_MAX * 2 + tRunPara.tNetPara[net].ethid] = 1;
  772. }
  773. else
  774. {
  775. rt_printf("net_104_thread:接收FIFO溢出(space=%d,len=%d)\r\n", space, len);
  776. }
  777. link_timeout = 0;
  778. }
  779. // 接收数据
  780. // printf("g_t104[0].bSM2Data:%d,g_t104[0].bRecvOk:%d, g_link_comm.link_flag: %d, buflen: %d \n",g_t104[net].bSM2Data,g_t104[net].bRecvOk, g_link_comm.link_flag, len);
  781. while (g_t104[net].bSM2Data == false && g_t104[net].bRecvOk == false)
  782. {
  783. int j; //+++
  784. j = rt_fifo_get(&g_net_104_fifo[net], &buf, 1); //+++
  785. // printf("----rt_fifo_get: %d \n",j); //+++
  786. // if(rt_fifo_get(&g_net_104_fifo[net],&buf,1))
  787. if (j)
  788. {
  789. if (g_print_comm_raw && (g_print_port & (1 << (net + CFG_UART_NUM_MAX))))
  790. {
  791. rt_printf("%02x ", buf);
  792. }
  793. if (IEC104_Recv(&g_t104[net], buf))
  794. {
  795. // printf("----IEC104_Recv recv_timeout\n"); //+++
  796. // 如果接收到完整的一帧104报文(其它数据不清定时器,防止意外连接),超时定时器清零。
  797. recv_timeout = 0;
  798. }
  799. }
  800. else
  801. {
  802. break;
  803. }
  804. }
  805. }
  806. // 关闭客户端socket
  807. net_104_close(net);
  808. }
  809. #endif
  810. while (1)
  811. {
  812. rt_printf("net 104\r\n");
  813. usleep(1000 * 1000);
  814. }
  815. // 理论上,程序不会运行到这儿
  816. return 0;
  817. }
  818. int _net_104Client_thread(int net)
  819. {
  820. struct sockaddr_in server_addr;
  821. // struct timeval timeout;
  822. // struct linger ling;
  823. // SOCKET s;
  824. int s;
  825. int len, ret;
  826. unsigned int ip_server, link_count;
  827. int recv_timeout;
  828. unsigned char buf;
  829. unsigned char *ip;
  830. // int net = *pnet;
  831. while (1)
  832. {
  833. // rt_printf("BEGIN ---------[ %d ] [ %s ] \r\n",__LINE__,__func__);
  834. BEGIN:
  835. link_count = 0;
  836. // 检查级联IP是否设置
  837. ip_server = tRunPara.ip104Master[net];
  838. while (1)
  839. {
  840. ip_server = tRunPara.ip104Master[net];
  841. // ip_server = inet_addr("192.168.9.57");
  842. if (ip_server)
  843. {
  844. break;
  845. }
  846. // 检查是否退出
  847. if (g_net_104_exit_flag[net])
  848. {
  849. // rt_printf_time("net_104link_thread exit.\r\n");
  850. // complete_and_exit(&g_exit_completion_net_104[net], 0);
  851. return 0;
  852. }
  853. // 1秒钟检查一次
  854. msleep(1000);
  855. }
  856. ip = (unsigned char *)&ip_server;
  857. // rt_printf_time("104连接服务器开始(%d):ip=%d.%d.%d.%d!\r\n",net,ip[0],ip[1],ip[2],ip[3]);
  858. // printf("104 conect ip=%x\n",ip_server);
  859. // 创建socket
  860. // s = rt_socket(AF_INET, SOCK_STREAM, 0);
  861. s = socket(AF_INET, SOCK_STREAM, 0);
  862. if (s == RT_SOCKET_ERR)
  863. {
  864. RT_PRINTF_POSITION();
  865. return -1;
  866. }
  867. // 服务器端填充sockaddr结构
  868. memset(&server_addr, 0, sizeof(struct sockaddr_in));
  869. server_addr.sin_family = AF_INET;
  870. // server_addr.sin_addr.s_addr = htonl (ip_server);
  871. server_addr.sin_addr.s_addr = ip_server;
  872. // server_addr.sin_port = htons (tRunPara.w104Port);
  873. server_addr.sin_port = htons(2404);
  874. // 连接服务器,没有连接成功不退出
  875. while (1)
  876. {
  877. // ret = rt_connect(s,(struct sockaddr *)&server_addr,sizeof(struct sockaddr_in));
  878. ret = connect(s, (struct sockaddr *)&server_addr, sizeof(struct sockaddr_in));
  879. // printf("ret is %d\n",ret);
  880. #if 0
  881. // 检查是否退出
  882. if(g_net_104_exit_flag[net])
  883. {
  884. // 关闭客户端
  885. g_104_client[net] = RT_SOCKET_ERR;
  886. rt_socket_close (s);
  887. rt_printf_time("net_104_thread exit(rt_recv).\r\n");
  888. // complete_and_exit(&g_exit_completion_net_104[net], 0);
  889. return 0;
  890. }
  891. // 检查服务器是否变更
  892. if(ip_server != tRunPara.ip104Master[net])
  893. {
  894. // 关闭客户端
  895. g_104_client[net] = RT_SOCKET_ERR;
  896. rt_socket_close (s);
  897. ip = (unsigned char *)&tRunPara.ip104Master[net];
  898. rt_printf_time("主站服务器变更(%d):ip=%d.%d.%d.%d!\r\n",net,ip[0],ip[1],ip[2],ip[3]);
  899. goto BEGIN;
  900. }
  901. #endif
  902. if (ret == 0)
  903. {
  904. g_net_104_close_flag[net] = 0;
  905. g_link104_init_ok[net] = 0;
  906. g_104_client[net] = s;
  907. g_t104[net].bClientStart = false;
  908. link_count++;
  909. // rt_printf_time("104连接服务器成功(通道=%d,连接计数=%d):ip=%d.%d.%d.%d!\r\n",net,link_count,ip[0],ip[1],ip[2],ip[3]);
  910. printf("104 connected ok +++++++ok\n");
  911. break;
  912. }
  913. // 1秒钟连接一次
  914. msleep(1000);
  915. }
  916. #if 0
  917. // 设置接收超时
  918. timeout.tv_sec = 0;
  919. timeout.tv_usec = 100000;
  920. rt_setsockopt(s,SOL_SOCKET,SO_RCVTIMEO,(char *)&timeout ,sizeof(struct timeval));
  921. // 设置关闭延时
  922. ling.l_onoff = 1;
  923. ling.l_linger = 0;
  924. rt_setsockopt(s,SOL_SOCKET,SO_LINGER,(char *)&ling ,sizeof(struct linger));
  925. // 初始化FIFO
  926. rt_fifo_init(&g_net_104_fifo[net],g_net_104_buf[net],NET_104_BUF_SIZE);
  927. #endif
  928. // 处理接收
  929. recv_timeout = 0;
  930. while (1)
  931. {
  932. len = rt_recv(s, g_net_104_buf_frame[net], NET_RECV_MAX, 0);
  933. printf("recv data : %s \r\n", g_net_104_buf_frame[net]);
  934. // 检查是否退出
  935. if (g_net_104_exit_flag[net])
  936. {
  937. // 关闭客户端
  938. g_104_client[net] = RT_SOCKET_ERR;
  939. rt_socket_close(s);
  940. rt_printf_time("net_104client_thread exit(rt_recv).\r\n");
  941. // complete_and_exit(&g_exit_completion_net_104[net], 0);
  942. return 0;
  943. }
  944. // 检查服务器是否变更
  945. if (ip_server != tRunPara.ip104Master[net])
  946. {
  947. // 关闭客户端
  948. g_104_client[net] = RT_SOCKET_ERR;
  949. rt_socket_close(s);
  950. rt_printf_time("104服务器变更(%d):ip=%d.%d.%d.%d!\r\n", net, ip[0], ip[1], ip[2], ip[3]);
  951. goto BEGIN;
  952. }
  953. // 应用程序主动关闭
  954. if (g_net_104_close_flag[net])
  955. {
  956. break;
  957. }
  958. if (len == -EAGAIN)
  959. {
  960. // 超时
  961. recv_timeout++;
  962. if (recv_timeout > 300) // 超时30s,端口未收到数据,关闭端口
  963. {
  964. rt_printf_time("104客户端30S超时关闭(net=%d)\r\n", net);
  965. break;
  966. }
  967. }
  968. else if (len <= 0)
  969. {
  970. // 调用recv时,如果返回0,则表示对端关闭;返回负数,表示出错
  971. rt_printf_time("104客户端关闭(net=%d,ret=%d)\r\n", net, len);
  972. msleep(100);
  973. break;
  974. }
  975. else
  976. {
  977. rt_fifo_put(&g_net_104_fifo[net], g_net_104_buf_frame[net], len);
  978. recv_timeout = 0; // 超时计数器清零
  979. if (tRunPara.tNetPara[net].ethid < CFG_ETH_NUM_MAX)
  980. g_run_stu.led[CFG_UART_NUM_MAX * 2 + tRunPara.tNetPara[net].ethid] = 1;
  981. }
  982. // 接收数据
  983. while (g_t104[net].bSM2Data == false && g_t104[net].bRecvOk == false)
  984. {
  985. if (rt_fifo_get(&g_net_104_fifo[net], &buf, 1))
  986. {
  987. IEC104_Recv(&g_t104[net], buf);
  988. }
  989. else
  990. {
  991. break;
  992. }
  993. }
  994. // msleep(100);
  995. }
  996. // 关闭客户端socket
  997. g_104_client[net] = RT_SOCKET_ERR;
  998. rt_socket_close(s);
  999. // rt_printf_time ("net_104link_thread:rt_recv(ret=%d)\r\n",len);
  1000. }
  1001. // 理论上,程序不会运行到这儿
  1002. return 0;
  1003. }
  1004. #else
  1005. /*------------------------------- 头文件 --------------------------------------
  1006. */
  1007. #include "head.h"
  1008. #include <linux/delay.h>
  1009. /*------------------------------- 宏定义 --------------------------------------
  1010. */
  1011. #define NET_104_BUF_SIZE 16384
  1012. /*------------------------------ 类型结构 -------------------------------------
  1013. */
  1014. /*------------------------------ 全局变量 -------------------------------------
  1015. */
  1016. static struct task_struct *g_ts_104[IEC104_TOTAL_SOCKETS];
  1017. static SOCKET g_104_client[IEC104_TOTAL_SOCKETS];
  1018. static unsigned char g_net_104_buf_frame[IEC104_TOTAL_SOCKETS][NET_RECV_MAX]; // 以太网接收缓冲区
  1019. static unsigned char g_net_104_buf[IEC104_TOTAL_SOCKETS][NET_104_BUF_SIZE]; // 以太网接收缓冲区
  1020. static struct rt_fifo g_net_104_fifo[IEC104_TOTAL_SOCKETS];
  1021. static volatile int g_net_reinit[CFG_ETH_MAX_LOGIC] = {NET_SOCKET_INIT}; // 网络重新初始化标志.0表示不用重新初始化,1表示需要重新初始化
  1022. static struct semaphore net_r_lock[CFG_ETH_MAX_LOGIC]; // 接收锁
  1023. static struct semaphore net_s_lock[CFG_ETH_MAX_LOGIC]; // 发送锁
  1024. static int g_net_104_close_flag[CFG_ETH_MAX_LOGIC];
  1025. static int g_net_104_exit_flag[CFG_ETH_MAX_LOGIC];
  1026. static struct completion g_exit_completion_net_104[CFG_ETH_MAX_LOGIC];
  1027. extern u32 g_ip_net_maintain; // 104维护工具调试客户端地址
  1028. /*------------------------------ 函数声明 -------------------------------------
  1029. */
  1030. int _net_104_thread(IEC104_DEF *pt104);
  1031. // 设置socket关闭标志并等待socket关闭完成
  1032. void net_104_set_sock_closing(int no)
  1033. {
  1034. // if(no >= g_net_num) return;
  1035. g_net_reinit[no] = NET_SOCKET_CLOSING; // 置关闭标志
  1036. if (!tRunPara.b104Client)
  1037. {
  1038. int count = 0;
  1039. // 等待关闭完成
  1040. while (g_net_reinit[no] != NET_SOCKET_CLOSED)
  1041. {
  1042. msleep(20);
  1043. if (++count > 150)
  1044. {
  1045. rt_printf("104 client socket close fail!!!\r\n");
  1046. return;
  1047. }
  1048. }
  1049. }
  1050. }
  1051. // 设置socket重新创建标志
  1052. void net_104_set_sock_initflag(int no)
  1053. {
  1054. // if(no >= g_net_num) return;
  1055. if (g_net_reinit[no] == NET_SOCKET_CLOSED)
  1056. {
  1057. g_net_reinit[no] = NET_SOCKET_REINIT;
  1058. }
  1059. }
  1060. /**************************************************************************
  1061. 函数名称:Net_Init
  1062. 函数版本:1.00
  1063. 作者:
  1064. 创建日期:2009.1.8
  1065. 函数功能说明:以太网初始化
  1066. 输入参数:
  1067. 输出参数:
  1068. 返回值:
  1069. 更新信息:
  1070. 更新日志1:
  1071. 日期:
  1072. 修改者:
  1073. 修改内容:
  1074. 修改原因:
  1075. ***************************************************************************/
  1076. void Net_Init(void)
  1077. {
  1078. unsigned char mac[6];
  1079. unsigned char ip[4];
  1080. unsigned char mask[4];
  1081. unsigned char gw[4];
  1082. unsigned char routenet[4];
  1083. unsigned char routenetmask[4];
  1084. unsigned char routegate[4];
  1085. // char * acteth;
  1086. int i, j;
  1087. char tmp[16];
  1088. int ret = 0;
  1089. int gateflag = 0;
  1090. if (tRunPara.w104K == 0)
  1091. {
  1092. if (pRunSet->bTT_SoeResumeComm || pRunSet->bTT_SoeResumePower)
  1093. {
  1094. rt_printf("定值参数错误:SOE通讯续传、SOE上电续传时参数104 K值不能为0.\r\n");
  1095. rt_err_set(ERR_CODE_INIT_SOFTWARE, 0);
  1096. }
  1097. }
  1098. #if 0
  1099. int debug_port;
  1100. acteth = env_get_info(ENV_ETHACT);
  1101. if(acteth != NULL)
  1102. {
  1103. if(strcmp(acteth,"FEC0") == 0)
  1104. {
  1105. debug_port = 0;
  1106. }
  1107. else if(strcmp(acteth,"FEC1") == 0)
  1108. {
  1109. debug_port = 1;
  1110. }
  1111. else if(strcmp(acteth,"DM9000") == 0)
  1112. {
  1113. debug_port = 2;
  1114. }
  1115. else
  1116. {
  1117. debug_port = 0;
  1118. }
  1119. }
  1120. else
  1121. {
  1122. debug_port = 0;
  1123. }
  1124. #endif
  1125. // if(acteth != NULL && strcmp(acteth,"DM9000") == 0)
  1126. // {
  1127. // debug_port = 2;
  1128. // }
  1129. // else
  1130. // {
  1131. // debug_port = 0;
  1132. // }
  1133. // for(i=0;i<g_net_num;i++)
  1134. for (i = 0; i < CFG_ETH_MAX_LOGIC; i++)
  1135. {
  1136. // 没有改变参数,不用初始化
  1137. if (!tRunPara.tNetPara[i].bInit)
  1138. {
  1139. // 104配置参数有修改,需关闭socket重新初始化
  1140. if (tRunPara.sock_104_flag)
  1141. {
  1142. net_104_set_sock_initflag(i);
  1143. }
  1144. continue;
  1145. }
  1146. gateflag = 1;
  1147. tRunPara.tNetPara[i].bInit = false;
  1148. // 设置接口MAC地址
  1149. if (rt_if_sz2mac(env_get_info(ENV_NET1MAC + i), mac) < 0)
  1150. {
  1151. mac[0] = 'H';
  1152. mac[1] = 'G';
  1153. mac[2] = (BYTE)((tRunPara.tNetPara[i].wIp >> 24) & 0xff);
  1154. mac[3] = (BYTE)((tRunPara.tNetPara[i].wIp >> 16) & 0xff);
  1155. mac[4] = (BYTE)((tRunPara.tNetPara[i].wIp >> 8) & 0xff);
  1156. mac[5] = (BYTE)((tRunPara.tNetPara[i].wIp >> 0) & 0xff);
  1157. }
  1158. // 设置IP
  1159. ip[0] = (BYTE)((tRunPara.tNetPara[i].wIp >> 24) & 0xff);
  1160. ip[1] = (BYTE)((tRunPara.tNetPara[i].wIp >> 16) & 0xff);
  1161. ip[2] = (BYTE)((tRunPara.tNetPara[i].wIp >> 8) & 0xff);
  1162. ip[3] = (BYTE)((tRunPara.tNetPara[i].wIp >> 0) & 0xff);
  1163. // 设置MASK
  1164. mask[0] = (BYTE)((tRunPara.tNetPara[i].wMask >> 24) & 0xff);
  1165. mask[1] = (BYTE)((tRunPara.tNetPara[i].wMask >> 16) & 0xff);
  1166. mask[2] = (BYTE)((tRunPara.tNetPara[i].wMask >> 8) & 0xff);
  1167. mask[3] = (BYTE)((tRunPara.tNetPara[i].wMask >> 0) & 0xff);
  1168. #if (1)
  1169. printf("[%s:%d]\r\n", __func__, __LINE__);
  1170. if (tRunPara.tNetPara[i].old_ethid != tRunPara.tNetPara[i].ethid) // 网络号已改变且为物理网卡时
  1171. {
  1172. BYTE count;
  1173. if ((int)tRunPara.tNetPara[i].old_index == 0)
  1174. {
  1175. rt_if_down(tRunPara.tNetPara[i].old_ethid); // 此时卸载当前网卡所有P 比如eth0 eth0:2 eth0:3
  1176. // rt_printf("down eth%d\r\n",tRunPara.tNetPara[i].old_ethid);
  1177. }
  1178. else if ((int)tRunPara.tNetPara[i].old_index > 0)
  1179. {
  1180. rt_if_down2(tRunPara.tNetPara[i].old_ethid, tRunPara.tNetPara[i].old_index);
  1181. // rt_printf("down eth%d:%d\r\n",tRunPara.tNetPara[i].old_ethid,tRunPara.tNetPara[i].old_index);
  1182. }
  1183. for (count = i + 1; count < CFG_ETH_MAX_LOGIC; count++) // 物理网卡被更新 相应的之前的物理网卡和虚拟网卡都需要重新配置
  1184. if ((tRunPara.tNetPara[i].ethid == tRunPara.tNetPara[count].old_ethid) || (tRunPara.tNetPara[i].old_ethid == tRunPara.tNetPara[count].ethid))
  1185. {
  1186. tRunPara.tNetPara[count].bInit = true;
  1187. if ((int)tRunPara.tNetPara[count].old_index > 0) // 若关联的为虚拟网卡则默认不需要进行投退
  1188. {
  1189. rt_if_down2(tRunPara.tNetPara[count].old_ethid, tRunPara.tNetPara[count].old_index);
  1190. // rt_printf("down eth%d:%d\r\n",tRunPara.tNetPara[count].old_ethid,tRunPara.tNetPara[count].old_index);
  1191. tRunPara.tNetPara[count].old_index = 0;
  1192. }
  1193. else
  1194. {
  1195. rt_if_down(tRunPara.tNetPara[count].old_ethid); // 此时卸载当前网卡所有P 比如eth0 eth0:2 eth0:3
  1196. // rt_printf("down eth%d\r\n",tRunPara.tNetPara[count].old_ethid);
  1197. }
  1198. }
  1199. }
  1200. else if ((int)tRunPara.tNetPara[i].old_index > 0) // 网络号未改变时的 虚拟网卡
  1201. {
  1202. rt_if_down2(tRunPara.tNetPara[i].old_ethid, tRunPara.tNetPara[i].old_index);
  1203. // rt_printf("down eth%d:%d\r\n",tRunPara.tNetPara[i].old_ethid,tRunPara.tNetPara[i].old_index);
  1204. }
  1205. #else
  1206. // 检查是否需要关闭虚拟网卡
  1207. if ((int)tRunPara.tNetPara[i].old_index > 0)
  1208. {
  1209. rt_if_down2(tRunPara.tNetPara[i].old_ethid, tRunPara.tNetPara[i].old_index);
  1210. }
  1211. #endif
  1212. // 获取配置相同的ethid有多少个
  1213. ret = get_ethcnt(i, tRunPara.tNetPara[i].ethid);
  1214. // 没有的话,使用物理的
  1215. if (ret == 0)
  1216. {
  1217. // 设置网络参数
  1218. net_if_set((int)tRunPara.tNetPara[i].ethid, mac, ip, mask);
  1219. tRunPara.tNetPara[i].index = 0;
  1220. // rt_printf_time("ret = %d, ethID = %d\r\n",ret,tRunPara.tNetPara[i].ethid);
  1221. }
  1222. else // 有的话使用虚拟的
  1223. {
  1224. #if (1)
  1225. printf("[%s:%d]\r\n", __func__, __LINE__);
  1226. net_if_set2((int)tRunPara.tNetPara[i].ethid, ret, 0, ip, mask);
  1227. tRunPara.tNetPara[i].index = ret;
  1228. #else
  1229. net_if_set2((int)tRunPara.tNetPara[i].ethid, i + 1, 0, ip, mask);
  1230. tRunPara.tNetPara[i].index = i + 1;
  1231. #endif
  1232. // rt_printf_time("Xnet = %d,ip=%x, ethID = %d, ret = %d\r\n",tRunPara.tNetPara[i].index,ip[3],tRunPara.tNetPara[i].ethid,ret);
  1233. }
  1234. tRunPara.tNetPara[i].old_ethid = tRunPara.tNetPara[i].ethid;
  1235. tRunPara.tNetPara[i].old_index = tRunPara.tNetPara[i].index;
  1236. // 如果是调试串口,不初始化
  1237. // if(i == debug_port)
  1238. if (i == (CFG_ETH_MAX_LOGIC - 1))
  1239. {
  1240. // 设置IP环境变量
  1241. if (tRunPara.tNetPara[i].changed & 0x01)
  1242. {
  1243. sprintf(tmp, "%d.%d.%d.%d", (tRunPara.tNetPara[i].wIp >> 24) & 0xff, (tRunPara.tNetPara[i].wIp >> 16) & 0xff, (tRunPara.tNetPara[i].wIp >> 8) & 0xff, (tRunPara.tNetPara[i].wIp & 0xff));
  1244. env_setenv("ipaddr", tmp);
  1245. }
  1246. // 设置Gate环境变量
  1247. if (tRunPara.tNetPara[i].changed & 0x02)
  1248. {
  1249. sprintf(tmp, "%d.%d.%d.%d", (tRunPara.tNetPara[i].wGate >> 24) & 0xff, (tRunPara.tNetPara[i].wGate >> 16) & 0xff, (tRunPara.tNetPara[i].wGate >> 8) & 0xff, (tRunPara.tNetPara[i].wGate & 0xff));
  1250. if (tRunPara.tNetPara[i].wGate)
  1251. env_setenv("gatewayip", tmp);
  1252. }
  1253. // 设置Mask环境变量
  1254. if (tRunPara.tNetPara[i].changed & 0x04)
  1255. {
  1256. sprintf(tmp, "%d.%d.%d.%d", (tRunPara.tNetPara[i].wMask >> 24) & 0xff, (tRunPara.tNetPara[i].wMask >> 16) & 0xff, (tRunPara.tNetPara[i].wMask >> 8) & 0xff, (tRunPara.tNetPara[i].wMask & 0xff));
  1257. env_setenv("netmask", tmp);
  1258. }
  1259. // 设置ethact环境变量
  1260. if (tRunPara.tNetPara[i].changed & 0x40)
  1261. {
  1262. if (tRunPara.tNetPara[i].ethid >= 2)
  1263. {
  1264. sprintf(tmp, "%s", "DM9000");
  1265. }
  1266. else
  1267. {
  1268. sprintf(tmp, "FEC%d", (int)tRunPara.tNetPara[i].ethid);
  1269. }
  1270. env_setenv("ethact", tmp);
  1271. }
  1272. // continue;
  1273. }
  1274. // 网段
  1275. routenet[0] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 24) & 0xff);
  1276. routenet[1] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 16) & 0xff);
  1277. routenet[2] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 8) & 0xff);
  1278. routenet[3] = (BYTE)((tRunPara.tNetPara[i].wRouteNet >> 0) & 0xff);
  1279. // 网段掩码
  1280. routenetmask[0] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 24) & 0xff);
  1281. routenetmask[1] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 16) & 0xff);
  1282. routenetmask[2] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 8) & 0xff);
  1283. routenetmask[3] = (BYTE)((tRunPara.tNetPara[i].wRouteNetMask >> 0) & 0xff);
  1284. // 网关
  1285. routegate[0] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 24) & 0xff);
  1286. routegate[1] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 16) & 0xff);
  1287. routegate[2] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 8) & 0xff);
  1288. routegate[3] = (BYTE)((tRunPara.tNetPara[i].wRouteGate >> 0) & 0xff);
  1289. net_route_set(routenet, routenetmask, routegate);
  1290. // g_net_reinit[i] = 1;//置重新初始化标志
  1291. net_104_set_sock_initflag(i);
  1292. net_debug_set_sock_initflag();
  1293. net_maintain_set_sock_initflag();
  1294. #if 0
  1295. // 得到并打印新的网络参数
  1296. // net_if_get(i,mac,ip,mask);
  1297. rt_printf("new mac: %02x:%02x:%02x:%02x:%02x:%02x\r\n",mac[0],mac[1],mac[2],mac[3],mac[4],mac[5]);
  1298. rt_printf("new ip:%d.%d.%d.%d\r\n",ip[0],ip[1],ip[2],ip[3]);
  1299. rt_printf("new mask:%d.%d.%d.%d\r\n",mask[0],mask[1],mask[2],mask[3]);
  1300. rt_printf("new gw:%d.%d.%d.%d\r\n",gw[0],gw[1],gw[2],gw[3]);
  1301. #endif
  1302. }
  1303. ret = 0;
  1304. // 查找是否关闭物理网卡
  1305. for (i = 0; i < g_net_num; i++)
  1306. {
  1307. for (j = 0; j < CFG_ETH_MAX_LOGIC; j++)
  1308. {
  1309. if (tRunPara.tNetPara[j].ethid == i)
  1310. {
  1311. ret++; // 虚拟网卡使用物理网卡计数
  1312. }
  1313. }
  1314. // 没有虚拟网卡使用物理网卡
  1315. if (ret == 0)
  1316. {
  1317. rt_if_down(i);
  1318. }
  1319. ret = 0;
  1320. }
  1321. // 设置网关
  1322. gw[0] = (BYTE)((tRunPara.tNetPara[0].wGate >> 24) & 0xff);
  1323. gw[1] = (BYTE)((tRunPara.tNetPara[0].wGate >> 16) & 0xff);
  1324. gw[2] = (BYTE)((tRunPara.tNetPara[0].wGate >> 8) & 0xff);
  1325. gw[3] = (BYTE)((tRunPara.tNetPara[0].wGate >> 0) & 0xff);
  1326. // 如果地址是默认的0.0.0.0,说明用户不需要网关,
  1327. // 不重设网关,使uboot环境变量中的网关有效,方便调试。
  1328. if (gw[0] == 0 && gw[1] == 0 && gw[2] == 0 && gw[3] == 0)
  1329. {
  1330. return;
  1331. }
  1332. if (gateflag)
  1333. {
  1334. net_gateway_set(gw);
  1335. }
  1336. return;
  1337. }
  1338. /*------------------------------ 外部函数 -------------------------------------
  1339. 外部函数供其它实体文件引用,必须仔细检查传入参数的合法性.
  1340. */
  1341. int net_104_init(void)
  1342. {
  1343. int net;
  1344. char buf[32];
  1345. struct sched_param sp;
  1346. pid_t pid;
  1347. IEC104_Init();
  1348. for (net = 0; net < CFG_ETH_MAX_LOGIC; net++)
  1349. {
  1350. g_104_client[net] = RT_SOCKET_ERR;
  1351. init_completion(&g_exit_completion_net_104[net]);
  1352. g_net_reinit[net] = 0; // 初始化标志
  1353. init_MUTEX(&net_r_lock[net]); // 初始化接收锁
  1354. init_MUTEX(&net_s_lock[net]); // 初始化发送锁
  1355. // 如果接口不正常,不初始化
  1356. if (tRunPara.tNetPara[net].index == 0)
  1357. {
  1358. if (rt_if_ip_get(tRunPara.tNetPara[net].ethid, buf) != 0)
  1359. {
  1360. continue;
  1361. }
  1362. }
  1363. else
  1364. {
  1365. if (rt_if_ip_get2(tRunPara.tNetPara[net].ethid, tRunPara.tNetPara[net].index, buf) != 0)
  1366. {
  1367. continue;
  1368. }
  1369. }
  1370. // 运行应用104线程
  1371. sprintf(buf, "net_104_%d", net);
  1372. pid = kernel_thread((int (*)(void *))_net_104_thread, &g_t104[net], CLONE_FS | CLONE_FILES | CLONE_SIGHAND);
  1373. g_ts_104[net] = find_task_by_vpid(pid);
  1374. if (IS_ERR(g_ts_104[net]))
  1375. {
  1376. printk("ts=%p\r\n", g_ts_104[net]);
  1377. g_ts_104[net] = NULL;
  1378. return -1;
  1379. }
  1380. // 设置调度策略和优先级
  1381. sp.sched_priority = 8;
  1382. sched_setscheduler(g_ts_104[net], SCHED_FIFO, &sp);
  1383. // 设置进程名字
  1384. set_task_comm(g_ts_104[net], buf);
  1385. }
  1386. return 0;
  1387. }
  1388. int net_104_exit(void)
  1389. {
  1390. int net;
  1391. for (net = 0; net < CFG_ETH_MAX_LOGIC; net++)
  1392. {
  1393. if (g_ts_104[net] != NULL)
  1394. {
  1395. // kthread_stop(g_ts_104[net]);
  1396. g_net_104_exit_flag[net] = 1;
  1397. wait_for_completion(&g_exit_completion_net_104[net]);
  1398. }
  1399. }
  1400. return 0;
  1401. }
  1402. int net_104_send_ext(int net, unsigned char *buf, int len)
  1403. {
  1404. int ret = 0;
  1405. int ch = net + CFG_UART_NUM_MAX;
  1406. if (g_print_comm_raw && (g_print_port & (1 << ch)))
  1407. {
  1408. char sz[16];
  1409. sprintf(sz, "\r\nTX[%d]:", ch);
  1410. print_mem(sz, buf, len);
  1411. rt_printf("\r\n");
  1412. }
  1413. down(&net_s_lock[net]);
  1414. if (g_104_client[net] != RT_SOCKET_ERR)
  1415. {
  1416. ret = rt_send(g_104_client[net], buf, len, 0);
  1417. }
  1418. up(&net_s_lock[net]);
  1419. if (ret < 0)
  1420. {
  1421. rt_printf("net_104_send:ret=%d.\r\n", ret);
  1422. }
  1423. return ret;
  1424. }
  1425. int net_104_send(int net, unsigned char *buf, int len)
  1426. {
  1427. int ret = 0;
  1428. u8 ti, cot, se;
  1429. u8 *out;
  1430. if (pRunSet->bTT_ESAM)
  1431. {
  1432. iec_GetMsgInfo(buf, len, &ti, &cot, &se, false);
  1433. len = sec_encrpt_iec(ti, cot, se, buf, len, &out);
  1434. if (len > 0)
  1435. {
  1436. ret = net_104_send_ext(net, out, len);
  1437. }
  1438. }
  1439. else
  1440. {
  1441. ret = net_104_send_ext(net, buf, len);
  1442. }
  1443. return ret;
  1444. }
  1445. static int net_104_recv(int net, unsigned char *buf, int len)
  1446. {
  1447. int ret = 0;
  1448. down(&net_r_lock[net]);
  1449. if (g_104_client[net] != RT_SOCKET_ERR)
  1450. {
  1451. ret = rt_recv(g_104_client[net], (void *)buf, NET_RECV_MAX, MSG_DONTWAIT);
  1452. }
  1453. up(&net_r_lock[net]);
  1454. return ret;
  1455. }
  1456. void net_104_close(int net)
  1457. {
  1458. down(&net_r_lock[net]);
  1459. down(&net_s_lock[net]);
  1460. if (g_104_client[net] != RT_SOCKET_ERR)
  1461. {
  1462. rt_socket_close(g_104_client[net]);
  1463. g_104_client[net] = RT_SOCKET_ERR;
  1464. }
  1465. g_net_104_close_flag[net] = 0;
  1466. up(&net_s_lock[net]);
  1467. up(&net_r_lock[net]);
  1468. }
  1469. void net_104_close_flag(int net)
  1470. {
  1471. down(&net_r_lock[net]);
  1472. down(&net_s_lock[net]);
  1473. if (g_104_client[net] != RT_SOCKET_ERR)
  1474. {
  1475. g_net_104_close_flag[net] = 1;
  1476. }
  1477. up(&net_s_lock[net]);
  1478. up(&net_r_lock[net]);
  1479. }
  1480. int net_104_is_connect(int net)
  1481. {
  1482. if ((g_104_client[net] == RT_SOCKET_ERR) || g_net_104_close_flag[net])
  1483. {
  1484. return 0;
  1485. }
  1486. return 1;
  1487. }
  1488. /*------------------------------ 内部函数 -------------------------------------
  1489. 内部函数以下划线‘_’开头,不需要检查参数的合法性.
  1490. */
  1491. extern int _net_104Client_thread(int net);
  1492. int _net_104_thread(IEC104_DEF *pt104)
  1493. {
  1494. struct sockaddr_in server_addr;
  1495. struct sockaddr_in client_addr;
  1496. struct linger ling;
  1497. SOCKET sk_server, sk_tmp;
  1498. int net;
  1499. int sin_size;
  1500. int len, ret;
  1501. unsigned char *ip;
  1502. unsigned int ip_server;
  1503. unsigned int recv_timeout, recv_timeout_set;
  1504. unsigned int link_timeout = dTCounter;
  1505. unsigned char buf;
  1506. u16 w104Port;
  1507. if (tRunPara.b104Client) // 104采用客户端
  1508. {
  1509. net = pt104->cNetIndex;
  1510. _net_104Client_thread(net);
  1511. return 0;
  1512. }
  1513. NET_BEGIN:
  1514. net = pt104->cNetIndex;
  1515. // 服务器端开始建立socket描述符
  1516. // sk_server = rt_socket(AF_INET, SOCK_STREAM, 0);
  1517. sk_server = rt_socket(AF_INET, SOCK_STREAM | SOCK_NONBLOCK, 0); // noted by sunxi: 20221212 设为非阻塞型
  1518. if (sk_server == RT_SOCKET_ERR)
  1519. {
  1520. RT_PRINTF_POSITION();
  1521. g_ts_104[net] = NULL;
  1522. return -1;
  1523. }
  1524. // 服务器端填充sockaddr结构
  1525. memset(&server_addr, 0, sizeof(struct sockaddr_in));
  1526. server_addr.sin_family = AF_INET;
  1527. // rt_if_ip_get(net,(unsigned char *)&ip_server);
  1528. // ret=get_ethcnt(net, tRunPara.tNetPara[net].ethid);
  1529. // IP在物理网卡上
  1530. if (tRunPara.tNetPara[net].index == 0)
  1531. {
  1532. rt_if_ip_get(tRunPara.tNetPara[net].ethid, (unsigned char *)&ip_server);
  1533. w104Port = tRunPara.w104Port; // 网络1、2使用可变端口,保证级联时不冲突。
  1534. }
  1535. else // IP在虚拟网卡上
  1536. {
  1537. // 从虚拟网卡获取IP地址
  1538. rt_printf("%s 获取虚拟网卡IP地址:ethid=%d,index=%d\r\n", __func__, tRunPara.tNetPara[net].ethid, tRunPara.tNetPara[net].index);
  1539. rt_if_ip_get2(tRunPara.tNetPara[net].ethid, tRunPara.tNetPara[net].index, (unsigned char *)&ip_server);
  1540. w104Port = NET_104_PORT; // 调试网络使用固定的2404端口,保证维护工具可以连接。
  1541. }
  1542. server_addr.sin_addr.s_addr = htonl(ip_server);
  1543. server_addr.sin_port = htons(w104Port);
  1544. // 捆绑sockfd描述符
  1545. ret = rt_bind(sk_server, (struct sockaddr *)(&server_addr), sizeof(struct sockaddr));
  1546. if (ret < 0)
  1547. {
  1548. RT_PRINTF_POSITION();
  1549. rt_socket_close(sk_server);
  1550. g_ts_104[net] = NULL;
  1551. return -2;
  1552. }
  1553. // 监听sockfd描述符
  1554. ret = rt_listen(sk_server, 1);
  1555. if (ret < 0)
  1556. {
  1557. RT_PRINTF_POSITION();
  1558. rt_socket_close(sk_server);
  1559. g_ts_104[net] = NULL;
  1560. return -3;
  1561. }
  1562. // 设置关闭延时
  1563. ling.l_onoff = 1;
  1564. ling.l_linger = 0;
  1565. rt_setsockopt(sk_server, SOL_SOCKET, SO_LINGER, (char *)&ling, sizeof(struct linger));
  1566. ip = (unsigned char *)&ip_server;
  1567. // rt_printf("应用104线程已启动(IP:%d.%d.%d.%d,PORT:%d)。\r\n",ip[0],ip[1],ip[2],ip[3],NET_104_PORT);
  1568. while (1)
  1569. {
  1570. msleep(100); // noted by sunxi: 20221212 设为非阻塞型
  1571. // 服务器阻塞,直到客户程序建立连接
  1572. sin_size = sizeof(struct sockaddr_in);
  1573. sk_tmp = rt_accept(sk_server, (struct sockaddr *)(&client_addr), &sin_size);
  1574. // 检查是否退出
  1575. if (g_net_104_exit_flag[net])
  1576. {
  1577. // 关闭客户端
  1578. net_104_close(net);
  1579. // 关闭服务器
  1580. rt_socket_close(sk_server);
  1581. complete_and_exit(&g_exit_completion_net_104[net], 0);
  1582. return 0;
  1583. }
  1584. // 是否重新初始化
  1585. if (g_net_reinit[net] == NET_SOCKET_CLOSING)
  1586. {
  1587. // 关闭客户端
  1588. net_104_close(net);
  1589. // 关闭服务器
  1590. rt_socket_close(sk_server);
  1591. // 置已经关闭标志
  1592. g_net_reinit[net] = NET_SOCKET_CLOSED;
  1593. // 等待IP修改完成
  1594. while (g_net_reinit[net] != NET_SOCKET_REINIT)
  1595. {
  1596. msleep(100);
  1597. }
  1598. // 置为初始化
  1599. g_net_reinit[net] = NET_SOCKET_INIT;
  1600. goto NET_BEGIN;
  1601. }
  1602. // 注意,用指针类型的socket接口,失败是返回NULL
  1603. // 而整数类型的socket接口,失败返回的是负数
  1604. #ifdef RT_SOCKET_FD
  1605. if (sk_tmp < 0)
  1606. {
  1607. // msleep(100);//noted by sunxi: 20221212 设为非阻塞型
  1608. // 超时
  1609. continue;
  1610. }
  1611. #else
  1612. if (sk_tmp == RT_SOCKET_ACCEPT_RST)
  1613. {
  1614. // msleep(100);//noted by sunxi: 20221212 设为非阻塞型
  1615. // 超时
  1616. continue;
  1617. }
  1618. #endif
  1619. g_104_client[net] = sk_tmp;
  1620. ip = (unsigned char *)&client_addr.sin_addr.s_addr;
  1621. rt_printf("104 client[net=%d,s=%d] connect(ip=%d.%d.%d.%d)!\r\n", net, sk_tmp, ip[0], ip[1], ip[2], ip[3]);
  1622. // 检查是否主站IP
  1623. if (tRunPara.ip104Master1 || tRunPara.ip104Master2 || tRunPara.ip104Master3 || tRunPara.ip104Master4)
  1624. {
  1625. u32 network0, network1;
  1626. network0 = client_addr.sin_addr.s_addr & tRunPara.tNetPara[CFG_ETH_MAX_LOGIC - 1].wMask;
  1627. network1 = tRunPara.tNetPara[CFG_ETH_MAX_LOGIC - 1].wIp & tRunPara.tNetPara[CFG_ETH_MAX_LOGIC - 1].wMask;
  1628. if ((client_addr.sin_addr.s_addr != tRunPara.ip104Master1) && (client_addr.sin_addr.s_addr != tRunPara.ip104Master2) && (client_addr.sin_addr.s_addr != tRunPara.ip104Master3) && (client_addr.sin_addr.s_addr != tRunPara.ip104Master4) && (g_ip_net_maintain == 0) // 如果维护工具已连接,任意104主站可以接入。
  1629. && (network0 != network1)) // 运行维护网络的104连接进来
  1630. {
  1631. net_104_close(net);
  1632. rt_printf("主站IP不在允许范围内!\r\n");
  1633. ip = (unsigned char *)&tRunPara.ip104Master1;
  1634. rt_printf("允许IP1:%d.%d.%d.%d)!\r\n", ip[0], ip[1], ip[2], ip[3]);
  1635. ip = (unsigned char *)&tRunPara.ip104Master2;
  1636. rt_printf("允许IP2:%d.%d.%d.%d)!\r\n", ip[0], ip[1], ip[2], ip[3]);
  1637. ip = (unsigned char *)&tRunPara.ip104Master3;
  1638. rt_printf("允许IP3:%d.%d.%d.%d)!\r\n", ip[0], ip[1], ip[2], ip[3]);
  1639. ip = (unsigned char *)&tRunPara.ip104Master4;
  1640. rt_printf("允许IP4:%d.%d.%d.%d)!\r\n", ip[0], ip[1], ip[2], ip[3]);
  1641. ip = (unsigned char *)&g_ip_net_maintain;
  1642. rt_printf("允许IP5:%d.%d.%d.%d)!\r\n", ip[0], ip[1], ip[2], ip[3]);
  1643. msleep(500);
  1644. continue;
  1645. }
  1646. }
  1647. // 客户端已连接,处理客户端命令
  1648. // 初始化接收FIFO
  1649. rt_fifo_init(&g_net_104_fifo[net], g_net_104_buf[net], NET_104_BUF_SIZE);
  1650. IEC104_Recv_Reset(&g_t104[net]);
  1651. memcpy(g_t104[net].ip, (unsigned char *)&client_addr.sin_addr.s_addr, 4);
  1652. g_t104[net].LinkCountNet++;
  1653. // 接收帧超时初始化,超时设置为测试超时加确认超时后的2倍。
  1654. recv_timeout = dTCounter;
  1655. recv_timeout_set = (tRunPara.w104TestTime + tRunPara.w104AckTime) * 2 * T_1s;
  1656. // 循环处理接收数据
  1657. while (1)
  1658. {
  1659. msleep(2); // noted by sunxi: 20221212 设为非阻塞型
  1660. len = net_104_recv(net, g_net_104_buf_frame[net], NET_RECV_MAX);
  1661. // 检查是否退出
  1662. if (g_net_104_exit_flag[net])
  1663. {
  1664. // 关闭客户端
  1665. net_104_close(net);
  1666. // 关闭服务器
  1667. rt_socket_close(sk_server);
  1668. complete_and_exit(&g_exit_completion_net_104[net], 0);
  1669. return 0;
  1670. }
  1671. // 是否重新初始化
  1672. if (g_net_reinit[net] == NET_SOCKET_CLOSING)
  1673. {
  1674. // 关闭客户端
  1675. net_104_close(net);
  1676. // 关闭服务器
  1677. rt_socket_close(sk_server);
  1678. // 置已经关闭标志
  1679. g_net_reinit[net] = NET_SOCKET_CLOSED;
  1680. // 等待IP修改完成
  1681. while (g_net_reinit[net] != NET_SOCKET_REINIT)
  1682. {
  1683. msleep(100);
  1684. }
  1685. // 置为初始化
  1686. g_net_reinit[net] = NET_SOCKET_INIT;
  1687. rt_printf("net_104_thread:链路重新初始化!\r\n");
  1688. goto NET_BEGIN;
  1689. }
  1690. if (g_net_104_close_flag[net])
  1691. {
  1692. break;
  1693. }
  1694. if (len == -EAGAIN)
  1695. {
  1696. if (rt_get_net_linkstatus(rt_get_netcard_id_from_socket(g_104_client[net])) == 1)
  1697. {
  1698. if ((dTCounter - link_timeout) > RT_LINK_TIMEOUT * T_1s) // 500ms超时
  1699. {
  1700. rt_printf("net_104_thread: link down\r\n");
  1701. link_timeout = dTCounter;
  1702. break;
  1703. }
  1704. }
  1705. else
  1706. {
  1707. link_timeout = dTCounter;
  1708. }
  1709. // 接收帧超时
  1710. if ((dTCounter - recv_timeout) > recv_timeout_set)
  1711. {
  1712. rt_printf("net_104_thread:接收帧超时(value=%d,set=%d)\r\n", recv_timeout, recv_timeout_set);
  1713. break;
  1714. }
  1715. }
  1716. else if (len <= 0)
  1717. {
  1718. // 调用recv时,如果返回0,则表示对端关闭;返回负数,表示出错
  1719. rt_printf("net_104_thread:rt_recv(ret=%d)\r\n", len);
  1720. // TODO:以下休眠语句必须屏蔽,否则net_104_close会延时调用,
  1721. // 导致主循环可以在此断开的socket上继续发送数据,引起系统异常。
  1722. // msleep(100);
  1723. break;
  1724. }
  1725. else
  1726. {
  1727. int space;
  1728. space = rt_fifo_space(&g_net_104_fifo[net]);
  1729. if (space > len)
  1730. {
  1731. rt_fifo_put(&g_net_104_fifo[net], g_net_104_buf_frame[net], len);
  1732. if (tRunPara.tNetPara[net].ethid < CFG_ETH_NUM_MAX)
  1733. g_run_stu.led[CFG_UART_NUM_MAX * 2 + tRunPara.tNetPara[net].ethid] = 1;
  1734. }
  1735. else
  1736. {
  1737. rt_printf("net_104_thread:接收FIFO溢出(space=%d,len=%d)\r\n", space, len);
  1738. }
  1739. link_timeout = dTCounter;
  1740. }
  1741. // 接收数据
  1742. while (g_t104[net].bSM2Data == false && g_t104[net].bRecvOk == false)
  1743. {
  1744. if (rt_fifo_get(&g_net_104_fifo[net], &buf, 1))
  1745. {
  1746. if (g_print_comm_raw && (g_print_port & (1 << (net + CFG_UART_NUM_MAX))))
  1747. {
  1748. rt_printf("%02x ", buf);
  1749. }
  1750. if (IEC104_Recv(&g_t104[net], buf))
  1751. {
  1752. // 如果接收到完整的一帧104报文(其它数据不清定时器,防止意外连接),超时定时器清零。
  1753. recv_timeout = dTCounter;
  1754. }
  1755. }
  1756. else
  1757. {
  1758. break;
  1759. }
  1760. }
  1761. }
  1762. // 关闭客户端socket
  1763. net_104_close(net);
  1764. }
  1765. // 理论上,程序不会运行到这儿
  1766. return 0;
  1767. }
  1768. int _net_104Client_thread(int net)
  1769. {
  1770. struct sockaddr_in server_addr;
  1771. struct linger ling;
  1772. SOCKET s;
  1773. int len, ret;
  1774. unsigned int ip_server, link_count;
  1775. unsigned int recv_timeout;
  1776. unsigned char buf;
  1777. unsigned char *ip;
  1778. // int net = *pnet;
  1779. while (1)
  1780. {
  1781. BEGIN:
  1782. link_count = 0;
  1783. // 检查级联IP是否设置
  1784. while (1)
  1785. {
  1786. ip_server = tRunPara.ip104Master[net];
  1787. if (ip_server)
  1788. {
  1789. break;
  1790. }
  1791. // 检查是否退出
  1792. if (g_net_104_exit_flag[net])
  1793. {
  1794. // rt_printf_time("net_104link_thread exit.\r\n");
  1795. complete_and_exit(&g_exit_completion_net_104[net], 0);
  1796. return 0;
  1797. }
  1798. // 1秒钟检查一次
  1799. msleep(1000);
  1800. }
  1801. ip = (unsigned char *)&ip_server;
  1802. rt_printf_time("104连接服务器开始(%d):ip=%d.%d.%d.%d!\r\n", net, ip[0], ip[1], ip[2], ip[3]);
  1803. // 创建socket
  1804. s = rt_socket(AF_INET, SOCK_STREAM | SOCK_NONBLOCK, 0);
  1805. if (s == RT_SOCKET_ERR)
  1806. {
  1807. RT_PRINTF_POSITION();
  1808. return -1;
  1809. }
  1810. // 服务器端填充sockaddr结构
  1811. memset(&server_addr, 0, sizeof(struct sockaddr_in));
  1812. server_addr.sin_family = AF_INET;
  1813. server_addr.sin_addr.s_addr = htonl(ip_server);
  1814. server_addr.sin_port = htons(tRunPara.w104Port);
  1815. // 连接服务器,没有连接成功不退出
  1816. while (1)
  1817. {
  1818. ret = rt_connect(s, (struct sockaddr *)&server_addr, sizeof(struct sockaddr_in));
  1819. // 检查是否退出
  1820. if (g_net_104_exit_flag[net])
  1821. {
  1822. // 关闭客户端
  1823. g_104_client[net] = RT_SOCKET_ERR;
  1824. rt_socket_close(s);
  1825. rt_printf_time("net_104_thread exit(rt_recv).\r\n");
  1826. complete_and_exit(&g_exit_completion_net_104[net], 0);
  1827. return 0;
  1828. }
  1829. // 检查服务器是否变更
  1830. if (ip_server != tRunPara.ip104Master[net])
  1831. {
  1832. // 关闭客户端
  1833. g_104_client[net] = RT_SOCKET_ERR;
  1834. rt_socket_close(s);
  1835. ip = (unsigned char *)&tRunPara.ip104Master[net];
  1836. rt_printf_time("主站服务器变更(%d):ip=%d.%d.%d.%d!\r\n", net, ip[0], ip[1], ip[2], ip[3]);
  1837. goto BEGIN;
  1838. }
  1839. if (ret == 0)
  1840. {
  1841. g_net_104_close_flag[net] = 0;
  1842. g_link104_init_ok[net] = 0;
  1843. g_104_client[net] = s;
  1844. g_t104[net].bClientStart = false;
  1845. link_count++;
  1846. rt_printf_time("104连接服务器成功(通道=%d,连接计数=%d):ip=%d.%d.%d.%d!\r\n", net, link_count, ip[0], ip[1], ip[2], ip[3]);
  1847. break;
  1848. }
  1849. // 1秒钟连接一次
  1850. msleep(1000);
  1851. }
  1852. // 设置关闭延时
  1853. ling.l_onoff = 1;
  1854. ling.l_linger = 0;
  1855. rt_setsockopt(s, SOL_SOCKET, SO_LINGER, (char *)&ling, sizeof(struct linger));
  1856. // 初始化FIFO
  1857. rt_fifo_init(&g_net_104_fifo[net], g_net_104_buf[net], NET_104_BUF_SIZE);
  1858. // 处理接收
  1859. recv_timeout = dTCounter;
  1860. while (1)
  1861. {
  1862. msleep(2); // noted by sunxi: 20221212 设为非阻塞型
  1863. len = rt_recv(s, g_net_104_buf_frame[net], NET_RECV_MAX, MSG_DONTWAIT);
  1864. // 检查是否退出
  1865. if (g_net_104_exit_flag[net])
  1866. {
  1867. // 关闭客户端
  1868. g_104_client[net] = RT_SOCKET_ERR;
  1869. rt_socket_close(s);
  1870. rt_printf_time("net_104client_thread exit(rt_recv).\r\n");
  1871. complete_and_exit(&g_exit_completion_net_104[net], 0);
  1872. return 0;
  1873. }
  1874. // 检查服务器是否变更
  1875. if (ip_server != tRunPara.ip104Master[net])
  1876. {
  1877. // 关闭客户端
  1878. g_104_client[net] = RT_SOCKET_ERR;
  1879. rt_socket_close(s);
  1880. rt_printf_time("104服务器变更(%d):ip=%d.%d.%d.%d!\r\n", net, ip[0], ip[1], ip[2], ip[3]);
  1881. goto BEGIN;
  1882. }
  1883. // 应用程序主动关闭
  1884. if (g_net_104_close_flag[net])
  1885. {
  1886. break;
  1887. }
  1888. if (len == -EAGAIN)
  1889. {
  1890. // 超时
  1891. if ((dTCounter - recv_timeout) > 30 * T_1s) // 超时30s,端口未收到数据,关闭端口
  1892. {
  1893. rt_printf_time("104客户端30S超时关闭(net=%d)\r\n", net);
  1894. break;
  1895. }
  1896. }
  1897. else if (len <= 0)
  1898. {
  1899. // 调用recv时,如果返回0,则表示对端关闭;返回负数,表示出错
  1900. rt_printf_time("104客户端关闭(net=%d,ret=%d)\r\n", net, len);
  1901. msleep(100);
  1902. break;
  1903. }
  1904. else
  1905. {
  1906. rt_fifo_put(&g_net_104_fifo[net], g_net_104_buf_frame[net], len);
  1907. recv_timeout = dTCounter; // 超时计数器清零
  1908. if (tRunPara.tNetPara[net].ethid < CFG_ETH_NUM_MAX)
  1909. g_run_stu.led[CFG_UART_NUM_MAX * 2 + tRunPara.tNetPara[net].ethid] = 1;
  1910. }
  1911. // 接收数据
  1912. while (g_t104[net].bSM2Data == false && g_t104[net].bRecvOk == false)
  1913. {
  1914. if (rt_fifo_get(&g_net_104_fifo[net], &buf, 1))
  1915. {
  1916. IEC104_Recv(&g_t104[net], buf);
  1917. }
  1918. else
  1919. {
  1920. break;
  1921. }
  1922. }
  1923. }
  1924. // 关闭客户端socket
  1925. g_104_client[net] = RT_SOCKET_ERR;
  1926. rt_socket_close(s);
  1927. // rt_printf_time ("net_104link_thread:rt_recv(ret=%d)\r\n",len);
  1928. }
  1929. // 理论上,程序不会运行到这儿
  1930. return 0;
  1931. }
  1932. #endif
  1933. /*------------------------------ 测试函数 -------------------------------------
  1934. 一个实体文件必须带一个本模块的测试函数来进行单元测试,如果的确不方便在本模块中
  1935. 进行单元测试,必须在此注明实际的测试位置(例如在哪个实体文件中使用哪个测试函数).
  1936. */
  1937. /*------------------------------ 文件结束 -------------------------------------
  1938. */