sockets.c revision 3608d832425ca3a6d00c4040f3bb979c5aa49899
1dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* 2dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * Copyright (C) 2007 The Android Open Source Project 3dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * 4dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * Licensed under the Apache License, Version 2.0 (the "License"); 5dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * you may not use this file except in compliance with the License. 6dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * You may obtain a copy of the License at 7dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * 8dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * http://www.apache.org/licenses/LICENSE-2.0 9dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * 10dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * Unless required by applicable law or agreed to in writing, software 11dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * distributed under the License is distributed on an "AS IS" BASIS, 12dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * See the License for the specific language governing permissions and 14dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project * limitations under the License. 15dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 16dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 17dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <stdio.h> 18dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <stdlib.h> 19dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <unistd.h> 20dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <errno.h> 21dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <string.h> 22dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include <ctype.h> 23dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 24dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include "sysdeps.h" 25dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 26dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#define TRACE_TAG TRACE_SOCKETS 27dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#include "adb.h" 28dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 29dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source ProjectADB_MUTEX_DEFINE( socket_list_lock ); 30dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 31dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_close_locked(asocket *s); 32dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 33dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectint sendfailmsg(int fd, const char *reason) 34dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 35dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project char buf[9]; 36dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int len; 37dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project len = strlen(reason); 38dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(len > 0xffff) len = 0xffff; 39dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project snprintf(buf, sizeof buf, "FAIL%04x", len); 40dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(writex(fd, buf, 8)) return -1; 41dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return writex(fd, reason, len); 42dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 43dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 44dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project//extern int online; 45dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 46dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic unsigned local_socket_next_id = 1; 47dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 48dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic asocket local_socket_list = { 49dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project .next = &local_socket_list, 50dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project .prev = &local_socket_list, 51dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project}; 52dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 53dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* the the list of currently closing local sockets. 54dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project** these have no peer anymore, but still packets to 55dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project** write to their fd. 56dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project*/ 57dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic asocket local_socket_closing_list = { 58dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project .next = &local_socket_closing_list, 59dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project .prev = &local_socket_closing_list, 60dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project}; 61dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 62dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectasocket *find_local_socket(unsigned id) 63dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 64dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s; 65dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *result = NULL; 66dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 67dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&socket_list_lock); 688182829ccb46fc5b043ea258672602dc2928dee2André Goddard Rosa for (s = local_socket_list.next; s != &local_socket_list; s = s->next) { 698182829ccb46fc5b043ea258672602dc2928dee2André Goddard Rosa if (s->id == id) { 708182829ccb46fc5b043ea258672602dc2928dee2André Goddard Rosa result = s; 718182829ccb46fc5b043ea258672602dc2928dee2André Goddard Rosa break; 728182829ccb46fc5b043ea258672602dc2928dee2André Goddard Rosa } 73dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 74dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&socket_list_lock); 75dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 76dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return result; 77dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 78dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 79dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void 80dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectinsert_local_socket(asocket* s, asocket* list) 81dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 82dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->next = list; 83dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->prev = s->next->prev; 84dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->prev->next = s; 85dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->next->prev = s; 86dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 87dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 88dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 89dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid install_local_socket(asocket *s) 90dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 91dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&socket_list_lock); 92dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 93dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->id = local_socket_next_id++; 94dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project insert_local_socket(s, &local_socket_list); 95dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 96dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&socket_list_lock); 97dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 98dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 99dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid remove_socket(asocket *s) 100dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 101dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // socket_list_lock should already be held 102dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (s->prev && s->next) 103dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project { 104dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->prev->next = s->next; 105dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->next->prev = s->prev; 106dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->next = 0; 107dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->prev = 0; 108dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->id = 0; 109dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 110dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 111dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 112dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid close_all_sockets(atransport *t) 113dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 114dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s; 115dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 116dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* this is a little gross, but since s->close() *will* modify 117dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** the list out from under you, your options are limited. 118dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 119dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&socket_list_lock); 120dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectrestart: 121dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(s = local_socket_list.next; s != &local_socket_list; s = s->next){ 122dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->transport == t || (s->peer && s->peer->transport == t)) { 123dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project local_socket_close_locked(s); 124dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto restart; 125dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 126dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 127dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&socket_list_lock); 128dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 129dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 130dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic int local_socket_enqueue(asocket *s, apacket *p) 131dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 132dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("LS(%d): enqueue %d\n", s->id, p->len); 133dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 134dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->ptr = p->data; 135dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 136dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* if there is already data queue'd, we will receive 137dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** events when it's time to write. just add this to 138dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** the tail 139dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 140dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->pkt_first) { 141dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto enqueue; 142dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 143dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 144dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* write as much as we can, until we 145dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** would block or there is an error/eof 146dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 147dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while(p->len > 0) { 148dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int r = adb_write(s->fd, p->ptr, p->len); 149dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(r > 0) { 150dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->len -= r; 151dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->ptr += r; 152dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 153dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 154dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if((r == 0) || (errno != EAGAIN)) { 155dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D( "LS(%d): not ready, errno=%d: %s\n", s->id, errno, strerror(errno) ); 156dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 157dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 1; /* not ready (error) */ 158dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 159dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 160dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 161dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 162dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 163dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(p->len == 0) { 164dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project put_apacket(p); 165dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; /* ready for more data */ 166dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 167dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 168dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectenqueue: 169dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->next = 0; 170dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->pkt_first) { 171dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->pkt_last->next = p; 172dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 173dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->pkt_first = p; 174dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 175dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->pkt_last = p; 176dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 177dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* make sure we are notified when we can drain the queue */ 178dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fdevent_add(&s->fde, FDE_WRITE); 179dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 180dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 1; /* not ready (backlog) */ 181dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 182dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 183dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_ready(asocket *s) 184dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 185dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* far side is ready for data, pay attention to 186dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project readable events */ 187dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fdevent_add(&s->fde, FDE_READ); 188dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project// D("LS(%d): ready()\n", s->id); 189dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 190dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 191dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_close(asocket *s) 192dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 193dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_lock(&socket_list_lock); 194dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project local_socket_close_locked(s); 195dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_mutex_unlock(&socket_list_lock); 196dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 197dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 198dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project// be sure to hold the socket list lock when calling this 199dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_destroy(asocket *s) 200dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 201dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project apacket *p, *n; 202408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): destroying fde.fd=%d\n", s->id, s->fde.fd); 203dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 204dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* IMPORTANT: the remove closes the fd 205dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** that belongs to this socket 206dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 207dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fdevent_remove(&s->fde); 208dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 209dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* dispose of any unwritten data */ 210dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project for(p = s->pkt_first; p; p = n) { 211dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("LS(%d): discarding %d bytes\n", s->id, p->len); 212dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project n = p->next; 213dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project put_apacket(p); 214dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 215dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project remove_socket(s); 216dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project free(s); 217dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 218dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 219dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 220dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_close_locked(asocket *s) 221dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 222408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("entered. LS(%d) fd=%d\n", s->id, s->fd); 223dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->peer) { 224408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): closing peer. peer->id=%d peer->fd=%d\n", 225408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall s->id, s->peer->id, s->peer->fd); 226dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->peer = 0; 227dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project // tweak to avoid deadlock 22849f1857dd8b64cdd57f28e965a1ff5fa0c2b0547Tom Marlin if (s->peer->close == local_socket_close) { 229dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project local_socket_close_locked(s->peer); 23049f1857dd8b64cdd57f28e965a1ff5fa0c2b0547Tom Marlin } else { 231dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->close(s->peer); 23249f1857dd8b64cdd57f28e965a1ff5fa0c2b0547Tom Marlin } 23349f1857dd8b64cdd57f28e965a1ff5fa0c2b0547Tom Marlin s->peer = 0; 234dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 235dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 236dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* If we are already closing, or if there are no 237dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** pending packets, destroy immediately 238dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 239dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (s->closing || s->pkt_first == NULL) { 240dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int id = s->id; 241dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project local_socket_destroy(s); 242dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("LS(%d): closed\n", id); 243dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return; 244dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 245dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 246dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* otherwise, put on the closing list 247dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 248dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("LS(%d): closing\n", s->id); 249dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->closing = 1; 250dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fdevent_del(&s->fde, FDE_READ); 251dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project remove_socket(s); 252408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): put on socket_closing_list fd=%d\n", s->id, s->fd); 253dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project insert_local_socket(s, &local_socket_closing_list); 254dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 255dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 256dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_event_func(int fd, unsigned ev, void *_s) 257dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 258dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s = _s; 259dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 260408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): event_func(fd=%d(==%d), ev=%04x)\n", s->id, s->fd, fd, ev); 261408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall 262dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* put the FDE_WRITE processing before the FDE_READ 263dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** in order to simplify the code. 264dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 265dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(ev & FDE_WRITE){ 266dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project apacket *p; 267dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 268dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while((p = s->pkt_first) != 0) { 269dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while(p->len > 0) { 270dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int r = adb_write(fd, p->ptr, p->len); 271dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(r > 0) { 272dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->ptr += r; 273dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->len -= r; 274dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 275dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 276dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(r < 0) { 277dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* returning here is ok because FDE_READ will 278dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** be processed in the next iteration loop 279dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 280dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(errno == EAGAIN) return; 281dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(errno == EINTR) continue; 282dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 2835b811fa5dd00288954f15209a56aea03d5e4a004Christopher Tate D(" closing after write because r=%d and errno is %d\n", r, errno); 284dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 285dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return; 286dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 287dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 288dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(p->len == 0) { 289dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->pkt_first = p->next; 290dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->pkt_first == 0) s->pkt_last = 0; 291dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project put_apacket(p); 292dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 293dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 294dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 295dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* if we sent the last packet of a closing socket, 296dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** we can now destroy it. 297dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 298dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (s->closing) { 2995b811fa5dd00288954f15209a56aea03d5e4a004Christopher Tate D(" closing because 'closing' is set after write\n"); 300dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 301dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return; 302dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 303dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 304dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* no more packets queued, so we can ignore 305dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** writable events again and tell our peer 306dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** to resume writing 307dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 308dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fdevent_del(&s->fde, FDE_WRITE); 309dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->ready(s->peer); 310dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 311dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 312dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 313dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(ev & FDE_READ){ 314dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project apacket *p = get_apacket(); 315dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned char *x = p->data; 316dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project size_t avail = MAX_PAYLOAD; 317dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int r; 318dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int is_eof = 0; 319dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 320dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while(avail > 0) { 321dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project r = adb_read(fd, x, avail); 322408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): post adb_read(fd=%d,...) r=%d (errno=%d) avail=%d\n", s->id, s->fd, r, r<0?errno:0, avail); 323dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(r > 0) { 324dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project avail -= r; 325dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project x += r; 326dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project continue; 327dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 328dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(r < 0) { 329dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(errno == EAGAIN) break; 330dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(errno == EINTR) continue; 331dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 332dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 333dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* r = 0 or unhandled error */ 334dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project is_eof = 1; 335dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 336dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 337408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): fd=%d post avail loop. r=%d is_eof=%d forced_eof=%d\n", 338408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall s->id, s->fd, r, is_eof, s->fde.force_eof); 339dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if((avail == MAX_PAYLOAD) || (s->peer == 0)) { 340dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project put_apacket(p); 341dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 342dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->len = MAX_PAYLOAD - avail; 343dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 344dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project r = s->peer->enqueue(s->peer, p); 345408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): fd=%d post peer->enqueue(). r=%d\n", s->id, s->fd, r); 346dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 347dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(r < 0) { 348dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* error return means they closed us as a side-effect 349dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** and we must return immediately. 350dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** 351dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** note that if we still have buffered packets, the 352dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** socket will be placed on the closing socket list. 353dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** this handler function will be called again 354dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** to process FDE_WRITE events. 355dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 356dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return; 357dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 358dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 359dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(r > 0) { 360dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* if the remote cannot accept further events, 361dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** we disable notification of READs. They'll 362dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** be enabled again when we get a call to ready() 363dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 364dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fdevent_del(&s->fde, FDE_READ); 365dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 366dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 367112445b8a752ce174f36cf853d5f1c356c3f5286JP Abgrall /* Don't allow a forced eof if data is still there */ 368112445b8a752ce174f36cf853d5f1c356c3f5286JP Abgrall if((s->fde.force_eof && !r) || is_eof) { 3695b811fa5dd00288954f15209a56aea03d5e4a004Christopher Tate D(" closing because is_eof=%d r=%d s->fde.force_eof=%d\n", is_eof, r, s->fde.force_eof); 370dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 371dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 372dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 373dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 374dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(ev & FDE_ERROR){ 375dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* this should be caught be the next read or write 376dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** catching it here means we may skip the last few 377dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** bytes of readable data. 378dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 379dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project// s->close(s); 380408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): FDE_ERROR (fd=%d)\n", s->id, s->fd); 381408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall 382dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return; 383dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 384dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 385dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 386dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectasocket *create_local_socket(int fd) 387dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 388dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s = calloc(1, sizeof(asocket)); 389c419e2a210ad7e37a1f749f2ab4de7c7f95b90d7André Goddard Rosa if (s == NULL) fatal("cannot allocate socket"); 390dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->fd = fd; 391dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->enqueue = local_socket_enqueue; 392dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->ready = local_socket_ready; 393dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close = local_socket_close; 394408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall install_local_socket(s); 395dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 396dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fdevent_install(&s->fde, fd, local_socket_event_func, s); 397dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* fdevent_add(&s->fde, FDE_ERROR); */ 398dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project //fprintf(stderr, "Created local socket in create_local_socket \n"); 399dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("LS(%d): created (fd=%d)\n", s->id, s->fd); 400dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return s; 401dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 402dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 403dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectasocket *create_local_service_socket(const char *name) 404dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 405dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s; 406dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int fd; 407dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 408dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#if !ADB_HOST 409dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (!strcmp(name,"jdwp")) { 410dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return create_jdwp_service_socket(); 411dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 412dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (!strcmp(name,"track-jdwp")) { 413dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return create_jdwp_tracker_service_socket(); 414dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 415dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#endif 416dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fd = service_to_fd(name); 417dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(fd < 0) return 0; 418dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 419dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s = create_local_socket(fd); 420408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("LS(%d): bound to '%s' via %d\n", s->id, name, fd); 421dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return s; 422dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 423dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 424dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#if ADB_HOST 425dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic asocket *create_host_service_socket(const char *name, const char* serial) 426dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 427dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s; 428dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 429dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s = host_service_to_socket(name, serial); 430dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 431dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (s != NULL) { 432dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("LS(%d) bound to '%s'\n", s->id, name); 433dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return s; 434dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 435dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 436dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return s; 437dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 438dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#endif /* ADB_HOST */ 439dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 440dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* a Remote socket is used to send/receive data to/from a given transport object 441dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project** it needs to be closed when the transport is forcibly destroyed by the user 442dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project*/ 443dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projecttypedef struct aremotesocket { 444dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket socket; 445dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adisconnect disconnect; 446dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} aremotesocket; 447dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 448dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic int remote_socket_enqueue(asocket *s, apacket *p) 449dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 450408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("entered remote_socket_enqueue RS(%d) WRITE fd=%d peer.fd=%d\n", 451408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall s->id, s->fd, s->peer->fd); 452dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.command = A_WRTE; 453dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.arg0 = s->peer->id; 454dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.arg1 = s->id; 455dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.data_length = p->len; 456dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project send_packet(p, s->transport); 457dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 1; 458dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 459dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 460dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void remote_socket_ready(asocket *s) 461dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 462408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("entered remote_socket_ready RS(%d) OKAY fd=%d peer.fd=%d\n", 463408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall s->id, s->fd, s->peer->fd); 464dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project apacket *p = get_apacket(); 465dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.command = A_OKAY; 466dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.arg0 = s->peer->id; 467dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.arg1 = s->id; 468dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project send_packet(p, s->transport); 469dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 470dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 471dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void remote_socket_close(asocket *s) 472dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 473408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("entered remote_socket_close RS(%d) CLOSE fd=%d peer->fd=%d\n", 474408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall s->id, s->fd, s->peer?s->peer->fd:-1); 475dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project apacket *p = get_apacket(); 476dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.command = A_CLSE; 477dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->peer) { 478dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.arg0 = s->peer->id; 479dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->peer = 0; 480408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("RS(%d) peer->close()ing peer->id=%d peer->fd=%d\n", 481408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall s->id, s->peer->id, s->peer->fd); 482dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->close(s->peer); 483dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 484dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.arg1 = s->id; 485dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project send_packet(p, s->transport); 486dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("RS(%d): closed\n", s->id); 487dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project remove_transport_disconnect( s->transport, &((aremotesocket*)s)->disconnect ); 488dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project free(s); 489dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 490dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 491dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void remote_socket_disconnect(void* _s, atransport* t) 492dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 493dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket* s = _s; 494dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket* peer = s->peer; 495dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 496dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("remote_socket_disconnect RS(%d)\n", s->id); 497dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (peer) { 498dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project peer->peer = NULL; 499dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project peer->close(peer); 500dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 501dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project remove_transport_disconnect( s->transport, &((aremotesocket*)s)->disconnect ); 502dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project free(s); 503dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 504dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 505dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectasocket *create_remote_socket(unsigned id, atransport *t) 506dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 507dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s = calloc(1, sizeof(aremotesocket)); 508dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adisconnect* dis = &((aremotesocket*)s)->disconnect; 509dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 510c419e2a210ad7e37a1f749f2ab4de7c7f95b90d7André Goddard Rosa if (s == NULL) fatal("cannot allocate socket"); 511dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->id = id; 512dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->enqueue = remote_socket_enqueue; 513dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->ready = remote_socket_ready; 514dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close = remote_socket_close; 515dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->transport = t; 516dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 517dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project dis->func = remote_socket_disconnect; 518dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project dis->opaque = s; 519dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project add_transport_disconnect( t, dis ); 520dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("RS(%d): created\n", s->id); 521dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return s; 522dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 523dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 524dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid connect_to_remote(asocket *s, const char *destination) 525dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 526408fa57864c01113deaa213e5c1848a9c594ae92JP Abgrall D("Connect_to_remote call RS(%d) fd=%d\n", s->id, s->fd); 527dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project apacket *p = get_apacket(); 528dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project int len = strlen(destination) + 1; 529dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 530dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(len > (MAX_PAYLOAD-1)) { 531dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project fatal("destination oversized"); 532dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 533dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 534dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("LS(%d): connect('%s')\n", s->id, destination); 535dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.command = A_OPEN; 536dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.arg0 = s->id; 537dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->msg.data_length = len; 538dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project strcpy((char*) p->data, destination); 539dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project send_packet(p, s->transport); 540dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 541dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 542dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 543dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* this is used by magic sockets to rig local sockets to 544dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project send the go-ahead message when they connect */ 545dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_ready_notify(asocket *s) 546dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 547dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->ready = local_socket_ready; 548dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close = local_socket_close; 549dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_write(s->fd, "OKAY", 4); 550dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->ready(s); 551dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 552dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 553dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project/* this is used by magic sockets to rig local sockets to 554dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project send the failure message if they are closed before 555dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project connected (to avoid closing them without a status message) */ 556dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void local_socket_close_notify(asocket *s) 557dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 558dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->ready = local_socket_ready; 559dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close = local_socket_close; 560dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project sendfailmsg(s->fd, "closed"); 561dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 562dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 563dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 564dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectunsigned unhex(unsigned char *s, int len) 565dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 566dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned n = 0, c; 567dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 568dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project while(len-- > 0) { 569dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project switch((c = *s++)) { 570dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case '0': case '1': case '2': 571dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case '3': case '4': case '5': 572dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case '6': case '7': case '8': 573dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case '9': 574dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project c -= '0'; 575dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 576dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case 'a': case 'b': case 'c': 577dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case 'd': case 'e': case 'f': 578dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project c = c - 'a' + 10; 579dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 580dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case 'A': case 'B': case 'C': 581dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project case 'D': case 'E': case 'F': 582dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project c = c - 'A' + 10; 583dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project break; 584dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project default: 585dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0xffffffff; 586dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 587dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 588dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project n = (n << 4) | c; 589dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 590dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 591dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return n; 592dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 593dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 59428e1390e688f721e13a9877d3c41884bf151db60Terence Haddock/* skip_host_serial return the position in a string 59528e1390e688f721e13a9877d3c41884bf151db60Terence Haddock skipping over the 'serial' parameter in the ADB protocol, 59628e1390e688f721e13a9877d3c41884bf151db60Terence Haddock where parameter string may be a host:port string containing 59728e1390e688f721e13a9877d3c41884bf151db60Terence Haddock the protocol delimiter (colon). */ 59828e1390e688f721e13a9877d3c41884bf151db60Terence Haddockchar *skip_host_serial(char *service) { 59928e1390e688f721e13a9877d3c41884bf151db60Terence Haddock char *first_colon, *serial_end; 60028e1390e688f721e13a9877d3c41884bf151db60Terence Haddock 6013608d832425ca3a6d00c4040f3bb979c5aa49899Scott Anderson if (!strncmp(service, "usb:", 4)) { 6023608d832425ca3a6d00c4040f3bb979c5aa49899Scott Anderson return strchr(service + 4, ':'); 6033608d832425ca3a6d00c4040f3bb979c5aa49899Scott Anderson } 6043608d832425ca3a6d00c4040f3bb979c5aa49899Scott Anderson 60528e1390e688f721e13a9877d3c41884bf151db60Terence Haddock first_colon = strchr(service, ':'); 60628e1390e688f721e13a9877d3c41884bf151db60Terence Haddock if (!first_colon) { 60728e1390e688f721e13a9877d3c41884bf151db60Terence Haddock /* No colon in service string. */ 60828e1390e688f721e13a9877d3c41884bf151db60Terence Haddock return NULL; 60928e1390e688f721e13a9877d3c41884bf151db60Terence Haddock } 61028e1390e688f721e13a9877d3c41884bf151db60Terence Haddock serial_end = first_colon; 61128e1390e688f721e13a9877d3c41884bf151db60Terence Haddock if (isdigit(serial_end[1])) { 61228e1390e688f721e13a9877d3c41884bf151db60Terence Haddock serial_end++; 61328e1390e688f721e13a9877d3c41884bf151db60Terence Haddock while ((*serial_end) && isdigit(*serial_end)) { 61428e1390e688f721e13a9877d3c41884bf151db60Terence Haddock serial_end++; 61528e1390e688f721e13a9877d3c41884bf151db60Terence Haddock } 61628e1390e688f721e13a9877d3c41884bf151db60Terence Haddock if ((*serial_end) != ':') { 61728e1390e688f721e13a9877d3c41884bf151db60Terence Haddock // Something other than numbers was found, reset the end. 61828e1390e688f721e13a9877d3c41884bf151db60Terence Haddock serial_end = first_colon; 61928e1390e688f721e13a9877d3c41884bf151db60Terence Haddock } 62028e1390e688f721e13a9877d3c41884bf151db60Terence Haddock } 62128e1390e688f721e13a9877d3c41884bf151db60Terence Haddock return serial_end; 62228e1390e688f721e13a9877d3c41884bf151db60Terence Haddock} 62328e1390e688f721e13a9877d3c41884bf151db60Terence Haddock 624dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic int smart_socket_enqueue(asocket *s, apacket *p) 625dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 626dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project unsigned len; 627dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#if ADB_HOST 628dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project char *service = NULL; 629dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project char* serial = NULL; 630dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project transport_type ttype = kTransportAny; 631dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#endif 632dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 633dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): enqueue %d\n", s->id, p->len); 634dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 635dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->pkt_first == 0) { 636dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->pkt_first = p; 637dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->pkt_last = p; 638dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 639dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if((s->pkt_first->len + p->len) > MAX_PAYLOAD) { 640dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): overflow\n", s->id); 641dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project put_apacket(p); 642dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 643dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 644dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 645dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project memcpy(s->pkt_first->data + s->pkt_first->len, 646dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->data, p->len); 647dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->pkt_first->len += p->len; 648dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project put_apacket(p); 649dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 650dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p = s->pkt_first; 651dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 652dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 653dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* don't bother if we can't decode the length */ 654dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(p->len < 4) return 0; 655dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 656dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project len = unhex(p->data, 4); 657dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if((len < 1) || (len > 1024)) { 658dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): bad size (%d)\n", s->id, len); 659dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 660dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 661dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 662dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): len is %d\n", s->id, len ); 663dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* can't do anything until we have the full header */ 664dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if((len + 4) > p->len) { 665dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): waiting for %d more bytes\n", s->id, len+4 - p->len); 666dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 667dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 668dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 669dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->data[len + 4] = 0; 670dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 671dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): '%s'\n", s->id, (char*) (p->data + 4)); 672dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 673dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#if ADB_HOST 674dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project service = (char *)p->data + 4; 675dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(!strncmp(service, "host-serial:", strlen("host-serial:"))) { 676dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project char* serial_end; 677dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project service += strlen("host-serial:"); 678dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 67928e1390e688f721e13a9877d3c41884bf151db60Terence Haddock // serial number should follow "host:" and could be a host:port string. 68028e1390e688f721e13a9877d3c41884bf151db60Terence Haddock serial_end = skip_host_serial(service); 681dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (serial_end) { 682dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project *serial_end = 0; // terminate string 683dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project serial = service; 684dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project service = serial_end + 1; 685dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 686dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else if (!strncmp(service, "host-usb:", strlen("host-usb:"))) { 687dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ttype = kTransportUsb; 688dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project service += strlen("host-usb:"); 689dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else if (!strncmp(service, "host-local:", strlen("host-local:"))) { 690dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ttype = kTransportLocal; 691dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project service += strlen("host-local:"); 692dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else if (!strncmp(service, "host:", strlen("host:"))) { 693dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ttype = kTransportAny; 694dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project service += strlen("host:"); 695dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } else { 696dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project service = NULL; 697dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 698dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 699dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (service) { 700dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s2; 701dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 702dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* some requests are handled immediately -- in that 703dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** case the handle_host_request() routine has sent 704dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** the OKAY or FAIL message and all we have to do 705dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** is clean up. 706dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 707dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(handle_host_request(service, ttype, serial, s->peer->fd, s) == 0) { 708dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* XXX fail message? */ 709dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D( "SS(%d): handled host service '%s'\n", s->id, service ); 710dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 711dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 712dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (!strncmp(service, "transport", strlen("transport"))) { 713dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D( "SS(%d): okay transport\n", s->id ); 714dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project p->len = 0; 715dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 716dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 717dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 718dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* try to find a local service with this name. 719dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** if no such service exists, we'll fail out 720dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** and tear down here. 721dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 722dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s2 = create_host_service_socket(service, serial); 723dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s2 == 0) { 724dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D( "SS(%d): couldn't create host service '%s'\n", s->id, service ); 725dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project sendfailmsg(s->peer->fd, "unknown host service"); 726dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 727dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 728dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 729dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* we've connected to a local host service, 730dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** so we make our peer back into a regular 731dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** local socket and bind it to the new local 732dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** service socket, acknowledge the successful 733dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** connection, and close this smart socket now 734dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** that its work is done. 735dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 736dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project adb_write(s->peer->fd, "OKAY", 4); 737dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 738dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->ready = local_socket_ready; 739dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->close = local_socket_close; 740dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->peer = s2; 741dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s2->peer = s->peer; 742dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer = 0; 743dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D( "SS(%d): okay\n", s->id ); 744dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 745dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 746dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* initial state is "ready" */ 747dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s2->ready(s2); 748dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 0; 749dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 750dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#else /* !ADB_HOST */ 751dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (s->transport == NULL) { 752dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project char* error_string = "unknown failure"; 753dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->transport = acquire_one_transport (CS_ANY, 754dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project kTransportAny, NULL, &error_string); 755dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 756dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if (s->transport == NULL) { 757dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project sendfailmsg(s->peer->fd, error_string); 758dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 759dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 760dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 761dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project#endif 762dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 763dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(!(s->transport) || (s->transport->connection_state == CS_OFFLINE)) { 764dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* if there's no remote we fail the connection 765dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** right here and terminate it 766dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 767dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project sendfailmsg(s->peer->fd, "device offline (x)"); 768dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project goto fail; 769dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 770dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 771dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 772dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* instrument our peer to pass the success or fail 773dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** message back once it connects or closes, then 774dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** detach from it, request the connection, and 775dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** tear down 776dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 777dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->ready = local_socket_ready_notify; 778dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->close = local_socket_close_notify; 779dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->peer = 0; 780dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* give him our transport and upref it */ 781dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->transport = s->transport; 782dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 783dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project connect_to_remote(s->peer, (char*) (p->data + 4)); 784dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer = 0; 785dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 786dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return 1; 787dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 788dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectfail: 789dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project /* we're going to close our peer as a side-effect, so 790dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** return -1 to signal that state to the local socket 791dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ** who is enqueueing against us 792dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project */ 793dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close(s); 794dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return -1; 795dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 796dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 797dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void smart_socket_ready(asocket *s) 798dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 799dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): ready\n", s->id); 800dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 801dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 802dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectstatic void smart_socket_close(asocket *s) 803dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 804dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): closed\n", s->id); 805dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->pkt_first){ 806dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project put_apacket(s->pkt_first); 807dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 808dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project if(s->peer) { 809dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->peer = 0; 810dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer->close(s->peer); 81149f1857dd8b64cdd57f28e965a1ff5fa0c2b0547Tom Marlin s->peer = 0; 812dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project } 813dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project free(s); 814dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 815dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 816dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectasocket *create_smart_socket(void (*action_cb)(asocket *s, const char *act)) 817dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 818dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("Creating smart socket \n"); 819dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *s = calloc(1, sizeof(asocket)); 820c419e2a210ad7e37a1f749f2ab4de7c7f95b90d7André Goddard Rosa if (s == NULL) fatal("cannot allocate socket"); 821dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->enqueue = smart_socket_enqueue; 822dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->ready = smart_socket_ready; 823dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->close = smart_socket_close; 824dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->extra = action_cb; 825dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 826dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("SS(%d): created %p\n", s->id, action_cb); 827dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project return s; 828dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 829dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 830dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid smart_socket_action(asocket *s, const char *act) 831dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 832dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 833dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 834dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project 835dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Projectvoid connect_to_smartsocket(asocket *s) 836dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project{ 837dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project D("Connecting to smart socket \n"); 838dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project asocket *ss = create_smart_socket(smart_socket_action); 839dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->peer = ss; 840dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project ss->peer = s; 841dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project s->ready(s); 842dd7bc3319deb2b77c5d07a51b7d6cd7e11b5beb0The Android Open Source Project} 843