server.cpp 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913
  1. /*
  2. * server.cpp
  3. *
  4. * Created on: Aug 29, 2018
  5. * Author: root
  6. */
  7. #include "common.h"
  8. #include "network.h"
  9. #include "connection.h"
  10. #include "misc.h"
  11. #include "log.h"
  12. #include "lib/md5.h"
  13. #include "encrypt.h"
  14. #include "fd_manager.h"
  15. int server_on_timer_multi(conn_info_t &conn_info) //for server. called when a timer is ready in epoll.for server,there will be one timer for every connection
  16. // there is also a global timer for server,but its not handled here
  17. {
  18. char ip_port[40];
  19. //u32_t ip=conn_info.raw_info.send_info.dst_ip;
  20. //u32_t port=conn_info.raw_info.send_info.dst_port;
  21. address_t tmp_addr;
  22. tmp_addr.from_ip_port_new(raw_ip_version,&conn_info.raw_info.send_info.new_dst_ip,conn_info.raw_info.send_info.dst_port);
  23. //sprintf(ip_port,"%s:%d",my_ntoa(ip),port);
  24. tmp_addr.to_str(ip_port);
  25. //keep_iptables_rule();
  26. mylog(log_trace,"server timer!\n");
  27. raw_info_t &raw_info=conn_info.raw_info;
  28. assert(conn_info.state.server_current_state==server_ready);
  29. if(conn_info.state.server_current_state==server_ready)
  30. {
  31. conn_info.blob->conv_manager.s.clear_inactive(ip_port);
  32. /*
  33. if( get_current_time()-conn_info.last_hb_recv_time>heartbeat_timeout )
  34. {
  35. mylog(log_trace,"%lld %lld\n",get_current_time(),conn_info.last_state_time);
  36. conn_info.server_current_state=server_nothing;
  37. //conn_manager.current_ready_ip=0;
  38. //conn_manager.current_ready_port=0;
  39. mylog(log_info,"changed state to server_nothing\n");
  40. return 0;
  41. }*/ //dont need to do this at server,conn_manger will clear expired connections
  42. if(get_current_time()-conn_info.last_hb_sent_time<heartbeat_interval)
  43. {
  44. return 0;
  45. }
  46. if(hb_mode==0)
  47. send_safer(conn_info,'h',hb_buf,0); /////////////send
  48. else
  49. send_safer(conn_info,'h',hb_buf,hb_len);
  50. conn_info.last_hb_sent_time=get_current_time();
  51. mylog(log_debug,"heart beat sent<%x,%x>\n",conn_info.my_id,conn_info.oppsite_id);
  52. }
  53. else
  54. {
  55. mylog(log_fatal,"this shouldnt happen!\n");
  56. myexit(-1);
  57. }
  58. return 0;
  59. }
  60. int server_on_raw_recv_ready(conn_info_t &conn_info,char * ip_port,char type,char *data,int data_len) //called while the state for a connection is server_ready
  61. //receives data and heart beat by recv_safer.
  62. {
  63. raw_info_t &raw_info = conn_info.raw_info;
  64. packet_info_t &send_info = conn_info.raw_info.send_info;
  65. packet_info_t &recv_info = conn_info.raw_info.recv_info;
  66. //char ip_port[40];
  67. //sprintf(ip_port,"%s:%d",my_ntoa(recv_info.src_ip),recv_info.src_port);
  68. /*
  69. if (recv_info.src_ip != send_info.dst_ip
  70. || recv_info.src_port != send_info.dst_port) {
  71. mylog(log_debug, "unexpected adress\n");
  72. return 0;
  73. }*/
  74. if (type == 'h' && data_len >= 0) {
  75. //u32_t tmp = ntohl(*((u32_t *) &data[sizeof(u32_t)]));
  76. mylog(log_debug,"[%s][hb]received hb \n",ip_port);
  77. conn_info.last_hb_recv_time = get_current_time();
  78. return 0;
  79. } else if (type== 'd' && data_len >=int( sizeof(u32_t) ))
  80. {
  81. //u32_t tmp_conv_id = ntohl(*((u32_t *) &data[0]));
  82. my_id_t tmp_conv_id;
  83. memcpy(&tmp_conv_id,&data[0],sizeof(tmp_conv_id));
  84. tmp_conv_id=ntohl(tmp_conv_id);
  85. if(hb_mode==0)
  86. conn_info.last_hb_recv_time = get_current_time();
  87. mylog(log_trace, "conv:%u\n", tmp_conv_id);
  88. if (!conn_info.blob->conv_manager.s.is_conv_used(tmp_conv_id)) {
  89. if (conn_info.blob->conv_manager.s.get_size() >= max_conv_num) {
  90. mylog(log_warn,
  91. "[%s]ignored new conv %x connect bc max_conv_num exceed\n",ip_port,
  92. tmp_conv_id);
  93. return 0;
  94. }
  95. /*
  96. struct sockaddr_in remote_addr_in={0};
  97. socklen_t slen = sizeof(sockaddr_in);
  98. //memset(&remote_addr_in, 0, sizeof(remote_addr_in));
  99. remote_addr_in.sin_family = AF_INET;
  100. remote_addr_in.sin_port = htons(remote_port);
  101. remote_addr_in.sin_addr.s_addr = remote_ip_uint32;
  102. int new_udp_fd = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
  103. if (new_udp_fd < 0) {
  104. mylog(log_warn, "[%s]create udp_fd error\n",ip_port);
  105. return -1;
  106. }
  107. setnonblocking(new_udp_fd);
  108. set_buf_size(new_udp_fd,socket_buf_size);
  109. mylog(log_debug, "[%s]created new udp_fd %d\n",ip_port, new_udp_fd);
  110. int ret = connect(new_udp_fd, (struct sockaddr *) &remote_addr_in,
  111. slen);
  112. if (ret != 0) {
  113. mylog(log_warn, "udp fd connect fail\n");
  114. close(new_udp_fd);
  115. return -1;
  116. }*/
  117. int new_udp_fd=remote_addr.new_connected_udp_fd();
  118. if (new_udp_fd < 0) {
  119. mylog(log_warn, "[%s]new_connected_udp_fd() failed\n",ip_port);
  120. return -1;
  121. }
  122. struct epoll_event ev;
  123. fd64_t new_udp_fd64 = fd_manager.create(new_udp_fd);
  124. fd_manager.get_info(new_udp_fd64).p_conn_info=&conn_info;
  125. mylog(log_trace, "[%s]u64: %lld\n",ip_port, new_udp_fd64);
  126. ev.events = EPOLLIN;
  127. ev.data.u64 = new_udp_fd64;
  128. int ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, new_udp_fd, &ev);
  129. if (ret != 0) {
  130. mylog(log_warn, "[%s]add udp_fd error\n",ip_port);
  131. close(new_udp_fd);
  132. return -1;
  133. }
  134. conn_info.blob->conv_manager.s.insert_conv(tmp_conv_id, new_udp_fd64);
  135. //assert(conn_manager.udp_fd_mp.find(new_udp_fd)==conn_manager.udp_fd_mp.end());
  136. //conn_manager.udp_fd_mp[new_udp_fd] = &conn_info;
  137. //pack_u64(conn_info.raw_info.recv_info.src_ip,conn_info.raw_info.recv_info.src_port);
  138. mylog(log_info, "[%s]new conv conv_id=%x, assigned fd=%d\n",ip_port,
  139. tmp_conv_id, new_udp_fd);
  140. }
  141. fd64_t fd64 = conn_info.blob->conv_manager.s.find_data_by_conv(tmp_conv_id);
  142. conn_info.blob->conv_manager.s.update_active_time(tmp_conv_id);
  143. int fd = fd_manager.to_fd(fd64);
  144. mylog(log_trace, "[%s]received a data from fake tcp,len:%d\n",ip_port, data_len);
  145. int ret = send(fd, data + sizeof(u32_t),
  146. data_len - ( sizeof(u32_t)), 0);
  147. mylog(log_trace, "[%s]%d byte sent ,fd :%d\n ",ip_port, ret, fd);
  148. if (ret < 0) {
  149. mylog(log_warn, "send returned %d\n", ret);
  150. //perror("what happened????");
  151. }
  152. return 0;
  153. }
  154. return 0;
  155. }
  156. int server_on_raw_recv_pre_ready(conn_info_t &conn_info,char * ip_port,u32_t tmp_oppsite_const_id)// do prepare work before state change to server ready for a specifc connection
  157. //connection recovery is also handle here
  158. {
  159. //u32_t ip;uint16_t port;
  160. //ip=conn_info.raw_info.recv_info.src_ip;
  161. //port=conn_info.raw_info.recv_info.src_port;
  162. //char ip_port[40];
  163. //sprintf(ip_port,"%s:%d",my_ntoa(ip),port);
  164. mylog(log_info,"[%s]received handshake oppsite_id:%x my_id:%x\n",ip_port,conn_info.oppsite_id,conn_info.my_id);
  165. mylog(log_info,"[%s]oppsite const_id:%x \n",ip_port,tmp_oppsite_const_id);
  166. if(conn_manager.const_id_mp.find(tmp_oppsite_const_id)==conn_manager.const_id_mp.end())
  167. {
  168. //conn_manager.const_id_mp=
  169. if(conn_manager.ready_num>=max_ready_conn_num)
  170. {
  171. mylog(log_info,"[%s]max_ready_conn_num,cant turn to ready\n",ip_port);
  172. conn_info.state.server_current_state =server_idle;
  173. return 0;
  174. }
  175. conn_info.prepare();
  176. conn_info.state.server_current_state = server_ready;
  177. conn_info.oppsite_const_id=tmp_oppsite_const_id;
  178. conn_manager.ready_num++;
  179. conn_manager.const_id_mp[tmp_oppsite_const_id]=&conn_info;
  180. //conn_info.last_state_time=get_current_time(); //dont change this!!!!!!!!!!!!!!!!!!!!!!!!!
  181. //conn_manager.current_ready_ip=ip;
  182. //conn_manager.current_ready_port=port;
  183. //my_id=conn_info.my_id;
  184. //oppsite_id=conn_info.oppsite_id;
  185. conn_info.last_hb_recv_time = get_current_time();
  186. conn_info.last_hb_sent_time = conn_info.last_hb_recv_time;//=get_current_time()
  187. if(hb_mode==0)
  188. send_safer(conn_info,'h',hb_buf,0);/////////////send
  189. else
  190. send_safer(conn_info,'h',hb_buf,hb_len);
  191. mylog(log_info, "[%s]changed state to server_ready\n",ip_port);
  192. conn_info.blob->anti_replay.re_init();
  193. //g_conn_info=conn_info;
  194. int new_timer_fd;
  195. set_timer_server(epollfd, new_timer_fd,conn_info.timer_fd64);
  196. fd_manager.get_info(conn_info.timer_fd64).p_conn_info=&conn_info;
  197. //assert(conn_manager.timer_fd_mp.find(new_timer_fd)==conn_manager.timer_fd_mp.end());
  198. //conn_manager.timer_fd_mp[new_timer_fd] = &conn_info;//pack_u64(ip,port);
  199. //timer_fd_mp[new_timer_fd]
  200. /*
  201. if(oppsite_const_id!=0&&tmp_oppsite_const_id!=oppsite_const_id) //TODO MOVE TO READY
  202. {
  203. mylog(log_info,"cleared all conv bc of const id doesnt match\n");
  204. conv_manager.clear();
  205. }*/
  206. //oppsite_const_id=tmp_oppsite_const_id;
  207. }
  208. else
  209. {
  210. conn_info_t &ori_conn_info=*conn_manager.const_id_mp[tmp_oppsite_const_id];
  211. if(ori_conn_info.state.server_current_state==server_ready)
  212. {
  213. if(conn_info.last_state_time<ori_conn_info.last_state_time)
  214. {
  215. mylog(log_info,"[%s]conn_info.last_state_time<ori_conn_info.last_state_time. ignored new handshake\n",ip_port);
  216. conn_info.state.server_current_state=server_idle;
  217. conn_info.oppsite_const_id=0;
  218. return 0;
  219. }
  220. address_t addr1;addr1.from_ip_port_new(raw_ip_version,&ori_conn_info.raw_info.recv_info.new_src_ip,ori_conn_info.raw_info.recv_info.src_port);
  221. if(!conn_manager.exist(addr1))//TODO remove this
  222. {
  223. mylog(log_fatal,"[%s]this shouldnt happen\n",ip_port);
  224. myexit(-1);
  225. }
  226. address_t addr2;addr2.from_ip_port_new(raw_ip_version,&conn_info.raw_info.recv_info.new_src_ip,conn_info.raw_info.recv_info.src_port);
  227. if(!conn_manager.exist(addr2))//TODO remove this
  228. {
  229. mylog(log_fatal,"[%s]this shouldnt happen2\n",ip_port);
  230. myexit(-1);
  231. }
  232. conn_info_t *&p_ori=conn_manager.find_insert_p(addr1);
  233. conn_info_t *&p=conn_manager.find_insert_p(addr2);
  234. conn_info_t *tmp=p;
  235. p=p_ori;
  236. p_ori=tmp;
  237. mylog(log_info,"[%s]grabbed a connection\n",ip_port);
  238. //ori_conn_info.state.server_current_state=server_ready;
  239. ori_conn_info.recover(conn_info);
  240. //send_safer(ori_conn_info, 'h',hb_buf, hb_len);
  241. //ori_conn_info.blob->anti_replay.re_init();
  242. if(hb_mode==0)
  243. send_safer(ori_conn_info,'h',hb_buf,0);/////////////send
  244. else
  245. send_safer(ori_conn_info,'h',hb_buf,hb_len);
  246. ori_conn_info.last_hb_recv_time=get_current_time();
  247. conn_info.state.server_current_state=server_idle;
  248. conn_info.oppsite_const_id=0;
  249. }
  250. else
  251. {
  252. mylog(log_fatal,"[%s]this should never happen\n",ip_port);
  253. myexit(-1);
  254. }
  255. return 0;
  256. }
  257. return 0;
  258. }
  259. int server_on_raw_recv_handshake1(conn_info_t &conn_info,char * ip_port,char * data, int data_len)//called when server received a handshake1 packet from client
  260. {
  261. packet_info_t &send_info=conn_info.raw_info.send_info;
  262. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  263. raw_info_t &raw_info=conn_info.raw_info;
  264. //u32_t ip=conn_info.raw_info.recv_info.src_ip;
  265. //uint16_t port=conn_info.raw_info.recv_info.src_port;
  266. //char ip_port[40];
  267. //sprintf(ip_port,"%s:%d",my_ntoa(ip),port);
  268. if(data_len<int( 3*sizeof(my_id_t)))
  269. {
  270. mylog(log_debug,"[%s] data_len=%d too short to be a handshake\n",ip_port,data_len);
  271. return -1;
  272. }
  273. //id_t tmp_oppsite_id= ntohl(* ((u32_t *)&data[0]));
  274. my_id_t tmp_oppsite_id;
  275. memcpy(&tmp_oppsite_id,(u32_t *)&data[0],sizeof(tmp_oppsite_id));
  276. tmp_oppsite_id=ntohl(tmp_oppsite_id);
  277. //id_t tmp_my_id=ntohl(* ((u32_t *)&data[sizeof(id_t)]));
  278. my_id_t tmp_my_id;
  279. memcpy(&tmp_my_id,&data[sizeof(my_id_t)],sizeof(tmp_my_id));
  280. tmp_my_id=ntohl(tmp_my_id);
  281. if(tmp_my_id==0) //received init handshake again
  282. {
  283. if(raw_mode==mode_faketcp)
  284. {
  285. send_info.seq=recv_info.ack_seq;
  286. send_info.ack_seq=recv_info.seq+raw_info.recv_info.data_len;
  287. send_info.ts_ack=recv_info.ts;
  288. }
  289. if(raw_mode==mode_icmp)
  290. {
  291. send_info.my_icmp_seq=recv_info.my_icmp_seq;
  292. }
  293. send_handshake(raw_info,conn_info.my_id,tmp_oppsite_id,const_id); //////////////send
  294. mylog(log_info,"[%s]changed state to server_handshake1,my_id is %x\n",ip_port,conn_info.my_id);
  295. }
  296. else if(tmp_my_id==conn_info.my_id)
  297. {
  298. conn_info.oppsite_id=tmp_oppsite_id;
  299. //id_t tmp_oppsite_const_id=ntohl(* ((u32_t *)&data[sizeof(id_t)*2]));
  300. my_id_t tmp_oppsite_const_id;
  301. memcpy(&tmp_oppsite_const_id,&data[sizeof(my_id_t)*2],sizeof(tmp_oppsite_const_id));
  302. tmp_oppsite_const_id=ntohl(tmp_oppsite_const_id);
  303. if(raw_mode==mode_faketcp)
  304. {
  305. send_info.seq=recv_info.ack_seq;
  306. send_info.ack_seq=recv_info.seq+raw_info.recv_info.data_len;
  307. send_info.ts_ack=recv_info.ts;
  308. }
  309. if(raw_mode==mode_icmp)
  310. {
  311. send_info.my_icmp_seq=recv_info.my_icmp_seq;
  312. }
  313. server_on_raw_recv_pre_ready(conn_info,ip_port,tmp_oppsite_const_id);
  314. }
  315. else
  316. {
  317. mylog(log_debug,"[%s]invalid my_id %x,my_id is %x\n",ip_port,tmp_my_id,conn_info.my_id);
  318. }
  319. return 0;
  320. }
  321. int server_on_recv_safer_multi(conn_info_t &conn_info,char type,char *data,int data_len)
  322. {
  323. return 0;
  324. }
  325. int server_on_raw_recv_multi() //called when server received an raw packet
  326. {
  327. char dummy_buf[buf_len];
  328. raw_info_t peek_raw_info;
  329. peek_raw_info.peek=1;
  330. packet_info_t &peek_info=peek_raw_info.recv_info;
  331. mylog(log_trace,"got a packet\n");
  332. if(pre_recv_raw_packet()<0) return -1;
  333. if(peek_raw(peek_raw_info)<0)
  334. {
  335. discard_raw_packet();
  336. //recv(raw_recv_fd, 0,0, 0 );//
  337. //struct sockaddr saddr;
  338. //socklen_t saddr_size=sizeof(saddr);
  339. ///recvfrom(raw_recv_fd, 0,0, 0 ,&saddr , &saddr_size);//
  340. mylog(log_trace,"peek_raw failed\n");
  341. return -1;
  342. }else
  343. {
  344. mylog(log_trace,"peek_raw success\n");
  345. }
  346. //u32_t ip=peek_info.src_ip;uint16_t port=peek_info.src_port;
  347. int data_len; char *data;
  348. address_t addr;
  349. addr.from_ip_port_new(raw_ip_version,&peek_info.new_src_ip,peek_info.src_port);
  350. char ip_port[40];
  351. addr.to_str(ip_port);
  352. //sprintf(ip_port,"%s:%d",my_ntoa(ip),port);
  353. mylog(log_trace,"[%s]peek_raw\n",ip_port);
  354. if(raw_mode==mode_faketcp&&peek_info.syn==1)
  355. {
  356. if(!conn_manager.exist(addr)||conn_manager.find_insert(addr).state.server_current_state!=server_ready)
  357. {//reply any syn ,before state become ready
  358. raw_info_t tmp_raw_info;
  359. if(recv_raw0(tmp_raw_info,data,data_len)<0)
  360. {
  361. return 0;
  362. }
  363. if(use_tcp_dummy_socket!=0)
  364. return 0;
  365. raw_info_t &raw_info=tmp_raw_info;
  366. packet_info_t &send_info=raw_info.send_info;
  367. packet_info_t &recv_info=raw_info.recv_info;
  368. send_info.new_src_ip=recv_info.new_dst_ip;
  369. send_info.src_port=recv_info.dst_port;
  370. send_info.dst_port = recv_info.src_port;
  371. send_info.new_dst_ip = recv_info.new_src_ip;
  372. if(lower_level)
  373. {
  374. handle_lower_level(raw_info);
  375. }
  376. if(data_len==0&&raw_info.recv_info.syn==1&&raw_info.recv_info.ack==0)
  377. {
  378. send_info.ack_seq = recv_info.seq + 1;
  379. send_info.psh = 0;
  380. send_info.syn = 1;
  381. send_info.ack = 1;
  382. send_info.ts_ack=recv_info.ts;
  383. mylog(log_info,"[%s]received syn,sent syn ack back\n",ip_port);
  384. send_raw0(raw_info, 0, 0);
  385. return 0;
  386. }
  387. }
  388. else
  389. {
  390. discard_raw_packet();
  391. //recv(raw_recv_fd, 0,0,0);
  392. }
  393. return 0;
  394. }
  395. if(!conn_manager.exist(addr))
  396. {
  397. if(conn_manager.mp.size()>=max_handshake_conn_num)
  398. {
  399. mylog(log_info,"[%s]reached max_handshake_conn_num,ignored new handshake\n",ip_port);
  400. discard_raw_packet();
  401. //recv(raw_recv_fd, 0,0, 0 );//
  402. return 0;
  403. }
  404. raw_info_t tmp_raw_info;
  405. if(raw_mode==mode_icmp)
  406. {
  407. tmp_raw_info.send_info.dst_port=tmp_raw_info.send_info.src_port=addr.get_port();
  408. }
  409. if(recv_bare(tmp_raw_info,data,data_len)<0)
  410. {
  411. return 0;
  412. }
  413. if(data_len<int( 3*sizeof(my_id_t)))
  414. {
  415. mylog(log_debug,"[%s]too short to be a handshake\n",ip_port);
  416. return -1;
  417. }
  418. //id_t zero=ntohl(* ((u32_t *)&data[sizeof(id_t)]));
  419. my_id_t zero;
  420. memcpy(&zero,&data[sizeof(my_id_t)],sizeof(zero));
  421. zero=ntohl(zero);
  422. if(zero!=0)
  423. {
  424. mylog(log_debug,"[%s]not a invalid initial handshake\n",ip_port);
  425. return -1;
  426. }
  427. mylog(log_info,"[%s]got packet from a new ip\n",ip_port);
  428. conn_info_t &conn_info=conn_manager.find_insert(addr);
  429. conn_info.raw_info=tmp_raw_info;
  430. raw_info_t &raw_info=conn_info.raw_info;
  431. packet_info_t &send_info=conn_info.raw_info.send_info;
  432. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  433. //conn_info.ip_port.ip=ip;
  434. //conn_info.ip_port.port=port;
  435. send_info.new_src_ip=recv_info.new_dst_ip;
  436. send_info.src_port=recv_info.dst_port;
  437. send_info.dst_port = recv_info.src_port;
  438. send_info.new_dst_ip = recv_info.new_src_ip;
  439. if(lower_level)
  440. {
  441. handle_lower_level(raw_info);
  442. }
  443. //id_t tmp_oppsite_id= ntohl(* ((u32_t *)&data[0]));
  444. //mylog(log_info,"[%s]handshake1 received %x\n",ip_port,tmp_oppsite_id);
  445. conn_info.my_id=get_true_random_number_nz();
  446. mylog(log_info,"[%s]created new conn,state: server_handshake1,my_id is %x\n",ip_port,conn_info.my_id);
  447. conn_info.state.server_current_state = server_handshake1;
  448. conn_info.last_state_time = get_current_time();
  449. server_on_raw_recv_handshake1(conn_info,ip_port,data,data_len);
  450. return 0;
  451. }
  452. conn_info_t & conn_info=conn_manager.find_insert(addr);//insert if not exist
  453. packet_info_t &send_info=conn_info.raw_info.send_info;
  454. packet_info_t &recv_info=conn_info.raw_info.recv_info;
  455. raw_info_t &raw_info=conn_info.raw_info;
  456. if(conn_info.state.server_current_state==server_handshake1)
  457. {
  458. if(recv_bare(raw_info,data,data_len)!=0)
  459. {
  460. return -1;
  461. }
  462. return server_on_raw_recv_handshake1(conn_info,ip_port,data,data_len);
  463. }
  464. if(conn_info.state.server_current_state==server_ready)
  465. {
  466. vector<char> type_vec;
  467. vector<string> data_vec;
  468. recv_safer_multi(conn_info,type_vec,data_vec);
  469. if(data_vec.empty())
  470. {
  471. mylog(log_debug,"recv_safer failed!\n");
  472. return -1;
  473. }
  474. for(int i=0;i<(int)type_vec.size();i++)
  475. {
  476. char type=type_vec[i];
  477. char *data=(char *)data_vec[i].c_str(); //be careful, do not append data to it
  478. int data_len=data_vec[i].length();
  479. server_on_raw_recv_ready(conn_info,ip_port,type,data,data_len);
  480. }
  481. return 0;
  482. }
  483. if(conn_info.state.server_current_state==server_idle)
  484. {
  485. discard_raw_packet();
  486. //recv(raw_recv_fd, 0,0, 0 );//
  487. return 0;
  488. }
  489. mylog(log_fatal,"we should never run to here\n");
  490. myexit(-1);
  491. return -1;
  492. }
  493. int server_on_udp_recv(conn_info_t &conn_info,fd64_t fd64)
  494. {
  495. char buf[buf_len];
  496. if(conn_info.state.server_current_state!=server_ready)//TODO remove this for peformance
  497. {
  498. mylog(log_fatal,"p_conn_info->state.server_current_state!=server_ready!!!this shouldnt happen\n");
  499. myexit(-1);
  500. }
  501. //conn_info_t &conn_info=*p_conn_info;
  502. assert(conn_info.blob->conv_manager.s.is_data_used(fd64));
  503. u32_t conv_id=conn_info.blob->conv_manager.s.find_conv_by_data(fd64);
  504. int fd=fd_manager.to_fd(fd64);
  505. int recv_len=recv(fd,buf,max_data_len+1,0);
  506. mylog(log_trace,"received a packet from udp_fd,len:%d\n",recv_len);
  507. if(recv_len==max_data_len+1)
  508. {
  509. mylog(log_warn,"huge packet, data_len > %d,dropped\n",max_data_len);
  510. return -1;
  511. }
  512. if(recv_len<0)
  513. {
  514. mylog(log_debug,"udp fd,recv_len<0 continue,%s\n",strerror(errno));
  515. return -1;
  516. }
  517. if(recv_len>=mtu_warn)
  518. {
  519. 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);
  520. }
  521. //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)
  522. if(conn_info.state.server_current_state==server_ready)
  523. {
  524. send_data_safer(conn_info,buf,recv_len,conv_id);
  525. //send_data(g_packet_info_send,buf,recv_len,my_id,oppsite_id,conv_id);
  526. mylog(log_trace,"send_data_safer ,sent !!\n");
  527. }
  528. return 0;
  529. }
  530. int server_event_loop()
  531. {
  532. char buf[buf_len];
  533. int i, j, k;int ret;
  534. if(raw_ip_version==AF_INET)
  535. {
  536. if(local_addr.inner.ipv4.sin_addr.s_addr!=0)
  537. {
  538. bind_addr_used=1;
  539. bind_addr.v4=local_addr.inner.ipv4.sin_addr.s_addr;
  540. }
  541. }
  542. else
  543. {
  544. assert(raw_ip_version==AF_INET6);
  545. char zero_arr[16]={0};
  546. if(memcmp(&local_addr.inner.ipv6.sin6_addr,zero_arr,16)!=0)
  547. {
  548. bind_addr_used=1;
  549. bind_addr.v6=local_addr.inner.ipv6.sin6_addr;
  550. }
  551. }
  552. //bind_address_uint32=local_ip_uint32;//only server has bind adress,client sets it to zero
  553. if(lower_level)
  554. {
  555. if(lower_level_manual)
  556. {
  557. init_ifindex(if_name,raw_send_fd,ifindex);
  558. mylog(log_info,"we are running at lower-level (manual) mode\n");
  559. }
  560. else
  561. {
  562. mylog(log_info,"we are running at lower-level (auto) mode\n");
  563. }
  564. }
  565. if(raw_mode==mode_faketcp)
  566. {
  567. bind_fd=socket(local_addr.get_type(),SOCK_STREAM,0);
  568. }
  569. 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
  570. {
  571. bind_fd=socket(local_addr.get_type(),SOCK_DGRAM,0);
  572. }
  573. //struct sockaddr_in temp_bind_addr={0};
  574. // bzero(&temp_bind_addr, sizeof(temp_bind_addr));
  575. //temp_bind_addr.sin_family = AF_INET;
  576. //temp_bind_addr.sin_port = local_addr.get_port();
  577. //temp_bind_addr.sin_addr.s_addr = local_addr.inner.ipv4.sin_addr.s_addr;
  578. if (bind(bind_fd, (struct sockaddr*)&local_addr.inner, local_addr.get_len()) !=0)
  579. {
  580. mylog(log_fatal,"bind fail\n");
  581. myexit(-1);
  582. }
  583. if(raw_mode==mode_faketcp)
  584. {
  585. if(listen(bind_fd, SOMAXCONN) != 0 )
  586. {
  587. mylog(log_fatal,"listen fail\n");
  588. myexit(-1);
  589. }
  590. }
  591. //init_raw_socket();
  592. init_filter(local_addr.get_port());//bpf filter
  593. epollfd = epoll_create1(0);
  594. const int max_events = 4096;
  595. struct epoll_event ev, events[max_events];
  596. if (epollfd < 0) {
  597. mylog(log_fatal,"epoll return %d\n", epollfd);
  598. myexit(-1);
  599. }
  600. ev.events = EPOLLIN;
  601. ev.data.u64 = raw_recv_fd;
  602. ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, raw_recv_fd, &ev);
  603. if (ret!= 0) {
  604. mylog(log_fatal,"add raw_fd error\n");
  605. myexit(-1);
  606. }
  607. int timer_fd;
  608. set_timer(epollfd,timer_fd);
  609. u64_t begin_time=0;
  610. u64_t end_time=0;
  611. mylog(log_info,"now listening at %s\n",local_addr.get_str());
  612. int fifo_fd=-1;
  613. if(fifo_file[0]!=0)
  614. {
  615. fifo_fd=create_fifo(fifo_file);
  616. ev.events = EPOLLIN;
  617. ev.data.u64 = fifo_fd;
  618. ret = epoll_ctl(epollfd, EPOLL_CTL_ADD, fifo_fd, &ev);
  619. if (ret!= 0) {
  620. mylog(log_fatal,"add fifo_fd to epoll error %s\n",strerror(errno));
  621. myexit(-1);
  622. }
  623. mylog(log_info,"fifo_file=%s\n",fifo_file);
  624. }
  625. while(1)////////////////////////
  626. {
  627. if(about_to_exit) myexit(0);
  628. int nfds = epoll_wait(epollfd, events, max_events, 180 * 1000);
  629. if (nfds < 0) { //allow zero
  630. if(errno==EINTR )
  631. {
  632. mylog(log_info,"epoll interrupted by signal,continue\n");
  633. //myexit(0);
  634. }
  635. else
  636. {
  637. mylog(log_fatal,"epoll_wait return %d,%s\n", nfds,strerror(errno));
  638. myexit(-1);
  639. }
  640. }
  641. int idx;
  642. for (idx = 0; idx < nfds; ++idx)
  643. {
  644. //mylog(log_debug,"ndfs: %d \n",nfds);
  645. epoll_trigger_counter++;
  646. //printf("%d %d %d %d\n",timer_fd,raw_recv_fd,raw_send_fd,n);
  647. if ((events[idx].data.u64 ) == (u64_t)timer_fd)
  648. {
  649. if(debug_flag)begin_time=get_current_time();
  650. conn_manager.clear_inactive();
  651. u64_t dummy;
  652. int unused=read(timer_fd, &dummy, 8);
  653. //current_time_rough=get_current_time();
  654. if(debug_flag)
  655. {
  656. end_time=get_current_time();
  657. mylog(log_debug,"timer_fd,%llu,%llu,%llu\n",begin_time,end_time,end_time-begin_time);
  658. }
  659. mylog(log_trace,"epoll_trigger_counter: %d \n",epoll_trigger_counter);
  660. epoll_trigger_counter=0;
  661. }
  662. else if (events[idx].data.u64 == (u64_t)raw_recv_fd)
  663. {
  664. if(debug_flag)begin_time=get_current_time();
  665. server_on_raw_recv_multi();
  666. if(debug_flag)
  667. {
  668. end_time=get_current_time();
  669. mylog(log_debug,"raw_recv_fd,%llu,%llu,%llu \n",begin_time,end_time,end_time-begin_time);
  670. }
  671. }
  672. else if (events[idx].data.u64 == (u64_t)fifo_fd)
  673. {
  674. int len=read (fifo_fd, buf, sizeof (buf));
  675. if(len<0)
  676. {
  677. mylog(log_warn,"fifo read failed len=%d,errno=%s\n",len,strerror(errno));
  678. continue;
  679. }
  680. //assert(len>=0);
  681. buf[len]=0;
  682. while(len>=1&&buf[len-1]=='\n')
  683. buf[len-1]=0;
  684. mylog(log_info,"got data from fifo,len=%d,s=[%s]\n",len,buf);
  685. mylog(log_info,"unknown command\n");
  686. }
  687. else if (events[idx].data.u64>u32_t(-1) )
  688. {
  689. fd64_t fd64=events[idx].data.u64;
  690. if(!fd_manager.exist(fd64))
  691. {
  692. mylog(log_trace ,"fd64 no longer exist\n");
  693. return -1;
  694. }
  695. assert(fd_manager.exist_info(fd64));
  696. conn_info_t* p_conn_info=fd_manager.get_info(fd64).p_conn_info;
  697. conn_info_t &conn_info=*p_conn_info;
  698. if(fd64==conn_info.timer_fd64)//////////timer_fd64
  699. {
  700. if(debug_flag)begin_time=get_current_time();
  701. int fd=fd_manager.to_fd(fd64);
  702. u64_t dummy;
  703. int unused=read(fd, &dummy, 8);
  704. assert(conn_info.state.server_current_state == server_ready); //TODO remove this for peformance
  705. server_on_timer_multi(conn_info);
  706. if(debug_flag)
  707. {
  708. end_time=get_current_time();
  709. mylog(log_debug,"(events[idx].data.u64 >>32u) == 2u ,%llu,%llu,%llu \n",begin_time,end_time,end_time-begin_time);
  710. }
  711. }
  712. else//udp_fd64
  713. {
  714. if(debug_flag)begin_time=get_current_time();
  715. server_on_udp_recv(conn_info,fd64);
  716. if(debug_flag)
  717. {
  718. end_time=get_current_time();
  719. mylog(log_debug,"(events[idx].data.u64 >>32u) == 1u,%lld,%lld,%lld \n",begin_time,end_time,end_time-begin_time);
  720. }
  721. }
  722. }
  723. else
  724. {
  725. mylog(log_fatal,"unknown fd,this should never happen\n");
  726. myexit(-1);
  727. }
  728. }
  729. }
  730. return 0;
  731. }