server.cpp 29 KB

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