main.cpp 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830
  1. #include "common.h"
  2. #include "network.h"
  3. #include "connection.h"
  4. #include "misc.h"
  5. #include "log.h"
  6. #include "lib/md5.h"
  7. #include "encrypt.h"
  8. #include "fd_manager.h"
  9. char hb_buf[buf_len];
  10. int on_epoll_recv_event=0; //TODO, just a flag to help detect epoll infinite shoot
  11. int client_on_timer(conn_info_t &conn_info) //for client. called when a timer is ready in epoll
  12. {
  13. packet_info_t &send_info=conn_info.raw_info.send_info;
  14. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  15. raw_info_t &raw_info=conn_info.raw_info;
  16. conn_info.blob->conv_manager.clear_inactive();
  17. mylog(log_trace,"timer!\n");
  18. mylog(log_trace,"roller my %d,oppsite %d,%lld\n",int(conn_info.my_roller),int(conn_info.oppsite_roller),conn_info.last_oppsite_roller_time);
  19. mylog(log_trace,"<client_on_timer,send_info.ts_ack= %u>\n",send_info.ts_ack);
  20. if(raw_info.disabled)
  21. {
  22. conn_info.state.client_current_state=client_idle;
  23. conn_info.my_id=get_true_random_number_nz();
  24. mylog(log_info,"state back to client_idle\n");
  25. }
  26. if(conn_info.state.client_current_state==client_idle)
  27. {
  28. raw_info.rst_received=0;
  29. raw_info.disabled=0;
  30. fail_time_counter++;
  31. if(max_fail_time>0&&fail_time_counter>max_fail_time)
  32. {
  33. mylog(log_fatal,"max_fail_time exceed\n");
  34. myexit(-1);
  35. }
  36. conn_info.blob->anti_replay.re_init();
  37. conn_info.my_id = get_true_random_number_nz(); ///todo no need to do this everytime
  38. u32_t new_ip=0;
  39. if(!force_source_ip&&get_src_adress(new_ip,remote_ip_uint32,remote_port)==0)
  40. {
  41. if(new_ip!=source_ip_uint32)
  42. {
  43. mylog(log_info,"source ip changed from %s to ",my_ntoa(source_ip_uint32));
  44. log_bare(log_info,"%s\n",my_ntoa(new_ip));
  45. source_ip_uint32=new_ip;
  46. send_info.src_ip=new_ip;
  47. }
  48. }
  49. if (source_port == 0)
  50. {
  51. send_info.src_port = client_bind_to_a_new_port(bind_fd,local_ip_uint32);
  52. }
  53. else
  54. {
  55. send_info.src_port = source_port;
  56. }
  57. if (raw_mode == mode_icmp)
  58. {
  59. send_info.dst_port = send_info.src_port;
  60. }
  61. mylog(log_info, "using port %d\n", send_info.src_port);
  62. init_filter(send_info.src_port);
  63. if(raw_mode==mode_icmp||raw_mode==mode_udp)
  64. {
  65. conn_info.state.client_current_state=client_handshake1;
  66. mylog(log_info,"state changed from client_idle to client_pre_handshake\n");
  67. }
  68. if(raw_mode==mode_faketcp)
  69. {
  70. conn_info.state.client_current_state=client_tcp_handshake;
  71. mylog(log_info,"state changed from client_idle to client_tcp_handshake\n");
  72. }
  73. conn_info.last_state_time=get_current_time();
  74. conn_info.last_hb_sent_time=0;
  75. //dont return;
  76. }
  77. if(conn_info.state.client_current_state==client_tcp_handshake) //send and resend syn
  78. {
  79. assert(raw_mode==mode_faketcp);
  80. if (get_current_time() - conn_info.last_state_time > client_handshake_timeout)
  81. {
  82. conn_info.state.client_current_state = client_idle;
  83. mylog(log_info, "state back to client_idle from client_tcp_handshake\n");
  84. return 0;
  85. }
  86. else if (get_current_time() - conn_info.last_hb_sent_time > client_retry_interval)
  87. {
  88. if (raw_mode == mode_faketcp)
  89. {
  90. if (conn_info.last_hb_sent_time == 0)
  91. {
  92. send_info.psh = 0;
  93. send_info.syn = 1;
  94. send_info.ack = 0;
  95. send_info.ts_ack =0;
  96. send_info.seq=get_true_random_number();
  97. send_info.ack_seq=get_true_random_number();
  98. }
  99. }
  100. send_raw0(raw_info, 0, 0);
  101. conn_info.last_hb_sent_time = get_current_time();
  102. mylog(log_info, "(re)sent tcp syn\n");
  103. return 0;
  104. }
  105. else
  106. {
  107. return 0;
  108. }
  109. return 0;
  110. }
  111. else if(conn_info.state.client_current_state==client_handshake1)//send and resend handshake1
  112. {
  113. if(get_current_time()-conn_info.last_state_time>client_handshake_timeout)
  114. {
  115. conn_info.state.client_current_state=client_idle;
  116. mylog(log_info,"state back to client_idle from client_handshake1\n");
  117. return 0;
  118. }
  119. else if(get_current_time()-conn_info.last_hb_sent_time>client_retry_interval)
  120. {
  121. if(raw_mode==mode_faketcp)
  122. {
  123. if(conn_info.last_hb_sent_time==0)
  124. {
  125. send_info.seq++;
  126. send_info.ack_seq=recv_info.seq+1;
  127. send_info.ts_ack=recv_info.ts;
  128. raw_info.reserved_send_seq=send_info.seq;
  129. }
  130. send_info.seq=raw_info.reserved_send_seq;
  131. send_info.psh = 0;
  132. send_info.syn = 0;
  133. send_info.ack = 1;
  134. send_raw0(raw_info, 0, 0);
  135. send_handshake(raw_info,conn_info.my_id,0,const_id);
  136. send_info.seq+=raw_info.send_info.data_len;
  137. }
  138. else
  139. {
  140. send_handshake(raw_info,conn_info.my_id,0,const_id);
  141. if(raw_mode==mode_icmp)
  142. send_info.my_icmp_seq++;
  143. }
  144. conn_info.last_hb_sent_time=get_current_time();
  145. mylog(log_info,"(re)sent handshake1\n");
  146. return 0;
  147. }
  148. else
  149. {
  150. return 0;
  151. }
  152. return 0;
  153. }
  154. else if(conn_info.state.client_current_state==client_handshake2)
  155. {
  156. if(get_current_time()-conn_info.last_state_time>client_handshake_timeout)
  157. {
  158. conn_info.state.client_current_state=client_idle;
  159. mylog(log_info,"state back to client_idle from client_handshake2\n");
  160. return 0;
  161. }
  162. else if(get_current_time()-conn_info.last_hb_sent_time>client_retry_interval)
  163. {
  164. if(raw_mode==mode_faketcp)
  165. {
  166. if(conn_info.last_hb_sent_time==0)
  167. {
  168. send_info.ack_seq=recv_info.seq+raw_info.recv_info.data_len;
  169. send_info.ts_ack=recv_info.ts;
  170. raw_info.reserved_send_seq=send_info.seq;
  171. }
  172. send_info.seq=raw_info.reserved_send_seq;
  173. send_handshake(raw_info,conn_info.my_id,conn_info.oppsite_id,const_id);
  174. send_info.seq+=raw_info.send_info.data_len;
  175. }
  176. else
  177. {
  178. send_handshake(raw_info,conn_info.my_id,conn_info.oppsite_id,const_id);
  179. if(raw_mode==mode_icmp)
  180. send_info.my_icmp_seq++;
  181. }
  182. conn_info.last_hb_sent_time=get_current_time();
  183. mylog(log_info,"(re)sent handshake2\n");
  184. return 0;
  185. }
  186. else
  187. {
  188. return 0;
  189. }
  190. return 0;
  191. }
  192. else if(conn_info.state.client_current_state==client_ready)
  193. {
  194. fail_time_counter=0;
  195. mylog(log_trace,"time %llu,%llu\n",get_current_time(),conn_info.last_state_time);
  196. if(get_current_time()-conn_info.last_hb_recv_time>client_conn_timeout)
  197. {
  198. conn_info.state.client_current_state=client_idle;
  199. conn_info.my_id=get_true_random_number_nz();
  200. mylog(log_info,"state back to client_idle from client_ready bc of server-->client direction timeout\n");
  201. return 0;
  202. }
  203. if(get_current_time()- conn_info.last_oppsite_roller_time>client_conn_uplink_timeout)
  204. {
  205. conn_info.state.client_current_state=client_idle;
  206. conn_info.my_id=get_true_random_number_nz();
  207. mylog(log_info,"state back to client_idle from client_ready bc of client-->server direction timeout\n");
  208. }
  209. if(get_current_time()-conn_info.last_hb_sent_time<heartbeat_interval)
  210. {
  211. return 0;
  212. }
  213. mylog(log_debug,"heartbeat sent <%x,%x>\n",conn_info.oppsite_id,conn_info.my_id);
  214. if(hb_mode==0)
  215. send_safer(conn_info,'h',hb_buf,0);/////////////send
  216. else
  217. send_safer(conn_info,'h',hb_buf,hb_len);
  218. conn_info.last_hb_sent_time=get_current_time();
  219. return 0;
  220. }
  221. else
  222. {
  223. mylog(log_fatal,"unknown state,this shouldnt happen.\n");
  224. myexit(-1);
  225. }
  226. return 0;
  227. }
  228. int client_on_raw_recv(conn_info_t &conn_info) //called when raw fd received a packet.
  229. {
  230. char* data;int data_len;
  231. packet_info_t &send_info=conn_info.raw_info.send_info;
  232. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  233. raw_info_t &raw_info=conn_info.raw_info;
  234. mylog(log_trace,"<client_on_raw_recv,send_info.ts_ack= %u>\n",send_info.ts_ack);
  235. if(conn_info.state.client_current_state==client_idle )
  236. {
  237. recv(raw_recv_fd, 0,0, 0 );
  238. }
  239. else if(conn_info.state.client_current_state==client_tcp_handshake)//received syn ack
  240. {
  241. assert(raw_mode==mode_faketcp);
  242. if(recv_raw0(raw_info,data,data_len)<0)
  243. {
  244. return -1;
  245. }
  246. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  247. {
  248. 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);
  249. return -1;
  250. }
  251. if(data_len==0&&raw_info.recv_info.syn==1&&raw_info.recv_info.ack==1)
  252. {
  253. if(recv_info.ack_seq!=send_info.seq+1)
  254. {
  255. mylog(log_debug,"seq ack_seq mis match\n");
  256. return -1;
  257. }
  258. conn_info.state.client_current_state = client_handshake1;
  259. mylog(log_info,"state changed from client_tcp_handshake to client_handshake1\n");
  260. conn_info.last_state_time = get_current_time();
  261. conn_info.last_hb_sent_time=0;
  262. client_on_timer(conn_info);
  263. return 0;
  264. }
  265. else
  266. {
  267. mylog(log_debug,"unexpected packet type,expected:syn ack\n");
  268. return -1;
  269. }
  270. }
  271. else if(conn_info.state.client_current_state==client_handshake1)//recevied respond of handshake1
  272. {
  273. if(recv_bare(raw_info,data,data_len)!=0)
  274. {
  275. mylog(log_debug,"recv_bare failed!\n");
  276. return -1;
  277. }
  278. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  279. {
  280. 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);
  281. return -1;
  282. }
  283. if(data_len<int( 3*sizeof(id_t)))
  284. {
  285. mylog(log_debug,"too short to be a handshake\n");
  286. return -1;
  287. }
  288. id_t tmp_oppsite_id;
  289. memcpy(&tmp_oppsite_id,&data[0],sizeof(tmp_oppsite_id));
  290. tmp_oppsite_id=ntohl(tmp_oppsite_id);
  291. id_t tmp_my_id;
  292. memcpy(&tmp_my_id,&data[sizeof(id_t)],sizeof(tmp_my_id));
  293. tmp_my_id=ntohl(tmp_my_id);
  294. id_t tmp_oppsite_const_id;
  295. memcpy(&tmp_oppsite_const_id,&data[sizeof(id_t)*2],sizeof(tmp_oppsite_const_id));
  296. tmp_oppsite_const_id=ntohl(tmp_oppsite_const_id);
  297. if(tmp_my_id!=conn_info.my_id)
  298. {
  299. mylog(log_debug,"tmp_my_id doesnt match\n");
  300. return -1;
  301. }
  302. if(raw_mode==mode_faketcp)
  303. {
  304. if(recv_info.ack_seq!=send_info.seq)
  305. {
  306. mylog(log_debug,"seq ack_seq mis match\n");
  307. return -1;
  308. }
  309. if(recv_info.seq!=send_info.ack_seq)
  310. {
  311. mylog(log_debug,"seq ack_seq mis match\n");
  312. return -1;
  313. }
  314. }
  315. conn_info.oppsite_id=tmp_oppsite_id;
  316. mylog(log_info,"changed state from to client_handshake1 to client_handshake2,my_id is %x,oppsite id is %x\n",conn_info.my_id,conn_info.oppsite_id);
  317. conn_info.state.client_current_state = client_handshake2;
  318. conn_info.last_state_time = get_current_time();
  319. conn_info.last_hb_sent_time=0;
  320. client_on_timer(conn_info);
  321. return 0;
  322. }
  323. else if(conn_info.state.client_current_state==client_handshake2||conn_info.state.client_current_state==client_ready)//received heartbeat or data
  324. {
  325. char type;
  326. if(recv_safer(conn_info,type,data,data_len)!=0)
  327. {
  328. mylog(log_debug,"recv_safer failed!\n");
  329. return -1;
  330. }
  331. if(recv_info.src_ip!=send_info.dst_ip||recv_info.src_port!=send_info.dst_port)
  332. {
  333. mylog(log_warn,"unexpected adress %x %x %d %d,this shouldnt happen.\n",recv_info.src_ip,send_info.dst_ip,recv_info.src_port,send_info.dst_port);
  334. return -1;
  335. }
  336. if(conn_info.state.client_current_state==client_handshake2)
  337. {
  338. mylog(log_info,"changed state from to client_handshake2 to client_ready\n");
  339. conn_info.state.client_current_state=client_ready;
  340. conn_info.last_hb_sent_time=0;
  341. conn_info.last_hb_recv_time=get_current_time();
  342. conn_info.last_oppsite_roller_time=conn_info.last_hb_recv_time;
  343. client_on_timer(conn_info);
  344. }
  345. if(data_len>=0&&type=='h')
  346. {
  347. mylog(log_debug,"[hb]heart beat received,oppsite_roller=%d\n",int(conn_info.oppsite_roller));
  348. conn_info.last_hb_recv_time=get_current_time();
  349. return 0;
  350. }
  351. else if(data_len>= int( sizeof(u32_t))&&type=='d')
  352. {
  353. mylog(log_trace,"received a data from fake tcp,len:%d\n",data_len);
  354. if(hb_mode==0)
  355. conn_info.last_hb_recv_time=get_current_time();
  356. u32_t tmp_conv_id;
  357. memcpy(&tmp_conv_id,&data[0],sizeof(tmp_conv_id));
  358. tmp_conv_id=ntohl(tmp_conv_id);
  359. if(!conn_info.blob->conv_manager.is_conv_used(tmp_conv_id))
  360. {
  361. mylog(log_info,"unknow conv %d,ignore\n",tmp_conv_id);
  362. return 0;
  363. }
  364. conn_info.blob->conv_manager.update_active_time(tmp_conv_id);
  365. u64_t u64=conn_info.blob->conv_manager.find_u64_by_conv(tmp_conv_id);
  366. sockaddr_in tmp_sockaddr={0};
  367. tmp_sockaddr.sin_family = AF_INET;
  368. tmp_sockaddr.sin_addr.s_addr=(u64>>32u);
  369. tmp_sockaddr.sin_port= htons(uint16_t((u64<<32u)>>32u));
  370. int ret=sendto(udp_fd,data+sizeof(u32_t),data_len -(sizeof(u32_t)),0,(struct sockaddr *)&tmp_sockaddr,sizeof(tmp_sockaddr));
  371. if(ret<0)
  372. {
  373. mylog(log_warn,"sento returned %d\n",ret);
  374. }
  375. mylog(log_trace,"%s :%d\n",inet_ntoa(tmp_sockaddr.sin_addr),ntohs(tmp_sockaddr.sin_port));
  376. mylog(log_trace,"%d byte sent\n",ret);
  377. }
  378. else
  379. {
  380. mylog(log_warn,"unknown packet,this shouldnt happen.\n");
  381. return -1;
  382. }
  383. return 0;
  384. }
  385. else
  386. {
  387. mylog(log_fatal,"unknown state,this shouldnt happen.\n");
  388. myexit(-1);
  389. }
  390. return 0;
  391. }
  392. void udp_accept_cb(struct ev_loop *loop, struct ev_io *watcher, int revents)
  393. {
  394. char buf[buf_len];
  395. conn_info_t & conn_info= *((conn_info_t*)watcher->data);;
  396. int recv_len;
  397. struct sockaddr_in udp_new_addr_in={0};
  398. socklen_t udp_new_addr_len = sizeof(sockaddr_in);
  399. if ((recv_len = recvfrom(udp_fd, buf, max_data_len+1, 0,
  400. (struct sockaddr *) &udp_new_addr_in, &udp_new_addr_len)) == -1) {
  401. mylog(log_error,"recv_from error,this shouldnt happen at client\n");
  402. myexit(1);
  403. };
  404. if(recv_len==max_data_len+1)
  405. {
  406. mylog(log_warn,"huge packet, data_len > %d,dropped\n",max_data_len);
  407. return;
  408. }
  409. if(recv_len>=mtu_warn)
  410. {
  411. mylog(log_warn,"huge packet,data len=%d (>=%d).strongly suggested to set a smaller mtu at upper level,to get rid of this warn\n ",recv_len,mtu_warn);
  412. }
  413. mylog(log_trace,"Received packet from %s:%d,len: %d\n", inet_ntoa(udp_new_addr_in.sin_addr),
  414. ntohs(udp_new_addr_in.sin_port),recv_len);
  415. u64_t u64=((u64_t(udp_new_addr_in.sin_addr.s_addr))<<32u)+ntohs(udp_new_addr_in.sin_port);
  416. u32_t conv;
  417. if(!conn_info.blob->conv_manager.is_u64_used(u64))
  418. {
  419. if(conn_info.blob->conv_manager.get_size() >=max_conv_num)
  420. {
  421. mylog(log_warn,"ignored new udp connect bc max_conv_num exceed\n");
  422. return;
  423. }
  424. conv=conn_info.blob->conv_manager.get_new_conv();
  425. conn_info.blob->conv_manager.insert_conv(conv,u64);
  426. mylog(log_info,"new packet from %s:%d,conv_id=%x\n",inet_ntoa(udp_new_addr_in.sin_addr),ntohs(udp_new_addr_in.sin_port),conv);
  427. }
  428. else
  429. {
  430. conv=conn_info.blob->conv_manager.find_conv_by_u64(u64);
  431. }
  432. conn_info.blob->conv_manager.update_active_time(conv);
  433. if(conn_info.state.client_current_state==client_ready)
  434. {
  435. send_data_safer(conn_info,buf,recv_len,conv);
  436. }
  437. }
  438. void raw_recv_cb(struct ev_loop *loop, struct ev_io *watcher, int revents)
  439. {
  440. conn_info_t & conn_info= *((conn_info_t*)watcher->data);
  441. client_on_raw_recv(conn_info);
  442. }
  443. void clear_timer_cb(struct ev_loop *loop, struct ev_timer *watcher, int revents)
  444. {
  445. conn_info_t & conn_info= *((conn_info_t*)watcher->data);
  446. //u64_t value;
  447. //read(timer_fd, &value, 8);
  448. client_on_timer(conn_info);
  449. mylog(log_trace,"epoll_trigger_counter: %d \n",epoll_trigger_counter);
  450. epoll_trigger_counter=0;
  451. }
  452. void fifo_cb(struct ev_loop *loop, struct ev_io *watcher, int revents)
  453. {
  454. conn_info_t & conn_info= *((conn_info_t*)watcher->data);
  455. char buf[buf_len];
  456. int fifo_fd=watcher->fd;
  457. int len=read (fifo_fd, buf, sizeof (buf));
  458. if(len<0)
  459. {
  460. mylog(log_warn,"fifo read failed len=%d,errno=%s\n",len,strerror(errno));
  461. return;
  462. }
  463. buf[len]=0;
  464. while(len>=1&&buf[len-1]=='\n')
  465. buf[len-1]=0;
  466. mylog(log_info,"got data from fifo,len=%d,s=[%s]\n",len,buf);
  467. if(strcmp(buf,"reconnect")==0)
  468. {
  469. mylog(log_info,"received command: reconnect\n");
  470. conn_info.state.client_current_state=client_idle;
  471. conn_info.my_id=get_true_random_number_nz();
  472. }
  473. else
  474. {
  475. mylog(log_info,"unknown command\n");
  476. }
  477. }
  478. int client_event_loop()
  479. {
  480. char buf[buf_len];
  481. conn_info_t conn_info;
  482. conn_info.my_id=get_true_random_number_nz();
  483. conn_info.prepare();
  484. packet_info_t &send_info=conn_info.raw_info.send_info;
  485. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  486. if(source_ip_uint32==0)
  487. {
  488. mylog(log_info,"get_src_adress called\n");
  489. if(retry_on_error==0)
  490. {
  491. if(get_src_adress(source_ip_uint32,remote_ip_uint32,remote_port)!=0)
  492. {
  493. mylog(log_fatal,"the trick to auto get source ip failed, maybe you dont have internet access\n");
  494. myexit(-1);
  495. }
  496. }
  497. else
  498. {
  499. int ok=0;
  500. while(!ok)
  501. {
  502. if(get_src_adress(source_ip_uint32,remote_ip_uint32,remote_port)!=0)
  503. {
  504. mylog(log_warn,"the trick to auto get source ip failed, maybe you dont have internet access, retry in %d seconds\n",retry_on_error_interval);
  505. sleep(retry_on_error_interval);
  506. }
  507. else
  508. {
  509. ok=1;
  510. }
  511. }
  512. }
  513. }
  514. in_addr tmp;
  515. tmp.s_addr=source_ip_uint32;
  516. mylog(log_info,"source ip = %s\n",inet_ntoa(tmp));
  517. //printf("done\n");
  518. if(try_to_list_and_bind(bind_fd,local_ip_uint32,source_port)!=0)
  519. {
  520. mylog(log_fatal,"bind to source_port:%d fail\n ",source_port);
  521. myexit(-1);
  522. }
  523. send_info.src_port=source_port;
  524. send_info.src_ip = source_ip_uint32;
  525. int i, j, k;int ret;
  526. send_info.dst_ip=remote_ip_uint32;
  527. send_info.dst_port=remote_port;
  528. udp_fd=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
  529. set_buf_size(udp_fd,socket_buf_size,force_socket_buf);
  530. int yes = 1;
  531. struct sockaddr_in local_me={0};
  532. socklen_t slen = sizeof(sockaddr_in);
  533. local_me.sin_family = AF_INET;
  534. local_me.sin_port = htons(local_port);
  535. local_me.sin_addr.s_addr = local_ip_uint32;
  536. if (bind(udp_fd, (struct sockaddr*) &local_me, slen) == -1) {
  537. mylog(log_fatal,"socket bind error\n");
  538. myexit(1);
  539. }
  540. setnonblocking(udp_fd);
  541. //epollfd = epoll_create1(0);
  542. //const int max_events = 4096;
  543. //struct epoll_event ev, events[max_events];
  544. //if (epollfd < 0) {
  545. // mylog(log_fatal,"epoll return %d\n", epollfd);
  546. // myexit(-1);
  547. //}
  548. struct ev_loop * loop= ev_default_loop(0);
  549. assert(loop != NULL);
  550. //ev.events = EPOLLIN;
  551. //ev.data.u64 = udp_fd;
  552. //ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, udp_fd, &ev);
  553. //if (ret!=0) {
  554. // mylog(log_fatal,"add udp_listen_fd error\n");
  555. // myexit(-1);
  556. //}
  557. struct ev_io udp_accept_watcher;
  558. udp_accept_watcher.data=&conn_info;
  559. ev_io_init(&udp_accept_watcher, udp_accept_cb, udp_fd, EV_READ);
  560. ev_io_start(loop, &udp_accept_watcher);
  561. //ev.events = EPOLLIN;
  562. //ev.data.u64 = raw_recv_fd;
  563. //ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, raw_recv_fd, &ev);
  564. //if (ret!= 0) {
  565. // mylog(log_fatal,"add raw_fd error\n");
  566. // myexit(-1);
  567. //}
  568. struct ev_io raw_watcher;
  569. raw_watcher.data=&conn_info;
  570. ev_io_init(&raw_watcher, raw_recv_cb, raw_recv_fd, EV_READ);
  571. ev_io_start(loop, &raw_watcher);
  572. int unbind=1;
  573. //set_timer(epollfd,timer_fd);
  574. struct ev_timer clear_timer;
  575. clear_timer.data=&conn_info;
  576. ev_timer_init(&clear_timer, clear_timer_cb, 0, timer_interval/1000.0);
  577. ev_timer_start(loop, &clear_timer);
  578. 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);
  579. int fifo_fd=-1;
  580. struct ev_io fifo_watcher;
  581. fifo_watcher.data=&conn_info;
  582. if(fifo_file[0]!=0)
  583. {
  584. fifo_fd=create_fifo(fifo_file);
  585. //ev.events = EPOLLIN;
  586. //ev.data.u64 = fifo_fd;
  587. //ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, fifo_fd, &ev);
  588. //if (ret!= 0) {
  589. // mylog(log_fatal,"add fifo_fd to epoll error %s\n",strerror(errno));
  590. // myexit(-1);
  591. //}
  592. ev_io_init(&fifo_watcher, fifo_cb, fifo_fd, EV_READ);
  593. ev_io_start(loop, &fifo_watcher);
  594. mylog(log_info,"fifo_file=%s\n",fifo_file);
  595. }
  596. ev_run(loop, 0);
  597. /*
  598. while(1)////////////////////////
  599. {
  600. if(about_to_exit) myexit(0);
  601. epoll_trigger_counter++;
  602. int nfds = epoll_wait(epollfd, events, max_events, 180 * 1000);
  603. if (nfds < 0) { //allow zero
  604. if(errno==EINTR )
  605. {
  606. mylog(log_info,"epoll interrupted by signal,continue\n");
  607. }
  608. else
  609. {
  610. mylog(log_fatal,"epoll_wait return %d,%s\n", nfds,strerror(errno));
  611. myexit(-1);
  612. }
  613. }
  614. int idx;
  615. for (idx = 0; idx < nfds; ++idx) {
  616. if (events[idx].data.u64 == (u64_t)raw_recv_fd)
  617. {
  618. iphdr *iph;tcphdr *tcph;
  619. }
  620. else if(events[idx].data.u64 ==(u64_t)timer_fd)
  621. {
  622. }
  623. else if (events[idx].data.u64 == (u64_t)fifo_fd)
  624. {
  625. }
  626. else if (events[idx].data.u64 == (u64_t)udp_fd)
  627. {
  628. }
  629. else
  630. {
  631. mylog(log_fatal,"unknown fd,this should never happen\n");
  632. myexit(-1);
  633. }
  634. }
  635. }*/
  636. return 0;
  637. }
  638. int main(int argc, char *argv[])
  639. {
  640. libnet_t *l; /* the libnet context */
  641. char errbuf[LIBNET_ERRBUF_SIZE];
  642. l = libnet_init(LIBNET_RAW4, NULL, errbuf);
  643. dup2(1, 2);//redirect stderr to stdout
  644. signal(SIGINT, signal_handler);
  645. signal(SIGHUP, signal_handler);
  646. signal(SIGKILL, signal_handler);
  647. signal(SIGTERM, signal_handler);
  648. signal(SIGQUIT, signal_handler);
  649. pre_process_arg(argc,argv);
  650. if(geteuid() != 0)
  651. {
  652. mylog(log_warn,"root check failed, it seems like you are using a non-root account. we can try to continue, but it may fail. If you want to run udp2raw as non-root, you have to add iptables rule manually, and grant udp2raw CAP_NET_RAW capability, check README.md in repo for more info.\n");
  653. }
  654. else
  655. {
  656. mylog(log_warn,"you can run udp2raw with non-root account for better security. check README.md in repo for more info.\n");
  657. }
  658. local_ip_uint32=inet_addr(local_ip);
  659. source_ip_uint32=inet_addr(source_ip);
  660. mylog(log_info,"remote_ip=[%s], make sure this is a vaild IP address\n",remote_ip);
  661. strcpy(remote_ip,remote_address);
  662. remote_ip_uint32=inet_addr(remote_ip);
  663. init_random_number_fd();
  664. srand(get_true_random_number_nz());
  665. const_id=get_true_random_number_nz();
  666. mylog(log_info,"const_id:%x\n",const_id);
  667. char tmp[1000]="";
  668. strcat(tmp,key_string);
  669. strcat(tmp,"key1");
  670. md5((uint8_t*)tmp,strlen(tmp),(uint8_t*)key);
  671. iptables_rule();
  672. init_raw_socket();
  673. if(program_mode==client_mode)
  674. {
  675. client_event_loop();
  676. }
  677. else
  678. {
  679. mylog(log_fatal,"server mode not supported in portable version\n");
  680. myexit(-1);
  681. //server_event_loop();
  682. }
  683. return 0;
  684. }