server.cpp 25 KB

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