SocksUdpGwClient.c 6.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217
  1. /**
  2. * @file SocksUdpGwClient.c
  3. * @author Ambroz Bizjak <ambrop7@gmail.com>
  4. *
  5. * @section LICENSE
  6. *
  7. * This file is part of BadVPN.
  8. *
  9. * BadVPN is free software: you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License version 2
  11. * as published by the Free Software Foundation.
  12. *
  13. * BadVPN is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License along
  19. * with this program; if not, write to the Free Software Foundation, Inc.,
  20. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  21. */
  22. #include <misc/debug.h>
  23. #include <base/BLog.h>
  24. #include <tun2socks/SocksUdpGwClient.h>
  25. #include <generated/blog_channel_SocksUdpGwClient.h>
  26. static void free_socks (SocksUdpGwClient *o);
  27. static void try_connect (SocksUdpGwClient *o);
  28. static void reconnect_timer_handler (SocksUdpGwClient *o);
  29. static void socks_client_handler (SocksUdpGwClient *o, int event);
  30. static void udpgw_handler_servererror (SocksUdpGwClient *o);
  31. static void udpgw_handler_received (SocksUdpGwClient *o, BAddr local_addr, BAddr remote_addr, const uint8_t *data, int data_len);
  32. static void free_socks (SocksUdpGwClient *o)
  33. {
  34. ASSERT(o->have_socks)
  35. // disconnect udpgw client from SOCKS
  36. if (o->socks_up) {
  37. UdpGwClient_DisconnectServer(&o->udpgw_client);
  38. }
  39. // free SOCKS client
  40. BSocksClient_Free(&o->socks_client);
  41. // set have no SOCKS
  42. o->have_socks = 0;
  43. }
  44. static void try_connect (SocksUdpGwClient *o)
  45. {
  46. ASSERT(!o->have_socks)
  47. ASSERT(!BTimer_IsRunning(&o->reconnect_timer))
  48. // init SOCKS client
  49. if (!BSocksClient_Init(&o->socks_client, o->socks_server_addr, o->remote_udpgw_addr, (BSocksClient_handler)socks_client_handler, o, o->reactor)) {
  50. BLog(BLOG_ERROR, "BSocksClient_Init failed");
  51. goto fail0;
  52. }
  53. // set have SOCKS
  54. o->have_socks = 1;
  55. // set SOCKS not up
  56. o->socks_up = 0;
  57. return;
  58. fail0:
  59. // set reconnect timer
  60. BReactor_SetTimer(o->reactor, &o->reconnect_timer);
  61. }
  62. static void reconnect_timer_handler (SocksUdpGwClient *o)
  63. {
  64. DebugObject_Access(&o->d_obj);
  65. ASSERT(!o->have_socks)
  66. // try connecting
  67. try_connect(o);
  68. }
  69. static void socks_client_handler (SocksUdpGwClient *o, int event)
  70. {
  71. DebugObject_Access(&o->d_obj);
  72. ASSERT(o->have_socks)
  73. switch (event) {
  74. case BSOCKSCLIENT_EVENT_UP: {
  75. ASSERT(!o->socks_up)
  76. BLog(BLOG_INFO, "SOCKS up");
  77. // connect udpgw client to SOCKS
  78. if (!UdpGwClient_ConnectServer(&o->udpgw_client, BSocksClient_GetSendInterface(&o->socks_client), BSocksClient_GetRecvInterface(&o->socks_client))) {
  79. BLog(BLOG_ERROR, "UdpGwClient_ConnectServer failed");
  80. goto fail0;
  81. }
  82. // set SOCKS up
  83. o->socks_up = 1;
  84. return;
  85. fail0:
  86. // free SOCKS
  87. free_socks(o);
  88. // set reconnect timer
  89. BReactor_SetTimer(o->reactor, &o->reconnect_timer);
  90. } break;
  91. case BSOCKSCLIENT_EVENT_ERROR:
  92. case BSOCKSCLIENT_EVENT_ERROR_CLOSED: {
  93. BLog(BLOG_INFO, "SOCKS error");
  94. // free SOCKS
  95. free_socks(o);
  96. // set reconnect timer
  97. BReactor_SetTimer(o->reactor, &o->reconnect_timer);
  98. } break;
  99. default: ASSERT(0);
  100. }
  101. }
  102. static void udpgw_handler_servererror (SocksUdpGwClient *o)
  103. {
  104. DebugObject_Access(&o->d_obj);
  105. ASSERT(o->have_socks)
  106. ASSERT(o->socks_up)
  107. BLog(BLOG_ERROR, "client reports server error");
  108. // free SOCKS
  109. free_socks(o);
  110. // set reconnect timer
  111. BReactor_SetTimer(o->reactor, &o->reconnect_timer);
  112. }
  113. static void udpgw_handler_received (SocksUdpGwClient *o, BAddr local_addr, BAddr remote_addr, const uint8_t *data, int data_len)
  114. {
  115. DebugObject_Access(&o->d_obj);
  116. // submit to user
  117. o->handler_received(o->user, local_addr, remote_addr, data, data_len);
  118. return;
  119. }
  120. void SocksUdpGwClient_Init (SocksUdpGwClient *o, int udp_mtu, int max_connections, int send_buffer_size, btime_t keepalive_time, BAddr socks_server_addr, BAddr remote_udpgw_addr, btime_t reconnect_time, BReactor *reactor, void *user,
  121. SocksUdpGwClient_handler_received handler_received)
  122. {
  123. ASSERT(udp_mtu >= 0)
  124. ASSERT(udpgw_compute_mtu(udp_mtu) >= 0)
  125. ASSERT(udpgw_compute_mtu(udp_mtu) <= PACKETPROTO_MAXPAYLOAD)
  126. ASSERT(max_connections > 0)
  127. ASSERT(send_buffer_size > 0)
  128. ASSERT(!BAddr_IsInvalid(&socks_server_addr))
  129. ASSERT(remote_udpgw_addr.type == BADDR_TYPE_IPV4 || remote_udpgw_addr.type == BADDR_TYPE_IPV6)
  130. // init arguments
  131. o->udp_mtu = udp_mtu;
  132. o->socks_server_addr = socks_server_addr;
  133. o->remote_udpgw_addr = remote_udpgw_addr;
  134. o->reactor = reactor;
  135. o->user = user;
  136. o->handler_received = handler_received;
  137. // init udpgw client
  138. UdpGwClient_Init(&o->udpgw_client, udp_mtu, max_connections, send_buffer_size, keepalive_time, o->reactor, o,
  139. (UdpGwClient_handler_servererror)udpgw_handler_servererror,
  140. (UdpGwClient_handler_received)udpgw_handler_received);
  141. // init reconnect timer
  142. BTimer_Init(&o->reconnect_timer, reconnect_time, (BTimer_handler)reconnect_timer_handler, o);
  143. // set have no SOCKS
  144. o->have_socks = 0;
  145. // try connecting
  146. try_connect(o);
  147. DebugObject_Init(&o->d_obj);
  148. }
  149. void SocksUdpGwClient_Free (SocksUdpGwClient *o)
  150. {
  151. DebugObject_Free(&o->d_obj);
  152. // free SOCKS
  153. if (o->have_socks) {
  154. free_socks(o);
  155. }
  156. // free reconnect timer
  157. BReactor_RemoveTimer(o->reactor, &o->reconnect_timer);
  158. // free udpgw client
  159. UdpGwClient_Free(&o->udpgw_client);
  160. }
  161. void SocksUdpGwClient_SubmitPacket (SocksUdpGwClient *o, BAddr local_addr, BAddr remote_addr, const uint8_t *data, int data_len)
  162. {
  163. DebugObject_Access(&o->d_obj);
  164. ASSERT(local_addr.type == BADDR_TYPE_IPV4)
  165. ASSERT(remote_addr.type == BADDR_TYPE_IPV4)
  166. ASSERT(data_len >= 0)
  167. ASSERT(data_len <= o->udp_mtu)
  168. // submit to udpgw client
  169. UdpGwClient_SubmitPacket(&o->udpgw_client, local_addr, remote_addr, data, data_len);
  170. }