main.cpp 73 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915
  1. #include "common.h"
  2. #include "network.h"
  3. #include "log.h"
  4. #include "md5.h"
  5. char local_address[100]="0.0.0.0", remote_address[100]="255.255.255.255",source_address[100]="0.0.0.0";
  6. uint32_t local_address_uint32,remote_address_uint32,source_address_uint32;
  7. int source_port=0,local_port = -1, remote_port = -1;
  8. id_t const_id=0;
  9. const int disable_conv_clear=0;
  10. const int disable_conn_clear=0;
  11. enum server_current_state_t {server_nothing=0,server_syn_ack_sent,server_handshake_sent,server_ready};
  12. enum client_current_state_t {client_nothing=0,client_syn_sent,client_ack_sent,client_handshake_sent,client_ready};
  13. union current_state_t
  14. {
  15. server_current_state_t server_current_state;
  16. client_current_state_t client_current_state;
  17. };
  18. int udp_fd=-1; //for client only
  19. int bind_fd=-1; //bind only,never send or recv
  20. int epollfd=-1;
  21. int timer_fd=-1;
  22. char key_string[1000]= "secret key";
  23. char key[16],key2[16];
  24. uint64_t current_time_rough=0;
  25. int VVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVVV;
  26. ////////==============================variable divider=============================================================
  27. struct anti_replay_t
  28. {
  29. uint64_t max_packet_received;
  30. char window[anti_replay_window_size];
  31. char disabled;
  32. anti_replay_seq_t anti_replay_seq;
  33. anti_replay_seq_t get_new_seq_for_send()
  34. {
  35. return anti_replay_seq++;
  36. }
  37. anti_replay_t()
  38. {
  39. disabled=0;
  40. max_packet_received=0;
  41. anti_replay_seq=get_true_random_number();
  42. //memset(window,0,sizeof(window)); //not necessary
  43. }
  44. void re_init()
  45. {
  46. disabled=0;
  47. max_packet_received=0;
  48. //memset(window,0,sizeof(window));
  49. }
  50. void disable()
  51. {
  52. disabled=1;
  53. }
  54. void enable()
  55. {
  56. disabled=0;
  57. }
  58. int is_vaild(uint64_t seq)
  59. {
  60. //if(disabled) return 0;
  61. if(seq==max_packet_received) return 0||disabled;
  62. else if(seq>max_packet_received)
  63. {
  64. if(seq-max_packet_received>=anti_replay_window_size)
  65. {
  66. memset(window,0,sizeof(window));
  67. window[seq%anti_replay_window_size]=1;
  68. }
  69. else
  70. {
  71. for (uint32_t i=max_packet_received+1;i<seq;i++)
  72. window[i%anti_replay_window_size]=0;
  73. window[seq%anti_replay_window_size]=1;
  74. }
  75. max_packet_received=seq;
  76. return 1;
  77. }
  78. else if(seq<max_packet_received)
  79. {
  80. if(max_packet_received-seq>=anti_replay_window_size) return 0||disabled;
  81. else
  82. {
  83. if (window[seq%anti_replay_window_size]==1) return 0||disabled;
  84. else
  85. {
  86. window[seq%anti_replay_window_size]=1;
  87. return 1;
  88. }
  89. }
  90. }
  91. return 0; //for complier check
  92. }
  93. };//anti_replay;
  94. void server_clear_function(uint64_t u64);
  95. struct conv_manager_t //TODO change map to unordered map
  96. {
  97. //typedef hash_map map;
  98. unordered_map<uint64_t,uint32_t> u64_to_conv; //conv and u64 are both supposed to be uniq
  99. unordered_map<uint32_t,uint64_t> conv_to_u64;
  100. unordered_map<uint32_t,uint64_t> conv_last_active_time;
  101. unordered_map<uint32_t,uint64_t>::iterator clear_it;
  102. unordered_map<uint32_t,uint64_t>::iterator it;
  103. unordered_map<uint32_t,uint64_t>::iterator old_it;
  104. //void (*clear_function)(uint64_t u64) ;
  105. conv_manager_t()
  106. {
  107. clear_it=conv_last_active_time.begin();
  108. //clear_function=0;
  109. }
  110. ~conv_manager_t()
  111. {
  112. clear();
  113. }
  114. int get_size()
  115. {
  116. return conv_to_u64.size();
  117. }
  118. void reserve()
  119. {
  120. u64_to_conv.reserve(10007);
  121. conv_to_u64.reserve(10007);
  122. conv_last_active_time.reserve(10007);
  123. }
  124. void clear()
  125. {
  126. if(disable_conv_clear) return ;
  127. if(program_mode==server_mode)
  128. {
  129. for(it=conv_to_u64.begin();it!=conv_to_u64.end();it++)
  130. {
  131. //int fd=int((it->second<<32u)>>32u);
  132. server_clear_function( it->second);
  133. }
  134. }
  135. u64_to_conv.clear();
  136. conv_to_u64.clear();
  137. conv_last_active_time.clear();
  138. clear_it=conv_last_active_time.begin();
  139. }
  140. uint32_t get_new_conv()
  141. {
  142. uint32_t conv=get_true_random_number_nz();
  143. while(conv_to_u64.find(conv)!=conv_to_u64.end())
  144. {
  145. conv=get_true_random_number_nz();
  146. }
  147. return conv;
  148. }
  149. int is_conv_used(uint32_t conv)
  150. {
  151. return conv_to_u64.find(conv)!=conv_to_u64.end();
  152. }
  153. int is_u64_used(uint64_t u64)
  154. {
  155. return u64_to_conv.find(u64)!=u64_to_conv.end();
  156. }
  157. uint32_t find_conv_by_u64(uint64_t u64)
  158. {
  159. return u64_to_conv[u64];
  160. }
  161. uint64_t find_u64_by_conv(uint32_t conv)
  162. {
  163. return conv_to_u64[conv];
  164. }
  165. int update_active_time(uint32_t conv)
  166. {
  167. return conv_last_active_time[conv]=current_time_rough;
  168. }
  169. int insert_conv(uint32_t conv,uint64_t u64)
  170. {
  171. u64_to_conv[u64]=conv;
  172. conv_to_u64[conv]=u64;
  173. conv_last_active_time[conv]=current_time_rough;
  174. return 0;
  175. }
  176. int erase_conv(uint32_t conv)
  177. {
  178. if(disable_conv_clear) return 0;
  179. uint64_t u64=conv_to_u64[conv];
  180. if(program_mode==server_mode)
  181. {
  182. server_clear_function(u64);
  183. }
  184. conv_to_u64.erase(conv);
  185. u64_to_conv.erase(u64);
  186. conv_last_active_time.erase(conv);
  187. mylog(log_info,"conv %x cleared\n",conv);
  188. return 0;
  189. }
  190. int clear_inactive()
  191. {
  192. if(disable_conv_clear) return 0;
  193. //map<uint32_t,uint64_t>::iterator it;
  194. int cnt=0;
  195. it=clear_it;
  196. int size=conv_last_active_time.size();
  197. int num_to_clean=size/conv_clear_ratio+conv_clear_min; //clear 1/10 each time,to avoid latency glitch
  198. uint64_t current_time=get_current_time();
  199. for(;;)
  200. {
  201. if(cnt>=num_to_clean) break;
  202. if(conv_last_active_time.begin()==conv_last_active_time.end()) break;
  203. if(it==conv_last_active_time.end())
  204. {
  205. it=conv_last_active_time.begin();
  206. }
  207. if( current_time -it->second >conv_timeout )
  208. {
  209. //mylog(log_info,"inactive conv %u cleared \n",it->first);
  210. old_it=it;
  211. it++;
  212. erase_conv(old_it->first);
  213. }
  214. else
  215. {
  216. it++;
  217. }
  218. cnt++;
  219. }
  220. return 0;
  221. }
  222. };//g_conv_manager;
  223. struct conn_info_t
  224. {
  225. current_state_t state;
  226. raw_info_t raw_info;
  227. long long last_state_time;
  228. long long last_hb_recv_time;
  229. long long last_hb_sent_time;
  230. id_t my_id;
  231. id_t oppsite_id;
  232. conv_manager_t *conv_manager;
  233. anti_replay_t *anti_replay;
  234. int timer_fd;
  235. int retry_counter;
  236. id_t oppsite_const_id;
  237. conn_info_t()
  238. {
  239. //send_packet_info.protocol=g_packet_info_send.protocol;
  240. if(program_mode==server_mode)
  241. state.server_current_state=server_nothing;
  242. else
  243. state.client_current_state=client_nothing;
  244. last_state_time=0;
  245. oppsite_const_id=0;
  246. conv_manager=0;
  247. anti_replay=0;
  248. timer_fd=0;
  249. }
  250. void prepare()
  251. {
  252. conv_manager=new conv_manager_t;
  253. anti_replay=new anti_replay_t;
  254. }
  255. conn_info_t(const conn_info_t&b)
  256. {
  257. //mylog(log_error,"called!!!!!!!!!!!!!\n");
  258. *this=b;
  259. if(conv_manager!=0)
  260. {
  261. conv_manager=new conv_manager_t(*b.conv_manager);
  262. }
  263. if(anti_replay!=0)
  264. {
  265. anti_replay=new anti_replay_t(*b.anti_replay);
  266. }
  267. }
  268. conn_info_t& operator=(const conn_info_t& b)
  269. {
  270. mylog(log_fatal,"not allowed\n");
  271. myexit(-1);
  272. return *this;
  273. }
  274. ~conn_info_t();
  275. };//g_conn_info;
  276. struct conn_manager_t
  277. {
  278. uint32_t ready_num;
  279. unordered_map<int,conn_info_t *> udp_fd_mp; //a bit dirty to used pointer,but can void unordered_map search
  280. unordered_map<int,conn_info_t *> timer_fd_mp;//we can use pointer here since unordered_map.rehash() uses shallow copy
  281. unordered_map<id_t,conn_info_t *> const_id_mp;
  282. unordered_map<uint64_t,conn_info_t*> mp; //put it at end so that it de-consturcts first
  283. unordered_map<uint64_t,conn_info_t*>::iterator clear_it;
  284. conn_manager_t()
  285. {
  286. ready_num=0;
  287. mp.reserve(10007);
  288. clear_it=mp.begin();
  289. timer_fd_mp.reserve(10007);
  290. const_id_mp.reserve(10007);
  291. udp_fd_mp.reserve(100007);
  292. //current_ready_ip=0;
  293. // current_ready_port=0;
  294. }
  295. int exist(uint32_t ip,uint16_t port)
  296. {
  297. uint64_t u64=0;
  298. u64=ip;
  299. u64<<=32u;
  300. u64|=port;
  301. if(mp.find(u64)!=mp.end())
  302. {
  303. return 1;
  304. }
  305. return 0;
  306. }
  307. /*
  308. int insert(uint32_t ip,uint16_t port)
  309. {
  310. uint64_t u64=0;
  311. u64=ip;
  312. u64<<=32u;
  313. u64|=port;
  314. mp[u64];
  315. return 0;
  316. }*/
  317. conn_info_t *& find_insert_p(uint32_t ip,uint16_t port) //be aware,the adress may change after rehash
  318. {
  319. uint64_t u64=0;
  320. u64=ip;
  321. u64<<=32u;
  322. u64|=port;
  323. unordered_map<uint64_t,conn_info_t*>::iterator it=mp.find(u64);
  324. if(it==mp.end())
  325. {
  326. mp[u64]=new conn_info_t;
  327. }
  328. return mp[u64];
  329. }
  330. conn_info_t & find_insert(uint32_t ip,uint16_t port) //be aware,the adress may change after rehash
  331. {
  332. uint64_t u64=0;
  333. u64=ip;
  334. u64<<=32u;
  335. u64|=port;
  336. unordered_map<uint64_t,conn_info_t*>::iterator it=mp.find(u64);
  337. if(it==mp.end())
  338. {
  339. mp[u64]=new conn_info_t;
  340. }
  341. return *mp[u64];
  342. }
  343. int erase(unordered_map<uint64_t,conn_info_t*>::iterator erase_it)
  344. {
  345. if(erase_it->second->state.server_current_state==server_ready)
  346. {
  347. ready_num--;
  348. assert(int32_t(ready_num)!=-1);
  349. assert(erase_it->second!=0);
  350. assert(erase_it->second->timer_fd !=0);
  351. assert(erase_it->second->oppsite_const_id!=0);
  352. assert(const_id_mp.find(erase_it->second->oppsite_const_id)!=const_id_mp.end());
  353. assert(timer_fd_mp.find(erase_it->second->timer_fd)!=timer_fd_mp.end());
  354. const_id_mp.erase(erase_it->second->oppsite_const_id);
  355. timer_fd_mp.erase(erase_it->second->timer_fd);
  356. close(erase_it->second->timer_fd);// close will auto delte it from epoll
  357. delete(erase_it->second);
  358. mp.erase(erase_it->first);
  359. }
  360. else
  361. {
  362. assert(erase_it->second==0);
  363. assert(erase_it->second->timer_fd ==0);
  364. assert(erase_it->second->oppsite_const_id==0);
  365. }
  366. return 0;
  367. }
  368. int clear_inactive()
  369. {
  370. unordered_map<uint64_t,conn_info_t*>::iterator it;
  371. unordered_map<uint64_t,conn_info_t*>::iterator old_it;
  372. if(disable_conn_clear) return 0;
  373. //map<uint32_t,uint64_t>::iterator it;
  374. int cnt=0;
  375. it=clear_it;
  376. int size=mp.size();
  377. int num_to_clean=size/conn_clear_ratio+conn_clear_min; //clear 1/10 each time,to avoid latency glitch
  378. uint64_t current_time=get_current_time();
  379. for(;;)
  380. {
  381. if(cnt>=num_to_clean) break;
  382. if(mp.begin()==mp.end()) break;
  383. if(it==mp.end())
  384. {
  385. it=mp.begin();
  386. }
  387. if(it->second->state.server_current_state==server_ready &&current_time - it->second->last_hb_recv_time <=server_conn_timeout)
  388. {
  389. it++;
  390. }
  391. else if(it->second->state.server_current_state!=server_ready&& current_time - it->second->last_state_time <=server_handshake_timeout )
  392. {
  393. it++;
  394. }
  395. else if(it->second->conv_manager!=0&&it->second->conv_manager->get_size() >0)
  396. {
  397. assert(it->second->state.server_current_state==server_ready);
  398. it++;
  399. }
  400. else
  401. {
  402. mylog(log_info,"[%s:%d]inactive conn cleared \n",my_ntoa(it->second->raw_info.recv_info.src_ip),it->second->raw_info.recv_info.src_port);
  403. old_it=it;
  404. it++;
  405. erase(old_it);
  406. }
  407. cnt++;
  408. }
  409. return 0;
  410. }
  411. }conn_manager;
  412. conn_info_t::~conn_info_t()
  413. {
  414. if(program_mode==server_mode)
  415. {
  416. if(state.server_current_state==server_ready)
  417. {
  418. assert(conv_manager!=0);
  419. assert(anti_replay!=0);
  420. assert(oppsite_const_id!=0);
  421. //assert(conn_manager.const_id_mp.find(oppsite_const_id)!=conn_manager.const_id_mp.end()); // conn_manager 's deconstuction function erases it
  422. }
  423. else
  424. {
  425. assert(conv_manager==0);
  426. assert(anti_replay==0);
  427. assert(oppsite_const_id==0);
  428. }
  429. }
  430. //if(oppsite_const_id!=0) //do this at conn_manager 's deconstuction function
  431. //conn_manager.const_id_mp.erase(oppsite_const_id);
  432. if(conv_manager!=0)
  433. delete conv_manager;
  434. if(anti_replay!=0)
  435. delete anti_replay;
  436. //send_packet_info.protocol=g_packet_info_send.protocol;
  437. }
  438. int TTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTTT;
  439. ////////==========================type divider=======================================================
  440. /*
  441. int pre_send_deprecate(char * data, int &data_len)
  442. {
  443. const int disable_encrypt=0;
  444. const int disable_anti_replay=0;
  445. char replay_buf[buf_len];
  446. //return 0;
  447. if(data_len<0) return -3;
  448. if(disable_encrypt&&disable_anti_replay) return 0;
  449. if(!disable_anti_replay)
  450. {
  451. anti_replay_seq++;
  452. uint32_t seq_high= htonl(anti_replay_seq>>32u);
  453. uint32_t seq_low= htonl((anti_replay_seq<<32u)>>32u);
  454. memcpy(replay_buf,&seq_high,sizeof(uint32_t));
  455. memcpy(replay_buf+sizeof(uint32_t),&seq_low,sizeof(uint32_t));
  456. memcpy(replay_buf+sizeof(uint32_t)*2,data,data_len);
  457. data_len+=sizeof(uint32_t)*2;
  458. }
  459. else
  460. {
  461. memcpy(replay_buf,data,data_len);
  462. }
  463. if(!disable_encrypt)
  464. {
  465. if(my_encrypt(replay_buf,data,data_len,key2) <0)
  466. {
  467. mylog(log_debug,"encrypt fail\n");
  468. return -1;
  469. }
  470. }
  471. else
  472. {
  473. memcpy(data,replay_buf,data_len);
  474. }
  475. return 0;
  476. }
  477. int pre_recv_deprecated(char * data, int &data_len)
  478. {
  479. const int disable_encrypt=0;
  480. const int disable_anti_replay=0;
  481. char replay_buf[buf_len];
  482. //return 0;
  483. if(data_len<0) return -1;
  484. if(disable_encrypt&&disable_anti_replay) return 0;
  485. if(!disable_encrypt)
  486. {
  487. if(my_decrypt(data,replay_buf,data_len,key2) <0)
  488. {
  489. mylog(log_debug,"decrypt fail\n");
  490. return -1;
  491. }
  492. else
  493. {
  494. mylog(log_debug,"decrypt succ\n");
  495. }
  496. }
  497. else
  498. {
  499. memcpy(replay_buf,data,data_len);
  500. }
  501. if(!disable_anti_replay)
  502. {
  503. data_len-=sizeof(uint32_t)*2;
  504. if(data_len<0)
  505. {
  506. mylog(log_debug,"data_len<=0\n");
  507. return -2;
  508. }
  509. uint64_t seq_high= ntohl(*((uint32_t*)(replay_buf) ) );
  510. uint32_t seq_low= ntohl(*((uint32_t*)(replay_buf+sizeof(uint32_t)) ) );
  511. uint64_t recv_seq =(seq_high<<32u )+seq_low;
  512. if((program_mode==client_mode&&client_current_state==client_ready)
  513. ||(program_mode==server_mode&&server_current_state==server_ready ))
  514. {
  515. if(data_len<sizeof(uint32_t)*2+1)
  516. {
  517. mylog(log_debug,"no room for session id and oppiste session_id\n");
  518. return -4;
  519. }
  520. uint32_t tmp_oppiste_session_id = ntohl(
  521. *((uint32_t*) (replay_buf + sizeof(uint32_t) * 2+1)));
  522. uint32_t tmp_session_id = ntohl(
  523. *((uint32_t*) (replay_buf + sizeof(uint32_t) * 3+1)));
  524. if (tmp_oppiste_session_id != oppsite_id
  525. || tmp_session_id != my_id) {
  526. mylog(log_debug,"auth fail and pre send\n");
  527. return -5;
  528. }
  529. mylog(log_debug,"seq=========%u\n", recv_seq);
  530. if (anti_replay.is_vaild(recv_seq) != 1) {
  531. mylog(log_info,"dropped replay packet\n");
  532. return -1;
  533. }
  534. }
  535. mylog(log_trace,"<<<<<%ld,%d,%ld>>>>\n",seq_high,seq_low,recv_seq);
  536. memcpy(data,replay_buf+sizeof(uint32_t)*2,data_len);
  537. }
  538. else
  539. {
  540. memcpy(data,replay_buf,data_len);
  541. }
  542. return 0;
  543. }*/
  544. void server_clear_function(uint64_t u64)
  545. {
  546. int fd=int(u64);
  547. int ret;
  548. assert(fd!=0);
  549. /*
  550. epoll_event ev;
  551. ev.events = EPOLLIN;
  552. ev.data.u64 = u64;
  553. ret = epoll_ctl(epollfd, EPOLL_CTL_DEL, fd, &ev);
  554. if (ret!=0)
  555. {
  556. mylog(log_fatal,"fd:%d epoll delete failed!!!!\n",fd);
  557. myexit(-1); //this shouldnt happen
  558. }*/ //no need
  559. ret= close(fd); //closed fd should be auto removed from epoll
  560. if (ret!=0)
  561. {
  562. mylog(log_fatal,"close fd %d failed !!!!\n",fd);
  563. myexit(-1); //this shouldnt happen
  564. }
  565. //mylog(log_fatal,"size:%d !!!!\n",conn_manager.udp_fd_mp.size());
  566. assert(conn_manager.udp_fd_mp.find(fd)!=conn_manager.udp_fd_mp.end());
  567. conn_manager.udp_fd_mp.erase(fd);
  568. }
  569. int send_bare(raw_info_t &raw_info,const char* data,int len)
  570. {
  571. packet_info_t &send_info=raw_info.send_info;
  572. packet_info_t &recv_info=raw_info.recv_info;
  573. char send_data_buf[buf_len]; //buf for send data and send hb
  574. char send_data_buf2[buf_len];
  575. if(len==0) //dont encrpyt zero length packet;
  576. {
  577. send_raw(raw_info,data,len);
  578. return 0;
  579. }
  580. //static send_bare[buf_len];
  581. iv_t iv=get_true_random_number_64();
  582. memcpy(send_data_buf,&iv,sizeof(iv_t));
  583. memcpy(send_data_buf+sizeof(iv_t),data,len);
  584. int new_len=len+sizeof(iv_t);
  585. if(my_encrypt(send_data_buf,send_data_buf2,new_len,key)!=0)
  586. {
  587. return -1;
  588. }
  589. send_raw(raw_info,send_data_buf2,new_len);
  590. return 0;
  591. }
  592. int parse_bare(const char *input,int input_len,char* & data,int & len) //allow overlap
  593. {
  594. static char recv_data_buf[buf_len];
  595. if(len==0) //dont decrpyt zero length packet;
  596. {
  597. return 0;
  598. }
  599. if(my_decrypt(input,recv_data_buf,input_len,key)!=0)
  600. {
  601. mylog(log_debug,"decrypt_fail in recv bare\n");
  602. return -1;
  603. }
  604. len=input_len;
  605. data=recv_data_buf+sizeof(iv_t);
  606. len-=sizeof(iv_t);
  607. return 0;
  608. }
  609. int recv_bare(raw_info_t &raw_info,char* & data,int & len)
  610. {
  611. packet_info_t &send_info=raw_info.send_info;
  612. packet_info_t &recv_info=raw_info.recv_info;
  613. if(recv_raw(raw_info,data,len)<0)
  614. {
  615. //printf("recv_raw_fail in recv bare\n");
  616. return -1;
  617. }
  618. parse_bare(data,len,data,len);
  619. return 0;
  620. }
  621. int send_handshake(raw_info_t &raw_info,id_t id1,id_t id2,id_t id3)
  622. {
  623. packet_info_t &send_info=raw_info.send_info;
  624. packet_info_t &recv_info=raw_info.recv_info;
  625. char * data;int len;
  626. //len=sizeof(id_t)*3;
  627. if(numbers_to_char(id1,id2,id3,data,len)!=0) return -1;
  628. if(send_bare(raw_info,data,len)!=0) {mylog(log_warn,"send bare fail\n");return -1;}
  629. return 0;
  630. }
  631. /*
  632. int recv_handshake(packet_info_t &info,id_t &id1,id_t &id2,id_t &id3)
  633. {
  634. char * data;int len;
  635. if(recv_bare(info,data,len)!=0) return -1;
  636. if(char_to_numbers(data,len,id1,id2,id3)!=0) return -1;
  637. return 0;
  638. }*/
  639. int send_safer(conn_info_t &conn_info,const char* data,int len)
  640. {
  641. packet_info_t &send_info=conn_info.raw_info.send_info;
  642. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  643. char send_data_buf[buf_len]; //buf for send data and send hb
  644. char send_data_buf2[buf_len];
  645. id_t n_tmp_id=htonl(conn_info.my_id);
  646. memcpy(send_data_buf,&n_tmp_id,sizeof(n_tmp_id));
  647. n_tmp_id=htonl(conn_info.oppsite_id);
  648. memcpy(send_data_buf+sizeof(n_tmp_id),&n_tmp_id,sizeof(n_tmp_id));
  649. anti_replay_seq_t n_seq=hton64(conn_info.anti_replay->get_new_seq_for_send());
  650. memcpy(send_data_buf+sizeof(n_tmp_id)*2,&n_seq,sizeof(n_seq));
  651. memcpy(send_data_buf+sizeof(n_tmp_id)*2+sizeof(n_seq),data,len);//data;
  652. int new_len=len+sizeof(n_seq)+sizeof(n_tmp_id)*2;
  653. if(my_encrypt(send_data_buf,send_data_buf2,new_len,key2)!=0)
  654. {
  655. return -1;
  656. }
  657. send_raw(conn_info.raw_info,send_data_buf2,new_len);
  658. return 0;
  659. }
  660. int send_data_safer(conn_info_t &conn_info,const char* data,int len,uint32_t conv_num)
  661. {
  662. packet_info_t &send_info=conn_info.raw_info.send_info;
  663. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  664. char send_data_buf[buf_len];
  665. send_data_buf[0]='d';
  666. uint32_t n_conv_num=htonl(conv_num);
  667. memcpy(send_data_buf+1,&n_conv_num,sizeof(n_conv_num));
  668. memcpy(send_data_buf+1+sizeof(n_conv_num),data,len);
  669. int new_len=len+1+sizeof(n_conv_num);
  670. send_safer(conn_info,send_data_buf,new_len);
  671. return 0;
  672. }
  673. int parse_safer(conn_info_t &conn_info,const char * input,int input_len,char* &data,int &len)//allow overlap
  674. {
  675. static char recv_data_buf0[buf_len];
  676. char *recv_data_buf=recv_data_buf0; //fix strict alias warning
  677. if(my_decrypt(input,recv_data_buf,input_len,key2)!=0)
  678. {
  679. //printf("decrypt fail\n");
  680. return -1;
  681. }
  682. //char *a=recv_data_buf;
  683. id_t h_oppiste_id= ntohl ( *((id_t * )(recv_data_buf)) );
  684. id_t h_my_id= ntohl ( *((id_t * )(recv_data_buf+sizeof(id_t))) );
  685. anti_replay_seq_t h_seq= ntoh64 ( *((anti_replay_seq_t * )(recv_data_buf +sizeof(id_t) *2 )) );
  686. if(h_oppiste_id!=conn_info.oppsite_id||h_my_id!=conn_info.my_id)
  687. {
  688. mylog(log_warn,"id and oppsite_id verification failed %x %x %x %x \n",h_oppiste_id,conn_info.oppsite_id,h_my_id,conn_info.my_id);
  689. return -1;
  690. }
  691. if (conn_info.anti_replay->is_vaild(h_seq) != 1) {
  692. mylog(log_warn,"dropped replay packet\n");
  693. return -1;
  694. }
  695. //printf("recv _len %d\n ",recv_len);
  696. data=recv_data_buf+sizeof(anti_replay_seq_t)+sizeof(id_t)*2;
  697. len=input_len-(sizeof(anti_replay_seq_t)+sizeof(id_t)*2 );
  698. if(len<0)
  699. {
  700. mylog(log_error,"len <0 ,%d\n",len);
  701. return -1;
  702. }
  703. return 0;
  704. }
  705. int recv_safer(conn_info_t &conn_info,char* &data,int &len)
  706. {
  707. packet_info_t &send_info=conn_info.raw_info.send_info;
  708. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  709. char * recv_data;int recv_len;
  710. static char recv_data_buf[buf_len];
  711. if(recv_raw(conn_info.raw_info,recv_data,recv_len)!=0) return -1;
  712. return parse_safer(conn_info,recv_data,recv_len,data,len);
  713. }
  714. int try_to_list_and_bind(int port)
  715. {
  716. int old_bind_fd=bind_fd;
  717. if(raw_mode==mode_faketcp)
  718. {
  719. bind_fd=socket(AF_INET,SOCK_STREAM,0);
  720. }
  721. else if(raw_mode==mode_udp||raw_mode==mode_icmp)
  722. {
  723. bind_fd=socket(AF_INET,SOCK_DGRAM,0);
  724. }
  725. if(old_bind_fd!=-1)
  726. {
  727. close(old_bind_fd);
  728. }
  729. struct sockaddr_in temp_bind_addr;
  730. bzero(&temp_bind_addr, sizeof(temp_bind_addr));
  731. temp_bind_addr.sin_family = AF_INET;
  732. temp_bind_addr.sin_port = htons(port);
  733. temp_bind_addr.sin_addr.s_addr = local_address_uint32;
  734. if (bind(bind_fd, (struct sockaddr*)&temp_bind_addr, sizeof(temp_bind_addr)) !=0)
  735. {
  736. mylog(log_debug,"bind fail\n");
  737. return -1;
  738. }
  739. if(raw_mode==mode_faketcp)
  740. {
  741. if (listen(bind_fd, SOMAXCONN) != 0) {
  742. mylog(log_warn,"listen fail\n");
  743. return -1;
  744. }
  745. }
  746. return 0;
  747. }
  748. int client_bind_to_a_new_port()
  749. {
  750. int raw_send_port=10000+get_true_random_number()%(65535-10000);
  751. for(int i=0;i<1000;i++)//try 1000 times at max,this should be enough
  752. {
  753. if (try_to_list_and_bind(raw_send_port)==0)
  754. {
  755. return raw_send_port;
  756. }
  757. }
  758. mylog(log_fatal,"bind port fail\n");
  759. myexit(-1);
  760. return -1;////for compiler check
  761. }
  762. int keep_connection_client(conn_info_t &conn_info) //for client
  763. {
  764. packet_info_t &send_info=conn_info.raw_info.send_info;
  765. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  766. raw_info_t &raw_info=conn_info.raw_info;
  767. current_time_rough=get_current_time();
  768. conn_info.conv_manager->clear_inactive();
  769. mylog(log_trace,"timer!\n");
  770. //begin:
  771. if(conn_info.state.client_current_state==client_nothing)
  772. {
  773. conn_info.anti_replay->re_init(); // this is not safe
  774. if(raw_mode==mode_icmp)
  775. {
  776. remove_filter();
  777. }
  778. if(source_port==0)
  779. {
  780. send_info.src_port = client_bind_to_a_new_port();
  781. }
  782. else
  783. {
  784. send_info.src_port=source_port;
  785. }
  786. if(raw_mode==mode_icmp)
  787. {
  788. send_info.dst_port =send_info.src_port ;
  789. }
  790. mylog(log_info,"using port %d\n", send_info.src_port);
  791. init_filter(send_info.src_port);
  792. if(raw_mode==mode_faketcp)
  793. {
  794. conn_info.state.client_current_state = client_syn_sent;
  795. conn_info.last_state_time = get_current_time();
  796. mylog(log_info,"state changed from nothing to syn_sent %d\n",conn_info.state.client_current_state);
  797. conn_info.retry_counter = RETRY_TIME;
  798. send_info.seq = get_true_random_number();
  799. send_info.ack_seq = 0; //get_true_random_number();
  800. send_info.ts_ack = 0;
  801. send_info.ack = 0;
  802. send_info.syn = 1;
  803. send_info.psh = 0;
  804. send_bare(raw_info, 0, 0); /////////////send
  805. }
  806. else if(raw_mode==mode_udp||raw_mode==mode_icmp)
  807. {
  808. conn_info.state.client_current_state = client_ack_sent;
  809. conn_info.last_state_time = get_current_time();
  810. mylog(log_info,"state changed from nothing to ack_sent\n");
  811. conn_info.retry_counter = RETRY_TIME;
  812. send_info.icmp_seq=0;
  813. send_bare(raw_info, (char*)"hello", strlen("hello"));/////////////send
  814. }
  815. return 0;
  816. }
  817. if(conn_info.state.client_current_state==client_syn_sent &&get_current_time()-conn_info.last_state_time>client_handshake_timeout)
  818. {
  819. if(conn_info.retry_counter==0)
  820. {
  821. conn_info.state.client_current_state=client_nothing;
  822. mylog(log_info,"state back to nothing\n");
  823. return 0;
  824. //goto begin;
  825. }
  826. else
  827. {
  828. conn_info.retry_counter--;
  829. mylog(log_info,"retry send sync\n");
  830. send_bare(raw_info,0,0); /////////////send
  831. conn_info.last_state_time=get_current_time();
  832. }
  833. }
  834. if(conn_info.state.client_current_state==client_ack_sent &&get_current_time()-conn_info.last_state_time>client_handshake_timeout)
  835. {
  836. if(conn_info.retry_counter==0)
  837. {
  838. conn_info.state.client_current_state=client_nothing;
  839. mylog(log_info,"state back to nothing\n");
  840. return 0;
  841. //goto begin;
  842. }
  843. else
  844. {
  845. conn_info.retry_counter--;
  846. if(raw_mode==mode_faketcp)
  847. {
  848. send_bare(raw_info,0,0);/////////////send
  849. }
  850. else if(raw_mode==mode_udp||raw_mode==mode_icmp)
  851. {
  852. send_bare(raw_info, (char*)"hello", strlen("hello"));/////////////send
  853. }
  854. conn_info.last_state_time=get_current_time();
  855. mylog(log_info,"retry send ack counter left:%d\n",conn_info.retry_counter);
  856. }
  857. }
  858. if(conn_info.state.client_current_state==client_handshake_sent&&get_current_time()-conn_info.last_state_time>client_handshake_timeout)
  859. {
  860. if(conn_info.retry_counter==0)
  861. {
  862. conn_info.state.client_current_state=client_nothing;
  863. mylog(log_info,"state back to nothing\n");
  864. return 0;
  865. //goto begin;
  866. }
  867. else
  868. {
  869. conn_info.retry_counter--;
  870. send_handshake(raw_info,conn_info.my_id,conn_info.oppsite_id,const_id);/////////////send
  871. conn_info.last_state_time=get_current_time();
  872. mylog(log_info,"retry send handshake counter left:%d\n",conn_info.retry_counter);
  873. mylog(log_info,"handshake sent <%x,%x>\n",conn_info.oppsite_id,conn_info.my_id);
  874. }
  875. }
  876. if(conn_info.state.client_current_state==client_ready)
  877. {
  878. mylog(log_trace,"time %lld %lld\n",get_current_time(),conn_info.last_state_time);
  879. if(get_current_time()-conn_info.last_hb_recv_time>client_conn_timeout)
  880. {
  881. conn_info.state.client_current_state=client_nothing;
  882. conn_info.my_id=get_true_random_number_nz();
  883. mylog(log_info,"state back to nothing\n");
  884. return 0;
  885. }
  886. if(get_current_time()-conn_info.last_hb_sent_time<heartbeat_interval)
  887. {
  888. return 0;
  889. }
  890. mylog(log_trace,"heartbeat sent <%x,%x>\n",conn_info.oppsite_id,conn_info.my_id);
  891. send_safer(conn_info,(char *)"h",1);/////////////send
  892. conn_info.last_hb_sent_time=get_current_time();
  893. }
  894. return 0;
  895. }
  896. int keep_connection_server_multi(conn_info_t &conn_info)
  897. {
  898. mylog(log_trace,"server timer!\n");
  899. raw_info_t &raw_info=conn_info.raw_info;
  900. if(conn_info.state.server_current_state==server_ready)
  901. {
  902. conn_info.conv_manager->clear_inactive();
  903. /*
  904. if( get_current_time()-conn_info.last_hb_recv_time>heartbeat_timeout )
  905. {
  906. mylog(log_trace,"%lld %lld\n",get_current_time(),conn_info.last_state_time);
  907. conn_info.server_current_state=server_nothing;
  908. //conn_manager.current_ready_ip=0;
  909. //conn_manager.current_ready_port=0;
  910. mylog(log_info,"changed state to server_nothing\n");
  911. return 0;
  912. }*/ //dont need to do this at server,conn_manger will clear expired connections
  913. if(get_current_time()-conn_info.last_hb_sent_time<heartbeat_interval)
  914. {
  915. return 0;
  916. }
  917. send_safer(conn_info,(char *)"h",1); /////////////send
  918. conn_info.last_hb_sent_time=get_current_time();
  919. mylog(log_trace,"heart beat sent<%x>\n",conn_info.my_id);
  920. }
  921. else
  922. {
  923. mylog(log_fatal,"this shouldnt happen!\n");
  924. myexit(-1);
  925. }
  926. return 0;
  927. }
  928. /*
  929. int keep_connection_server()
  930. {
  931. current_time_rough=get_current_time();
  932. conv_manager.clean_inactive();
  933. //begin:
  934. mylog(log_trace,"timer!\n");
  935. if(server_current_state==server_nothing)
  936. {
  937. return 0;
  938. }
  939. if(server_current_state==server_syn_ack_sent &&get_current_time()-last_state_time>handshake_timeout )
  940. {
  941. if(retry_counter==0)
  942. {
  943. server_current_state=server_nothing;
  944. mylog(log_info,"state back to nothing\n");
  945. }
  946. else
  947. {
  948. retry_counter--;
  949. send_bare(g_packet_info_send,0,0); /////////////send
  950. last_state_time=get_current_time();
  951. mylog(log_info,"resend syn ack\n");
  952. }
  953. }
  954. if(server_current_state==server_handshake_sent &&get_current_time()-last_state_time>handshake_timeout)
  955. {
  956. if(retry_counter==0)
  957. {
  958. server_current_state=server_nothing;
  959. mylog(log_info,"state back to nothing\n");
  960. }
  961. else
  962. {
  963. retry_counter--;
  964. send_handshake(g_packet_info_send,my_id,random(),const_id); /////////////send
  965. last_state_time=get_current_time();
  966. mylog(log_info,"handshake sent<%x>\n",my_id);
  967. }
  968. }
  969. if(server_current_state==server_ready)
  970. {
  971. if( get_current_time()-last_hb_recv_time>heartbeat_timeout )
  972. {
  973. mylog(log_trace,"%lld %lld\n",get_current_time(),last_state_time);
  974. server_current_state=server_nothing;
  975. mylog(log_info,"changed server id\n");
  976. my_id=get_true_random_number_nz();
  977. mylog(log_info,"changed state to server_nothing\n");
  978. return 0;
  979. }
  980. if(get_current_time()-last_hb_sent_time<heartbeat_interval)
  981. {
  982. return 0;
  983. }
  984. //printf("heart beat sent\n");
  985. send_safer(g_packet_info_send,(char *)"h",1); /////////////send
  986. last_hb_sent_time=get_current_time();
  987. mylog(log_trace,"heart beat sent<%x>\n",my_id);
  988. }
  989. }
  990. */
  991. int set_timer(int epollfd,int &timer_fd)
  992. {
  993. int ret;
  994. epoll_event ev;
  995. itimerspec its;
  996. memset(&its,0,sizeof(its));
  997. if((timer_fd=timerfd_create(CLOCK_MONOTONIC,TFD_NONBLOCK)) < 0)
  998. {
  999. mylog(log_fatal,"timer_fd create error\n");
  1000. myexit(1);
  1001. }
  1002. its.it_interval.tv_sec=(timer_interval/1000);
  1003. its.it_interval.tv_nsec=(timer_interval%1000)*1000ll*1000ll;
  1004. its.it_value.tv_nsec=1; //imidiately
  1005. timerfd_settime(timer_fd,0,&its,0);
  1006. ev.events = EPOLLIN;
  1007. ev.data.u64 = timer_fd;
  1008. ret=epoll_ctl(epollfd, EPOLL_CTL_ADD, timer_fd, &ev);
  1009. if (ret < 0) {
  1010. mylog(log_fatal,"epoll_ctl return %d\n", ret);
  1011. myexit(-1);
  1012. }
  1013. return 0;
  1014. }
  1015. int set_timer_server(int epollfd,int &timer_fd)
  1016. {
  1017. int ret;
  1018. epoll_event ev;
  1019. itimerspec its;
  1020. memset(&its,0,sizeof(its));
  1021. if((timer_fd=timerfd_create(CLOCK_MONOTONIC,TFD_NONBLOCK)) < 0)
  1022. {
  1023. mylog(log_fatal,"timer_fd create error\n");
  1024. myexit(1);
  1025. }
  1026. its.it_interval.tv_sec=(timer_interval/1000);
  1027. its.it_interval.tv_nsec=(timer_interval%1000)*1000ll*1000ll;
  1028. its.it_value.tv_nsec=1; //imidiately
  1029. timerfd_settime(timer_fd,0,&its,0);
  1030. ev.events = EPOLLIN;
  1031. ev.data.u64 = pack_u64(2,timer_fd);
  1032. ret=epoll_ctl(epollfd, EPOLL_CTL_ADD, timer_fd, &ev);
  1033. if (ret < 0) {
  1034. mylog(log_fatal,"epoll_ctl return %d\n", ret);
  1035. myexit(-1);
  1036. }
  1037. return 0;
  1038. }
  1039. int client_on_raw_recv(conn_info_t &conn_info)
  1040. {
  1041. char* data;int data_len;
  1042. packet_info_t &send_info=conn_info.raw_info.send_info;
  1043. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  1044. raw_info_t &raw_info=conn_info.raw_info;
  1045. if(conn_info.state.client_current_state==client_nothing )
  1046. {
  1047. recv_raw(raw_info,data,data_len);//todo change it to something else faster
  1048. }
  1049. if(conn_info.state.client_current_state==client_syn_sent )
  1050. {
  1051. if(recv_bare(raw_info,data,data_len)!=0)
  1052. {
  1053. mylog(log_debug,"recv_bare failed!\n");
  1054. return -1;
  1055. }
  1056. if (raw_mode==mode_faketcp&&!(recv_info.syn==1&&recv_info.ack==1&&data_len==0))
  1057. {
  1058. mylog(log_debug,"%d %d %d \n",recv_info.syn,recv_info.ack,data_len);
  1059. }
  1060. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1061. {
  1062. mylog(log_debug,"unexpected adress %x %x %d %d\n",recv_info.src_ip,send_info.dst_ip,recv_info.src_port,send_info.dst_port);
  1063. return 0;
  1064. }
  1065. send_info.ack_seq=recv_info.seq+1;
  1066. send_info.psh=0;
  1067. send_info.syn=0;
  1068. send_info.ack=1;
  1069. send_info.seq+=1;
  1070. mylog(log_info,"sent ack back\n");
  1071. send_raw(raw_info,0,0);
  1072. conn_info.state.client_current_state=client_ack_sent;
  1073. conn_info.last_state_time=get_current_time();
  1074. conn_info.retry_counter=RETRY_TIME;
  1075. mylog(log_info,"changed state to client_ack_sent\n");
  1076. }
  1077. if(conn_info.state.client_current_state==client_ack_sent )
  1078. {
  1079. if(recv_bare(raw_info,data,data_len)!=0)
  1080. {
  1081. mylog(log_debug,"recv_bare failed!\n");
  1082. return -1;
  1083. }
  1084. if(raw_mode==mode_faketcp&& (recv_info.syn==1||recv_info.ack!=1 ||data_len==0))
  1085. {
  1086. mylog(log_debug,"unexpected syn ack or other zero lenght packet\n");
  1087. return 0;
  1088. }
  1089. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1090. {
  1091. mylog(log_debug,"unexpected adress %x %x %d %d\n",recv_info.src_ip,send_info.dst_ip,recv_info.src_port,send_info.dst_port);
  1092. return 0;
  1093. }
  1094. /*
  1095. if(data_len<hb_length||data[0]!='h')
  1096. {
  1097. printf("not a heartbeat\n");
  1098. return 0;
  1099. }*/
  1100. conn_info.oppsite_id= ntohl(* ((uint32_t *)&data[0]));
  1101. mylog(log_info,"handshake received %x\n",conn_info.oppsite_id);
  1102. mylog(log_info,"changed state to client_handshake_sent\n");
  1103. send_handshake(raw_info,conn_info.my_id,conn_info.oppsite_id,const_id);
  1104. mylog(log_info,"<<handshake sent %x %d>>\n",conn_info.my_id,conn_info.oppsite_id);
  1105. conn_info.state.client_current_state=client_handshake_sent;
  1106. conn_info.last_state_time=get_current_time();
  1107. conn_info.retry_counter=RETRY_TIME;
  1108. }
  1109. if(conn_info.state.client_current_state==client_handshake_sent)
  1110. {
  1111. if(recv_safer(conn_info,data,data_len)!=0)
  1112. {
  1113. return -1;
  1114. }
  1115. if((raw_mode==mode_faketcp&&( recv_info.syn==1||recv_info.ack!=1 ) )||data_len==0 )
  1116. {
  1117. mylog(log_trace,"unexpected syn ack or other zero lenght packet\n");
  1118. return 0;
  1119. }
  1120. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1121. {
  1122. mylog(log_trace,"unexpected adress\n");
  1123. return 0;
  1124. }
  1125. if(data_len!=1||data[0]!='h')
  1126. {
  1127. mylog(log_trace,"not a heartbeat\n");
  1128. return 0;
  1129. }
  1130. /*
  1131. uint32_t tmp_my_id= ntohl(* ((uint32_t *)&data[1+sizeof(my_id)]));
  1132. if(tmp_my_id!=my_id)
  1133. {
  1134. printf("auth fail\n");
  1135. return 0;
  1136. }
  1137. uint32_t tmp_oppsite_session_id=ntohl(* ((uint32_t *)&data[1]));
  1138. if(tmp_oppsite_session_id!=oppsite_id)
  1139. {
  1140. printf("oppsite id mismatch%x %x,ignore\n",tmp_oppsite_session_id,my_id);
  1141. return 0;
  1142. }*/
  1143. mylog(log_info,"changed state to client_ready\n");
  1144. conn_info.state.client_current_state=client_ready;
  1145. conn_info.last_state_time=get_current_time();
  1146. conn_info.last_hb_recv_time=get_current_time();
  1147. }
  1148. if(conn_info.state.client_current_state==client_ready )
  1149. {
  1150. if(recv_safer(conn_info,data,data_len)!=0)
  1151. {
  1152. return -1;
  1153. }
  1154. if((raw_mode==mode_faketcp&&( recv_info.syn==1||recv_info.ack!=1) )||data_len==0)
  1155. {
  1156. mylog(log_debug,"unexpected syn ack\n");
  1157. return 0;
  1158. }
  1159. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1160. {
  1161. mylog(log_debug,"unexpected adress\n");
  1162. return 0;
  1163. }
  1164. if(data_len==1&&data[0]=='h')
  1165. {
  1166. mylog(log_debug,"[hb]heart beat received\n");
  1167. conn_info.last_hb_recv_time=current_time_rough;
  1168. return 0;
  1169. }
  1170. else if(data_len>= int( sizeof(uint32_t)+1 )&&data[0]=='d')
  1171. {
  1172. mylog(log_trace,"received a data from fake tcp,len:%d\n",data_len);
  1173. conn_info.last_hb_recv_time=current_time_rough;
  1174. uint32_t tmp_conv_id= ntohl(* ((uint32_t *)&data[1]));
  1175. if(!conn_info.conv_manager->is_conv_used(tmp_conv_id))
  1176. {
  1177. mylog(log_info,"unknow conv %d,ignore\n",tmp_conv_id);
  1178. return 0;
  1179. }
  1180. conn_info.conv_manager->update_active_time(tmp_conv_id);
  1181. uint64_t u64=conn_info.conv_manager->find_u64_by_conv(tmp_conv_id);
  1182. sockaddr_in tmp_sockaddr;
  1183. tmp_sockaddr.sin_family = AF_INET;
  1184. tmp_sockaddr.sin_addr.s_addr=(u64>>32u);
  1185. tmp_sockaddr.sin_port= htons(uint16_t((u64<<32u)>>32u));
  1186. int ret=sendto(udp_fd,data+1+sizeof(uint32_t),data_len -(1+sizeof(uint32_t)),0,(struct sockaddr *)&tmp_sockaddr,sizeof(tmp_sockaddr));
  1187. if(ret<0)
  1188. {
  1189. mylog(log_warn,"sento returned %d\n",ret);
  1190. //perror("ret<0");
  1191. }
  1192. mylog(log_trace,"%s :%d\n",inet_ntoa(tmp_sockaddr.sin_addr),ntohs(tmp_sockaddr.sin_port));
  1193. mylog(log_trace,"%d byte sent\n",ret);
  1194. }
  1195. return 0;
  1196. }
  1197. return 0;
  1198. }
  1199. int server_on_raw_ready(conn_info_t &conn_info)
  1200. {
  1201. int data_len; char *data;
  1202. raw_info_t &raw_info = conn_info.raw_info;
  1203. packet_info_t &send_info = conn_info.raw_info.send_info;
  1204. packet_info_t &recv_info = conn_info.raw_info.recv_info;
  1205. char ip_port[40];
  1206. sprintf(ip_port,"%s:%d",my_ntoa(recv_info.src_ip),recv_info.src_port);
  1207. if (recv_safer(conn_info, data, data_len) != 0) {
  1208. return -1;
  1209. }
  1210. if ((raw_mode == mode_faketcp && (recv_info.syn == 1 || recv_info.ack != 1))
  1211. || data_len == 0)
  1212. return 0;
  1213. if (recv_info.src_ip != send_info.dst_ip
  1214. || recv_info.src_port != send_info.dst_port) {
  1215. mylog(log_debug, "unexpected adress\n");
  1216. return 0;
  1217. }
  1218. if (data[0] == 'h' && data_len == 1) {
  1219. uint32_t tmp = ntohl(*((uint32_t *) &data[1 + sizeof(uint32_t)]));
  1220. mylog(log_debug,"[%s][hb]received hb \n",ip_port);
  1221. conn_info.last_hb_recv_time = current_time_rough;
  1222. return 0;
  1223. } else if (data[0] == 'd' && data_len >=int( sizeof(uint32_t) + 1)) {
  1224. uint32_t tmp_conv_id = ntohl(*((uint32_t *) &data[1]));
  1225. conn_info.last_hb_recv_time = current_time_rough;
  1226. mylog(log_trace, "conv:%u\n", tmp_conv_id);
  1227. if (!conn_info.conv_manager->is_conv_used(tmp_conv_id)) {
  1228. if (conn_info.conv_manager->get_size() >= max_conv_num) {
  1229. mylog(log_warn,
  1230. "ignored new conv %x connect bc max_conv_num exceed\n",
  1231. tmp_conv_id);
  1232. return 0;
  1233. }
  1234. struct sockaddr_in remote_addr_in;
  1235. socklen_t slen = sizeof(sockaddr_in);
  1236. memset(&remote_addr_in, 0, sizeof(remote_addr_in));
  1237. remote_addr_in.sin_family = AF_INET;
  1238. remote_addr_in.sin_port = htons(remote_port);
  1239. remote_addr_in.sin_addr.s_addr = remote_address_uint32;
  1240. int new_udp_fd = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
  1241. if (new_udp_fd < 0) {
  1242. mylog(log_warn, "create udp_fd error\n");
  1243. return -1;
  1244. }
  1245. setnonblocking(new_udp_fd);
  1246. set_buf_size(new_udp_fd);
  1247. mylog(log_debug, "created new udp_fd %d\n", new_udp_fd);
  1248. int ret = connect(new_udp_fd, (struct sockaddr *) &remote_addr_in,
  1249. slen);
  1250. if (ret != 0) {
  1251. mylog(log_warn, "udp fd connect fail\n");
  1252. close(new_udp_fd);
  1253. return -1;
  1254. }
  1255. struct epoll_event ev;
  1256. uint64_t u64 = (uint32_t(new_udp_fd))+(1llu<<32u);
  1257. mylog(log_trace, "u64: %ld\n", u64);
  1258. ev.events = EPOLLIN;
  1259. ev.data.u64 = u64;
  1260. ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, new_udp_fd, &ev);
  1261. if (ret != 0) {
  1262. mylog(log_warn, "add udp_fd error\n");
  1263. close(new_udp_fd);
  1264. return -1;
  1265. }
  1266. conn_info.conv_manager->insert_conv(tmp_conv_id, new_udp_fd);
  1267. conn_manager.udp_fd_mp[new_udp_fd] = &conn_info;
  1268. //pack_u64(conn_info.raw_info.recv_info.src_ip,conn_info.raw_info.recv_info.src_port);
  1269. mylog(log_info, "new conv conv_id=%x, assigned fd=%d\n",
  1270. tmp_conv_id, new_udp_fd);
  1271. }
  1272. uint64_t u64 = conn_info.conv_manager->find_u64_by_conv(tmp_conv_id);
  1273. conn_info.conv_manager->update_active_time(tmp_conv_id);
  1274. int fd = int((u64 << 32u) >> 32u);
  1275. mylog(log_trace, "received a data from fake tcp,len:%d\n", data_len);
  1276. int ret = send(fd, data + 1 + sizeof(uint32_t),
  1277. data_len - (1 + sizeof(uint32_t)), 0);
  1278. mylog(log_trace, "%d byte sent ,fd :%d\n ", ret, fd);
  1279. if (ret < 0) {
  1280. mylog(log_warn, "send returned %d\n", ret);
  1281. //perror("what happened????");
  1282. }
  1283. return 0;
  1284. }
  1285. return 0;
  1286. }
  1287. int server_on_raw_is_syn()
  1288. {
  1289. return 1;
  1290. }
  1291. int server_on_raw_reply_syn()
  1292. {
  1293. return 0;
  1294. }
  1295. int server_on_raw_is_handshake()
  1296. {
  1297. return 1;
  1298. }
  1299. int server_on_raw_reply_handshake()
  1300. {
  1301. return 0;
  1302. }
  1303. int server_on_raw_recv_multi()
  1304. {
  1305. uint32_t ip;uint16_t port;
  1306. if(peek_raw(ip,port)<0)
  1307. {
  1308. struct sockaddr saddr;
  1309. socklen_t saddr_size;
  1310. recvfrom(raw_recv_fd, 0,0, 0 ,&saddr , &saddr_size);//
  1311. mylog(log_trace,"peek_raw failed\n");
  1312. return -1;
  1313. }
  1314. mylog(log_trace,"peek_raw %s %d\n",my_ntoa(ip),port);
  1315. char ip_port[40];
  1316. sprintf(ip_port,"%s:%d",my_ntoa(ip),port);
  1317. /*if(ip==conn_manager.current_ready_ip&&port==conn_manager.current_ready_port)
  1318. {
  1319. return server_on_raw_ready();
  1320. }*/
  1321. int data_len; char *data;
  1322. if(!conn_manager.exist(ip,port))
  1323. {
  1324. raw_info_t tmp_raw_info;
  1325. if(recv_bare(tmp_raw_info,data,data_len)<0)
  1326. {
  1327. return 0;
  1328. return 0;
  1329. }
  1330. if(raw_mode==mode_faketcp)
  1331. {
  1332. if (!(tmp_raw_info.recv_info.syn == 1 && tmp_raw_info.recv_info.ack == 0 && data_len == 0))
  1333. return 0;
  1334. }
  1335. else if(raw_mode==mode_udp||raw_mode==mode_icmp)
  1336. {
  1337. if(data_len==strlen("hello")&& memcmp((char *)"hello",data,strlen("hello"))!=0)
  1338. {
  1339. //data[6]=0;
  1340. mylog(log_debug,"[%s]not a hello packet %d\n",ip_port,data,data_len);
  1341. return 0;
  1342. }
  1343. }
  1344. conn_info_t &conn_info=conn_manager.find_insert(ip,port);
  1345. conn_info.raw_info=tmp_raw_info;
  1346. packet_info_t &send_info=conn_info.raw_info.send_info;
  1347. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  1348. raw_info_t &raw_info=conn_info.raw_info;
  1349. send_info.src_ip=recv_info.dst_ip;
  1350. send_info.src_port=recv_info.dst_port;
  1351. send_info.dst_port = recv_info.src_port;
  1352. send_info.dst_ip = recv_info.src_ip;
  1353. mylog(log_info,"[%s]send_info.src_port %d,%d\n",ip_port,send_info.src_port,send_info.dst_port);
  1354. if(raw_mode==mode_faketcp)
  1355. {
  1356. send_info.ack_seq = recv_info.seq + 1;
  1357. send_info.psh = 0;
  1358. send_info.syn = 1;
  1359. send_info.ack = 1;
  1360. send_info.seq = get_true_random_number(); //not necessary to set
  1361. mylog(log_info,"[%s]sent syn ack\n",ip_port);
  1362. send_bare(raw_info, 0, 0); //////////////send
  1363. mylog(log_info,"[%s]changed state to server_syn_ack_sent\n",ip_port);
  1364. conn_info.state.server_current_state = server_syn_ack_sent;
  1365. conn_info.last_state_time = get_current_time();
  1366. }
  1367. else if(raw_mode==mode_udp||raw_mode==mode_icmp)
  1368. {
  1369. mylog(log_info,"[%s]got a hello packet\n",ip_port);
  1370. mylog(log_info,"[%s]sent handshake\n",ip_port);
  1371. conn_info.my_id=get_true_random_number_nz();
  1372. send_handshake(raw_info,conn_info.my_id,get_true_random_number_nz(),const_id); //////////////send
  1373. mylog(log_info,"[%s]changed state to server_heartbeat_sent_sent\n",ip_port);
  1374. conn_info.state.server_current_state = server_handshake_sent;
  1375. conn_info.last_state_time = get_current_time();
  1376. }
  1377. return 0;
  1378. }
  1379. if(conn_manager.mp.size()>=max_handshake_conn_num)
  1380. {
  1381. mylog(log_info,"[%s]reached max_handshake_conn_num,ignored new handshake\n",ip_port);
  1382. return 0;
  1383. }
  1384. conn_info_t & conn_info=conn_manager.find_insert(ip,port);//insert if not exist
  1385. packet_info_t &send_info=conn_info.raw_info.send_info;
  1386. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  1387. raw_info_t &raw_info=conn_info.raw_info;
  1388. if(conn_info.state.server_current_state==server_ready)
  1389. {
  1390. return server_on_raw_ready(conn_info);
  1391. }
  1392. if(recv_bare(conn_info.raw_info,data,data_len)<0)
  1393. return -1;
  1394. if(conn_info.state.server_current_state==server_syn_ack_sent)
  1395. {
  1396. if(raw_mode==mode_faketcp&&!( recv_info.syn==0&&recv_info.ack==1 &&data_len==0)) return 0;
  1397. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1398. {
  1399. mylog(log_debug,"[%s]unexpected adress\n",ip_port);
  1400. return 0;
  1401. }
  1402. send_info.syn=0;
  1403. send_info.ack=1;
  1404. send_info.seq+=1;////////is this right?
  1405. conn_info.my_id=get_true_random_number_nz();
  1406. send_handshake(raw_info,conn_info.my_id,0,const_id); //////////////send
  1407. mylog(log_info,"[%s]changed state to server_handshake_sent\n",ip_port);
  1408. conn_info.state.server_current_state=server_handshake_sent;
  1409. conn_info.last_state_time=get_current_time();
  1410. }
  1411. else if(conn_info.state.server_current_state==server_handshake_sent)//heart beat received
  1412. {
  1413. if(( raw_mode==mode_faketcp&& (recv_info.syn==1||recv_info.ack!=1)) ||data_len==0)
  1414. {
  1415. mylog(log_debug,"[%s]enexpected packet type\n",ip_port);
  1416. return 0;
  1417. }
  1418. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1419. {
  1420. mylog(log_trace,"[%s]unexpected adress\n",ip_port);
  1421. return 0;
  1422. }
  1423. if(conn_info.last_state_time <conn_info.last_state_time)
  1424. {
  1425. mylog(log_info,"[%s]ignored handshake of older timestamp than current ready connection",ip_port);
  1426. return 0;
  1427. }
  1428. //mylog(log_debug,"!!!\n");
  1429. uint32_t tmp_session_id= ntohl(* ((uint32_t *)&data[sizeof(id_t)]));
  1430. uint32_t tmp_oppsite_const_id=ntohl(* ((uint32_t *)&data[sizeof(id_t)*2]));
  1431. /*
  1432. if(oppsite_const_id!=0&&tmp_oppsite_const_id!=oppsite_const_id) //TODO MOVE TO READY
  1433. {
  1434. conv_manager.clear();
  1435. }
  1436. oppsite_const_id=tmp_oppsite_const_id;*/
  1437. if(tmp_session_id!=conn_info.my_id)
  1438. {
  1439. mylog(log_debug,"[%s]%x %x auth fail!!\n",tmp_session_id,conn_info.my_id,ip_port);
  1440. return 0;
  1441. }
  1442. int tmp_oppsite_session_id= ntohl(* ((uint32_t *)&data[0]));
  1443. conn_info.oppsite_id=tmp_oppsite_session_id;
  1444. mylog(log_info,"[%s]received handshake %x %x\n",ip_port,conn_info.oppsite_id,conn_info.my_id);
  1445. if(conn_manager.const_id_mp.find(tmp_oppsite_const_id)==conn_manager.const_id_mp.end())
  1446. {
  1447. //conn_manager.const_id_mp=
  1448. if(conn_manager.ready_num>=max_ready_conn_num)
  1449. {
  1450. mylog(log_info,"[%s]max_ready_conn_num,cant turn to ready\n",ip_port);
  1451. conn_info.state.server_current_state =server_nothing;
  1452. return 0;
  1453. }
  1454. conn_info.prepare();
  1455. conn_info.state.server_current_state = server_ready;
  1456. conn_info.oppsite_const_id=tmp_oppsite_const_id;
  1457. conn_manager.ready_num++;
  1458. conn_manager.const_id_mp[tmp_oppsite_const_id]=&conn_info;
  1459. //conn_info.last_state_time=get_current_time(); //dont change this!!!!!!!!!!!!!!!!!!!!!!!!!
  1460. //conn_manager.current_ready_ip=ip;
  1461. //conn_manager.current_ready_port=port;
  1462. //my_id=conn_info.my_id;
  1463. //oppsite_id=conn_info.oppsite_id;
  1464. conn_info.last_hb_recv_time = get_current_time();
  1465. conn_info.last_hb_sent_time = conn_info.last_hb_recv_time;//=get_current_time()
  1466. send_safer(conn_info, (char *) "h", 1); /////////////send
  1467. mylog(log_info, "[%s]changed state to server_ready\n",ip_port);
  1468. conn_info.anti_replay->re_init();
  1469. //g_conn_info=conn_info;
  1470. int new_timer_fd;
  1471. set_timer_server(epollfd, new_timer_fd);
  1472. conn_info.timer_fd=new_timer_fd;
  1473. conn_manager.timer_fd_mp[new_timer_fd] = &conn_info;//pack_u64(ip,port);
  1474. //timer_fd_mp[new_timer_fd]
  1475. /*
  1476. if(oppsite_const_id!=0&&tmp_oppsite_const_id!=oppsite_const_id) //TODO MOVE TO READY
  1477. {
  1478. mylog(log_info,"cleared all conv bc of const id doesnt match\n");
  1479. conv_manager.clear();
  1480. }*/
  1481. //oppsite_const_id=tmp_oppsite_const_id;
  1482. }
  1483. else
  1484. {
  1485. conn_info_t &ori_conn_info=*conn_manager.const_id_mp[tmp_oppsite_const_id];
  1486. if(ori_conn_info.state.server_current_state==server_ready)
  1487. {
  1488. if(conn_info.last_state_time<ori_conn_info.last_state_time)
  1489. {
  1490. mylog(log_info,"[%s]conn_info.last_state_time<ori_conn_info.last_state_time. ignored new handshake\n",ip_port);
  1491. conn_info.state.server_current_state=server_nothing;
  1492. conn_info.oppsite_const_id=0;
  1493. return 0;
  1494. }
  1495. if(!conn_manager.exist(ori_conn_info.raw_info.recv_info.src_ip,ori_conn_info.raw_info.recv_info.src_port))//TODO remove this
  1496. {
  1497. mylog(log_fatal,"[%s]this shouldnt happen\n",ip_port);
  1498. myexit(-1);
  1499. }
  1500. if(!conn_manager.exist(conn_info.raw_info.recv_info.src_ip,conn_info.raw_info.recv_info.src_port))//TODO remove this
  1501. {
  1502. mylog(log_fatal,"[%s]this shouldnt happen2\n",ip_port);
  1503. myexit(-1);
  1504. }
  1505. conn_info_t *&p_ori=conn_manager.find_insert_p(ori_conn_info.raw_info.recv_info.src_ip,ori_conn_info.raw_info.recv_info.src_port);
  1506. conn_info_t *&p=conn_manager.find_insert_p(conn_info.raw_info.recv_info.src_ip,conn_info.raw_info.recv_info.src_port);
  1507. conn_info_t *tmp=p;
  1508. p=p_ori;
  1509. p_ori=tmp;
  1510. mylog(log_info,"[%s]grabbed a connection\n",ip_port);
  1511. //ori_conn_info.state.server_current_state=server_ready;
  1512. ori_conn_info.raw_info=conn_info.raw_info;
  1513. ori_conn_info.last_state_time=conn_info.last_state_time;
  1514. ori_conn_info.last_hb_recv_time=conn_info.last_hb_recv_time;
  1515. ori_conn_info.last_hb_sent_time=conn_info.last_hb_sent_time;
  1516. ori_conn_info.my_id=conn_info.my_id;
  1517. ori_conn_info.oppsite_id=conn_info.oppsite_id;
  1518. send_safer(ori_conn_info, (char *) "h", 1);
  1519. ori_conn_info.anti_replay->re_init();
  1520. conn_info.state.server_current_state=server_nothing;
  1521. conn_info.oppsite_const_id=0;
  1522. }
  1523. else
  1524. {
  1525. mylog(log_fatal,"[%s]this should never happen\n",ip_port);
  1526. myexit(-1);
  1527. }
  1528. }
  1529. }
  1530. return 0;
  1531. }
  1532. /*
  1533. int server_on_raw_recv()
  1534. {
  1535. raw_info_t &raw_info=g_conn_info.raw_info;
  1536. packet_info_t &send_info=g_conn_info.raw_info.send_info;
  1537. packet_info_t &recv_info=g_conn_info.raw_info.recv_info;
  1538. char* data;int data_len;
  1539. //packet_info_t send_info;
  1540. if(g_conn_info.server_current_state==server_nothing)
  1541. {
  1542. if(recv_bare(raw_info,data,data_len)!=0)
  1543. {
  1544. return -1;
  1545. }
  1546. anti_replay.re_init();
  1547. if(raw_mode==mode_icmp)
  1548. {
  1549. send_info.src_port = recv_info.src_port;;
  1550. }
  1551. send_info.src_ip=recv_info.dst_ip;
  1552. send_info.src_port=recv_info.dst_port;
  1553. send_info.dst_port = recv_info.src_port;
  1554. send_info.dst_ip = recv_info.src_ip;
  1555. if(raw_mode==mode_faketcp)
  1556. {
  1557. if (!(recv_info.syn == 1 && recv_info.ack == 0 && data_len == 0))
  1558. return 0;
  1559. send_info.ack_seq = recv_info.seq + 1;
  1560. send_info.psh = 0;
  1561. send_info.syn = 1;
  1562. send_info.ack = 1;
  1563. send_info.seq = get_true_random_number_nz(); //not necessary to set
  1564. mylog(log_info,"sent syn ack\n");
  1565. send_bare(raw_info, 0, 0); //////////////send
  1566. mylog(log_info,"changed state to server_syn_ack_sent\n");
  1567. g_conn_info.server_current_state = server_syn_ack_sent;
  1568. g_conn_info.retry_counter = 0;
  1569. g_conn_info.last_state_time = get_current_time();
  1570. }
  1571. else if(raw_mode==mode_udp||raw_mode==mode_icmp)
  1572. {
  1573. if(data_len==strlen("hello")&& memcmp((char *)"hello",data,strlen("hello"))!=0)
  1574. {
  1575. //data[6]=0;
  1576. mylog(log_debug,"not a hello packet %d\n",data,data_len);
  1577. return 0;
  1578. }
  1579. else
  1580. {
  1581. mylog(log_info,"got a hello packet\n");
  1582. }
  1583. mylog(log_info,"sent half heart_beat\n");
  1584. //send_raw(g_packet_info_send, 0, 0);
  1585. send_handshake(raw_info,my_id,random(),const_id); //////////////send
  1586. mylog(log_info,"changed state to server_heartbeat_sent_sent\n");
  1587. g_conn_info.server_current_state = server_handshake_sent;
  1588. g_conn_info.retry_counter = 0;
  1589. g_conn_info.last_state_time = get_current_time();
  1590. }
  1591. }
  1592. else if(g_conn_info.server_current_state==server_syn_ack_sent)
  1593. {
  1594. if(recv_bare(raw_info,data,data_len)!=0)
  1595. {
  1596. return -1;
  1597. }
  1598. if(raw_mode==mode_faketcp&&!( recv_info.syn==0&&recv_info.ack==1 &&data_len==0)) return 0;
  1599. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1600. {
  1601. mylog(log_debug,"unexpected adress\n");
  1602. return 0;
  1603. }
  1604. send_info.syn=0;
  1605. send_info.ack=1;
  1606. send_info.seq+=1;////////is this right?
  1607. send_handshake(raw_info,my_id,0,const_id); //////////////send
  1608. mylog(log_info,"changed state to server_handshake_sent\n");
  1609. g_conn_info.server_current_state=server_handshake_sent;
  1610. g_conn_info.last_state_time=get_current_time();
  1611. g_conn_info.retry_counter=RETRY_TIME;
  1612. }
  1613. else if(g_conn_info.server_current_state==server_handshake_sent)//heart beat received
  1614. {
  1615. if(recv_bare(raw_info,data,data_len)!=0)
  1616. {
  1617. return -1;
  1618. }
  1619. if(( raw_mode==mode_faketcp&& (recv_info.syn==1||recv_info.ack!=1)) ||data_len==0) return 0;
  1620. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1621. {
  1622. mylog(log_trace,"unexpected adress\n");
  1623. return 0;
  1624. }
  1625. //if(data_len<hb_length||data[0]!='h')
  1626. //{
  1627. // return 0;
  1628. //}
  1629. uint32_t tmp_session_id= ntohl(* ((uint32_t *)&data[sizeof(my_id)]));
  1630. uint32_t tmp_oppsite_const_id=ntohl(* ((uint32_t *)&data[sizeof(my_id)*2]));
  1631. if(oppsite_const_id!=0&&tmp_oppsite_const_id!=oppsite_const_id)
  1632. {
  1633. conv_manager.clear();
  1634. }
  1635. oppsite_const_id=tmp_oppsite_const_id;
  1636. if(tmp_session_id!=my_id)
  1637. {
  1638. mylog(log_trace,"auth fail!!\n");
  1639. return 0;
  1640. }
  1641. int tmp_oppsite_session_id= ntohl(* ((uint32_t *)&data[0]));
  1642. oppsite_id=tmp_oppsite_session_id;
  1643. mylog(log_info,"received heartbeat %x %x\n",oppsite_id,tmp_session_id);
  1644. send_safer(raw_info,(char *)"h",1);/////////////send
  1645. //send_hb(g_packet_info_send,my_id,oppsite_id,const_id);/////////////////send
  1646. g_conn_info.server_current_state=server_ready;
  1647. g_conn_info.last_state_time=get_current_time();
  1648. g_conn_info.last_hb_recv_time=get_current_time();
  1649. //first_data_packet=1;
  1650. mylog(log_info,"changed state to server_ready\n");
  1651. }
  1652. else if(g_conn_info.server_current_state==server_ready)
  1653. {
  1654. if(recv_safer(raw_info,data,data_len)!=0)
  1655. {
  1656. return -1;
  1657. }
  1658. if( (raw_mode==mode_faketcp&&(recv_info.syn==1||recv_info.ack!=1)) ||data_len==0) return 0;
  1659. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  1660. {
  1661. mylog(log_debug,"unexpected adress\n");
  1662. return 0;
  1663. }
  1664. if(data[0]=='h'&&data_len==1)
  1665. {
  1666. uint32_t tmp= ntohl(* ((uint32_t *)&data[1+sizeof(uint32_t)]));
  1667. mylog(log_debug,"received hb <%x,%x>\n",oppsite_id,tmp);
  1668. g_conn_info.last_hb_recv_time=current_time_rough;
  1669. return 0;
  1670. }
  1671. else if(data[0]=='d'&&data_len>=sizeof(uint32_t)+1)
  1672. {
  1673. uint32_t tmp_conv_id=ntohl(* ((uint32_t *)&data[1]));
  1674. g_conn_info.last_hb_recv_time=current_time_rough;
  1675. mylog(log_debug,"<<<<conv:%u>>>>\n",tmp_conv_id);
  1676. if(!conv_manager.is_conv_used(tmp_conv_id))
  1677. {
  1678. if(conv_manager.get_size() >=max_conv_num)
  1679. {
  1680. mylog(log_warn,"ignored new conv %x connect bc max_conv_num exceed\n",tmp_conv_id);
  1681. return 0;
  1682. }
  1683. struct sockaddr_in remote_addr_in;
  1684. socklen_t slen = sizeof(sockaddr_in);
  1685. memset(&remote_addr_in, 0, sizeof(remote_addr_in));
  1686. remote_addr_in.sin_family = AF_INET;
  1687. remote_addr_in.sin_port = htons(remote_port);
  1688. remote_addr_in.sin_addr.s_addr = remote_address_uint32;
  1689. int new_udp_fd=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
  1690. if(new_udp_fd<0)
  1691. {
  1692. mylog(log_warn,"create udp_fd error\n");
  1693. return -1;
  1694. }
  1695. set_buf_size(new_udp_fd);
  1696. mylog(log_debug,"created new udp_fd %d\n",new_udp_fd);
  1697. int ret = connect(new_udp_fd, (struct sockaddr *) &remote_addr_in, slen);
  1698. if(ret!=0)
  1699. {
  1700. mylog(log_warn,"udp fd connect fail\n");
  1701. close(new_udp_fd);
  1702. return -1;
  1703. }
  1704. struct epoll_event ev;
  1705. uint64_t u64=((u_int64_t(tmp_conv_id))<<32u)+(uint32_t)new_udp_fd;
  1706. mylog(log_trace,"u64: %ld\n",u64);
  1707. ev.events = EPOLLIN;
  1708. ev.data.u64 = u64;
  1709. ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, new_udp_fd, &ev);
  1710. if (ret!= 0) {
  1711. mylog(log_warn,"add udp_fd error\n");
  1712. close(new_udp_fd);
  1713. return -1;
  1714. }
  1715. conv_manager.insert_conv(tmp_conv_id,u64);
  1716. mylog(log_info,"new conv conv_id=%x, assigned fd=%d\n",tmp_conv_id,new_udp_fd);
  1717. }
  1718. uint64_t u64=conv_manager.find_u64_by_conv(tmp_conv_id);
  1719. conv_manager.update_active_time(tmp_conv_id);
  1720. int fd=int((u64<<32u)>>32u);
  1721. mylog(log_debug,"received a data from fake tcp,len:%d\n",data_len);
  1722. int ret=send(fd,data+1+sizeof(uint32_t),data_len -(1+sizeof(uint32_t)),0);
  1723. mylog(log_debug,"%d byte sent ,fd :%d\n ",ret,fd);
  1724. if(ret<0)
  1725. {
  1726. mylog(log_warn,"send returned %d\n",ret);
  1727. //perror("what happened????");
  1728. }
  1729. }
  1730. }
  1731. return 0;
  1732. }*/
  1733. int get_src_adress(uint32_t &ip)
  1734. {
  1735. struct sockaddr_in remote_addr_in;
  1736. socklen_t slen = sizeof(sockaddr_in);
  1737. memset(&remote_addr_in, 0, sizeof(remote_addr_in));
  1738. remote_addr_in.sin_family = AF_INET;
  1739. remote_addr_in.sin_port = htons(remote_port);
  1740. remote_addr_in.sin_addr.s_addr = remote_address_uint32;
  1741. int new_udp_fd=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
  1742. if(new_udp_fd<0)
  1743. {
  1744. mylog(log_warn,"create udp_fd error\n");
  1745. return -1;
  1746. }
  1747. set_buf_size(new_udp_fd);
  1748. mylog(log_debug,"created new udp_fd %d\n",new_udp_fd);
  1749. int ret = connect(new_udp_fd, (struct sockaddr *) &remote_addr_in, slen);
  1750. if(ret!=0)
  1751. {
  1752. mylog(log_warn,"udp fd connect fail\n");
  1753. close(new_udp_fd);
  1754. return -1;
  1755. }
  1756. struct sockaddr_in my_addr;
  1757. unsigned int len=sizeof(my_addr);
  1758. if(getsockname(new_udp_fd, (struct sockaddr *) &my_addr, &len)!=0) return -1;
  1759. ip=my_addr.sin_addr.s_addr;
  1760. close(new_udp_fd);
  1761. return 0;
  1762. }
  1763. int client_event_loop()
  1764. {
  1765. char buf[buf_len];
  1766. conn_info_t conn_info;
  1767. conn_info.my_id=get_true_random_number_nz();
  1768. conn_info.prepare();
  1769. packet_info_t &send_info=conn_info.raw_info.send_info;
  1770. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  1771. //printf("?????\n");
  1772. if(source_address_uint32==0)
  1773. {
  1774. mylog(log_info,"get_src_adress called\n");
  1775. if(get_src_adress(source_address_uint32)!=0)
  1776. {
  1777. mylog(log_fatal,"the trick to auto get source ip failed,you should specific an ip by --source-ip\n");
  1778. myexit(-1);
  1779. }
  1780. }
  1781. in_addr tmp;
  1782. tmp.s_addr=source_address_uint32;
  1783. mylog(log_info,"source ip = %s\n",inet_ntoa(tmp));
  1784. //printf("done\n");
  1785. if(try_to_list_and_bind(source_port)!=0)
  1786. {
  1787. mylog(log_fatal,"bind to source_port:%d fail\n ",source_port);
  1788. myexit(-1);
  1789. }
  1790. send_info.src_port=source_port;
  1791. send_info.src_ip = source_address_uint32;
  1792. int i, j, k;int ret;
  1793. init_raw_socket();
  1794. //init_filter(source_port);
  1795. send_info.dst_ip=remote_address_uint32;
  1796. send_info.dst_port=remote_port;
  1797. //g_packet_info.src_ip=source_address_uint32;
  1798. //g_packet_info.src_port=source_port;
  1799. udp_fd=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
  1800. set_buf_size(udp_fd);
  1801. int yes = 1;
  1802. //setsockopt(udp_fd, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(yes));
  1803. struct sockaddr_in local_me;
  1804. socklen_t slen = sizeof(sockaddr_in);
  1805. memset(&local_me, 0, sizeof(local_me));
  1806. local_me.sin_family = AF_INET;
  1807. local_me.sin_port = htons(local_port);
  1808. local_me.sin_addr.s_addr = local_address_uint32;
  1809. if (bind(udp_fd, (struct sockaddr*) &local_me, slen) == -1) {
  1810. mylog(log_fatal,"socket bind error\n");
  1811. //perror("socket bind error");
  1812. myexit(1);
  1813. }
  1814. setnonblocking(udp_fd);
  1815. epollfd = epoll_create1(0);
  1816. const int max_events = 4096;
  1817. struct epoll_event ev, events[max_events];
  1818. if (epollfd < 0) {
  1819. mylog(log_fatal,"epoll return %d\n", epollfd);
  1820. myexit(-1);
  1821. }
  1822. ev.events = EPOLLIN;
  1823. ev.data.u64 = udp_fd;
  1824. ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, udp_fd, &ev);
  1825. if (ret!=0) {
  1826. mylog(log_fatal,"add udp_listen_fd error\n");
  1827. myexit(-1);
  1828. }
  1829. ev.events = EPOLLIN;
  1830. ev.data.u64 = raw_recv_fd;
  1831. ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, raw_recv_fd, &ev);
  1832. if (ret!= 0) {
  1833. mylog(log_fatal,"add raw_fd error\n");
  1834. myexit(-1);
  1835. }
  1836. ////add_timer for fake_tcp_keep_connection_client
  1837. //sleep(10);
  1838. //memset(&udp_old_addr_in,0,sizeof(sockaddr_in));
  1839. int unbind=1;
  1840. set_timer(epollfd,timer_fd);
  1841. mylog(log_debug,"send_raw : from %x %d to %x %d\n",send_info.src_ip,send_info.src_port,send_info.dst_ip,send_info.dst_port);
  1842. while(1)////////////////////////
  1843. {
  1844. int nfds = epoll_wait(epollfd, events, max_events, 180 * 1000);
  1845. if (nfds < 0) { //allow zero
  1846. mylog(log_fatal,"epoll_wait return %d\n", nfds);
  1847. myexit(-1);
  1848. }
  1849. int idx;
  1850. for (idx = 0; idx < nfds; ++idx) {
  1851. if (events[idx].data.u64 == (uint64_t)raw_recv_fd)
  1852. {
  1853. iphdr *iph;tcphdr *tcph;
  1854. client_on_raw_recv(conn_info);
  1855. }
  1856. if(events[idx].data.u64 ==(uint64_t)timer_fd)
  1857. {
  1858. uint64_t value;
  1859. read(timer_fd, &value, 8);
  1860. keep_connection_client(conn_info);
  1861. }
  1862. if (events[idx].data.u64 == (uint64_t)udp_fd)
  1863. {
  1864. int recv_len;
  1865. struct sockaddr_in udp_new_addr_in;
  1866. if ((recv_len = recvfrom(udp_fd, buf, buf_len, 0,
  1867. (struct sockaddr *) &udp_new_addr_in, &slen)) == -1) {
  1868. mylog(log_error,"recv_from error,this shouldnt happen at client\n");
  1869. myexit(1);
  1870. };
  1871. mylog(log_trace,"Received packet from %s:%d,len: %d\n", inet_ntoa(udp_new_addr_in.sin_addr),
  1872. ntohs(udp_new_addr_in.sin_port),recv_len);
  1873. /*
  1874. if(udp_old_addr_in.sin_addr.s_addr==0&&udp_old_addr_in.sin_port==0)
  1875. {
  1876. memcpy(&udp_old_addr_in,&udp_new_addr_in,sizeof(udp_new_addr_in));
  1877. }
  1878. else if(udp_new_addr_in.sin_addr.s_addr!=udp_old_addr_in.sin_addr.s_addr
  1879. ||udp_new_addr_in.sin_port!=udp_old_addr_in.sin_port)
  1880. {
  1881. if(get_current_time()- last_udp_recv_time <udp_timeout)
  1882. {
  1883. printf("new <ip,port> connected in,ignored,bc last connection is still active\n");
  1884. continue;
  1885. }
  1886. else
  1887. {
  1888. printf("new <ip,port> connected in,accpeted\n");
  1889. memcpy(&udp_old_addr_in,&udp_new_addr_in,sizeof(udp_new_addr_in));
  1890. conv_id++;
  1891. }
  1892. }*/
  1893. //last_udp_recv_time=get_current_time();
  1894. uint64_t u64=((uint64_t(udp_new_addr_in.sin_addr.s_addr))<<32u)+ntohs(udp_new_addr_in.sin_port);
  1895. uint32_t conv;
  1896. if(!conn_info.conv_manager->is_u64_used(u64))
  1897. {
  1898. if(conn_info.conv_manager->get_size() >=max_conv_num)
  1899. {
  1900. mylog(log_warn,"ignored new udp connect bc max_conv_num exceed\n");
  1901. continue;
  1902. }
  1903. conv=conn_info.conv_manager->get_new_conv();
  1904. conn_info.conv_manager->insert_conv(conv,u64);
  1905. mylog(log_info,"new connection from %s:%d,conv_id=%x\n",inet_ntoa(udp_new_addr_in.sin_addr),ntohs(udp_new_addr_in.sin_port),conv);
  1906. }
  1907. else
  1908. {
  1909. conv=conn_info.conv_manager->find_conv_by_u64(u64);
  1910. }
  1911. conn_info.conv_manager->update_active_time(conv);
  1912. if(conn_info.state.client_current_state==client_ready)
  1913. {
  1914. send_data_safer(conn_info,buf,recv_len,conv);
  1915. }
  1916. }
  1917. }
  1918. }
  1919. return 0;
  1920. }
  1921. int server_event_loop()
  1922. {
  1923. char buf[buf_len];
  1924. int i, j, k;int ret;
  1925. bind_address_uint32=local_address_uint32;//only server has bind adress,client sets it to zero
  1926. if(raw_mode==mode_faketcp)
  1927. {
  1928. bind_fd=socket(AF_INET,SOCK_STREAM,0);
  1929. }
  1930. else if(raw_mode==mode_udp||raw_mode==mode_icmp)//bind an adress to avoid collision,for icmp,there is no port,just bind a udp port
  1931. {
  1932. bind_fd=socket(AF_INET,SOCK_DGRAM,0);
  1933. }
  1934. struct sockaddr_in temp_bind_addr;
  1935. bzero(&temp_bind_addr, sizeof(temp_bind_addr));
  1936. temp_bind_addr.sin_family = AF_INET;
  1937. temp_bind_addr.sin_port = htons(local_port);
  1938. temp_bind_addr.sin_addr.s_addr = local_address_uint32;
  1939. if (bind(bind_fd, (struct sockaddr*)&temp_bind_addr, sizeof(temp_bind_addr)) !=0)
  1940. {
  1941. mylog(log_fatal,"bind fail\n");
  1942. myexit(-1);
  1943. }
  1944. if(raw_mode==mode_faketcp)
  1945. {
  1946. if(listen(bind_fd, SOMAXCONN) != 0 )
  1947. {
  1948. mylog(log_fatal,"listen fail\n");
  1949. myexit(-1);
  1950. }
  1951. }
  1952. init_raw_socket();
  1953. init_filter(local_port);//bpf filter
  1954. epollfd = epoll_create1(0);
  1955. const int max_events = 4096;
  1956. struct epoll_event ev, events[max_events];
  1957. if (epollfd < 0) {
  1958. mylog(log_fatal,"epoll return %d\n", epollfd);
  1959. myexit(-1);
  1960. }
  1961. ev.events = EPOLLIN;
  1962. ev.data.u64 = raw_recv_fd;
  1963. ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, raw_recv_fd, &ev);
  1964. if (ret!= 0) {
  1965. mylog(log_fatal,"add raw_fd error\n");
  1966. myexit(-1);
  1967. }
  1968. int timer_fd;
  1969. set_timer(epollfd,timer_fd);
  1970. while(1)////////////////////////
  1971. {
  1972. int nfds = epoll_wait(epollfd, events, max_events, 180 * 1000);
  1973. if (nfds < 0) { //allow zero
  1974. mylog(log_fatal,"epoll_wait return %d\n", nfds);
  1975. myexit(-1);
  1976. }
  1977. int idx;
  1978. const int MTU=1440;
  1979. for (idx = 0; idx < nfds; ++idx)
  1980. {
  1981. //printf("%d %d %d %d\n",timer_fd,raw_recv_fd,raw_send_fd,n);
  1982. if ((events[idx].data.u64 ) == (uint64_t)timer_fd)
  1983. {
  1984. uint64_t dummy;
  1985. read(timer_fd, &dummy, 8);
  1986. current_time_rough=get_current_time();
  1987. conn_manager.clear_inactive();
  1988. }
  1989. else if (events[idx].data.u64 == (uint64_t)raw_recv_fd)
  1990. {
  1991. server_on_raw_recv_multi();
  1992. }
  1993. else if ((events[idx].data.u64 >>32u) == 2u)
  1994. {
  1995. int fd=get_u64_l(events[idx].data.u64);
  1996. uint64_t dummy;
  1997. read(fd, &dummy, 8);
  1998. if(conn_manager.timer_fd_mp.find(fd)==conn_manager.timer_fd_mp.end()) //this can happen,when fd is a just closed fd
  1999. {
  2000. mylog(log_info,"timer_fd no longer exits\n");
  2001. continue;
  2002. }
  2003. conn_info_t* p_conn_info=conn_manager.timer_fd_mp[fd];
  2004. uint32_t ip=p_conn_info->raw_info.recv_info.src_ip;
  2005. uint32_t port=p_conn_info->raw_info.recv_info.src_port;
  2006. if(!conn_manager.exist(ip,port))//TODO remove this for peformance
  2007. {
  2008. mylog(log_fatal,"ip port no longer exits 1!!!this shouldnt happen\n");
  2009. myexit(-1);
  2010. }
  2011. if (p_conn_info->state.server_current_state != server_ready) //TODO remove this for peformance
  2012. {
  2013. mylog(log_fatal,"p_conn_info->state.server_current_state!=server_ready!!!this shouldnt happen\n");
  2014. myexit(-1);
  2015. }
  2016. //conn_info_t &conn_info=conn_manager.find(ip,port);
  2017. keep_connection_server_multi(*p_conn_info);
  2018. }
  2019. else if ((events[idx].data.u64 >>32u) == 1u)
  2020. {
  2021. //uint32_t conv_id=events[n].data.u64>>32u;
  2022. int fd=int((events[idx].data.u64<<32u)>>32u);
  2023. if(conn_manager.udp_fd_mp.find(fd)==conn_manager.udp_fd_mp.end()) //this can happen,when fd is a just closed fd
  2024. {
  2025. mylog(log_debug,"fd no longer exists in udp_fd_mp,udp fd %d\n",fd);
  2026. recv(fd,0,0,0);
  2027. continue;
  2028. }
  2029. conn_info_t* p_conn_info=conn_manager.udp_fd_mp[fd];
  2030. uint32_t ip=p_conn_info->raw_info.recv_info.src_ip;
  2031. uint32_t port=p_conn_info->raw_info.recv_info.src_port;
  2032. if(!conn_manager.exist(ip,port))//TODO remove this for peformance
  2033. {
  2034. mylog(log_fatal,"ip port no longer exits 2!!!this shouldnt happen\n", nfds);
  2035. myexit(-1);
  2036. }
  2037. if(p_conn_info->state.server_current_state!=server_ready)//TODO remove this for peformance
  2038. {
  2039. mylog(log_fatal,"p_conn_info->state.server_current_state!=server_ready!!!this shouldnt happen\n", nfds);
  2040. myexit(-1);
  2041. }
  2042. conn_info_t &conn_info=*p_conn_info;
  2043. if(!conn_info.conv_manager->is_u64_used(fd))
  2044. {
  2045. mylog(log_debug,"conv no longer exists,udp fd %d\n",fd);
  2046. int recv_len=recv(fd,0,0,0); ///////////TODO ,delete this
  2047. continue;
  2048. }
  2049. uint32_t conv_id=conn_info.conv_manager->find_conv_by_u64(fd);
  2050. int recv_len=recv(fd,buf,buf_len,0);
  2051. mylog(log_trace,"received a packet from udp_fd,len:%d\n",recv_len);
  2052. if(recv_len<0)
  2053. {
  2054. mylog(log_debug,"udp fd,recv_len<0 continue\n");
  2055. continue;
  2056. }
  2057. //conn_info.conv_manager->update_active_time(conv_id); server dosnt update from upd side,only update from raw side. (client updates at both side)
  2058. if(conn_info.state.server_current_state==server_ready)
  2059. {
  2060. send_data_safer(conn_info,buf,recv_len,conv_id);
  2061. //send_data(g_packet_info_send,buf,recv_len,my_id,oppsite_id,conv_id);
  2062. mylog(log_trace,"send_data_safer ,sent !!\n");
  2063. }
  2064. }
  2065. }
  2066. }
  2067. return 0;
  2068. }
  2069. void print_help()
  2070. {
  2071. printf("udp-to-raw tunnel v0.1\n");
  2072. printf("\n");
  2073. printf("usage:\n");
  2074. printf(" run as client : ./this_program -c -l adress:port -r adress:port [options]\n");
  2075. printf(" run as server : ./this_program -s -l adress:port -r adress:port [options]\n");
  2076. printf("\n");
  2077. printf("common options,these options must be same on both side:\n");
  2078. printf(" --raw-mode <string> avaliable values:faketcp,udp,icmp\n");
  2079. printf(" --key <string> password to gen symetric key\n");
  2080. printf(" --auth-mode <string> avaliable values:aes128cbc,xor,none\n");
  2081. printf(" --cipher-mode <string> avaliable values:md5,crc32,sum,none\n");
  2082. printf("\n");
  2083. printf("client options:\n");
  2084. printf(" --source-ip <ip> override source-ip for raw socket\n");
  2085. printf(" --source-port <port> override source-port for tcp/udp \n");
  2086. printf("\n");
  2087. printf("other options:\n");
  2088. printf(" --log-level <number> 0:never print log\n");
  2089. printf(" 1:fatal\n");
  2090. printf(" 2:error\n");
  2091. printf(" 3:warn\n");
  2092. printf(" 4:info (default)\n");
  2093. printf(" 5:debug\n");
  2094. printf(" 6:trace\n");
  2095. printf("\n");
  2096. printf(" --disable-color disable log color\n");
  2097. printf(" --log-position enable file name,function name,line number in log\n");
  2098. printf(" --disable-bpf disable the kernel space filter,most time its not necessary\n");
  2099. printf(" unless you suspect there is a bug\n");
  2100. printf("\n");
  2101. printf(" --sock-buf <number> buf size for socket,>=1 and <=10240,unit:kbyte\n");
  2102. printf(" --seqmode <number> seq increase mode for faketcp:\n");
  2103. printf(" 0:dont increase\n");
  2104. printf(" 1:increase every packet\n");
  2105. printf(" 2:increase randomly, about every 5 packets (default)\n");
  2106. printf("\n");
  2107. printf(" -h,--help print this help message\n");
  2108. //printf("common options,these options must be same on both side\n");
  2109. }
  2110. void process_arg(int argc, char *argv[])
  2111. {
  2112. int i,j,k,opt;
  2113. static struct option long_options[] =
  2114. {
  2115. /* These options set a flag. */
  2116. {"source-ip", required_argument, 0, 1},
  2117. {"source-port", required_argument, 0, 1},
  2118. {"log-level", required_argument, 0, 1},
  2119. {"key", required_argument, 0, 'k'},
  2120. {"auth-mode", required_argument, 0, 1},
  2121. {"cipher-mode", required_argument, 0, 1},
  2122. {"raw-mode", required_argument, 0, 1},
  2123. {"disable-color", no_argument, 0, 1},
  2124. {"log-position", no_argument, 0, 1},
  2125. {"disable-bpf", no_argument, 0, 1},
  2126. {"sock-buf", required_argument, 0, 1},
  2127. {"seq-mode", required_argument, 0, 1},
  2128. {NULL, 0, 0, 0}
  2129. };
  2130. int option_index = 0;
  2131. for (i = 0; i < argc; i++)
  2132. {
  2133. if(strcmp(argv[i],"-h")==0||strcmp(argv[i],"--help")==0)
  2134. {
  2135. print_help();
  2136. myexit(0);
  2137. }
  2138. }
  2139. for (i = 0; i < argc; i++)
  2140. {
  2141. if(strcmp(argv[i],"--log-level")==0)
  2142. {
  2143. if(i<argc -1)
  2144. {
  2145. sscanf(argv[i+1],"%d",&log_level);
  2146. if(0<=log_level&&log_level<log_end)
  2147. {
  2148. }
  2149. else
  2150. {
  2151. log_bare(log_fatal,"invalid log_level\n");
  2152. myexit(-1);
  2153. }
  2154. }
  2155. }
  2156. if(strcmp(argv[i],"--disable-color")==0)
  2157. {
  2158. enable_log_color=0;
  2159. }
  2160. }
  2161. mylog(log_info,"argc=%d ", argc);
  2162. for (i = 0; i < argc; i++) {
  2163. log_bare(log_info, "%s ", argv[i]);
  2164. }
  2165. log_bare(log_info, "\n");
  2166. if (argc == 1)
  2167. {
  2168. print_help();
  2169. myexit(-1);
  2170. }
  2171. int no_l = 1, no_r = 1;
  2172. while ((opt = getopt_long(argc, argv, "l:r:sch",long_options,&option_index)) != -1) {
  2173. //string opt_key;
  2174. //opt_key+=opt;
  2175. switch (opt) {
  2176. case 'l':
  2177. no_l = 0;
  2178. if (strchr(optarg, ':') != 0) {
  2179. sscanf(optarg, "%[^:]:%d", local_address, &local_port);
  2180. } else {
  2181. strcpy(local_address, "127.0.0.1");
  2182. sscanf(optarg, "%d", &local_port);
  2183. }
  2184. break;
  2185. case 'r':
  2186. no_r = 0;
  2187. if (strchr(optarg, ':') != 0) {
  2188. sscanf(optarg, "%[^:]:%d", remote_address, &remote_port);
  2189. } else {
  2190. strcpy(remote_address, "127.0.0.1");
  2191. sscanf(optarg, "%d", &remote_port);
  2192. }
  2193. break;
  2194. case 's':
  2195. if(program_mode==0)
  2196. {
  2197. program_mode=server_mode;
  2198. }
  2199. else
  2200. {
  2201. mylog(log_fatal,"-s /-c has already been set,-s option conflict\n");
  2202. myexit(-1);
  2203. }
  2204. break;
  2205. case 'c':
  2206. if(program_mode==0)
  2207. {
  2208. program_mode=client_mode;
  2209. }
  2210. else
  2211. {
  2212. mylog(log_fatal,"-s /-c has already been set,-c option conflict\n");
  2213. myexit(-1);
  2214. }
  2215. break;
  2216. case 'h':
  2217. break;
  2218. case 'k':
  2219. mylog(log_debug,"parsing key option\n");
  2220. sscanf(optarg,"%s",key_string);
  2221. break;
  2222. case 1:
  2223. mylog(log_debug,"option_index: %d\n",option_index);
  2224. if(strcmp(long_options[option_index].name,"source-ip")==0)
  2225. {
  2226. mylog(log_debug,"parsing long option :source-ip\n");
  2227. sscanf(optarg, "%s", source_address);
  2228. mylog(log_debug,"source: %s\n",source_address);
  2229. }
  2230. else if(strcmp(long_options[option_index].name,"source-port")==0)
  2231. {
  2232. mylog(log_debug,"parsing long option :source-port\n");
  2233. sscanf(optarg, "%d", &source_port);
  2234. mylog(log_info,"source: %d\n",&source_port);
  2235. }
  2236. else if(strcmp(long_options[option_index].name,"raw-mode")==0)
  2237. {
  2238. for(i=0;i<mode_end;i++)
  2239. {
  2240. if(strcmp(optarg,raw_mode_tostring[i])==0)
  2241. {
  2242. raw_mode=(raw_mode_t)i;
  2243. break;
  2244. }
  2245. }
  2246. if(i==mode_end)
  2247. {
  2248. mylog(log_fatal,"no such raw_mode %s\n",optarg);
  2249. myexit(-1);
  2250. }
  2251. }
  2252. else if(strcmp(long_options[option_index].name,"auth-mode")==0)
  2253. {
  2254. for(i=0;i<auth_end;i++)
  2255. {
  2256. if(strcmp(optarg,auth_mode_tostring[i])==0)
  2257. {
  2258. auth_mode=(auth_mode_t)i;
  2259. break;
  2260. }
  2261. }
  2262. if(i==auth_end)
  2263. {
  2264. mylog(log_fatal,"no such auth_mode %s\n",optarg);
  2265. myexit(-1);
  2266. }
  2267. }
  2268. else if(strcmp(long_options[option_index].name,"cipher-mode")==0)
  2269. {
  2270. for(i=0;i<cipher_end;i++)
  2271. {
  2272. if(strcmp(optarg,cipher_mode_tostring[i])==0)
  2273. {
  2274. cipher_mode=(cipher_mode_t)i;
  2275. break;
  2276. }
  2277. }
  2278. if(i==cipher_end)
  2279. {
  2280. mylog(log_fatal,"no such cipher_mode %s\n",optarg);
  2281. myexit(-1);
  2282. }
  2283. }
  2284. else if(strcmp(long_options[option_index].name,"log-level")==0)
  2285. {
  2286. }
  2287. else if(strcmp(long_options[option_index].name,"disable-color")==0)
  2288. {
  2289. //enable_log_color=0;
  2290. }
  2291. else if(strcmp(long_options[option_index].name,"log-position")==0)
  2292. {
  2293. enable_log_position=1;
  2294. }
  2295. else if(strcmp(long_options[option_index].name,"disable-bpf")==0)
  2296. {
  2297. disable_bpf_filter=1;
  2298. }
  2299. else if(strcmp(long_options[option_index].name,"sock-buf")==0)
  2300. {
  2301. int tmp=-1;
  2302. sscanf(optarg,"%d",&tmp);
  2303. if(1<=tmp&&tmp<=10*1024)
  2304. {
  2305. socket_buf_size=tmp*1024;
  2306. }
  2307. else
  2308. {
  2309. mylog(log_fatal,"sock-buf value must be between 1 and 10240 (kbyte) \n");
  2310. myexit(-1);
  2311. }
  2312. }
  2313. else if(strcmp(long_options[option_index].name,"seq-mode")==0)
  2314. {
  2315. sscanf(optarg,"%d",&seq_mode);
  2316. if(1<=seq_mode&&seq_mode<=10*1024)
  2317. {
  2318. }
  2319. else
  2320. {
  2321. mylog(log_fatal,"seq_mode value must be 0,1,or 2 \n");
  2322. myexit(-1);
  2323. }
  2324. }
  2325. else
  2326. {
  2327. mylog(log_warn,"ignored unknown long option ,option_index:%d code:<%x>\n",option_index, optopt);
  2328. }
  2329. break;
  2330. default:
  2331. mylog(log_warn,"ignored unknown option ,code:<%x>\n", optopt);
  2332. }
  2333. }
  2334. if (no_l)
  2335. mylog(log_fatal,"error: -l not found\n");
  2336. if (no_r)
  2337. mylog(log_fatal,"error: -r not found\n");
  2338. if(program_mode==0)
  2339. mylog(log_fatal,"error: -c /-s hasnt been set\n");
  2340. if (no_l || no_r||program_mode==0)
  2341. {
  2342. print_help();
  2343. myexit(-1);
  2344. }
  2345. mylog(log_info,"important variables: ", argc);
  2346. log_bare(log_info,"log_level=%d:%s ",log_level,log_text[log_level]);
  2347. log_bare(log_info,"raw_mode=%s ",raw_mode_tostring[raw_mode]);
  2348. log_bare(log_info,"cipher_mode=%s ",cipher_mode_tostring[cipher_mode]);
  2349. log_bare(log_info,"auth_mode=%s ",auth_mode_tostring[auth_mode]);
  2350. log_bare(log_info,"key=%s ",key_string);
  2351. log_bare(log_info,"local_ip=%s ",local_address);
  2352. log_bare(log_info,"local_port=%d ",local_port);
  2353. log_bare(log_info,"remote_ip=%s ",remote_address);
  2354. log_bare(log_info,"remote_port=%d ",remote_port);
  2355. log_bare(log_info,"source_ip=%s ",source_address);
  2356. log_bare(log_info,"source_port=%d ",source_port);
  2357. log_bare(log_info,"socket_buf_size=%d ",socket_buf_size);
  2358. log_bare(log_info,"\n");
  2359. }
  2360. void iptables_warn()
  2361. {
  2362. if(program_mode==client_mode)
  2363. {
  2364. if(raw_mode==mode_faketcp)
  2365. {
  2366. mylog(log_warn,"make sure you have run once: iptables -A INPUT -s %s/32 -p tcp -m tcp --sport %d -j DROP\n",remote_address,remote_port);
  2367. }
  2368. if(raw_mode==mode_udp)
  2369. {
  2370. mylog(log_warn,"make sure you have run once: iptables -A INPUT -s %s/32 -p udp -m udp --sport %d -j DROP\n",remote_address,remote_port);
  2371. }
  2372. if(raw_mode==mode_icmp)
  2373. {
  2374. mylog(log_warn,"make sure you have run once: iptables -A INPUT -s %s/32 -p icmp -j DROP\n",remote_address);
  2375. }
  2376. }
  2377. if(program_mode==server_mode)
  2378. {
  2379. if(raw_mode==mode_faketcp)
  2380. {
  2381. mylog(log_warn,"make sure you have run once: iptables -A INPUT -p tcp -m tcp --dport %d -j DROP\n",local_port);
  2382. }
  2383. if(raw_mode==mode_udp)
  2384. {
  2385. mylog(log_warn,"make sure you have run once: iptables -A INPUT -p udp -m udp --udp %d -j DROP\n",local_port);
  2386. }
  2387. if(raw_mode==mode_icmp)
  2388. {
  2389. if(local_address_uint32==0)
  2390. {
  2391. mylog(log_warn,"make sure you have run once: iptables -A INPUT -p icmp -j DROP\n");
  2392. }
  2393. else
  2394. {
  2395. mylog(log_warn,"make sure you have run once: iptables -A INPUT -d %s/32 -p icmp -j DROP\n",local_address);
  2396. }
  2397. }
  2398. }
  2399. }
  2400. int main(int argc, char *argv[])
  2401. {
  2402. //assert(0==1);
  2403. dup2(1, 2);//redirect stderr to stdout
  2404. signal(SIGINT, INThandler);
  2405. process_arg(argc,argv);
  2406. iptables_warn();
  2407. current_time_rough=get_current_time();
  2408. init_random_number_fd();
  2409. srand(get_true_random_number_nz());
  2410. const_id=get_true_random_number_nz();
  2411. mylog(log_info,"const_id:%x\n",const_id);
  2412. local_address_uint32=inet_addr(local_address);
  2413. remote_address_uint32=inet_addr(remote_address);
  2414. source_address_uint32=inet_addr(source_address);
  2415. char tmp[1000]="";
  2416. strcat(tmp,key_string);
  2417. strcat(tmp,"key1");
  2418. md5((uint8_t*)tmp,strlen(tmp),(uint8_t*)key);
  2419. tmp[0]=0;
  2420. strcat(tmp,key_string);
  2421. strcat(tmp,"key2");
  2422. md5((uint8_t*)tmp,strlen(tmp),(uint8_t*)key2);
  2423. if(program_mode==client_mode)
  2424. {
  2425. client_event_loop();
  2426. }
  2427. else
  2428. {
  2429. server_event_loop();
  2430. }
  2431. return 0;
  2432. }