transport_local.c - SHIFTPHONES/android_packages_modules_adb - Gitiles

 /*
  * Copyright (C) 2007 The Android Open Source Project
  *
  * Licensed under the Apache License, Version 2.0 (the "License");
  * you may not use this file except in compliance with the License.
  * You may obtain a copy of the License at
  *
  *      http://www.apache.org/licenses/LICENSE-2.0
  *
  * Unless required by applicable law or agreed to in writing, software
  * distributed under the License is distributed on an "AS IS" BASIS,
  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  * See the License for the specific language governing permissions and
  * limitations under the License.
  */

 #include <stdio.h>
 #include <stdlib.h>
 #include <string.h>
 #include <errno.h>

 #include "sysdeps.h"
 #include <sys/types.h>

 #define  TRACE_TAG  TRACE_TRANSPORT
 #include "adb.h"

 #ifdef __ppc__
 #define H4(x)	(((x) & 0xFF000000) >> 24) | (((x) & 0x00FF0000) >> 8) | (((x) & 0x0000FF00) << 8) | (((x) & 0x000000FF) << 24)
 static inline void fix_endians(apacket *p)
 {
     p->msg.command     = H4(p->msg.command);
     p->msg.arg0        = H4(p->msg.arg0);
     p->msg.arg1        = H4(p->msg.arg1);
     p->msg.data_length = H4(p->msg.data_length);
     p->msg.data_check  = H4(p->msg.data_check);
     p->msg.magic       = H4(p->msg.magic);
 }
 #else
 #define fix_endians(p) do {} while (0)
 #endif

 #if ADB_HOST
 /* we keep a list of opened transports. The atransport struct knows to which
  * local transport it is connected. The list is used to detect when we're
  * trying to connect twice to a given local transport.
  */
 #define  ADB_LOCAL_TRANSPORT_MAX  16

 ADB_MUTEX_DEFINE( local_transports_lock );

 static atransport*  local_transports[ ADB_LOCAL_TRANSPORT_MAX ];
 #endif /* ADB_HOST */

 static int remote_read(apacket *p, atransport *t)
 {
     if(readx(t->sfd, &p->msg, sizeof(amessage))){
         D("remote local: read terminated (message)\n");
         return -1;
     }

     fix_endians(p);

 #if 0 && defined __ppc__
     D("read remote packet: %04x arg0=%0x arg1=%0x data_length=%0x data_check=%0x magic=%0x\n",
       p->msg.command, p->msg.arg0, p->msg.arg1, p->msg.data_length, p->msg.data_check, p->msg.magic);
 #endif
     if(check_header(p)) {
         D("bad header: terminated (data)\n");
         return -1;
     }

     if(readx(t->sfd, p->data, p->msg.data_length)){
         D("remote local: terminated (data)\n");
         return -1;
     }

     if(check_data(p)) {
         D("bad data: terminated (data)\n");
         return -1;
     }

     return 0;
 }

 static int remote_write(apacket *p, atransport *t)
 {
     int   length = p->msg.data_length;

     fix_endians(p);

 #if 0 && defined __ppc__
     D("write remote packet: %04x arg0=%0x arg1=%0x data_length=%0x data_check=%0x magic=%0x\n",
       p->msg.command, p->msg.arg0, p->msg.arg1, p->msg.data_length, p->msg.data_check, p->msg.magic);
 #endif
     if(writex(t->sfd, &p->msg, sizeof(amessage) + length)) {
         D("remote local: write terminated\n");
         return -1;
     }

     return 0;
 }


 int local_connect(int port) {
     return local_connect_arbitrary_ports(port-1, port);
 }

 int local_connect_arbitrary_ports(int console_port, int adb_port)
 {
     char buf[64];
     int  fd = -1;

 #if ADB_HOST
     const char *host = getenv("ADBHOST");
     if (host) {
         fd = socket_network_client(host, adb_port, SOCK_STREAM);
     }
 #endif
     if (fd < 0) {
         fd = socket_loopback_client(adb_port, SOCK_STREAM);
     }

     if (fd >= 0) {
         D("client: connected on remote on fd %d\n", fd);
         close_on_exec(fd);
         disable_tcp_nagle(fd);
         snprintf(buf, sizeof buf, "%s%d", LOCAL_CLIENT_PREFIX, console_port);
         register_socket_transport(fd, buf, adb_port, 1);
         return 0;
     }
     return -1;
 }


 static void *client_socket_thread(void *x)
 {
 #if ADB_HOST
     int  port  = DEFAULT_ADB_LOCAL_TRANSPORT_PORT;
     int  count = ADB_LOCAL_TRANSPORT_MAX;

     D("transport: client_socket_thread() starting\n");

     /* try to connect to any number of running emulator instances     */
     /* this is only done when ADB starts up. later, each new emulator */
     /* will send a message to ADB to indicate that is is starting up  */
     for ( ; count > 0; count--, port += 2 ) {
         (void) local_connect(port);
     }
 #endif
     return 0;
 }

 static void *server_socket_thread(void * arg)
 {
     int serverfd, fd;
     struct sockaddr addr;
     socklen_t alen;
     int port = (int)arg;

     D("transport: server_socket_thread() starting\n");
     serverfd = -1;
     for(;;) {
         if(serverfd == -1) {
             serverfd = socket_inaddr_any_server(port, SOCK_STREAM);
             if(serverfd < 0) {
                 D("server: cannot bind socket yet\n");
                 adb_sleep_ms(1000);
                 continue;
             }
             close_on_exec(serverfd);
         }

         alen = sizeof(addr);
         D("server: trying to get new connection from %d\n", port);
         fd = adb_socket_accept(serverfd, &addr, &alen);
         if(fd >= 0) {
             D("server: new connection on fd %d\n", fd);
             close_on_exec(fd);
             disable_tcp_nagle(fd);
             register_socket_transport(fd, "host", port, 1);
         }
     }
     D("transport: server_socket_thread() exiting\n");
     return 0;
 }

 void local_init(int port)
 {
     adb_thread_t thr;
     void* (*func)(void *);

     if(HOST) {
         func = client_socket_thread;
     } else {
         func = server_socket_thread;
     }

     D("transport: local %s init\n", HOST ? "client" : "server");

     if(adb_thread_create(&thr, func, (void *)port)) {
         fatal_errno("cannot create local socket %s thread",
                     HOST ? "client" : "server");
     }
 }

 static void remote_kick(atransport *t)
 {
     int fd = t->sfd;
     t->sfd = -1;
     adb_shutdown(fd);
     adb_close(fd);

 #if ADB_HOST
     if(HOST) {
         int  nn;
         adb_mutex_lock( &local_transports_lock );
         for (nn = 0; nn < ADB_LOCAL_TRANSPORT_MAX; nn++) {
             if (local_transports[nn] == t) {
                 local_transports[nn] = NULL;
                 break;
             }
         }
         adb_mutex_unlock( &local_transports_lock );
     }
 #endif
 }

 static void remote_close(atransport *t)
 {
     adb_close(t->fd);
 }


 #if ADB_HOST
 /* Only call this function if you already hold local_transports_lock. */
 atransport* find_emulator_transport_by_adb_port_locked(int adb_port)
 {
     int i;
     for (i = 0; i < ADB_LOCAL_TRANSPORT_MAX; i++) {
         if (local_transports[i] && local_transports[i]->adb_port == adb_port) {
             return local_transports[i];
         }
     }
     return NULL;
 }

 atransport* find_emulator_transport_by_adb_port(int adb_port)
 {
     adb_mutex_lock( &local_transports_lock );
     atransport* result = find_emulator_transport_by_adb_port_locked(adb_port);
     adb_mutex_unlock( &local_transports_lock );
     return result;
 }

 /* Only call this function if you already hold local_transports_lock. */
 int get_available_local_transport_index_locked()
 {
     int i;
     for (i = 0; i < ADB_LOCAL_TRANSPORT_MAX; i++) {
         if (local_transports[i] == NULL) {
             return i;
         }
     }
     return -1;
 }

 int get_available_local_transport_index()
 {
     adb_mutex_lock( &local_transports_lock );
     int result = get_available_local_transport_index_locked();
     adb_mutex_unlock( &local_transports_lock );
     return result;
 }
 #endif

 int init_socket_transport(atransport *t, int s, int adb_port, int local)
 {
     int  fail = 0;

     t->kick = remote_kick;
     t->close = remote_close;
     t->read_from_remote = remote_read;
     t->write_to_remote = remote_write;
     t->sfd = s;
     t->sync_token = 1;
     t->connection_state = CS_OFFLINE;
     t->type = kTransportLocal;
     t->adb_port = 0;

 #if ADB_HOST
     if (HOST && local) {
         adb_mutex_lock( &local_transports_lock );
         {
             t->adb_port = adb_port;
             atransport* existing_transport =
                     find_emulator_transport_by_adb_port_locked(adb_port);
             int index = get_available_local_transport_index_locked();
             if (existing_transport != NULL) {
                 D("local transport for port %d already registered (%p)?\n",
                 adb_port, existing_transport);
                 fail = -1;
             } else if (index < 0) {
                 // Too many emulators.
                 D("cannot register more emulators. Maximum is %d\n",
                         ADB_LOCAL_TRANSPORT_MAX);
                 fail = -1;
             } else {
                 local_transports[index] = t;
             }
        }
        adb_mutex_unlock( &local_transports_lock );
     }
 #endif
     return fail;
 }
	/*
	* Copyright (C) 2007 The Android Open Source Project
	*
	* Licensed under the Apache License, Version 2.0 (the "License");
	* you may not use this file except in compliance with the License.
	* You may obtain a copy of the License at
	*
	* http://www.apache.org/licenses/LICENSE-2.0
	*
	* Unless required by applicable law or agreed to in writing, software
	* distributed under the License is distributed on an "AS IS" BASIS,
	* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
	* See the License for the specific language governing permissions and
	* limitations under the License.
	*/

	#include <stdio.h>
	#include <stdlib.h>
	#include <string.h>
	#include <errno.h>

	#include "sysdeps.h"
	#include <sys/types.h>

	#define TRACE_TAG TRACE_TRANSPORT
	#include "adb.h"

	#ifdef __ppc__
	#define H4(x) (((x) & 0xFF000000) >> 24) \| (((x) & 0x00FF0000) >> 8) \| (((x) & 0x0000FF00) << 8) \| (((x) & 0x000000FF) << 24)
	static inline void fix_endians(apacket *p)
	{
	p->msg.command = H4(p->msg.command);
	p->msg.arg0 = H4(p->msg.arg0);
	p->msg.arg1 = H4(p->msg.arg1);
	p->msg.data_length = H4(p->msg.data_length);
	p->msg.data_check = H4(p->msg.data_check);
	p->msg.magic = H4(p->msg.magic);
	}
	#else
	#define fix_endians(p) do {} while (0)
	#endif

	#if ADB_HOST
	/* we keep a list of opened transports. The atransport struct knows to which
	* local transport it is connected. The list is used to detect when we're
	* trying to connect twice to a given local transport.
	*/
	#define ADB_LOCAL_TRANSPORT_MAX 16

	ADB_MUTEX_DEFINE( local_transports_lock );

	static atransport* local_transports[ ADB_LOCAL_TRANSPORT_MAX ];
	#endif /* ADB_HOST */

	static int remote_read(apacket p, atransport t)
	{
	if(readx(t->sfd, &p->msg, sizeof(amessage))){
	D("remote local: read terminated (message)\n");
	return -1;
	}

	fix_endians(p);

	#if 0 && defined __ppc__
	D("read remote packet: %04x arg0=%0x arg1=%0x data_length=%0x data_check=%0x magic=%0x\n",
	p->msg.command, p->msg.arg0, p->msg.arg1, p->msg.data_length, p->msg.data_check, p->msg.magic);
	#endif
	if(check_header(p)) {
	D("bad header: terminated (data)\n");
	return -1;
	}

	if(readx(t->sfd, p->data, p->msg.data_length)){
	D("remote local: terminated (data)\n");
	return -1;
	}

	if(check_data(p)) {
	D("bad data: terminated (data)\n");
	return -1;
	}

	return 0;
	}

	static int remote_write(apacket p, atransport t)
	{
	int length = p->msg.data_length;

	fix_endians(p);

	#if 0 && defined __ppc__
	D("write remote packet: %04x arg0=%0x arg1=%0x data_length=%0x data_check=%0x magic=%0x\n",
	p->msg.command, p->msg.arg0, p->msg.arg1, p->msg.data_length, p->msg.data_check, p->msg.magic);
	#endif
	if(writex(t->sfd, &p->msg, sizeof(amessage) + length)) {
	D("remote local: write terminated\n");
	return -1;
	}

	return 0;
	}


	int local_connect(int port) {
	return local_connect_arbitrary_ports(port-1, port);
	}

	int local_connect_arbitrary_ports(int console_port, int adb_port)
	{
	char buf[64];
	int fd = -1;

	#if ADB_HOST
	const char *host = getenv("ADBHOST");
	if (host) {
	fd = socket_network_client(host, adb_port, SOCK_STREAM);
	}
	#endif
	if (fd < 0) {
	fd = socket_loopback_client(adb_port, SOCK_STREAM);
	}

	if (fd >= 0) {
	D("client: connected on remote on fd %d\n", fd);
	close_on_exec(fd);
	disable_tcp_nagle(fd);
	snprintf(buf, sizeof buf, "%s%d", LOCAL_CLIENT_PREFIX, console_port);
	register_socket_transport(fd, buf, adb_port, 1);
	return 0;
	}
	return -1;
	}


	static void client_socket_thread(void x)
	{
	#if ADB_HOST
	int port = DEFAULT_ADB_LOCAL_TRANSPORT_PORT;
	int count = ADB_LOCAL_TRANSPORT_MAX;

	D("transport: client_socket_thread() starting\n");

	/* try to connect to any number of running emulator instances */
	/* this is only done when ADB starts up. later, each new emulator */
	/* will send a message to ADB to indicate that is is starting up */
	for ( ; count > 0; count--, port += 2 ) {
	(void) local_connect(port);
	}
	#endif
	return 0;
	}

	static void server_socket_thread(void arg)
	{
	int serverfd, fd;
	struct sockaddr addr;
	socklen_t alen;
	int port = (int)arg;

	D("transport: server_socket_thread() starting\n");
	serverfd = -1;
	for(;;) {
	if(serverfd == -1) {
	serverfd = socket_inaddr_any_server(port, SOCK_STREAM);
	if(serverfd < 0) {
	D("server: cannot bind socket yet\n");
	adb_sleep_ms(1000);
	continue;
	}
	close_on_exec(serverfd);
	}

	alen = sizeof(addr);
	D("server: trying to get new connection from %d\n", port);
	fd = adb_socket_accept(serverfd, &addr, &alen);
	if(fd >= 0) {
	D("server: new connection on fd %d\n", fd);
	close_on_exec(fd);
	disable_tcp_nagle(fd);
	register_socket_transport(fd, "host", port, 1);
	}
	}
	D("transport: server_socket_thread() exiting\n");
	return 0;
	}

	void local_init(int port)
	{
	adb_thread_t thr;
	void* (func)(void );

	if(HOST) {
	func = client_socket_thread;
	} else {
	func = server_socket_thread;
	}

	D("transport: local %s init\n", HOST ? "client" : "server");

	if(adb_thread_create(&thr, func, (void *)port)) {
	fatal_errno("cannot create local socket %s thread",
	HOST ? "client" : "server");
	}
	}

	static void remote_kick(atransport *t)
	{
	int fd = t->sfd;
	t->sfd = -1;
	adb_shutdown(fd);
	adb_close(fd);

	#if ADB_HOST
	if(HOST) {
	int nn;
	adb_mutex_lock( &local_transports_lock );
	for (nn = 0; nn < ADB_LOCAL_TRANSPORT_MAX; nn++) {
	if (local_transports[nn] == t) {
	local_transports[nn] = NULL;
	break;
	}
	}
	adb_mutex_unlock( &local_transports_lock );
	}
	#endif
	}

	static void remote_close(atransport *t)
	{
	adb_close(t->fd);
	}


	#if ADB_HOST
	/* Only call this function if you already hold local_transports_lock. */
	atransport* find_emulator_transport_by_adb_port_locked(int adb_port)
	{
	int i;
	for (i = 0; i < ADB_LOCAL_TRANSPORT_MAX; i++) {
	if (local_transports[i] && local_transports[i]->adb_port == adb_port) {
	return local_transports[i];
	}
	}
	return NULL;
	}

	atransport* find_emulator_transport_by_adb_port(int adb_port)
	{
	adb_mutex_lock( &local_transports_lock );
	atransport* result = find_emulator_transport_by_adb_port_locked(adb_port);
	adb_mutex_unlock( &local_transports_lock );
	return result;
	}

	/* Only call this function if you already hold local_transports_lock. */
	int get_available_local_transport_index_locked()
	{
	int i;
	for (i = 0; i < ADB_LOCAL_TRANSPORT_MAX; i++) {
	if (local_transports[i] == NULL) {
	return i;
	}
	}
	return -1;
	}

	int get_available_local_transport_index()
	{
	adb_mutex_lock( &local_transports_lock );
	int result = get_available_local_transport_index_locked();
	adb_mutex_unlock( &local_transports_lock );
	return result;
	}
	#endif

	int init_socket_transport(atransport *t, int s, int adb_port, int local)
	{
	int fail = 0;

	t->kick = remote_kick;
	t->close = remote_close;
	t->read_from_remote = remote_read;
	t->write_to_remote = remote_write;
	t->sfd = s;
	t->sync_token = 1;
	t->connection_state = CS_OFFLINE;
	t->type = kTransportLocal;
	t->adb_port = 0;

	#if ADB_HOST
	if (HOST && local) {
	adb_mutex_lock( &local_transports_lock );
	{
	t->adb_port = adb_port;
	atransport* existing_transport =
	find_emulator_transport_by_adb_port_locked(adb_port);
	int index = get_available_local_transport_index_locked();
	if (existing_transport != NULL) {
	D("local transport for port %d already registered (%p)?\n",
	adb_port, existing_transport);
	fail = -1;
	} else if (index < 0) {
	// Too many emulators.
	D("cannot register more emulators. Maximum is %d\n",
	ADB_LOCAL_TRANSPORT_MAX);
	fail = -1;
	} else {
	local_transports[index] = t;
	}
	}
	adb_mutex_unlock( &local_transports_lock );
	}
	#endif
	return fail;
	}