blob: 31b54431bd69ad51d44164352c29a4bc7a61820a [file] [log] [blame]
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -08001/*
2 * Copyright (C) 2007 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
Dan Albert33134262015-03-19 15:21:08 -070017#define TRACE_TAG TRACE_SOCKETS
18
19#include "sysdeps.h"
20
Dan Albert76649012015-02-24 15:51:19 -080021#include <ctype.h>
22#include <errno.h>
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080023#include <stdio.h>
24#include <stdlib.h>
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080025#include <string.h>
Dan Albert76649012015-02-24 15:51:19 -080026#include <unistd.h>
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080027
Josh Gao6f641ad2016-05-17 19:23:39 -070028#include <algorithm>
29#include <mutex>
30#include <string>
31#include <vector>
32
Dan Albert76649012015-02-24 15:51:19 -080033#if !ADB_HOST
34#include "cutils/properties.h"
35#endif
Dan Albert33134262015-03-19 15:21:08 -070036
37#include "adb.h"
38#include "adb_io.h"
Josh Gao6f641ad2016-05-17 19:23:39 -070039#include "sysdeps/mutex.h"
Dan Albert76649012015-02-24 15:51:19 -080040#include "transport.h"
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080041
Josh Gao6f641ad2016-05-17 19:23:39 -070042#if !defined(__BIONIC__)
43using std::recursive_mutex;
44#endif
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080045
Josh Gao6f641ad2016-05-17 19:23:39 -070046static void local_socket_close(asocket* s);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080047
Josh Gao6f641ad2016-05-17 19:23:39 -070048static recursive_mutex& local_socket_list_lock = *new recursive_mutex();
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080049static unsigned local_socket_next_id = 1;
50
51static asocket local_socket_list = {
52 .next = &local_socket_list,
53 .prev = &local_socket_list,
54};
55
56/* the the list of currently closing local sockets.
57** these have no peer anymore, but still packets to
58** write to their fd.
59*/
60static asocket local_socket_closing_list = {
61 .next = &local_socket_closing_list,
62 .prev = &local_socket_closing_list,
63};
64
David 'Digit' Turner818d6412013-12-13 14:09:44 +010065// Parse the global list of sockets to find one with id |local_id|.
66// If |peer_id| is not 0, also check that it is connected to a peer
67// with id |peer_id|. Returns an asocket handle on success, NULL on failure.
68asocket *find_local_socket(unsigned local_id, unsigned peer_id)
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080069{
70 asocket *s;
71 asocket *result = NULL;
72
Josh Gao6f641ad2016-05-17 19:23:39 -070073 std::lock_guard<recursive_mutex> lock(local_socket_list_lock);
André Goddard Rosa81828292010-06-12 11:40:20 -030074 for (s = local_socket_list.next; s != &local_socket_list; s = s->next) {
David 'Digit' Turner818d6412013-12-13 14:09:44 +010075 if (s->id != local_id)
76 continue;
77 if (peer_id == 0 || (s->peer && s->peer->id == peer_id)) {
André Goddard Rosa81828292010-06-12 11:40:20 -030078 result = s;
André Goddard Rosa81828292010-06-12 11:40:20 -030079 }
David 'Digit' Turner818d6412013-12-13 14:09:44 +010080 break;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080081 }
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080082
83 return result;
84}
85
86static void
87insert_local_socket(asocket* s, asocket* list)
88{
89 s->next = list;
90 s->prev = s->next->prev;
91 s->prev->next = s;
92 s->next->prev = s;
93}
94
Josh Gao6f641ad2016-05-17 19:23:39 -070095void install_local_socket(asocket* s) {
96 std::lock_guard<recursive_mutex> lock(local_socket_list_lock);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -080097
98 s->id = local_socket_next_id++;
David 'Digit' Turner818d6412013-12-13 14:09:44 +010099
100 // Socket ids should never be 0.
Josh Gao6f641ad2016-05-17 19:23:39 -0700101 if (local_socket_next_id == 0) {
102 fatal("local socket id overflow");
103 }
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100104
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800105 insert_local_socket(s, &local_socket_list);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800106}
107
108void remove_socket(asocket *s)
109{
110 // socket_list_lock should already be held
111 if (s->prev && s->next)
112 {
113 s->prev->next = s->next;
114 s->next->prev = s->prev;
115 s->next = 0;
116 s->prev = 0;
117 s->id = 0;
118 }
119}
120
121void close_all_sockets(atransport *t)
122{
123 asocket *s;
Josh Gao6f641ad2016-05-17 19:23:39 -0700124 /* this is a little gross, but since s->close() *will* modify
125 ** the list out from under you, your options are limited.
126 */
127 std::lock_guard<recursive_mutex> lock(local_socket_list_lock);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800128restart:
Josh Gao6f641ad2016-05-17 19:23:39 -0700129 for (s = local_socket_list.next; s != &local_socket_list; s = s->next) {
130 if (s->transport == t || (s->peer && s->peer->transport == t)) {
131 local_socket_close(s);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800132 goto restart;
133 }
134 }
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800135}
136
137static int local_socket_enqueue(asocket *s, apacket *p)
138{
139 D("LS(%d): enqueue %d\n", s->id, p->len);
140
141 p->ptr = p->data;
142
143 /* if there is already data queue'd, we will receive
144 ** events when it's time to write. just add this to
145 ** the tail
146 */
147 if(s->pkt_first) {
148 goto enqueue;
149 }
150
151 /* write as much as we can, until we
152 ** would block or there is an error/eof
153 */
154 while(p->len > 0) {
155 int r = adb_write(s->fd, p->ptr, p->len);
156 if(r > 0) {
157 p->len -= r;
158 p->ptr += r;
159 continue;
160 }
161 if((r == 0) || (errno != EAGAIN)) {
162 D( "LS(%d): not ready, errno=%d: %s\n", s->id, errno, strerror(errno) );
163 s->close(s);
164 return 1; /* not ready (error) */
165 } else {
166 break;
167 }
168 }
169
170 if(p->len == 0) {
171 put_apacket(p);
172 return 0; /* ready for more data */
173 }
174
175enqueue:
176 p->next = 0;
177 if(s->pkt_first) {
178 s->pkt_last->next = p;
179 } else {
180 s->pkt_first = p;
181 }
182 s->pkt_last = p;
183
184 /* make sure we are notified when we can drain the queue */
185 fdevent_add(&s->fde, FDE_WRITE);
186
187 return 1; /* not ready (backlog) */
188}
189
190static void local_socket_ready(asocket *s)
191{
Nanik Tolaramb627a0e2015-02-18 22:53:37 +1100192 /* far side is ready for data, pay attention to
193 readable events */
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800194 fdevent_add(&s->fde, FDE_READ);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800195}
196
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800197// be sure to hold the socket list lock when calling this
198static void local_socket_destroy(asocket *s)
199{
200 apacket *p, *n;
Benoit Gobyf366b362012-03-16 14:50:07 -0700201 int exit_on_close = s->exit_on_close;
202
JP Abgrall408fa572011-03-16 15:57:42 -0700203 D("LS(%d): destroying fde.fd=%d\n", s->id, s->fde.fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800204
205 /* IMPORTANT: the remove closes the fd
206 ** that belongs to this socket
207 */
208 fdevent_remove(&s->fde);
209
210 /* dispose of any unwritten data */
211 for(p = s->pkt_first; p; p = n) {
212 D("LS(%d): discarding %d bytes\n", s->id, p->len);
213 n = p->next;
214 put_apacket(p);
215 }
216 remove_socket(s);
217 free(s);
Benoit Gobyf366b362012-03-16 14:50:07 -0700218
219 if (exit_on_close) {
220 D("local_socket_destroy: exiting\n");
221 exit(1);
222 }
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800223}
224
Josh Gao6f641ad2016-05-17 19:23:39 -0700225static void local_socket_close(asocket* s) {
226 D("entered local_socket_close. LS(%d) fd=%d", s->id, s->fd);
227 std::lock_guard<recursive_mutex> lock(local_socket_list_lock);
228 if (s->peer) {
229 D("LS(%d): closing peer. peer->id=%d peer->fd=%d", s->id, s->peer->id, s->peer->fd);
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100230 /* Note: it's important to call shutdown before disconnecting from
231 * the peer, this ensures that remote sockets can still get the id
232 * of the local socket they're connected to, to send a CLOSE()
233 * protocol event. */
Josh Gao6f641ad2016-05-17 19:23:39 -0700234 if (s->peer->shutdown) {
235 s->peer->shutdown(s->peer);
Tom Marlin49f18572011-05-13 13:24:55 -0500236 }
Josh Gao6f641ad2016-05-17 19:23:39 -0700237 s->peer->peer = nullptr;
238 s->peer->close(s->peer);
239 s->peer = nullptr;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800240 }
241
242 /* If we are already closing, or if there are no
243 ** pending packets, destroy immediately
244 */
245 if (s->closing || s->pkt_first == NULL) {
246 int id = s->id;
247 local_socket_destroy(s);
248 D("LS(%d): closed\n", id);
249 return;
250 }
251
252 /* otherwise, put on the closing list
253 */
254 D("LS(%d): closing\n", s->id);
255 s->closing = 1;
256 fdevent_del(&s->fde, FDE_READ);
257 remove_socket(s);
JP Abgrall408fa572011-03-16 15:57:42 -0700258 D("LS(%d): put on socket_closing_list fd=%d\n", s->id, s->fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800259 insert_local_socket(s, &local_socket_closing_list);
260}
261
Dan Albertbac34742015-02-25 17:51:28 -0800262static void local_socket_event_func(int fd, unsigned ev, void* _s)
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800263{
Dan Albertbac34742015-02-25 17:51:28 -0800264 asocket* s = reinterpret_cast<asocket*>(_s);
JP Abgrall408fa572011-03-16 15:57:42 -0700265 D("LS(%d): event_func(fd=%d(==%d), ev=%04x)\n", s->id, s->fd, fd, ev);
266
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800267 /* put the FDE_WRITE processing before the FDE_READ
268 ** in order to simplify the code.
269 */
Dan Albertbac34742015-02-25 17:51:28 -0800270 if (ev & FDE_WRITE) {
271 apacket* p;
272 while ((p = s->pkt_first) != nullptr) {
273 while (p->len > 0) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800274 int r = adb_write(fd, p->ptr, p->len);
Dan Albertbac34742015-02-25 17:51:28 -0800275 if (r == -1) {
276 /* returning here is ok because FDE_READ will
277 ** be processed in the next iteration loop
278 */
279 if (errno == EAGAIN) {
280 return;
281 }
282 } else if (r > 0) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800283 p->ptr += r;
284 p->len -= r;
285 continue;
286 }
Dan Albertbac34742015-02-25 17:51:28 -0800287
Christopher Tate5b811fa2011-06-10 11:38:37 -0700288 D(" closing after write because r=%d and errno is %d\n", r, errno);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800289 s->close(s);
290 return;
291 }
292
Dan Albertbac34742015-02-25 17:51:28 -0800293 if (p->len == 0) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800294 s->pkt_first = p->next;
Dan Albertbac34742015-02-25 17:51:28 -0800295 if (s->pkt_first == 0) {
296 s->pkt_last = 0;
297 }
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800298 put_apacket(p);
299 }
300 }
301
Dan Albertbac34742015-02-25 17:51:28 -0800302 /* if we sent the last packet of a closing socket,
303 ** we can now destroy it.
304 */
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800305 if (s->closing) {
Christopher Tate5b811fa2011-06-10 11:38:37 -0700306 D(" closing because 'closing' is set after write\n");
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800307 s->close(s);
308 return;
309 }
310
Dan Albertbac34742015-02-25 17:51:28 -0800311 /* no more packets queued, so we can ignore
312 ** writable events again and tell our peer
313 ** to resume writing
314 */
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800315 fdevent_del(&s->fde, FDE_WRITE);
316 s->peer->ready(s->peer);
317 }
318
319
Dan Albertbac34742015-02-25 17:51:28 -0800320 if (ev & FDE_READ) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800321 apacket *p = get_apacket();
322 unsigned char *x = p->data;
323 size_t avail = MAX_PAYLOAD;
324 int r;
325 int is_eof = 0;
326
Dan Albertbac34742015-02-25 17:51:28 -0800327 while (avail > 0) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800328 r = adb_read(fd, x, avail);
Dan Albertbac34742015-02-25 17:51:28 -0800329 D("LS(%d): post adb_read(fd=%d,...) r=%d (errno=%d) avail=%zu\n",
330 s->id, s->fd, r, r < 0 ? errno : 0, avail);
331 if (r == -1) {
332 if (errno == EAGAIN) {
333 break;
334 }
335 } else if (r > 0) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800336 avail -= r;
337 x += r;
338 continue;
339 }
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800340
Dan Albertbac34742015-02-25 17:51:28 -0800341 /* r = 0 or unhandled error */
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800342 is_eof = 1;
343 break;
344 }
JP Abgrall408fa572011-03-16 15:57:42 -0700345 D("LS(%d): fd=%d post avail loop. r=%d is_eof=%d forced_eof=%d\n",
346 s->id, s->fd, r, is_eof, s->fde.force_eof);
Dan Albertbac34742015-02-25 17:51:28 -0800347 if ((avail == MAX_PAYLOAD) || (s->peer == 0)) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800348 put_apacket(p);
349 } else {
350 p->len = MAX_PAYLOAD - avail;
351
352 r = s->peer->enqueue(s->peer, p);
Dan Albertbac34742015-02-25 17:51:28 -0800353 D("LS(%d): fd=%d post peer->enqueue(). r=%d\n", s->id, s->fd,
354 r);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800355
Dan Albertbac34742015-02-25 17:51:28 -0800356 if (r < 0) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800357 /* error return means they closed us as a side-effect
358 ** and we must return immediately.
359 **
360 ** note that if we still have buffered packets, the
361 ** socket will be placed on the closing socket list.
362 ** this handler function will be called again
363 ** to process FDE_WRITE events.
364 */
365 return;
366 }
367
Dan Albertbac34742015-02-25 17:51:28 -0800368 if (r > 0) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800369 /* if the remote cannot accept further events,
370 ** we disable notification of READs. They'll
371 ** be enabled again when we get a call to ready()
372 */
373 fdevent_del(&s->fde, FDE_READ);
374 }
375 }
JP Abgrall112445b2011-04-12 22:01:58 -0700376 /* Don't allow a forced eof if data is still there */
Dan Albertbac34742015-02-25 17:51:28 -0800377 if ((s->fde.force_eof && !r) || is_eof) {
378 D(" closing because is_eof=%d r=%d s->fde.force_eof=%d\n",
379 is_eof, r, s->fde.force_eof);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800380 s->close(s);
381 }
382 }
383
Dan Albertbac34742015-02-25 17:51:28 -0800384 if (ev & FDE_ERROR){
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800385 /* this should be caught be the next read or write
386 ** catching it here means we may skip the last few
387 ** bytes of readable data.
388 */
JP Abgrall408fa572011-03-16 15:57:42 -0700389 D("LS(%d): FDE_ERROR (fd=%d)\n", s->id, s->fd);
390
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800391 return;
392 }
393}
394
395asocket *create_local_socket(int fd)
396{
Dan Albertbac34742015-02-25 17:51:28 -0800397 asocket *s = reinterpret_cast<asocket*>(calloc(1, sizeof(asocket)));
André Goddard Rosac419e2a2010-06-10 20:48:19 -0300398 if (s == NULL) fatal("cannot allocate socket");
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800399 s->fd = fd;
400 s->enqueue = local_socket_enqueue;
401 s->ready = local_socket_ready;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100402 s->shutdown = NULL;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800403 s->close = local_socket_close;
JP Abgrall408fa572011-03-16 15:57:42 -0700404 install_local_socket(s);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800405
406 fdevent_install(&s->fde, fd, local_socket_event_func, s);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800407 D("LS(%d): created (fd=%d)\n", s->id, s->fd);
408 return s;
409}
410
411asocket *create_local_service_socket(const char *name)
412{
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800413#if !ADB_HOST
414 if (!strcmp(name,"jdwp")) {
415 return create_jdwp_service_socket();
416 }
417 if (!strcmp(name,"track-jdwp")) {
418 return create_jdwp_tracker_service_socket();
419 }
420#endif
Dan Pasanen98858812014-10-06 12:57:20 -0500421 int fd = service_to_fd(name);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800422 if(fd < 0) return 0;
423
Dan Pasanen98858812014-10-06 12:57:20 -0500424 asocket* s = create_local_socket(fd);
JP Abgrall408fa572011-03-16 15:57:42 -0700425 D("LS(%d): bound to '%s' via %d\n", s->id, name, fd);
Benoit Gobyf366b362012-03-16 14:50:07 -0700426
JP Abgrallf91259a2012-03-30 13:19:11 -0700427#if !ADB_HOST
Dan Pasanen98858812014-10-06 12:57:20 -0500428 char debug[PROPERTY_VALUE_MAX];
jzhuan51297d222013-05-24 17:40:15 -0400429 if (!strncmp(name, "root:", 5))
430 property_get("ro.debuggable", debug, "");
431
Dan Pasanen98858812014-10-06 12:57:20 -0500432 if ((!strncmp(name, "root:", 5) && getuid() != 0 && strcmp(debug, "1") == 0)
433 || (!strncmp(name, "unroot:", 7) && getuid() == 0)
Benoit Gobyaeceb512012-06-12 12:12:18 -0700434 || !strncmp(name, "usb:", 4)
435 || !strncmp(name, "tcpip:", 6)) {
Benoit Gobyf366b362012-03-16 14:50:07 -0700436 D("LS(%d): enabling exit_on_close\n", s->id);
437 s->exit_on_close = 1;
438 }
JP Abgrallf91259a2012-03-30 13:19:11 -0700439#endif
Benoit Gobyf366b362012-03-16 14:50:07 -0700440
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800441 return s;
442}
443
444#if ADB_HOST
445static asocket *create_host_service_socket(const char *name, const char* serial)
446{
447 asocket *s;
448
449 s = host_service_to_socket(name, serial);
450
451 if (s != NULL) {
452 D("LS(%d) bound to '%s'\n", s->id, name);
453 return s;
454 }
455
456 return s;
457}
458#endif /* ADB_HOST */
459
460/* a Remote socket is used to send/receive data to/from a given transport object
461** it needs to be closed when the transport is forcibly destroyed by the user
462*/
Elliott Hughes2d4121c2015-04-17 09:47:42 -0700463struct aremotesocket {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800464 asocket socket;
465 adisconnect disconnect;
Elliott Hughes2d4121c2015-04-17 09:47:42 -0700466};
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800467
468static int remote_socket_enqueue(asocket *s, apacket *p)
469{
JP Abgrall408fa572011-03-16 15:57:42 -0700470 D("entered remote_socket_enqueue RS(%d) WRITE fd=%d peer.fd=%d\n",
471 s->id, s->fd, s->peer->fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800472 p->msg.command = A_WRTE;
473 p->msg.arg0 = s->peer->id;
474 p->msg.arg1 = s->id;
475 p->msg.data_length = p->len;
476 send_packet(p, s->transport);
477 return 1;
478}
479
480static void remote_socket_ready(asocket *s)
481{
JP Abgrall408fa572011-03-16 15:57:42 -0700482 D("entered remote_socket_ready RS(%d) OKAY fd=%d peer.fd=%d\n",
483 s->id, s->fd, s->peer->fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800484 apacket *p = get_apacket();
485 p->msg.command = A_OKAY;
486 p->msg.arg0 = s->peer->id;
487 p->msg.arg1 = s->id;
488 send_packet(p, s->transport);
489}
490
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100491static void remote_socket_shutdown(asocket *s)
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800492{
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100493 D("entered remote_socket_shutdown RS(%d) CLOSE fd=%d peer->fd=%d\n",
JP Abgrall408fa572011-03-16 15:57:42 -0700494 s->id, s->fd, s->peer?s->peer->fd:-1);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800495 apacket *p = get_apacket();
496 p->msg.command = A_CLSE;
497 if(s->peer) {
498 p->msg.arg0 = s->peer->id;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100499 }
500 p->msg.arg1 = s->id;
501 send_packet(p, s->transport);
502}
503
504static void remote_socket_close(asocket *s)
505{
506 if (s->peer) {
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800507 s->peer->peer = 0;
JP Abgrall408fa572011-03-16 15:57:42 -0700508 D("RS(%d) peer->close()ing peer->id=%d peer->fd=%d\n",
509 s->id, s->peer->id, s->peer->fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800510 s->peer->close(s->peer);
511 }
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100512 D("entered remote_socket_close RS(%d) CLOSE fd=%d peer->fd=%d\n",
513 s->id, s->fd, s->peer?s->peer->fd:-1);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800514 D("RS(%d): closed\n", s->id);
515 remove_transport_disconnect( s->transport, &((aremotesocket*)s)->disconnect );
516 free(s);
517}
518
519static void remote_socket_disconnect(void* _s, atransport* t)
520{
Dan Albertbac34742015-02-25 17:51:28 -0800521 asocket* s = reinterpret_cast<asocket*>(_s);
522 asocket* peer = s->peer;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800523
524 D("remote_socket_disconnect RS(%d)\n", s->id);
525 if (peer) {
526 peer->peer = NULL;
527 peer->close(peer);
528 }
529 remove_transport_disconnect( s->transport, &((aremotesocket*)s)->disconnect );
530 free(s);
531}
532
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100533/* Create an asocket to exchange packets with a remote service through transport
534 |t|. Where |id| is the socket id of the corresponding service on the other
535 side of the transport (it is allocated by the remote side and _cannot_ be 0).
536 Returns a new non-NULL asocket handle. */
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800537asocket *create_remote_socket(unsigned id, atransport *t)
538{
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100539 if (id == 0) fatal("invalid remote socket id (0)");
Dan Albertbac34742015-02-25 17:51:28 -0800540 asocket* s = reinterpret_cast<asocket*>(calloc(1, sizeof(aremotesocket)));
541 adisconnect* dis = &reinterpret_cast<aremotesocket*>(s)->disconnect;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800542
André Goddard Rosac419e2a2010-06-10 20:48:19 -0300543 if (s == NULL) fatal("cannot allocate socket");
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800544 s->id = id;
545 s->enqueue = remote_socket_enqueue;
546 s->ready = remote_socket_ready;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100547 s->shutdown = remote_socket_shutdown;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800548 s->close = remote_socket_close;
549 s->transport = t;
550
551 dis->func = remote_socket_disconnect;
552 dis->opaque = s;
553 add_transport_disconnect( t, dis );
554 D("RS(%d): created\n", s->id);
555 return s;
556}
557
558void connect_to_remote(asocket *s, const char *destination)
559{
JP Abgrall408fa572011-03-16 15:57:42 -0700560 D("Connect_to_remote call RS(%d) fd=%d\n", s->id, s->fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800561 apacket *p = get_apacket();
562 int len = strlen(destination) + 1;
563
564 if(len > (MAX_PAYLOAD-1)) {
565 fatal("destination oversized");
566 }
567
568 D("LS(%d): connect('%s')\n", s->id, destination);
569 p->msg.command = A_OPEN;
570 p->msg.arg0 = s->id;
571 p->msg.data_length = len;
572 strcpy((char*) p->data, destination);
573 send_packet(p, s->transport);
574}
575
576
577/* this is used by magic sockets to rig local sockets to
578 send the go-ahead message when they connect */
579static void local_socket_ready_notify(asocket *s)
580{
581 s->ready = local_socket_ready;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100582 s->shutdown = NULL;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800583 s->close = local_socket_close;
Elliott Hughes92af7332015-04-30 17:32:03 -0700584 SendOkay(s->fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800585 s->ready(s);
586}
587
588/* this is used by magic sockets to rig local sockets to
589 send the failure message if they are closed before
590 connected (to avoid closing them without a status message) */
591static void local_socket_close_notify(asocket *s)
592{
593 s->ready = local_socket_ready;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100594 s->shutdown = NULL;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800595 s->close = local_socket_close;
Elliott Hughes92af7332015-04-30 17:32:03 -0700596 SendFail(s->fd, "closed");
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800597 s->close(s);
598}
599
Elliott Hughes92af7332015-04-30 17:32:03 -0700600static unsigned unhex(unsigned char *s, int len)
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800601{
602 unsigned n = 0, c;
603
604 while(len-- > 0) {
605 switch((c = *s++)) {
606 case '0': case '1': case '2':
607 case '3': case '4': case '5':
608 case '6': case '7': case '8':
609 case '9':
610 c -= '0';
611 break;
612 case 'a': case 'b': case 'c':
613 case 'd': case 'e': case 'f':
614 c = c - 'a' + 10;
615 break;
616 case 'A': case 'B': case 'C':
617 case 'D': case 'E': case 'F':
618 c = c - 'A' + 10;
619 break;
620 default:
621 return 0xffffffff;
622 }
623
624 n = (n << 4) | c;
625 }
626
627 return n;
628}
629
Elliott Hughes92af7332015-04-30 17:32:03 -0700630#if ADB_HOST
631
Scott Anderson2ca3e6b2012-05-30 18:11:27 -0700632#define PREFIX(str) { str, sizeof(str) - 1 }
633static const struct prefix_struct {
634 const char *str;
635 const size_t len;
636} prefixes[] = {
637 PREFIX("usb:"),
638 PREFIX("product:"),
639 PREFIX("model:"),
640 PREFIX("device:"),
641};
642static const int num_prefixes = (sizeof(prefixes) / sizeof(prefixes[0]));
643
Terence Haddock28e13902011-03-16 09:43:56 +0100644/* skip_host_serial return the position in a string
645 skipping over the 'serial' parameter in the ADB protocol,
646 where parameter string may be a host:port string containing
647 the protocol delimiter (colon). */
Elliott Hughes92af7332015-04-30 17:32:03 -0700648static char *skip_host_serial(char *service) {
Terence Haddock28e13902011-03-16 09:43:56 +0100649 char *first_colon, *serial_end;
Scott Anderson2ca3e6b2012-05-30 18:11:27 -0700650 int i;
Terence Haddock28e13902011-03-16 09:43:56 +0100651
Scott Anderson2ca3e6b2012-05-30 18:11:27 -0700652 for (i = 0; i < num_prefixes; i++) {
653 if (!strncmp(service, prefixes[i].str, prefixes[i].len))
654 return strchr(service + prefixes[i].len, ':');
Scott Anderson3608d832012-05-31 12:04:23 -0700655 }
656
Terence Haddock28e13902011-03-16 09:43:56 +0100657 first_colon = strchr(service, ':');
658 if (!first_colon) {
659 /* No colon in service string. */
660 return NULL;
661 }
662 serial_end = first_colon;
663 if (isdigit(serial_end[1])) {
664 serial_end++;
665 while ((*serial_end) && isdigit(*serial_end)) {
666 serial_end++;
667 }
668 if ((*serial_end) != ':') {
669 // Something other than numbers was found, reset the end.
670 serial_end = first_colon;
671 }
672 }
673 return serial_end;
674}
675
Elliott Hughes92af7332015-04-30 17:32:03 -0700676#endif // ADB_HOST
677
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800678static int smart_socket_enqueue(asocket *s, apacket *p)
679{
680 unsigned len;
681#if ADB_HOST
682 char *service = NULL;
683 char* serial = NULL;
684 transport_type ttype = kTransportAny;
685#endif
686
687 D("SS(%d): enqueue %d\n", s->id, p->len);
688
689 if(s->pkt_first == 0) {
690 s->pkt_first = p;
691 s->pkt_last = p;
692 } else {
693 if((s->pkt_first->len + p->len) > MAX_PAYLOAD) {
694 D("SS(%d): overflow\n", s->id);
695 put_apacket(p);
696 goto fail;
697 }
698
699 memcpy(s->pkt_first->data + s->pkt_first->len,
700 p->data, p->len);
701 s->pkt_first->len += p->len;
702 put_apacket(p);
703
704 p = s->pkt_first;
705 }
706
707 /* don't bother if we can't decode the length */
708 if(p->len < 4) return 0;
709
710 len = unhex(p->data, 4);
711 if((len < 1) || (len > 1024)) {
712 D("SS(%d): bad size (%d)\n", s->id, len);
713 goto fail;
714 }
715
716 D("SS(%d): len is %d\n", s->id, len );
717 /* can't do anything until we have the full header */
718 if((len + 4) > p->len) {
719 D("SS(%d): waiting for %d more bytes\n", s->id, len+4 - p->len);
720 return 0;
721 }
722
723 p->data[len + 4] = 0;
724
725 D("SS(%d): '%s'\n", s->id, (char*) (p->data + 4));
726
727#if ADB_HOST
728 service = (char *)p->data + 4;
729 if(!strncmp(service, "host-serial:", strlen("host-serial:"))) {
730 char* serial_end;
731 service += strlen("host-serial:");
732
Terence Haddock28e13902011-03-16 09:43:56 +0100733 // serial number should follow "host:" and could be a host:port string.
734 serial_end = skip_host_serial(service);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800735 if (serial_end) {
736 *serial_end = 0; // terminate string
737 serial = service;
738 service = serial_end + 1;
739 }
740 } else if (!strncmp(service, "host-usb:", strlen("host-usb:"))) {
741 ttype = kTransportUsb;
742 service += strlen("host-usb:");
743 } else if (!strncmp(service, "host-local:", strlen("host-local:"))) {
744 ttype = kTransportLocal;
745 service += strlen("host-local:");
746 } else if (!strncmp(service, "host:", strlen("host:"))) {
747 ttype = kTransportAny;
748 service += strlen("host:");
749 } else {
750 service = NULL;
751 }
752
753 if (service) {
754 asocket *s2;
755
756 /* some requests are handled immediately -- in that
757 ** case the handle_host_request() routine has sent
758 ** the OKAY or FAIL message and all we have to do
759 ** is clean up.
760 */
761 if(handle_host_request(service, ttype, serial, s->peer->fd, s) == 0) {
762 /* XXX fail message? */
763 D( "SS(%d): handled host service '%s'\n", s->id, service );
764 goto fail;
765 }
766 if (!strncmp(service, "transport", strlen("transport"))) {
767 D( "SS(%d): okay transport\n", s->id );
768 p->len = 0;
769 return 0;
770 }
771
772 /* try to find a local service with this name.
773 ** if no such service exists, we'll fail out
774 ** and tear down here.
775 */
776 s2 = create_host_service_socket(service, serial);
777 if(s2 == 0) {
778 D( "SS(%d): couldn't create host service '%s'\n", s->id, service );
Elliott Hughes92af7332015-04-30 17:32:03 -0700779 SendFail(s->peer->fd, "unknown host service");
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800780 goto fail;
781 }
782
783 /* we've connected to a local host service,
784 ** so we make our peer back into a regular
785 ** local socket and bind it to the new local
786 ** service socket, acknowledge the successful
787 ** connection, and close this smart socket now
788 ** that its work is done.
789 */
Elliott Hughes92af7332015-04-30 17:32:03 -0700790 SendOkay(s->peer->fd);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800791
792 s->peer->ready = local_socket_ready;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100793 s->peer->shutdown = NULL;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800794 s->peer->close = local_socket_close;
795 s->peer->peer = s2;
796 s2->peer = s->peer;
797 s->peer = 0;
798 D( "SS(%d): okay\n", s->id );
799 s->close(s);
800
801 /* initial state is "ready" */
802 s2->ready(s2);
803 return 0;
804 }
805#else /* !ADB_HOST */
806 if (s->transport == NULL) {
Elliott Hughes7be29c82015-04-16 22:54:44 -0700807 std::string error_msg = "unknown failure";
808 s->transport = acquire_one_transport(CS_ANY, kTransportAny, NULL, &error_msg);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800809
810 if (s->transport == NULL) {
Elliott Hughes92af7332015-04-30 17:32:03 -0700811 SendFail(s->peer->fd, error_msg);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800812 goto fail;
813 }
814 }
815#endif
816
817 if(!(s->transport) || (s->transport->connection_state == CS_OFFLINE)) {
818 /* if there's no remote we fail the connection
819 ** right here and terminate it
820 */
Elliott Hughes92af7332015-04-30 17:32:03 -0700821 SendFail(s->peer->fd, "device offline (x)");
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800822 goto fail;
823 }
824
825
826 /* instrument our peer to pass the success or fail
827 ** message back once it connects or closes, then
828 ** detach from it, request the connection, and
829 ** tear down
830 */
831 s->peer->ready = local_socket_ready_notify;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100832 s->peer->shutdown = NULL;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800833 s->peer->close = local_socket_close_notify;
834 s->peer->peer = 0;
835 /* give him our transport and upref it */
836 s->peer->transport = s->transport;
837
838 connect_to_remote(s->peer, (char*) (p->data + 4));
839 s->peer = 0;
840 s->close(s);
841 return 1;
842
843fail:
844 /* we're going to close our peer as a side-effect, so
845 ** return -1 to signal that state to the local socket
846 ** who is enqueueing against us
847 */
848 s->close(s);
849 return -1;
850}
851
852static void smart_socket_ready(asocket *s)
853{
854 D("SS(%d): ready\n", s->id);
855}
856
857static void smart_socket_close(asocket *s)
858{
859 D("SS(%d): closed\n", s->id);
860 if(s->pkt_first){
861 put_apacket(s->pkt_first);
862 }
863 if(s->peer) {
864 s->peer->peer = 0;
865 s->peer->close(s->peer);
Tom Marlin49f18572011-05-13 13:24:55 -0500866 s->peer = 0;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800867 }
868 free(s);
869}
870
Benoit Goby9470c2f2013-02-20 15:04:53 -0800871static asocket *create_smart_socket(void)
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800872{
873 D("Creating smart socket \n");
Dan Albertbac34742015-02-25 17:51:28 -0800874 asocket *s = reinterpret_cast<asocket*>(calloc(1, sizeof(asocket)));
André Goddard Rosac419e2a2010-06-10 20:48:19 -0300875 if (s == NULL) fatal("cannot allocate socket");
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800876 s->enqueue = smart_socket_enqueue;
877 s->ready = smart_socket_ready;
David 'Digit' Turner818d6412013-12-13 14:09:44 +0100878 s->shutdown = NULL;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800879 s->close = smart_socket_close;
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800880
Benoit Goby9470c2f2013-02-20 15:04:53 -0800881 D("SS(%d)\n", s->id);
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800882 return s;
883}
884
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800885void connect_to_smartsocket(asocket *s)
886{
887 D("Connecting to smart socket \n");
Benoit Goby9470c2f2013-02-20 15:04:53 -0800888 asocket *ss = create_smart_socket();
The Android Open Source Projectdd7bc332009-03-03 19:32:55 -0800889 s->peer = ss;
890 ss->peer = s;
891 s->ready(s);
892}