P2PModule.cpp 24 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199
  1. // P2PModule.cpp : 定义 DLL 应用程序的导出函数。
  2. //
  3. #include "stdafx.h"
  4. #include <string>
  5. #include <mstcpip.h>
  6. #include "P2PModule.h"
  7. #include "DeviceBus.h"
  8. #include "Logger.h"
  9. #include "common_api.h"
  10. using namespace std;
  11. #define P2P_CHECK_PERIOD (2000)
  12. string FormatLinkError(int ErrorCode)
  13. {
  14. switch (ErrorCode)
  15. {
  16. case 7: return "sckOutOfMemory";// 7 内存不足
  17. case 380: return "sckInvalidPropertyValue";// 380 属性值无效
  18. case 394: return "sckGetNotSupported";// 394 属性不可读
  19. case 383: return "sckGetNotSupported";// 383 属性是只读的
  20. case 40006: return "sckBadState";// 40006 所请求的事务或请求本身的错误协议或者错误连接状态
  21. case 40014: return "sckInvalidArg";// 40014 传递给函数的参数格式不确定,或者不在指定范围内
  22. case 40017: return "sckSuccess";// 40017 成功
  23. case 40018: return "sckUnsupported";// 40018 不支持的变量类型
  24. case 40020: return "sckInvalidOp";// 40020 在当前状态下的无效操作
  25. case 40021: return "sckOutOfRange";// 40021 参数越界
  26. case 40026: return "sckWrongProtocol";// 40026 所请求的事务或请求本身的错误协议
  27. case 10004: return "sckOpCanceled";// 10004 取消操作
  28. case 10014: return "sckInvalidArgument";// 10014 所请求的地址是广播地址,但未设置标记
  29. case 10035: return "sckWouldBlock";// 10035 套接字不成块,而指定操作将使之成块
  30. case 10036: return "sckInProgress";// 10036 制造块的Winsock操作在进行之中
  31. case 10037: return "sckAlreadyComplete";// 10037 完成操作。未进行制作块的操作
  32. case 10038: return "sckNotSocket";// 10038 描述符不是套接字
  33. case 10040: return "sckMsgTooBig";// 10040 数据太大,不适于缓冲区的要求,因而被截断
  34. case 10043: return "sckPortNotSupported";// 10043 不支持指定的端口
  35. case 10048: return "sckAddressInUse";// 10048 地址在使用中
  36. case 10049: return "sckAddressNotAvailable";// 10049 来自本地机器的不可用地址
  37. case 10050: return "sckNetworkSubsystemFailed";// 10050 网络子系统失败
  38. case 10051: return "sckNetworkUnreachable";// 10051 当前不能从主机到达网络
  39. case 10052: return "sckNetReset 10052";// 在设置SO_KEEPALIVE时连接超时
  40. case 10053: return "sckConnectAborted";// 10053 由于超时或者其它失败而中止接连
  41. case 10054: return "sckConnectionReset";// 10054 通过远端重新设置连接
  42. case 10055: return "sckNoBufferSpace";// 10055 没有可用的缓存空间
  43. case 10056: return "sckAlreadyConnected";// 10056 已连接的套接字
  44. case 10057: return "sckNotConnected";// 10057 未接连套接字
  45. case 10058: return "sckSockedShutdown";// 10058 已关闭套接字
  46. case 10060: return "sckTimedout";// 10060 套接字超时
  47. case 10061: return "sckConnectionRefused";// 10061 强行拒绝连接
  48. case 10093: return "sckNotInitialized";// 10093 套接字没有初始化
  49. case 11001: return "sckHostNotFound";// 11001 授权应答:未找到主机
  50. case 11002: return "sckHostNotFoundTryAgain";// 11002 非授权应答:未找到主机,重试
  51. case 11003: return "sckNonRecoverableError";// 11003 不可恢复的错误
  52. case 11004: return "sckNoData";// 11004 无效名,对所请求的类型无数据记录
  53. default: return string("Socket error %d", ErrorCode);
  54. }
  55. }
  56. int socket_set_keepalive(SOCKET &fd)
  57. {
  58. //struct tcp_keepalive kavars[1] = {
  59. // 1,
  60. // 10 * 1000, /* 10 seconds */
  61. // 5 * 1000 /* 5 seconds */
  62. //};
  63. ///* Set: use keepalive on fd */
  64. //int alive = 1;
  65. //int ret;
  66. //if (setsockopt
  67. // (fd, SOL_SOCKET, SO_KEEPALIVE, (const char *)&alive,
  68. // sizeof alive) != 0)
  69. //{
  70. // //printf("Set keep alive error1: %s.\n", strerror (errno));
  71. // return -1;
  72. //}
  73. //if (WSAIoctl(fd, SIO_KEEPALIVE_VALS, kavars, sizeof(kavars), NULL, sizeof (int), (LPDWORD)&ret, NULL,
  74. // NULL) != 0)
  75. //{
  76. // //printf("Set keep alive error2: %s.\n", strerror (WSAGetLastError ()));
  77. // return -2;
  78. //}
  79. return 0;
  80. }
  81. P2P_Module_Base::P2P_Module_Base()
  82. {
  83. m_Port = 0;
  84. m_MessageBuffSize = 1024 * 1024;//set 1M limits
  85. m_pszMessageBuff = new char[m_MessageBuffSize];
  86. m_pMainDevBus = NULL;
  87. Socketfd = NULL;
  88. m_SocketTarget = NULL;
  89. m_pszIpAddress = new char[256];
  90. m_pszLocalBusId = new char[256];
  91. m_pszRemoteBusId = new char[256];
  92. memset(m_pszIpAddress, 0, 256);
  93. memset(m_pszLocalBusId, 0, 256);
  94. memset(m_pszRemoteBusId, 0, 256);
  95. m_ConnectionReady = CreateEvent(0, 1, 0, 0);
  96. }
  97. P2P_Module_Base::~P2P_Module_Base()
  98. {
  99. Disconnect();
  100. delete[]m_pszIpAddress;
  101. delete[]m_pszLocalBusId;
  102. delete[]m_pszRemoteBusId;
  103. m_pszIpAddress = NULL;
  104. m_pszLocalBusId = NULL;
  105. m_pszRemoteBusId = NULL;
  106. CloseHandle(m_ConnectionReady);
  107. delete[]m_pszMessageBuff;
  108. m_pszMessageBuff = NULL;
  109. }
  110. //init
  111. void P2P_Module_Base::InitP2P(const char *pszIp, const char *pszLocalBusId, bool AsServer, PVOID pParent)
  112. {
  113. strcpy_s(m_pszIpAddress,256, pszIp);
  114. strcpy_s(m_pszLocalBusId,256, pszLocalBusId);
  115. m_Port = (WORD)(CCOS_HW_CHANNEL/10) + 3;//80000 is out of WORD limits
  116. m_AsServer = AsServer;
  117. m_pMainDevBus = pParent;
  118. string logfile = GetProcessDirectory() + "\\logs\\Local_p2pDispathlog.log";
  119. Logger *pLog = CreateLogger();
  120. pLog->SetLogFilepath(logfile.c_str());
  121. SetLogger(pLog);
  122. }
  123. //connect
  124. bool P2P_Module_Base::ConnectP2P()
  125. {
  126. return false;
  127. }
  128. //disconnect
  129. void P2P_Module_Base::Disconnect()
  130. {
  131. }
  132. bool P2P_Module_Base::IsConnected()
  133. {
  134. return false;
  135. }
  136. //Blob的定义
  137. //4字节 大长度:4字节Msg的长度:Msg内容,4字节Block的长度:Block内容
  138. //必须存在项为 大长度,Msg长度,Block长度,如果无此内容,其值为0
  139. bool P2P_Module_Base::SendRaw(SOCKET &sck, const char *pData, DWORD size, bool Sync)
  140. {
  141. DWORD Sented = 0;
  142. int Sendonce = 0;
  143. Logger *pLog = (Logger*)GetLogger();
  144. PRINTA_TRACE(pLog,"Enter SendRaw");
  145. while (Sented < size)
  146. {
  147. Thread_Lock();
  148. if (WaitTheThreadEndSign(0) == false)
  149. {
  150. if (sck)
  151. {
  152. int sel_ret = 1;
  153. if (Sync == false)
  154. {
  155. //check readable
  156. // 超时时间
  157. struct timeval tm;
  158. FD_SET WriteSet;
  159. tm.tv_sec = P2P_CHECK_PERIOD / 1000;
  160. tm.tv_usec = P2P_CHECK_PERIOD % 1000;
  161. FD_ZERO(&WriteSet);
  162. FD_SET(sck, &WriteSet);
  163. //PRINTA_TRACE(pLog,"bs--");
  164. sel_ret = select(-1, NULL, &WriteSet, NULL, &tm);
  165. }
  166. //PRINTA_TRACE(pLog,"as--");
  167. if (sel_ret > 0)
  168. {
  169. //ok
  170. //PRINTA_TRACE(pLog,"bsend--");
  171. Sendonce = send(sck, (char*)&pData[Sented], size - Sented, 0);
  172. //PRINTA_TRACE(pLog,"asend--%d", Sendonce);
  173. if (Sendonce > 0)
  174. {
  175. Sented += Sendonce;
  176. }
  177. else
  178. {
  179. //socket error,or closed
  180. string errinfo = FormatLinkError(WSAGetLastError());
  181. PRINTA_ERROR(pLog, "socket error:%s\n", errinfo.c_str());
  182. closesocket(sck);
  183. sck = NULL;
  184. Thread_UnLock();
  185. return false;
  186. }
  187. }
  188. else if (sel_ret < 0)
  189. {
  190. //socket error,or closed
  191. string errinfo = FormatLinkError(WSAGetLastError());
  192. PRINTA_ERROR(pLog, "socket error:%s\n", errinfo.c_str());
  193. closesocket(sck);
  194. sck = NULL;
  195. Thread_UnLock();
  196. return false;
  197. }
  198. //timeout
  199. }
  200. else
  201. {
  202. //socket erroe
  203. Thread_UnLock();
  204. PRINTA_ERROR(pLog, "socket error:using empty socket handle\n");
  205. return false;
  206. }
  207. }
  208. else
  209. {
  210. if (sck)
  211. {
  212. closesocket(sck);
  213. sck = NULL;
  214. }
  215. Thread_UnLock();
  216. PRINTA_INFO(pLog, "exit thread:close socket\n");
  217. return false;
  218. }
  219. Thread_UnLock();
  220. }
  221. TPRINTA_TRACE("Leave SendRaw OK");
  222. return true;
  223. }
  224. bool P2P_Module_Base::ReadRawSync(SOCKET &sck, char *pszBuff, DWORD ExpectedSize)
  225. {
  226. DWORD Total = 0;
  227. int Received = 0;
  228. TPRINTA_TRACE("Enter ReadRawSync");
  229. while (Total < ExpectedSize)
  230. {
  231. Thread_Lock();
  232. if (WaitTheThreadEndSign(0) == false)
  233. {
  234. if (sck)
  235. {
  236. //ok
  237. //TPRINTA_TRACE("br--");
  238. Received = recv(sck, (char*)&pszBuff[Total], ExpectedSize - Total, 0);
  239. //TPRINTA_TRACE("ar--:%d", Received);
  240. if (Received > 0)
  241. {
  242. Total += Received;
  243. }
  244. else
  245. {
  246. closesocket(sck);
  247. sck = NULL;
  248. Thread_UnLock();
  249. //socket error,or closed
  250. string errinfo = FormatLinkError(WSAGetLastError());
  251. TPRINTA_ERROR("socket error:%s\n", errinfo.c_str());
  252. return false;
  253. }
  254. }
  255. }
  256. Thread_UnLock();
  257. }
  258. TPRINTA_TRACE("Leave ReadRawSync OK");
  259. return true;
  260. }
  261. bool P2P_Module_Base::ReadRaw(SOCKET &sck, char *pszBuff, DWORD ExpectedSize)
  262. {
  263. DWORD Total = 0;
  264. int Received = 0;
  265. TPRINTA_TRACE("Enter ReadRaw");
  266. while (Total < ExpectedSize)
  267. {
  268. Thread_Lock();
  269. if (WaitTheThreadEndSign(0) == false)
  270. {
  271. if (sck)
  272. {
  273. //check readable
  274. // 超时时间
  275. struct timeval tm;
  276. FD_SET ReadSet;
  277. tm.tv_sec = P2P_CHECK_PERIOD / 1000;
  278. tm.tv_usec = P2P_CHECK_PERIOD % 1000;
  279. FD_ZERO(&ReadSet);
  280. FD_SET(sck, &ReadSet);
  281. //TPRINTA_TRACE("bs--");
  282. int sel_ret = select(-1, &ReadSet, NULL, NULL, &tm);
  283. //TPRINTA_TRACE("as--");
  284. if (sel_ret > 0)
  285. {
  286. //ok
  287. //TPRINTA_TRACE("br--");
  288. Received = recv(sck, (char*)&pszBuff[Total], ExpectedSize - Total, 0);
  289. //TPRINTA_TRACE("ar--:%d", Received);
  290. if (Received > 0)
  291. {
  292. Total += Received;
  293. }
  294. else
  295. {
  296. closesocket(sck);
  297. sck = NULL;
  298. Thread_UnLock();
  299. //socket error,or closed
  300. string errinfo = FormatLinkError(WSAGetLastError());
  301. TPRINTA_ERROR("socket error:%s\n", errinfo.c_str());
  302. return false;
  303. }
  304. }
  305. else if (sel_ret < 0)
  306. {
  307. closesocket(sck);
  308. sck = NULL;
  309. Thread_UnLock();
  310. string errinfo = FormatLinkError(WSAGetLastError());
  311. TPRINTA_ERROR("socket error:%s\n", errinfo.c_str());
  312. //socket error,or closed
  313. return false;
  314. }
  315. //timeout
  316. }
  317. else
  318. {
  319. //socket erroe
  320. Thread_UnLock();
  321. TPRINTA_ERROR("socket error:using empty sck.\n");
  322. return false;
  323. }
  324. }
  325. else
  326. {
  327. if (sck)
  328. {
  329. closesocket(sck);
  330. sck = NULL;
  331. }
  332. Thread_UnLock();
  333. TPRINTA_INFO("exit thread.close socket .\n");
  334. return false;
  335. }
  336. Thread_UnLock();
  337. }
  338. TPRINTA_TRACE("Leave ReadRaw OK");
  339. return true;
  340. }
  341. //send block
  342. bool P2P_Module_Base::SendBlob(SOCKET &sck, const char *pMsg, const char *pBlock, DWORD size, bool Sync)
  343. {
  344. bool ret = false;
  345. DWORD MsgLen = 0;
  346. Logger *pLog = (Logger*)GetLogger();
  347. if (pMsg)
  348. {
  349. MsgLen = (DWORD)strlen(pMsg);
  350. }
  351. DWORD BlockLen = size;
  352. DWORD TotalLen = MsgLen + BlockLen + 4 + 4;
  353. if (MsgLen > m_MessageBuffSize - 12)
  354. {
  355. PRINTA_ERROR(pLog, "SendBlob error.Message size is too big\n");
  356. return false;
  357. }
  358. int MsgPartSize = 0;
  359. //copy total Len
  360. memcpy(&m_pszMessageBuff[MsgPartSize], (const char*)&TotalLen, sizeof(TotalLen));
  361. MsgPartSize += sizeof(TotalLen);
  362. //copy msg Len
  363. memcpy(&m_pszMessageBuff[MsgPartSize], (const char*)&MsgLen, sizeof(MsgLen));
  364. MsgPartSize += sizeof(MsgLen);
  365. //copy msg
  366. memcpy(&m_pszMessageBuff[MsgPartSize], pMsg, MsgLen);
  367. MsgPartSize += MsgLen;
  368. //copy BlockLen
  369. memcpy(&m_pszMessageBuff[MsgPartSize], (const char*)&BlockLen, sizeof(BlockLen));
  370. MsgPartSize += sizeof(BlockLen);
  371. if (MsgLen > 0)
  372. {
  373. PRINTA_TRACE(pLog, "TotalLen = %d,MsgLen = %d,BlobLen = %d.MsgInfo:{\n%s}", TotalLen, MsgLen, BlockLen, pMsg);
  374. }
  375. //connection is steady
  376. Thread_Lock();
  377. if (sck)
  378. {
  379. bool Sent = SendRaw(sck, m_pszMessageBuff, MsgPartSize);
  380. if (Sent)
  381. {
  382. PRINTA_TRACE(pLog, "write head part succeed.size = %d", MsgPartSize);
  383. if (BlockLen > 0)
  384. {
  385. Sent = SendRaw(sck, (const char*)pBlock, BlockLen);
  386. if (Sent)
  387. {
  388. PRINTA_TRACE(pLog, "write Block data: %d succeed\n", BlockLen);
  389. PRINTA_TRACE(pLog, "write Blob: succeed----------------\n");
  390. ret = true;
  391. }
  392. }
  393. else
  394. {
  395. PRINTA_TRACE(pLog, "write MessageOnly: succeed----------------\n");
  396. ret = true;
  397. }
  398. }
  399. }
  400. if (ret == false)
  401. {
  402. PRINTA_ERROR(pLog, "SendBlob error.close p2p socket\n");
  403. }
  404. Thread_UnLock();
  405. return ret;
  406. }
  407. void P2P_Module_Base::Quit()
  408. {
  409. }
  410. bool P2P_Module_Base::SendBlob(const char *pMsg, const char *pBlock, DWORD size)
  411. {
  412. bool ret = false;
  413. return ret;
  414. }
  415. bool P2P_Module_Base::ReadBlobSync(SOCKET &sck, char *pMsg, DWORD &MsgSize, char *pBlock, DWORD &size)
  416. {
  417. bool ret = false;
  418. DWORD TotalLen = 0;
  419. DWORD MsgLen = 0;
  420. DWORD BlockLen = 0;
  421. do {
  422. //head
  423. ret = ReadRawSync(sck, (char*)&TotalLen, sizeof(TotalLen));
  424. if (ret == false || TotalLen < 8)
  425. {
  426. break;
  427. }
  428. TPRINTA_DEBUG("read head:%d\n", TotalLen);
  429. //msg len
  430. ret = ReadRawSync(sck, (char*)&MsgLen, sizeof(MsgLen));
  431. if (ret == false || MsgLen + 8 > TotalLen || (MsgLen > MsgSize))
  432. {
  433. break;
  434. }
  435. TPRINTA_DEBUG("read MsgLen:%d\n", MsgLen);
  436. //msg info
  437. if (MsgLen > 0)
  438. {
  439. ret = ReadRawSync(sck, pMsg, MsgLen);
  440. if (ret == false)
  441. {
  442. break;
  443. }
  444. pMsg[MsgLen] = 0;
  445. TPRINTA_DEBUG("read Msg:%s\n", pMsg);
  446. }
  447. //Block Len
  448. ret = ReadRawSync(sck, (char*)&BlockLen, sizeof(BlockLen));
  449. if (ret == false || BlockLen + MsgLen + 8 > TotalLen || (BlockLen > size))
  450. {
  451. break;
  452. }
  453. TPRINTA_DEBUG("read BlockLen:%d\n", BlockLen);
  454. //block info
  455. if (BlockLen > 0)
  456. {
  457. if (pBlock == NULL)
  458. {
  459. break;
  460. }
  461. ret = ReadRawSync(sck, pBlock, BlockLen);
  462. if (ret == false)
  463. {
  464. break;
  465. }
  466. TPRINTA_DEBUG("read Block data Succeed\n");
  467. }
  468. MsgSize = MsgLen;
  469. size = BlockLen;
  470. TPRINTA_DEBUG("read Block Succeed-\n");
  471. return true;
  472. } while (0);
  473. return false;
  474. }
  475. //Read block
  476. bool P2P_Module_Base::ReadBlob(SOCKET &sck, char *pMsg, DWORD &MsgSize, char *pBlock, DWORD &size)
  477. {
  478. bool ret = false;
  479. DWORD TotalLen = 0;
  480. DWORD MsgLen = 0;
  481. DWORD BlockLen = 0;
  482. do {
  483. //head
  484. ret = ReadRaw(sck,(char*)&TotalLen, sizeof(TotalLen));
  485. if (ret == false || TotalLen < 8)
  486. {
  487. break;
  488. }
  489. TPRINTA_TRACE("read head:%d\n", TotalLen);
  490. //msg len
  491. ret = ReadRaw(sck, (char*)&MsgLen, sizeof(MsgLen));
  492. if (ret == false || MsgLen + 8 > TotalLen || (MsgLen > MsgSize))
  493. {
  494. break;
  495. }
  496. TPRINTA_TRACE("read MsgLen:%d\n", MsgLen);
  497. //msg info
  498. if (MsgLen > 0)
  499. {
  500. ret = ReadRaw(sck, pMsg, MsgLen);
  501. if (ret == false)
  502. {
  503. break;
  504. }
  505. pMsg[MsgLen] = 0;
  506. TPRINTA_TRACE("read Msg:%s\n", pMsg);
  507. }
  508. //Block Len
  509. ret = ReadRaw(sck, (char*)&BlockLen, sizeof(BlockLen));
  510. if (ret == false || BlockLen + MsgLen + 8 > TotalLen || (BlockLen > size))
  511. {
  512. break;
  513. }
  514. TPRINTA_TRACE("read BlockLen:%d\n", BlockLen);
  515. //block info
  516. if (BlockLen > 0)
  517. {
  518. if (pBlock == NULL)
  519. {
  520. break;
  521. }
  522. ret = ReadRaw(sck, pBlock, BlockLen);
  523. if (ret == false)
  524. {
  525. break;
  526. }
  527. TPRINTA_TRACE("read Block data Succeed\n");
  528. }
  529. MsgSize = MsgLen;
  530. size = BlockLen;
  531. TPRINTA_TRACE("read Block Succeed-\n");
  532. return true;
  533. } while (0);
  534. return false;
  535. }
  536. //callback
  537. void P2P_Module_Base::OnBlob(char *pMsg,unsigned char *pData, DWORD size)
  538. {
  539. if (m_pMainDevBus)
  540. {
  541. ((DeviceBUS*)m_pMainDevBus)->BlobDataArrived(pMsg, pData, size);
  542. }
  543. }
  544. bool P2P_Module_Base::Exec()
  545. {
  546. return false;
  547. }
  548. bool P2P_Module_Base::IsTargetBusId(const char *pszTargetBusId)
  549. {
  550. bool ret = false;
  551. //Thread_Lock();
  552. //only server can do this check....
  553. if ((m_pszRemoteBusId != NULL) && (pszTargetBusId != NULL) && (m_AsServer == true))
  554. {
  555. ret = (strcmp(m_pszRemoteBusId, pszTargetBusId) == 0);
  556. }
  557. //Thread_UnLock();
  558. return ret;
  559. }
  560. //---------------------------------------------------------------------------------------------------------------
  561. P2P_Module_Server::P2P_Module_Server()
  562. {
  563. m_HeartBeatTimeout = 0;
  564. }
  565. P2P_Module_Server::~P2P_Module_Server()
  566. {
  567. }
  568. //connect
  569. bool P2P_Module_Server::ConnectP2P()
  570. {
  571. //start thread
  572. return StartThread();
  573. }
  574. void P2P_Module_Server::Quit()
  575. {
  576. StopThread(1000);
  577. }
  578. //disconnect
  579. void P2P_Module_Server::Disconnect()
  580. {
  581. //stop thread
  582. //不能给太长时间,因为内部用的Socket是阻塞模式
  583. //StopThread(P2P_CHECK_PERIOD + 1000);
  584. // close socket in the internal thread
  585. }
  586. bool P2P_Module_Server::IsConnected()
  587. {
  588. if (m_SocketTarget != NULL)
  589. {
  590. return (WaitForSingleObject(m_ConnectionReady, 0) == WAIT_OBJECT_0);
  591. }
  592. return false;
  593. }
  594. //-1:exit,0:socket error,1:succeed
  595. int P2P_Module_Server::TryInit()
  596. {
  597. while (WaitTheThreadEndSign(0) == false)
  598. {
  599. //init socket
  600. Socketfd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
  601. if (Socketfd == INVALID_SOCKET)
  602. {
  603. return 0;
  604. }
  605. sockaddr_in service;
  606. service.sin_family = AF_INET;
  607. service.sin_addr.s_addr = inet_addr(m_pszIpAddress);
  608. service.sin_port = htons(m_Port);
  609. //bind
  610. if (bind(Socketfd, (LPSOCKADDR)&service, sizeof(service)) == SOCKET_ERROR)
  611. {
  612. closesocket(Socketfd);
  613. return 0;
  614. }
  615. //buff size
  616. //listen
  617. if (listen(Socketfd, SOMAXCONN) == SOCKET_ERROR)
  618. {
  619. closesocket(Socketfd);
  620. return 0;
  621. }
  622. // 设置为非阻塞模式
  623. ULONG NonBlock = 1;
  624. if (ioctlsocket(Socketfd, FIONBIO, &NonBlock) == SOCKET_ERROR)
  625. {
  626. //printf("ioctlsocket() failed with error %d\n", WSAGetLastError());
  627. closesocket(Socketfd);
  628. return 0;
  629. }
  630. return 1;
  631. }
  632. return -1;
  633. }
  634. //-1:exit,0:socket error,1:succeed
  635. int P2P_Module_Server::TryAccept()
  636. {
  637. while (WaitTheThreadEndSign(0) == false)
  638. {
  639. SOCKET sClient;
  640. FD_SET ReadSet;
  641. sockaddr_in remoteAddr;
  642. int nAddrlen = sizeof(remoteAddr);
  643. // 超时时间
  644. struct timeval tm;
  645. tm.tv_sec = P2P_CHECK_PERIOD / 1000;
  646. tm.tv_usec = P2P_CHECK_PERIOD % 1000;
  647. FD_ZERO(&ReadSet);
  648. FD_SET(Socketfd, &ReadSet);
  649. int sel_ret = select(-1, &ReadSet,NULL, NULL, &tm);
  650. if (sel_ret > 0)
  651. {
  652. //ok
  653. sClient = accept(Socketfd, (SOCKADDR *)&remoteAddr, &nAddrlen);
  654. if (sClient == INVALID_SOCKET)
  655. {
  656. continue;
  657. }
  658. //accept succeed
  659. Thread_Lock();
  660. m_SocketTarget = sClient;
  661. Thread_UnLock();
  662. return 1;
  663. }
  664. else if (sel_ret < 0)
  665. {
  666. closesocket(Socketfd);
  667. return 0;
  668. }
  669. //timeout
  670. }
  671. return -1;
  672. }
  673. //-1:exit,0:socket error
  674. int P2P_Module_Server::TryCheckConnection()
  675. {
  676. while (WaitTheThreadEndSign(100) == false)
  677. {
  678. {
  679. DWORD ret = Thread_Lock(1000);
  680. if (ret == WAIT_OBJECT_0)
  681. {
  682. //got lock
  683. if (m_SocketTarget)
  684. {
  685. //check connection
  686. // 超时时间
  687. FD_SET ErrSet;
  688. struct timeval tm;
  689. tm.tv_sec = 0 / 1000;
  690. tm.tv_usec = 0 % 1000;
  691. FD_ZERO(&ErrSet);
  692. FD_SET(Socketfd, &ErrSet);
  693. int sel_ret = select(-1, NULL, NULL, &ErrSet, &tm);
  694. if (sel_ret < 0)
  695. {
  696. closesocket(m_SocketTarget);
  697. m_SocketTarget = NULL;
  698. closesocket(Socketfd);
  699. Thread_UnLock();
  700. string errinfo = FormatLinkError(WSAGetLastError());
  701. TPRINTA_ERROR("socket error:%s\n", errinfo.c_str());
  702. return 0;//do over
  703. }
  704. //timeout or ok
  705. if ((GetTickCount() - m_HeartBeatTimeout) > 20000)
  706. {
  707. //heartbeat
  708. //server -> client
  709. //it might cause the m_SocketTarget gets empty
  710. if (SendBlob(m_pszLocalBusId, 0, 0))
  711. {
  712. TPRINTA_INFO("Server:Send heart beat\n");
  713. }
  714. }
  715. }
  716. if (m_SocketTarget == NULL)
  717. {
  718. closesocket(Socketfd);
  719. Thread_UnLock();
  720. string errinfo = FormatLinkError(WSAGetLastError());
  721. TPRINTA_ERROR("socket error:%s\n", errinfo.c_str());
  722. return 0;//do over
  723. }
  724. Thread_UnLock();
  725. }
  726. }
  727. }
  728. //exit
  729. TPRINTA_INFO("Server:Stop Thread.exiting...\n");
  730. DWORD ret = Thread_Lock(1000);
  731. if (ret == WAIT_OBJECT_0)
  732. {
  733. //got lock
  734. if (m_SocketTarget)
  735. {
  736. closesocket(m_SocketTarget);
  737. m_SocketTarget = NULL;
  738. closesocket(Socketfd);
  739. }
  740. Thread_UnLock();
  741. }
  742. else
  743. {
  744. //no lock ,no fxxx...
  745. TPRINTA_INFO("P2PServer:Failed CLose Socket...\n");
  746. }
  747. return -1;
  748. }
  749. bool P2P_Module_Server::Exec()
  750. {
  751. int ret = 0;
  752. TPRINTA_INFO("P2PServer:init Entry\n");
  753. ResetEvent(m_ConnectionReady);
  754. if (WaitTheThreadEndSign(100) == true)
  755. {
  756. return false;
  757. }
  758. //init socket
  759. ret = TryInit();
  760. if (ret < 0)
  761. {
  762. return false;
  763. }
  764. else if (ret == 0)
  765. {
  766. return true;
  767. }
  768. TPRINTA_INFO("P2PServer:try init succeed\n");
  769. //try accept
  770. ret = TryAccept();
  771. if (ret < 0)
  772. {
  773. return false;
  774. }
  775. else if (ret == 0)
  776. {
  777. return true;
  778. }
  779. TPRINTA_INFO("P2PServer:try accept succeed\n");
  780. //protocal one: read client's BusId
  781. //read targetbusId
  782. DWORD MsgSize = 256;
  783. DWORD BlockSize = 0;
  784. memset(m_pszRemoteBusId, 0, MsgSize);
  785. if (ReadBlob(m_SocketTarget,m_pszRemoteBusId, MsgSize, NULL, BlockSize) == false)
  786. {
  787. //handshake failed
  788. closesocket(Socketfd);
  789. return true;
  790. }
  791. TPRINTA_INFO("P2PServer:try handshake succeed.%s\n", m_pszRemoteBusId);
  792. int on = 1;
  793. //tcp no delay
  794. setsockopt(m_SocketTarget, IPPROTO_TCP, TCP_NODELAY, (const char *)&on, sizeof(on));
  795. int optVal = 1024 * 1280 * 6 + 6000;
  796. int optLen = sizeof(int);
  797. setsockopt(m_SocketTarget, SOL_SOCKET, SO_SNDBUF, (char*)&optVal, optLen);
  798. TPRINTA_INFO("try set send buff size:%d\n", optVal);
  799. getsockopt(m_SocketTarget, SOL_SOCKET, SO_SNDBUF, (char*)&optVal, &optLen);
  800. TPRINTA_INFO("after try set send buff size:%d\n", optVal);
  801. SetEvent(m_ConnectionReady);
  802. m_HeartBeatTimeout = GetTickCount();
  803. //do while and try check connection + exitflag
  804. ret = TryCheckConnection();
  805. if (ret < 0)
  806. {
  807. return false;
  808. }
  809. return true;
  810. }
  811. bool P2P_Module_Server::SendBlob(const char *pMsg, const char *pBlock, DWORD size)
  812. {
  813. bool ret = P2P_Module_Base::SendBlob(m_SocketTarget, pMsg, pBlock, size);
  814. if (ret)
  815. {
  816. m_HeartBeatTimeout = GetTickCount();
  817. }
  818. return ret;
  819. }
  820. //---------------------------------------------------------------------------------------------------------------
  821. P2P_Module_Client::P2P_Module_Client()
  822. {
  823. m_pszMsgBuff = new char[1024 * 1024];
  824. m_pszBlockBuff = new unsigned char[1024 * 1024 * 4];
  825. }
  826. P2P_Module_Client::~P2P_Module_Client()
  827. {
  828. delete []m_pszMsgBuff;
  829. m_pszMsgBuff = NULL;
  830. delete[]m_pszBlockBuff;
  831. m_pszBlockBuff = NULL;
  832. }
  833. //connect
  834. bool P2P_Module_Client::ConnectP2P()
  835. {
  836. return StartThread();
  837. }
  838. //disconnect
  839. void P2P_Module_Client::Disconnect()
  840. {
  841. StopThread(P2P_CHECK_PERIOD + 1000);
  842. }
  843. //send block,one way to client no send to anyone
  844. //virtual bool SendBlob(char *pMsg, char *pBlock, DWORD size);
  845. //callback
  846. //void P2P_Module_Client::OnBlob(char *pMsg, char *pData, DWORD size)
  847. //{
  848. //
  849. //}
  850. bool P2P_Module_Client::TryConnectServer()
  851. {
  852. while (WaitTheThreadEndSign(100) == false)
  853. {
  854. Socketfd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
  855. if (Socketfd == INVALID_SOCKET)
  856. {
  857. return false;
  858. }
  859. //u_long iMode = 1;
  860. //int ret = ioctlsocket(Socketfd, FIONBIO, &iMode);//non-blocking mode
  861. //if (ret == 0)
  862. {
  863. SOCKADDR_IN addrSrv;
  864. addrSrv.sin_addr.S_un.S_addr = inet_addr(m_pszIpAddress);//服务器端的地址
  865. addrSrv.sin_family = AF_INET;
  866. addrSrv.sin_port = htons(m_Port);
  867. int Error = connect(Socketfd, (SOCKADDR*)&addrSrv, sizeof(SOCKADDR));
  868. if (!Error)
  869. {
  870. //just try it
  871. socket_set_keepalive(Socketfd);
  872. return true;
  873. }
  874. //else
  875. //{
  876. // // 超时时间
  877. // struct timeval tm;
  878. // tm.tv_sec = P2P_CHECK_PERIOD / 1000;
  879. // tm.tv_usec = P2P_CHECK_PERIOD % 1000;
  880. // int selret = 0;
  881. // fd_set set;
  882. // FD_ZERO(&set);
  883. // FD_SET(Socketfd, &set);
  884. // Sleep(1000);
  885. // selret = select(-1, NULL, &set, NULL, &tm);
  886. // if (selret > 0)
  887. // {
  888. // int error = -1;
  889. // int optLen = sizeof(int);
  890. // getsockopt(Socketfd, SOL_SOCKET, SO_ERROR, (char*)&error, &optLen);
  891. // // 之所以下面的程序不写成三目运算符的形式, 是为了更直观, 便于注释
  892. // if (0 == error)
  893. // {
  894. // //just try it
  895. // socket_set_keepalive(Socketfd);
  896. // return StartThread();
  897. // }
  898. // }
  899. //}
  900. }
  901. closesocket(Socketfd);
  902. Socketfd = NULL;
  903. }
  904. return false;
  905. }
  906. bool P2P_Module_Client::Exec()
  907. {
  908. if (TryConnectServer())
  909. {
  910. int on = 1;
  911. //tcp no delay
  912. setsockopt(Socketfd, IPPROTO_TCP, TCP_NODELAY, (const char *)&on, sizeof(on));
  913. int optVal = 1024 * 1280 * 6 + 6000;
  914. int optLen = sizeof(int);
  915. setsockopt(Socketfd, SOL_SOCKET, SO_RCVBUF, (char*)&optVal, optLen);
  916. TPRINTA_INFO("try set read buff size:%d\n", optVal);
  917. getsockopt(Socketfd, SOL_SOCKET, SO_RCVBUF, (char*)&optVal, &optLen);
  918. TPRINTA_INFO("after try set read buff size:%d\n", optVal);
  919. //send local BusId
  920. bool ret = P2P_Module_Base::SendBlob(Socketfd, m_pszLocalBusId, 0, 0, true);
  921. if (ret == false)
  922. {
  923. closesocket(Socketfd);
  924. Socketfd = NULL;
  925. TPRINTA_ERROR("Send Handshake failed");
  926. return false;
  927. }
  928. TPRINTA_INFO("Handshake succeed:\n");
  929. //u_long iMode = 0;
  930. //ioctlsocket(Socketfd, FIONBIO, &iMode);//blocking mode
  931. DWORD MsgSize = 1024 * 1024;
  932. DWORD BlockSize = 1024 * 1024 * 4;
  933. while (ReadBlobSync(Socketfd, m_pszMsgBuff, MsgSize, (char*)m_pszBlockBuff, BlockSize))
  934. {
  935. TPRINTA_TRACE("Read Block Data succeed:\n");
  936. if (BlockSize > 0)
  937. {
  938. //TPRINTA_TRACE("Notify Block Data begin\n");
  939. OnBlob(m_pszMsgBuff, m_pszBlockBuff, BlockSize);
  940. //TPRINTA_TRACE("Notify Block Data end\n");
  941. }
  942. else
  943. {
  944. //ignore others
  945. //printf("got Heartbeat--------------------------\n\n\n");
  946. TPRINTA_INFO("got Heartbeat--------------------------");
  947. }
  948. //reinit the buff
  949. MsgSize = 1024 * 1024;
  950. BlockSize = 1024 * 1024 * 4;
  951. }
  952. TPRINTA_INFO("Exit Thread--------------------------");
  953. if (Thread_Lock(1000) == WAIT_OBJECT_0)
  954. {
  955. if (Socketfd)
  956. {
  957. closesocket(Socketfd);
  958. Socketfd = NULL;
  959. }
  960. Thread_UnLock();
  961. }
  962. else
  963. {
  964. //no can do...
  965. }
  966. }
  967. if (WaitTheThreadEndSign(0))
  968. {
  969. return false;
  970. }
  971. return true;
  972. }