OLD | NEW |
| (Empty) |
1 // Copyright (c) 2012 The Chromium Authors. All rights reserved. | |
2 // Use of this source code is governed by a BSD-style license that can be | |
3 // found in the LICENSE file. | |
4 | |
5 #include <errno.h> | |
6 #include <fcntl.h> | |
7 #include <netinet/in.h> | |
8 #include <netinet/tcp.h> | |
9 #include <pthread.h> | |
10 #include <signal.h> | |
11 #include <stdio.h> | |
12 #include <stdlib.h> | |
13 #include <string.h> | |
14 #include <sys/select.h> | |
15 #include <sys/socket.h> | |
16 #include <sys/wait.h> | |
17 #include <unistd.h> | |
18 | |
19 #include "base/command_line.h" | |
20 #include "base/eintr_wrapper.h" | |
21 #include "base/logging.h" | |
22 #include "tools/android/common/adb_connection.h" | |
23 #include "tools/android/common/daemon.h" | |
24 #include "tools/android/common/net.h" | |
25 | |
26 namespace { | |
27 | |
28 const pthread_t kInvalidThread = static_cast<pthread_t>(-1); | |
29 volatile bool g_killed = false; | |
30 | |
31 void CloseSocket(int fd) { | |
32 if (fd >= 0) { | |
33 int old_errno = errno; | |
34 (void) HANDLE_EINTR(close(fd)); | |
35 errno = old_errno; | |
36 } | |
37 } | |
38 | |
39 class Buffer { | |
40 public: | |
41 Buffer() | |
42 : bytes_read_(0), | |
43 write_offset_(0) { | |
44 } | |
45 | |
46 bool CanRead() { | |
47 return bytes_read_ == 0; | |
48 } | |
49 | |
50 bool CanWrite() { | |
51 return write_offset_ < bytes_read_; | |
52 } | |
53 | |
54 int Read(int fd) { | |
55 int ret = -1; | |
56 if (CanRead()) { | |
57 ret = HANDLE_EINTR(read(fd, buffer_, kBufferSize)); | |
58 if (ret > 0) | |
59 bytes_read_ = ret; | |
60 } | |
61 return ret; | |
62 } | |
63 | |
64 int Write(int fd) { | |
65 int ret = -1; | |
66 if (CanWrite()) { | |
67 ret = HANDLE_EINTR(write(fd, buffer_ + write_offset_, | |
68 bytes_read_ - write_offset_)); | |
69 if (ret > 0) { | |
70 write_offset_ += ret; | |
71 if (write_offset_ == bytes_read_) { | |
72 write_offset_ = 0; | |
73 bytes_read_ = 0; | |
74 } | |
75 } | |
76 } | |
77 return ret; | |
78 } | |
79 | |
80 private: | |
81 // A big buffer to let our file-over-http bridge work more like real file. | |
82 static const int kBufferSize = 1024 * 128; | |
83 int bytes_read_; | |
84 int write_offset_; | |
85 char buffer_[kBufferSize]; | |
86 | |
87 DISALLOW_COPY_AND_ASSIGN(Buffer); | |
88 }; | |
89 | |
90 class Server; | |
91 | |
92 struct ForwarderThreadInfo { | |
93 ForwarderThreadInfo(Server* a_server, int a_forwarder_index) | |
94 : server(a_server), | |
95 forwarder_index(a_forwarder_index) { | |
96 } | |
97 Server* server; | |
98 int forwarder_index; | |
99 }; | |
100 | |
101 struct ForwarderInfo { | |
102 time_t start_time; | |
103 int socket1; | |
104 time_t socket1_last_byte_time; | |
105 size_t socket1_bytes; | |
106 int socket2; | |
107 time_t socket2_last_byte_time; | |
108 size_t socket2_bytes; | |
109 }; | |
110 | |
111 class Server { | |
112 public: | |
113 Server() | |
114 : thread_(kInvalidThread), | |
115 socket_(-1) { | |
116 memset(forward_to_, 0, sizeof(forward_to_)); | |
117 memset(&forwarders_, 0, sizeof(forwarders_)); | |
118 } | |
119 | |
120 int GetFreeForwarderIndex() { | |
121 for (int i = 0; i < kMaxForwarders; i++) { | |
122 if (forwarders_[i].start_time == 0) | |
123 return i; | |
124 } | |
125 return -1; | |
126 } | |
127 | |
128 void DisposeForwarderInfo(int index) { | |
129 forwarders_[index].start_time = 0; | |
130 } | |
131 | |
132 ForwarderInfo* GetForwarderInfo(int index) { | |
133 return &forwarders_[index]; | |
134 } | |
135 | |
136 void DumpInformation() { | |
137 LOG(INFO) << "Server information: " << forward_to_; | |
138 LOG(INFO) << "No.: age up(bytes,idle) down(bytes,idle)"; | |
139 int count = 0; | |
140 time_t now = time(NULL); | |
141 for (int i = 0; i < kMaxForwarders; i++) { | |
142 const ForwarderInfo& info = forwarders_[i]; | |
143 if (info.start_time) { | |
144 count++; | |
145 LOG(INFO) << count << ": " << now - info.start_time << " up(" | |
146 << info.socket1_bytes << "," | |
147 << now - info.socket1_last_byte_time << " down(" | |
148 << info.socket2_bytes << "," | |
149 << now - info.socket2_last_byte_time << ")"; | |
150 } | |
151 } | |
152 } | |
153 | |
154 void Shutdown() { | |
155 if (socket_ >= 0) | |
156 shutdown(socket_, SHUT_RDWR); | |
157 } | |
158 | |
159 bool InitSocket(const char* arg); | |
160 | |
161 void StartThread() { | |
162 pthread_create(&thread_, NULL, ServerThread, this); | |
163 } | |
164 | |
165 void JoinThread() { | |
166 if (thread_ != kInvalidThread) | |
167 pthread_join(thread_, NULL); | |
168 } | |
169 | |
170 private: | |
171 static void* ServerThread(void* arg); | |
172 | |
173 // There are 3 kinds of threads that will access the array: | |
174 // 1. Server thread will get a free ForwarderInfo and initialize it; | |
175 // 2. Forwarder threads will dispose the ForwarderInfo when it finishes; | |
176 // 3. Main thread will iterate and print the forwarders. | |
177 // Using an array is not optimal, but can avoid locks or other complex | |
178 // inter-thread communication. | |
179 static const int kMaxForwarders = 512; | |
180 ForwarderInfo forwarders_[kMaxForwarders]; | |
181 | |
182 pthread_t thread_; | |
183 int socket_; | |
184 char forward_to_[40]; | |
185 | |
186 DISALLOW_COPY_AND_ASSIGN(Server); | |
187 }; | |
188 | |
189 // Forwards all outputs from one socket to another socket. | |
190 void* ForwarderThread(void* arg) { | |
191 ForwarderThreadInfo* thread_info = | |
192 reinterpret_cast<ForwarderThreadInfo*>(arg); | |
193 Server* server = thread_info->server; | |
194 int index = thread_info->forwarder_index; | |
195 delete thread_info; | |
196 ForwarderInfo* info = server->GetForwarderInfo(index); | |
197 int socket1 = info->socket1; | |
198 int socket2 = info->socket2; | |
199 int nfds = socket1 > socket2 ? socket1 + 1 : socket2 + 1; | |
200 fd_set read_fds; | |
201 fd_set write_fds; | |
202 Buffer buffer1; | |
203 Buffer buffer2; | |
204 | |
205 while (!g_killed) { | |
206 FD_ZERO(&read_fds); | |
207 if (buffer1.CanRead()) | |
208 FD_SET(socket1, &read_fds); | |
209 if (buffer2.CanRead()) | |
210 FD_SET(socket2, &read_fds); | |
211 | |
212 FD_ZERO(&write_fds); | |
213 if (buffer1.CanWrite()) | |
214 FD_SET(socket2, &write_fds); | |
215 if (buffer2.CanWrite()) | |
216 FD_SET(socket1, &write_fds); | |
217 | |
218 if (HANDLE_EINTR(select(nfds, &read_fds, &write_fds, NULL, NULL)) <= 0) { | |
219 LOG(ERROR) << "Select error: " << strerror(errno); | |
220 break; | |
221 } | |
222 | |
223 int now = time(NULL); | |
224 if (FD_ISSET(socket1, &read_fds)) { | |
225 info->socket1_last_byte_time = now; | |
226 int bytes = buffer1.Read(socket1); | |
227 if (bytes <= 0) | |
228 break; | |
229 info->socket1_bytes += bytes; | |
230 } | |
231 if (FD_ISSET(socket2, &read_fds)) { | |
232 info->socket2_last_byte_time = now; | |
233 int bytes = buffer2.Read(socket2); | |
234 if (bytes <= 0) | |
235 break; | |
236 info->socket2_bytes += bytes; | |
237 } | |
238 if (FD_ISSET(socket1, &write_fds)) { | |
239 if (buffer2.Write(socket1) <= 0) | |
240 break; | |
241 } | |
242 if (FD_ISSET(socket2, &write_fds)) { | |
243 if (buffer1.Write(socket2) <= 0) | |
244 break; | |
245 } | |
246 } | |
247 | |
248 CloseSocket(socket1); | |
249 CloseSocket(socket2); | |
250 server->DisposeForwarderInfo(index); | |
251 return NULL; | |
252 } | |
253 | |
254 // Listens to a server socket. On incoming request, forward it to the host. | |
255 // static | |
256 void* Server::ServerThread(void* arg) { | |
257 Server* server = reinterpret_cast<Server*>(arg); | |
258 while (!g_killed) { | |
259 int forwarder_index = server->GetFreeForwarderIndex(); | |
260 if (forwarder_index < 0) { | |
261 LOG(ERROR) << "Too many forwarders"; | |
262 continue; | |
263 } | |
264 | |
265 struct sockaddr_in addr; | |
266 socklen_t addr_len = sizeof(addr); | |
267 int socket = HANDLE_EINTR(accept(server->socket_, | |
268 reinterpret_cast<sockaddr*>(&addr), | |
269 &addr_len)); | |
270 if (socket < 0) { | |
271 LOG(ERROR) << "Failed to accept: " << strerror(errno); | |
272 break; | |
273 } | |
274 tools::DisableNagle(socket); | |
275 | |
276 int host_socket = tools::ConnectAdbHostSocket(server->forward_to_); | |
277 if (host_socket >= 0) { | |
278 // Set NONBLOCK flag because we use select(). | |
279 fcntl(socket, F_SETFL, fcntl(socket, F_GETFL) | O_NONBLOCK); | |
280 fcntl(host_socket, F_SETFL, fcntl(host_socket, F_GETFL) | O_NONBLOCK); | |
281 | |
282 ForwarderInfo* forwarder_info = server->GetForwarderInfo(forwarder_index); | |
283 time_t now = time(NULL); | |
284 forwarder_info->start_time = now; | |
285 forwarder_info->socket1 = socket; | |
286 forwarder_info->socket1_last_byte_time = now; | |
287 forwarder_info->socket1_bytes = 0; | |
288 forwarder_info->socket2 = host_socket; | |
289 forwarder_info->socket2_last_byte_time = now; | |
290 forwarder_info->socket2_bytes = 0; | |
291 | |
292 pthread_t thread; | |
293 pthread_create(&thread, NULL, ForwarderThread, | |
294 new ForwarderThreadInfo(server, forwarder_index)); | |
295 } else { | |
296 // Close the unused client socket which is failed to connect to host. | |
297 CloseSocket(socket); | |
298 } | |
299 } | |
300 | |
301 CloseSocket(server->socket_); | |
302 server->socket_ = -1; | |
303 return NULL; | |
304 } | |
305 | |
306 // Format of arg: <Device port>[:<Forward to port>:<Forward to address>] | |
307 bool Server::InitSocket(const char* arg) { | |
308 char* endptr; | |
309 int local_port = static_cast<int>(strtol(arg, &endptr, 10)); | |
310 if (local_port < 0) | |
311 return false; | |
312 | |
313 if (*endptr != ':') { | |
314 snprintf(forward_to_, sizeof(forward_to_), "%d:127.0.0.1", local_port); | |
315 } else { | |
316 strncpy(forward_to_, endptr + 1, sizeof(forward_to_) - 1); | |
317 } | |
318 | |
319 socket_ = socket(AF_INET, SOCK_STREAM, 0); | |
320 if (socket_ < 0) { | |
321 perror("server socket"); | |
322 return false; | |
323 } | |
324 tools::DisableNagle(socket_); | |
325 | |
326 sockaddr_in addr; | |
327 memset(&addr, 0, sizeof(addr)); | |
328 addr.sin_family = AF_INET; | |
329 addr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); | |
330 addr.sin_port = htons(local_port); | |
331 int reuse_addr = 1; | |
332 setsockopt(socket_, SOL_SOCKET, SO_REUSEADDR, | |
333 &reuse_addr, sizeof(reuse_addr)); | |
334 tools::DeferAccept(socket_); | |
335 if (HANDLE_EINTR(bind(socket_, reinterpret_cast<sockaddr*>(&addr), | |
336 sizeof(addr))) < 0 || | |
337 HANDLE_EINTR(listen(socket_, 5)) < 0) { | |
338 perror("server bind"); | |
339 CloseSocket(socket_); | |
340 socket_ = -1; | |
341 return false; | |
342 } | |
343 | |
344 if (local_port == 0) { | |
345 socklen_t addrlen = sizeof(addr); | |
346 if (getsockname(socket_, reinterpret_cast<sockaddr*>(&addr), &addrlen) | |
347 != 0) { | |
348 perror("get listen address"); | |
349 CloseSocket(socket_); | |
350 socket_ = -1; | |
351 return false; | |
352 } | |
353 local_port = ntohs(addr.sin_port); | |
354 } | |
355 | |
356 printf("Forwarding device port %d to host %s\n", local_port, forward_to_); | |
357 return true; | |
358 } | |
359 | |
360 int g_server_count = 0; | |
361 Server* g_servers = NULL; | |
362 | |
363 void KillHandler(int unused) { | |
364 g_killed = true; | |
365 for (int i = 0; i < g_server_count; i++) | |
366 g_servers[i].Shutdown(); | |
367 } | |
368 | |
369 void DumpInformation(int unused) { | |
370 for (int i = 0; i < g_server_count; i++) | |
371 g_servers[i].DumpInformation(); | |
372 } | |
373 | |
374 } // namespace | |
375 | |
376 int main(int argc, char** argv) { | |
377 printf("Android device to host TCP forwarder\n"); | |
378 printf("Like 'adb forward' but in the reverse direction\n"); | |
379 | |
380 CommandLine command_line(argc, argv); | |
381 CommandLine::StringVector server_args = command_line.GetArgs(); | |
382 if (tools::HasHelpSwitch(command_line) || server_args.empty()) { | |
383 tools::ShowHelp( | |
384 argv[0], | |
385 "<Device port>[:<Forward to port>:<Forward to address>] ...", | |
386 " <Forward to port> default is <Device port>\n" | |
387 " <Forward to address> default is 127.0.0.1\n" | |
388 "If <Device port> is 0, a port will by dynamically allocated.\n"); | |
389 return 0; | |
390 } | |
391 | |
392 g_servers = new Server[server_args.size()]; | |
393 g_server_count = 0; | |
394 int failed_count = 0; | |
395 for (size_t i = 0; i < server_args.size(); i++) { | |
396 if (!g_servers[g_server_count].InitSocket(server_args[i].c_str())) { | |
397 printf("Couldn't start forwarder server for port spec: %s\n", | |
398 server_args[i].c_str()); | |
399 ++failed_count; | |
400 } else { | |
401 ++g_server_count; | |
402 } | |
403 } | |
404 | |
405 if (g_server_count == 0) { | |
406 printf("No forwarder servers could be started. Exiting.\n"); | |
407 delete [] g_servers; | |
408 return failed_count; | |
409 } | |
410 | |
411 if (!tools::HasNoSpawnDaemonSwitch(command_line)) | |
412 tools::SpawnDaemon(failed_count); | |
413 | |
414 signal(SIGTERM, KillHandler); | |
415 signal(SIGUSR2, DumpInformation); | |
416 | |
417 for (int i = 0; i < g_server_count; i++) | |
418 g_servers[i].StartThread(); | |
419 for (int i = 0; i < g_server_count; i++) | |
420 g_servers[i].JoinThread(); | |
421 g_server_count = 0; | |
422 delete [] g_servers; | |
423 | |
424 return 0; | |
425 } | |
426 | |
OLD | NEW |