hw-qemud.c revision d0e2872813e1d37e8233befdfd13a4d6cb0d7431
19877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* Copyright (C) 2007-2008 The Android Open Source Project 29877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** 39877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** This software is licensed under the terms of the GNU General Public 49877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** License version 2, as published by the Free Software Foundation, and 59877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** may be copied, distributed, and modified under those terms. 69877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** 79877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** This program is distributed in the hope that it will be useful, 89877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** but WITHOUT ANY WARRANTY; without even the implied warranty of 99877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project** GNU General Public License for more details. 119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project*/ 129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "android/hw-qemud.h" 139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "android/utils/debug.h" 149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "android/utils/misc.h" 159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "android/utils/system.h" 169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "android/utils/bufprint.h" 1777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine#include "android/looper.h" 18871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#include "hw/hw.h" 1977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine#include "hw/goldfish_pipe.h" 209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "qemu-char.h" 219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "charpipe.h" 229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#include "cbuffer.h" 239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 247ffddd66de46c27c4e24d9af9b47fc0b9a8da8d1Vladimir Chtchetkine#define D(...) VERBOSE_PRINT(qemud,__VA_ARGS__) 259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define D_ACTIVE VERBOSE_CHECK(qemud) 269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* the T(...) macro is used to dump traffic */ 289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define T_ACTIVE 0 299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#if T_ACTIVE 319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define T(...) VERBOSE_PRINT(qemud,__VA_ARGS__) 329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#else 339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define T(...) ((void)0) 349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#endif 359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* max serial MTU. Don't change this without modifying 379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * development/emulator/qemud/qemud.c as well. 389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define MAX_SERIAL_PAYLOAD 4000 409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* max framed data payload. Must be < (1 << 16) 429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define MAX_FRAME_PAYLOAD 65535 449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 45871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Version number of snapshots code. Increment whenever the data saved 46871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * or the layout in which it is saved is changed. 47871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 48d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine#define QEMUD_SAVE_VERSION 2 49871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 504c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine#define min(a, b) (((a) < (b)) ? (a) : (b)) 514c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine 529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 53791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* define SUPPORT_LEGACY_QEMUD to 1 if you want to support 54791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * talking to a legacy qemud daemon. See docs/ANDROID-QEMUD.TXT 55791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * for details. 56791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 57334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#ifdef TARGET_ARM 58791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#define SUPPORT_LEGACY_QEMUD 1 59334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#endif 60334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#ifdef TARGET_I386 61334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#define SUPPORT_LEGACY_QEMUD 0 /* no legacy support */ 62334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#endif 63fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#if SUPPORT_LEGACY_QEMUD 64fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#include "telephony/android_modem.h" 65fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#include "telephony/modem_driver.h" 66fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#endif 67fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner 689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* 69791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * This implements support for the 'qemud' multiplexing communication 70791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * channel between clients running in the emulated system and 'services' 71791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * provided by the emulator. 729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 73791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * For additional details, please read docs/ANDROID-QEMUD.TXT 749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* 789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * IMPLEMENTATION DETAILS: 799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * We use one charpipe to connect the emulated serial port to the 'QemudSerial' 819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * object. This object is used to receive data from the serial port, and 829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * unframe messages (i.e. extract payload length + channel id from header, 839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * then the payload itself), before sending them to a generic receiver. 849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The QemudSerial object can also be used to send messages to the daemon 869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * through the serial port (see qemud_serial_send()) 879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The multiplexer is connected to one or more 'service' objects. 899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * are themselves connected through a charpipe to an emulated device or 909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * control sub-module in the emulator. 919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * tty <==charpipe==> QemudSerial ---> QemudMultiplexer ----> QemudClient 939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * ^ | 949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * | | 959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * +--------------------------------------+ 969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** HANDLING INCOMING DATA FRAMES 1009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 1019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 102791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* A QemudSink is just a handly data structure that is used to 103791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * read a fixed amount of bytes into a buffer 104791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct QemudSink { 106871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int used; /* number of bytes already used */ 107871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int size; /* total number of bytes in buff */ 1089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* buff; 1099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} QemudSink; 1109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 111871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* save the state of a QemudSink to a snapshot. 112871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 113871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * The buffer pointer is not saved, since it usually points to buffer 114871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * fields in other structs, which have save functions themselves. It 115871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * is up to the caller to make sure the buffer is correctly saved and 116871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * restored. 117871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 118871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 119871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_sink_save(QEMUFile* f, QemudSink* s) 120871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 121871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->used); 122871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->size); 123871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 124871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 125871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* load the state of a QemudSink from a snapshot. 126871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 127871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 128871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_sink_load(QEMUFile* f, QemudSink* s) 129871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 130871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->used = qemu_get_be32(f); 131871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->size = qemu_get_be32(f); 132871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 133871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 134871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 135871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 136791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* reset a QemudSink, i.e. provide a new destination buffer address 137791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * and its size in bytes. 138791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 1409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_sink_reset( QemudSink* ss, int size, uint8_t* buffer ) 1419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 142871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije ss->used = 0; 1439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ss->size = size; 1449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ss->buff = buffer; 1459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 1469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 147791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* try to fill the sink by reading bytes from the source buffer 148791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * '*pmsg' which contains '*plen' bytes 149791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 150791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * this functions updates '*pmsg' and '*plen', and returns 151791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 1 if the sink's destination buffer is full, or 0 otherwise. 152791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 1549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_sink_fill( QemudSink* ss, const uint8_t* *pmsg, int *plen) 1559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 156871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int avail = ss->size - ss->used; 1579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail <= 0) 1599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 1; 1609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail > *plen) 1629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = *plen; 1639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 164871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije memcpy(ss->buff + ss->used, *pmsg, avail); 1659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *pmsg += avail; 1669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *plen -= avail; 167871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije ss->used += avail; 1689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 169871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return (ss->used == ss->size); 1709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 1719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 172791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* returns the number of bytes needed to fill a sink's destination 173791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * buffer. 174791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 1769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_sink_needed( QemudSink* ss ) 1779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 178871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ss->size - ss->used; 1799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 1809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** HANDLING SERIAL PORT CONNECTION 1829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 1839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* The QemudSerial object receives data from the serial port charpipe. 1859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It parses the header to extract the channel id and payload length, 1869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * then the message itself. 1879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 1889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Incoming messages are sent to a generic receiver identified by 1899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the 'recv_opaque' and 'recv_func' parameters to qemud_serial_init() 1909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 1919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It also provides qemud_serial_send() which can be used to send 1929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * messages back through the serial port. 1939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 1949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define HEADER_SIZE 6 1969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define LENGTH_OFFSET 2 1989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define LENGTH_SIZE 4 1999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define CHANNEL_OFFSET 0 2019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define CHANNEL_SIZE 2 2029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 203791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 204791d86195fedca3a8cba5d7fa3e3610302361a78David Turnertypedef enum { 205791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QEMUD_VERSION_UNKNOWN, 206791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QEMUD_VERSION_LEGACY, 207791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QEMUD_VERSION_NORMAL 208791d86195fedca3a8cba5d7fa3e3610302361a78David Turner} QemudVersion; 209791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 210791d86195fedca3a8cba5d7fa3e3610302361a78David Turner# define LEGACY_LENGTH_OFFSET 0 211791d86195fedca3a8cba5d7fa3e3610302361a78David Turner# define LEGACY_CHANNEL_OFFSET 4 212791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 213791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 2149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* length of the framed header */ 2159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define FRAME_HEADER_SIZE 4 2169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define BUFFER_SIZE MAX_SERIAL_PAYLOAD 2189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* out of convenience, the incoming message is zero-terminated 2209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * and can be modified by the receiver (e.g. for tokenization). 2219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 2229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef void (*QemudSerialReceive)( void* opaque, int channel, uint8_t* msg, int msglen); 2239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct QemudSerial { 2259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; /* serial charpipe endpoint */ 2269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* managing incoming packets from the serial port */ 2289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ABool need_header; 2299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int overflow; 2309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int in_size; 2319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int in_channel; 232791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 233791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QemudVersion version; 234791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 2359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink header[1]; 2369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink payload[1]; 2379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t data0[MAX_SERIAL_PAYLOAD+1]; 2389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* receiver */ 2409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerialReceive recv_func; /* receiver callback */ 2419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* recv_opaque; /* receiver user-specific data */ 2429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} QemudSerial; 2439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 245871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Save the state of a QemudSerial to a snapshot file. 246871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 247871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 248871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_serial_save(QEMUFile* f, QemudSerial* s) 249871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 250871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* cs, recv_func and recv_opaque are not saved, as these are assigned only 251871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * during emulator init. A load within a session can re-use the values 252871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * already assigned, a newly launched emulator has freshly assigned values. 253871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 254871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 255871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* state of incoming packets from the serial port */ 256871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->need_header); 257871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->overflow); 258871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->in_size); 259871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->in_channel); 260871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#if SUPPORT_LEGACY_QEMUD 261871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->version); 262871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#endif 263871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_save(f, s->header); 264871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_save(f, s->payload); 265871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, MAX_SERIAL_PAYLOAD+1); 266871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, s->data0, MAX_SERIAL_PAYLOAD+1); 267871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 268871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 269871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Load the state of a QemudSerial from a snapshot file. 270871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 271871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 272871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_serial_load(QEMUFile* f, QemudSerial* s) 273871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 274871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* state of incoming packets from the serial port */ 275871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->need_header = qemu_get_be32(f); 276871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->overflow = qemu_get_be32(f); 277871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->in_size = qemu_get_be32(f); 278871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->in_channel = qemu_get_be32(f); 279871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#if SUPPORT_LEGACY_QEMUD 280871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->version = qemu_get_be32(f); 281871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#endif 282871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_load(f, s->header); 283871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_load(f, s->payload); 284871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 285871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* s->header and s->payload are only ever connected to s->data0 */ 286871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->header->buff = s->payload->buff = s->data0; 287871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 288871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int len = qemu_get_be32(f); 289871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (len - 1 > MAX_SERIAL_PAYLOAD) { 290871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: load failed: size of saved payload buffer (%d) exceeds " 291871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije "current maximum (%d)\n", 292871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, len - 1, MAX_SERIAL_PAYLOAD); 293871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 294871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 295871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 296871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, s->data0, len)) != len) { 297871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: failed to load serial buffer contents (tried reading %d bytes, got %d)\n", 298871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, len, ret); 299871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 300871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 301871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 302871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 303871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 304871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 3059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called by the charpipe to see how much bytes can be 3069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * read from the serial port. 3079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 3089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 3099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_can_read( void* opaque ) 3109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 3119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial* s = opaque; 3129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->overflow > 0) { 3149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return s->overflow; 3159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* if in_size is 0, we're reading the header */ 3189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->need_header) 3199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return qemud_sink_needed(s->header); 3209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* otherwise, we're reading the payload */ 3229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return qemud_sink_needed(s->payload); 3239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 3249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called by the charpipe to read data from the serial 3269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * port. 'len' cannot be more than the value returned 3279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * by 'qemud_serial_can_read'. 3289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 3299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 3309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_read( void* opaque, const uint8_t* from, int len ) 3319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 3329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial* s = opaque; 3339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project T("%s: received %3d bytes: '%s'", __FUNCTION__, len, quote_bytes((const void*)from, len)); 3359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project while (len > 0) { 3379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int avail; 3389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* skip overflow bytes */ 3409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->overflow > 0) { 3419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = s->overflow; 3429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail > len) 3439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = len; 3449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project from += avail; 3469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len -= avail; 3479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 3489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read header if needed */ 3519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->need_header) { 3529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(s->header, (const uint8_t**)&from, &len)) 3539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 3549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 355791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 356791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (s->version == QEMUD_VERSION_UNKNOWN) { 357791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* if we receive "001200" as the first header, then we 358791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * detected a legacy qemud daemon. See the comments 359791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * in qemud_serial_send_legacy_probe() for details. 360791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 361791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if ( !memcmp(s->data0, "001200", 6) ) { 362791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: legacy qemud detected.", __FUNCTION__); 363791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->version = QEMUD_VERSION_LEGACY; 364fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner /* tell the modem to use legacy emulation mode */ 365fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner amodem_set_legacy(android_modem); 366791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } else { 367791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: normal qemud detected.", __FUNCTION__); 368791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->version = QEMUD_VERSION_NORMAL; 369791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 370791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 371791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 372791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (s->version == QEMUD_VERSION_LEGACY) { 373791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_size = hex2int( s->data0 + LEGACY_LENGTH_OFFSET, LENGTH_SIZE ); 374791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_channel = hex2int( s->data0 + LEGACY_CHANNEL_OFFSET, CHANNEL_SIZE ); 375791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } else { 376791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_size = hex2int( s->data0 + LENGTH_OFFSET, LENGTH_SIZE ); 377791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_channel = hex2int( s->data0 + CHANNEL_OFFSET, CHANNEL_SIZE ); 378791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 379791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#else 3809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* extract payload length + channel id */ 3819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_size = hex2int( s->data0 + LENGTH_OFFSET, LENGTH_SIZE ); 3829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_channel = hex2int( s->data0 + CHANNEL_OFFSET, CHANNEL_SIZE ); 383791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 384871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->header->used = 0; 3859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->in_size <= 0 || s->in_channel < 0) { 3879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: bad header: '%.*s'", __FUNCTION__, HEADER_SIZE, s->data0); 3889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 3899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->in_size > MAX_SERIAL_PAYLOAD) { 3929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring huge serial packet: length=%d channel=%1", 3939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, s->in_size, s->in_channel); 3949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->overflow = s->in_size; 3959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 3969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* prepare 'in_data' for payload */ 3999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->need_header = 0; 4009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset(s->payload, s->in_size, s->data0); 4019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 4029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read payload bytes */ 4049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(s->payload, &from, &len)) 4059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 4069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* zero-terminate payload, then send it to receiver */ 4089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->payload->buff[s->payload->size] = 0; 4099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: channel=%2d len=%3d '%s'", __FUNCTION__, 4109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_channel, s->payload->size, 4119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project quote_bytes((const void*)s->payload->buff, s->payload->size)); 4129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->recv_func( s->recv_opaque, s->in_channel, s->payload->buff, s->payload->size ); 4149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* prepare for new header */ 4169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->need_header = 1; 4179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 4189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 4199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 420791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 421791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 422791d86195fedca3a8cba5d7fa3e3610302361a78David Turnerstatic void 423791d86195fedca3a8cba5d7fa3e3610302361a78David Turnerqemud_serial_send_legacy_probe( QemudSerial* s ) 424791d86195fedca3a8cba5d7fa3e3610302361a78David Turner{ 425791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* we're going to send a specially crafted packet to the qemud 426791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * daemon, this will help us determine whether we're talking 427791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * to a legacy or a normal daemon. 428791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 429791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * the trick is to known that a legacy daemon uses the following 430791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * header: 431791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 432791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * <length><channel><payload> 433791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 434791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * while the normal one uses: 435791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 436791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * <channel><length><payload> 437791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 438791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * where <channel> is a 2-hexchar string, and <length> a 4-hexchar 439791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * string. 440791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 441791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * if we send a header of "000100", it is interpreted: 442791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 443791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * - as the header of a 1-byte payload by the legacy daemon 444791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * - as the header of a 256-byte payload by the normal one. 445791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 446791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * we're going to send something that looks like: 447791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 448791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000100" + "X" + 449791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000b00" + "connect:gsm" + 450791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000b00" + "connect:gps" + 451791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000f00" + "connect:control" + 452791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "00c210" + "0"*194 453791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 454791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * the normal daemon will interpret this as a 256-byte payload 455791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * for channel 0, with garbage content ("X000b00conn...") which 456791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * will be silently ignored. 457791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 458791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * on the other hand, the legacy daemon will see it as a 459791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * series of packets: 460791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 461791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * one message "X" on channel 0, which will force the daemon 462791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * to send back "001200ko:unknown command" as its first answer. 463791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 464791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * three "connect:<xxx>" messages used to receive the channel 465791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * numbers of the three legacy services implemented by the daemon. 466791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 467791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * a garbage packet of 194 zeroes for channel 16, which will be 468791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * silently ignored. 469791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 470791d86195fedca3a8cba5d7fa3e3610302361a78David Turner uint8_t tab[194]; 471791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 472791d86195fedca3a8cba5d7fa3e3610302361a78David Turner memset(tab, 0, sizeof(tab)); 473791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000100X", 7); 474791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000b00connect:gsm", 17); 475791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000b00connect:gps", 17); 476791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000f00connect:control", 21); 477791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"00c210", 6); 478791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, tab, sizeof(tab)); 479791d86195fedca3a8cba5d7fa3e3610302361a78David Turner} 480791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif /* SUPPORT_LEGACY_QEMUD */ 481791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 4829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* intialize a QemudSerial object with a charpipe endpoint 4839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * and a receiver. 4849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 4859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 4869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_init( QemudSerial* s, 4879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs, 4889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerialReceive recv_func, 4899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* recv_opaque ) 4909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 4919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->cs = cs; 4929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->recv_func = recv_func; 4939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->recv_opaque = recv_opaque; 4949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->need_header = 1; 4959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->overflow = 0; 4969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset( s->header, HEADER_SIZE, s->data0 ); 4989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_size = 0; 4999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_channel = -1; 5009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 501791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 502791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->version = QEMUD_VERSION_UNKNOWN; 503791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemud_serial_send_legacy_probe(s); 504791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 505791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 5069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_add_handlers( cs, 5079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_can_read, 5089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_read, 5099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project NULL, 5109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s ); 5119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 5129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* send a message to the serial port. This will add the necessary 5149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * header. 5159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 5169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 5179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_send( QemudSerial* s, 5189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel, 5199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ABool framing, 5209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const uint8_t* msg, 5219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int msglen ) 5229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 5239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t header[HEADER_SIZE]; 5249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t frame[FRAME_HEADER_SIZE]; 5259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int avail, len = msglen; 5269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (msglen <= 0 || channel < 0) 5289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 5299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: channel=%2d len=%3d '%s'", 5319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, channel, msglen, 5329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project quote_bytes((const void*)msg, msglen)); 5339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (framing) { 5359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len += FRAME_HEADER_SIZE; 5369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 5379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* packetize the payload for the serial MTU */ 539bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner while (len > 0) 5409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project { 5419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = len; 5429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail > MAX_SERIAL_PAYLOAD) 5439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = MAX_SERIAL_PAYLOAD; 5449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* write this packet's header */ 546791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 547791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (s->version == QEMUD_VERSION_LEGACY) { 548791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + LEGACY_LENGTH_OFFSET, LENGTH_SIZE, avail); 549791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + LEGACY_CHANNEL_OFFSET, CHANNEL_SIZE, channel); 550791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } else { 551791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + LENGTH_OFFSET, LENGTH_SIZE, avail); 552791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + CHANNEL_OFFSET, CHANNEL_SIZE, channel); 553791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 554791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#else 5559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int2hex(header + LENGTH_OFFSET, LENGTH_SIZE, avail); 5569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int2hex(header + CHANNEL_OFFSET, CHANNEL_SIZE, channel); 557791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 558791d86195fedca3a8cba5d7fa3e3610302361a78David Turner T("%s: '%.*s'", __FUNCTION__, HEADER_SIZE, header); 5599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(s->cs, header, HEADER_SIZE); 5609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* insert frame header when needed */ 5629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (framing) { 5639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int2hex(frame, FRAME_HEADER_SIZE, msglen); 564791d86195fedca3a8cba5d7fa3e3610302361a78David Turner T("%s: '%.*s'", __FUNCTION__, FRAME_HEADER_SIZE, frame); 5659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(s->cs, frame, FRAME_HEADER_SIZE); 5669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail -= FRAME_HEADER_SIZE; 5679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len -= FRAME_HEADER_SIZE; 5689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project framing = 0; 5699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 5709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* write message content */ 572791d86195fedca3a8cba5d7fa3e3610302361a78David Turner T("%s: '%.*s'", __FUNCTION__, avail, msg); 5739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(s->cs, msg, avail); 5749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project msg += avail; 5759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len -= avail; 5769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 5779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 5789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** CLIENTS 5809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 5819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 58277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Descriptor for a data buffer pending to be sent to a qemud pipe client. 58377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 58477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * When a service decides to send data to the client, there could be cases when 58577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * client is not ready to read them. In this case there is no GoldfishPipeBuffer 58677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * available to write service's data to, So, we need to cache that data into the 58777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * client descriptor, and "send" them over to the client in _qemudPipe_recvBuffers 58877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * callback. Pending service data is stored in the client descriptor as a list 58977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * of QemudPipeMessage instances. 59077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 59177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinetypedef struct QemudPipeMessage QemudPipeMessage; 59277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestruct QemudPipeMessage { 59377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message to send. */ 59477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine uint8_t* message; 59577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message size. */ 59677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t size; 59777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Offset in the message buffer of the chunk, that has not been sent 59877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * to the pipe yet. */ 59977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t offset; 60077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Links next message in the client. */ 60177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* next; 60277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine}; 60377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 60477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 6059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* A QemudClient models a single client as seen by the emulator. 60677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * Each client has its own channel id (for the serial qemud), or pipe descriptor 60777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * (for the pipe based qemud), and belongs to a given QemudService (see below). 6089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 60977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * There is a global list of serial clients used to multiplex incoming 61077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * messages from the channel id (see qemud_multiplexer_serial_recv()). Pipe 61177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * clients don't need multiplexing, because they are communicated via qemud pipes 61277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * that are unique for each client. 6139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 6149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 6159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 61677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Defines type of the client: pipe, or serial. 61777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 61877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinetypedef enum QemudProtocol { 61977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Client is communicating via pipe. */ 62077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QEMUD_PROTOCOL_PIPE, 62177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Client is communicating via serial port. */ 62277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QEMUD_PROTOCOL_SERIAL 62377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} QemudProtocol; 62477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 625593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine/* Descriptor for a QEMUD pipe connection. 626593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * 627593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * Every time a client connects to the QEMUD via pipe, an instance of this 628593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * structure is created to represent a connection used by new pipe client. 629593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine */ 630593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkinetypedef struct QemudPipe { 631593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Pipe descriptor. */ 632593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine void* hwpipe; 633593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Looper used for I/O */ 634593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine void* looper; 635593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Service for this pipe. */ 636593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudService* service; 637593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Client for this pipe. */ 638593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudClient* client; 639593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine} QemudPipe; 640593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 6419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstruct QemudClient { 64277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Defines protocol, used by the client. */ 64377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudProtocol protocol; 64477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 64577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Fields that are common for all protocols. */ 6464c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine char* param; 6479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* clie_opaque; 6489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientRecv clie_recv; 6499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientClose clie_close; 650871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientSave clie_save; 651871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientLoad clie_load; 6529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* service; 6539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* next_serv; /* next in same service */ 6549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* next; 6559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient** pref; 6569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 6579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* framing support */ 6589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int framing; 6599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ABool need_header; 660bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner ABool closing; 6619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink header[1]; 6629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t header0[FRAME_HEADER_SIZE]; 6639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink payload[1]; 66477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 66577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Fields that are protocol-specific. */ 66677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine union { 66777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Serial-specific fields. */ 66877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine struct { 66977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int channel; 67077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudSerial* serial; 67177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } Serial; 67277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Pipe-specific fields. */ 67377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine struct { 674593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudPipe* qemud_pipe; 67577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* messages; 67677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } Pipe; 67777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } ProtocolSelector; 6789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project}; 6799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 68077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic ABool 68177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_is_pipe_client(QemudClient* client) 68277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 68377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return (client-> protocol == QEMUD_PROTOCOL_PIPE) ? true : false; 68477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 68577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 6869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void qemud_service_remove_client( QemudService* service, 6879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* client ); 6889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 6899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* remove a QemudClient from global list */ 6909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 6919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_remove( QemudClient* c ) 6929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 6939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->pref[0] = c->next; 6949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->next) 6959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next->pref = c->pref; 6969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 6979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next = NULL; 6989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->pref = &c->next; 6999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 7009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* add a QemudClient to global list */ 7029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 7039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_prepend( QemudClient* c, QemudClient** plist ) 7049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 7059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next = *plist; 7069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->pref = plist; 7079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *plist = c; 7089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->next) 7099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next->pref = &c->next; 7109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 7119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* receive a new message from a client, and dispatch it to 7139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the real service implementation. 7149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 7159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 7169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_recv( void* opaque, uint8_t* msg, int msglen ) 7179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 7189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = opaque; 7199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* no framing, things are simple */ 7219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!c->framing) { 7229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_recv) 723318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner c->clie_recv( c->clie_opaque, msg, msglen, c ); 7249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 7259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* framing */ 7289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#if 1 7309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* special case, in 99% of cases, everything is in 7319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the incoming message, and we can do all we need 7329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * directly without dynamic allocation. 7339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 7349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (msglen > FRAME_HEADER_SIZE && 7359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->need_header == 1 && 7369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_needed(c->header) == 0) 7379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project { 7389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int len = hex2int( msg, FRAME_HEADER_SIZE ); 7399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (len >= 0 && msglen == len + FRAME_HEADER_SIZE) { 7419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_recv) 742bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner c->clie_recv( c->clie_opaque, 7439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project msg+FRAME_HEADER_SIZE, 744318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner msglen-FRAME_HEADER_SIZE, c ); 7459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 7469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#endif 7499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project while (msglen > 0) { 75183f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner uint8_t *data; 75283f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner 7539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read the header */ 7549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->need_header) { 7559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int frame_size; 7569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* data; 7579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(c->header, (const uint8_t**)&msg, &msglen)) 7599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 7609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project frame_size = hex2int(c->header0, 4); 7629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (frame_size == 0) { 7639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring empty frame", __FUNCTION__); 7649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 7659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (frame_size < 0) { 7679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring corrupted frame header '.*s'", 7689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, FRAME_HEADER_SIZE, c->header0 ); 7699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 7709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project AARRAY_NEW(data, frame_size+1); /* +1 for terminating zero */ 7739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset(c->payload, frame_size, data); 7749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->need_header = 0; 775871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->header->used = 0; 7769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read the payload */ 7799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(c->payload, (const uint8_t**)&msg, &msglen)) 7809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 7819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->payload->buff[c->payload->size] = 0; 78383f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner c->need_header = 1; 78483f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner data = c->payload->buff; 7859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 78683f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner /* Technically, calling 'clie_recv' can destroy client object 'c' 78783f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner * if it decides to close the connection, so ensure we don't 78883f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner * use/dereference it after the call. */ 7899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_recv) 790318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner c->clie_recv( c->clie_opaque, c->payload->buff, c->payload->size, c ); 7919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 79283f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner AFREE(data); 7939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 7959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 79677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Sends data to a pipe-based client. 79777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 79877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 79977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemud_pipe_send(QemudClient* client, const uint8_t* msg, int msglen); 80077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 8014c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine/* Frees memory allocated for the qemud client. 8024c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine */ 8034c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkinestatic void 8044c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine_qemud_client_free(QemudClient* c) 8054c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine{ 8064c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if ( c != NULL) { 8074c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (_is_pipe_client(c)) { 8084c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine /* Free outstanding messages. */ 8094c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine QemudPipeMessage** msg_list = &c->ProtocolSelector.Pipe.messages; 8104c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine while (*msg_list != NULL) { 8114c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine QemudPipeMessage* to_free = *msg_list; 8124c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine *msg_list = to_free->next; 8134c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine free(to_free); 8144c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8154c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8164c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (c->param != NULL) { 8174c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine free(c->param); 8184c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8194c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine AFREE(c); 8204c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8214c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine} 8224c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine 8239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* disconnect a client. this automatically frees the QemudClient. 8249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * note that this also removes the client from the global list 8259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * and from its service's list, if any. 8269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 8279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 8289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_disconnect( void* opaque ) 8299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 8309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = opaque; 8319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 832bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner if (c->closing) { /* recursive call, exit immediately */ 833bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner return; 834bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner } 835bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner c->closing = 1; 836bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner 8379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* remove from current list */ 8389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_remove(c); 8399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* send a disconnect command to the daemon */ 84177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (_is_pipe_client(c)) { 8429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project char tmp[128], *p=tmp, *end=p+sizeof(tmp); 84377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine p = bufprint(tmp, end, "disconnect:00"); 84477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_send(c, (uint8_t*)tmp, p-tmp); 845593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* We must NULL the client reference in the QemuPipe for this connection, 846593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * so if a sudden receive request comes after client has been closed, we 847593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * don't blow up. */ 848593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine c->ProtocolSelector.Pipe.qemud_pipe->client = NULL; 84977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else if (c->ProtocolSelector.Serial.channel > 0) { 85077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine char tmp[128], *p=tmp, *end=p+sizeof(tmp); 85177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine p = bufprint(tmp, end, "disconnect:%02x", 85277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel); 85377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_serial_send(c->ProtocolSelector.Serial.serial, 0, 0, (uint8_t*)tmp, p-tmp); 8549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 8559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* call the client close callback */ 8579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_close) { 8589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_close(c->clie_opaque); 8599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_close = NULL; 8609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 8619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_recv = NULL; 8629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* remove from service list, if any */ 8649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->service) { 8659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_service_remove_client(c->service, c); 8669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->service = NULL; 8679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 8689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8694c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine _qemud_client_free(c); 8709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 8719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 87277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* allocate a new QemudClient object 87377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * NOTE: channel_id valie is used as a selector between serial and pipe clients. 87477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * Since channel_id < 0 is an invalid value for a serial client, it would 87577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * indicate that creating client is a pipe client. */ 8769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudClient* 8779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_alloc( int channel_id, 8784c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param, 8799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* clie_opaque, 8809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientRecv clie_recv, 8819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientClose clie_close, 882871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientSave clie_save, 883871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientLoad clie_load, 8849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial* serial, 8859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient** pclients ) 8869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 8879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c; 8889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ANEW0(c); 8909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 89177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (channel_id < 0) { 89277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Allocating a pipe client. */ 89377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->protocol = QEMUD_PROTOCOL_PIPE; 89477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Pipe.messages = NULL; 895593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine c->ProtocolSelector.Pipe.qemud_pipe = NULL; 89677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else { 89777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Allocating a serial client. */ 89877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->protocol = QEMUD_PROTOCOL_SERIAL; 89977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.serial = serial; 90077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel = channel_id; 90177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 9024c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine c->param = client_param ? ASTRDUP(client_param) : NULL; 9039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_opaque = clie_opaque; 9049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_recv = clie_recv; 9059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_close = clie_close; 906871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->clie_save = clie_save; 907871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->clie_load = clie_load; 90877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->service = NULL; 90977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->next_serv = NULL; 91077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->next = NULL; 9119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->framing = 0; 9129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->need_header = 1; 9139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset(c->header, FRAME_HEADER_SIZE, c->header0); 9149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 9159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_prepend(c, pclients); 9169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 9179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return c; 9189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 9199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 920871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* forward */ 921871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void qemud_service_save_name( QEMUFile* f, QemudService* s ); 922871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic char* qemud_service_load_name( QEMUFile* f ); 923871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudService* qemud_service_find( QemudService* service_list, 924871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije const char* service_name ); 925871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudClient* qemud_service_connect_client( QemudService *sv, 9264c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine int channel_id, 9274c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param); 928871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 929871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves the client state needed to re-establish connections on load. 930871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 931871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 932871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_client_save(QEMUFile* f, QemudClient* c) 933871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 934871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save generic information */ 935871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save_name(f, c->service); 93677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemu_put_be32(f, c->protocol); 937d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine if (!_is_pipe_client(c)) { 93877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemu_put_be32(f, c->ProtocolSelector.Serial.channel); 93977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 940871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 941871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save client-specific state */ 942871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->clie_save) 943871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->clie_save(f, c, c->clie_opaque); 944871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 945871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save framing configuration */ 946871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, c->framing); 947871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->framing) { 948871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, c->need_header); 949871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* header sink always connected to c->header0, no need to save */ 950871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, FRAME_HEADER_SIZE); 951871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, c->header0, FRAME_HEADER_SIZE); 952871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* payload sink */ 953871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_save(f, c->payload); 954871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, c->payload->buff, c->payload->size); 955871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 956871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 957871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 958871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Loads client state from file, then starts a new client connected to the 959871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * corresponding service. 960871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 961871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 962d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkineqemud_client_load(QEMUFile* f, QemudService* current_services, int version ) 963871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 964871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char *service_name = qemud_service_load_name(f); 965871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (service_name == NULL) 966871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 967871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 968871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* get current service instance */ 969871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService *sv = qemud_service_find(current_services, service_name); 970871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (sv == NULL) { 971871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: load failed: unknown service \"%s\"\n", 972871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, service_name); 973871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 974871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 975871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 97677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int channel = -1; 977d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine 978d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine if (version >= 2) { 979d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine /* get protocol. */ 980d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine QemudProtocol protocol = qemu_get_be32(f); 981d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine /* get channel id */ 982d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine if (protocol == QEMUD_PROTOCOL_SERIAL) { 983d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine channel = qemu_get_be32(f); 984d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine } 985d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine } else { 986d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine channel = qemu_get_be32(f); 98777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 988d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine 989871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (channel == 0) { 990871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: illegal snapshot: client for control channel must no be saved\n", 991871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__); 992871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 993871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 994871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 995871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* re-connect client */ 9964c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine QemudClient* c = qemud_service_connect_client(sv, channel, NULL); 997871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if(c == NULL) 998871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 999871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1000871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* load client-specific state */ 1001871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1002871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->clie_load) 1003871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = c->clie_load(f, c, c->clie_opaque))) 1004871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; /* load failure */ 1005871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1006871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* load framing configuration */ 1007871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->framing = qemu_get_be32(f); 1008871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->framing) { 1009871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1010871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* header buffer */ 1011871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->need_header = qemu_get_be32(f); 1012871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int header_size = qemu_get_be32(f); 1013871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (header_size > FRAME_HEADER_SIZE) { 1014871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: load failed: payload buffer requires %d bytes, %d available\n", 1015871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, header_size, FRAME_HEADER_SIZE); 1016871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1017871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1018871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1019871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, c->header0, header_size)) != header_size) { 1020871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: frame header buffer load failed: expected %d bytes, got %d\n", 1021871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, header_size, ret); 1022871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1023871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1024871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1025871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* payload sink */ 1026871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_sink_load(f, c->payload))) 1027871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1028871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1029871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* replace payload buffer by saved data */ 1030871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->payload->buff) { 1031871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(c->payload->buff); 1032871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1033871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AARRAY_NEW(c->payload->buff, c->payload->size+1); /* +1 for terminating zero */ 1034871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, c->payload->buff, c->payload->size)) != c->payload->size) { 1035871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: frame payload buffer load failed: expected %d bytes, got %d\n", 1036871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, c->payload->size, ret); 1037871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(c->payload->buff); 1038871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1039871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1040871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1041871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1042871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1043871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1044871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1045871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 10469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** SERVICES 10479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 10489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* A QemudService models a _named_ service facility implemented 10509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * by the emulator, that clients in the emulated system can connect 10519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to. 10529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 10539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Each service can have a limit on the number of clients they 10549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * accept (this number if unlimited if 'max_clients' is 0). 10559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 10569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Each service maintains a list of active QemudClients and 10579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * can also be used to create new QemudClient objects through 10589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * its 'serv_opaque' and 'serv_connect' fields. 10599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 10609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstruct QemudService { 10619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const char* name; 10629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int max_clients; 10639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int num_clients; 10649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* clients; 10659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudServiceConnect serv_connect; 1066871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceSave serv_save; 1067871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceLoad serv_load; 10689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* serv_opaque; 10699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* next; 10709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project}; 10719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* Create a new QemudService object */ 10739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudService* 10749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_new( const char* name, 10759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int max_clients, 10769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* serv_opaque, 10779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudServiceConnect serv_connect, 1078871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceSave serv_save, 1079871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceLoad serv_load, 10809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService** pservices ) 10819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 10829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* s; 10839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ANEW0(s); 10859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->name = ASTRDUP(name); 10869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->max_clients = max_clients; 10879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->num_clients = 0; 10889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->clients = NULL; 10899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->serv_opaque = serv_opaque; 10919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->serv_connect = serv_connect; 1092871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->serv_save = serv_save; 1093871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->serv_load = serv_load; 10949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->next = *pservices; 10969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *pservices = s; 10979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return s; 10999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 11009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* used internally to populate a QemudService object with a 11029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * new QemudClient */ 11039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 11049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_add_client( QemudService* s, QemudClient* c ) 11059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 11069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->service = s; 11079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next_serv = s->clients; 11089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->clients = c; 11099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->num_clients += 1; 11109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 11119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* used internally to remove a QemudClient from a QemudService */ 11139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 11149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_remove_client( QemudService* s, QemudClient* c ) 11159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 11169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient** pnode = &s->clients; 11179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* node; 11189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* remove from clients linked-list */ 11209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for (;;) { 11219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project node = *pnode; 11229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (node == NULL) { 112377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: could not find client for service '%s'", 112477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, s->name); 11259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 11269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 11279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (node == c) 11289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 11299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project pnode = &node->next_serv; 11309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 11319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *pnode = node->next_serv; 11339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->num_clients -= 1; 11349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 11359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1136871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* ask the service to create a new QemudClient. Note that we 1137871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * assume that this calls qemud_client_new() which will add 1138871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * the client to the service's list automatically. 1139871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1140871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * returns the client or NULL if an error occurred 1141871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1142871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudClient* 11434c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkineqemud_service_connect_client(QemudService *sv, 11444c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine int channel_id, 11454c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param) 1146871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 11474c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine QemudClient* client = 11484c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine sv->serv_connect( sv->serv_opaque, sv, channel_id, client_param ); 1149871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (client == NULL) { 1150871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: registration failed for '%s' service", 1151871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, sv->name); 1152871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return NULL; 1153871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1154871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: registered client channel %d for '%s' service", 1155871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, channel_id, sv->name); 1156871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return client; 1157871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1158871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1159871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* find a registered service by name. 1160871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1161871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudService* 1162871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_find( QemudService* service_list, const char* service_name) 1163871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1164871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService* sv = NULL; 1165871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (sv = service_list; sv != NULL; sv = sv->next) { 1166871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (!strcmp(sv->name, service_name)) { 1167871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije break; 1168871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1169871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1170871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return sv; 1171871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1172871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1173871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Save the name of the given service. 1174871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1175871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1176871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_save_name(QEMUFile* f, QemudService* s) 1177871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1178871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int len = strlen(s->name) + 1; // include '\0' terminator 1179871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, len); 1180871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, (const uint8_t *) s->name, len); 1181871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1182871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1183871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Load the name of a service. Returns a pointer to the loaded name, or NULL 1184871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * on failure. 1185871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1186871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic char* 1187871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_load_name( QEMUFile* f ) 1188871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1189871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1190871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int name_len = qemu_get_be32(f); 1191871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char *service_name = android_alloc(name_len); 1192871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, (uint8_t*)service_name, name_len) != name_len)) { 1193871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: service name load failed: expected %d bytes, got %d\n", 1194871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, name_len, ret); 1195871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(service_name); 1196871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return NULL; 1197871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1198871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (service_name[name_len - 1] != '\0') { 1199871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char last = service_name[name_len - 1]; 1200871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije service_name[name_len - 1] = '\0'; /* make buffer contents printable */ 1201871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: service name load failed: expecting NULL-terminated string, but " 1202871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije "last char is '%c' (buffer contents: '%s%c')\n", 1203871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, name_len, last, service_name, last); 1204871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(service_name); 1205871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return NULL; 1206871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1207871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1208871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return service_name; 1209871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1210871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1211871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves state of a service. 1212871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1213871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1214871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_save(QEMUFile* f, QemudService* s) 1215871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1216871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save_name(f, s); 1217871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->max_clients); 1218871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->num_clients); 1219871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1220871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (s->serv_save) 1221871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->serv_save(f, s, s->serv_opaque); 1222871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1223871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1224871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Loads service state from file, then updates the currently running instance 1225871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * of that service to mirror the loaded state. If the service is not running, 1226871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * the load process is aborted. 1227871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1228871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * Parameter 'current_services' should be the list of active services. 1229871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1230871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1231871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_load( QEMUFile* f, QemudService* current_services ) 1232871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1233871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char* service_name = qemud_service_load_name(f); 1234871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (service_name == NULL) 1235871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1236871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1237871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* get current service instance */ 1238871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService *sv = qemud_service_find(current_services, service_name); 1239871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (sv == NULL) { 1240871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: loading failed: service \"%s\" not available\n", 1241871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, service_name); 1242871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1243871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1244871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1245871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* reconfigure service as required */ 1246871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije sv->max_clients = qemu_get_be32(f); 1247871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije sv->num_clients = qemu_get_be32(f); 1248871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1249871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* load service specific data */ 1250871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1251871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (sv->serv_load) 1252871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = sv->serv_load(f, sv, sv->serv_opaque))) 1253871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; /* load failure */ 1254871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1255871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1256871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1257871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1258871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 12599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** MULTIPLEXER 12609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 12619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 12629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* A QemudMultiplexer object maintains the global state of the 12639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * qemud service facility. It holds a QemudSerial object to 12649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * maintain the state of the serial port connection. 12659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 12669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The QemudMultiplexer receives all incoming messages from 12679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the serial port, and dispatches them to the appropriate 12689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudClient. 12699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 12709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It also has a global list of clients, and a global list of 12719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * services. 12729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 12739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Finally, the QemudMultiplexer has a special QemudClient used 12749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to handle channel 0, i.e. the control channel used to handle 12759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * connections and disconnections of clients. 12769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 12779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct QemudMultiplexer QemudMultiplexer; 12789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 12799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstruct QemudMultiplexer { 12809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial serial[1]; 12819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* clients; 12829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* services; 12839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project}; 12849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 12859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this is the serial_recv callback that is called 12869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * whenever an incoming message arrives through the serial port 12879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 12889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 12899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_serial_recv( void* opaque, 12909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel, 12919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* msg, 12929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int msglen ) 12939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 12949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudMultiplexer* m = opaque; 12959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = m->clients; 12969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 12979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* dispatch to an existing client if possible 12989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * note that channel 0 is handled by a special 12999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudClient that is setup in qemud_multiplexer_init() 13009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 13019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for ( ; c != NULL; c = c->next ) { 130277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel == channel) { 13039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_recv(c, msg, msglen); 13049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 13059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring %d bytes for unknown channel %d", 13099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, msglen, channel); 13109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 13119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* handle a new connection attempt. This returns 0 on 13139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * success, -1 if the service name is unknown, or -2 13149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * if the service's maximum number of clients has been 13159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * reached. 13169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 13179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 13189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_connect( QemudMultiplexer* m, 13199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const char* service_name, 13209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel_id ) 13219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 13229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* find the corresponding registered service by name */ 1323871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService* sv = qemud_service_find(m->services, service_name); 13249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (sv == NULL) { 13259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: no registered '%s' service", __FUNCTION__, service_name); 13269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return -1; 13279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* check service's client count */ 13309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (sv->max_clients > 0 && sv->num_clients >= sv->max_clients) { 13319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: registration failed for '%s' service: too many clients (%d)", 13329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, service_name, sv->num_clients); 13339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return -2; 13349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1336871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* connect a new client to the service on the given channel */ 13374c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (qemud_service_connect_client(sv, channel_id, NULL) == NULL) 13389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return -1; 13399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 0; 13419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 13429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* disconnect a given client from its channel id */ 13449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 13459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_disconnect( QemudMultiplexer* m, 13469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel ) 13479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 13489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c; 13499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* find the client by its channel id, then disconnect it */ 13519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for (c = m->clients; c; c = c->next) { 135277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel == channel) { 13539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: disconnecting client %d", 13549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, channel); 13559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* note thatt this removes the client from 13569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * m->clients automatically. 13579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 135877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel = -1; /* no need to send disconnect:<id> */ 13599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_disconnect(c); 13609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 13619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: disconnecting unknown channel %d", 13649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, channel); 13659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 13669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1367871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* disconnects all channels, except for the control channel, without informing 1368871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * the daemon in the guest that disconnection has occurred. 1369871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1370871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * Used to silently kill clients when restoring emulator state snapshots. 1371871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1372871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1373871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_multiplexer_disconnect_noncontrol( QemudMultiplexer* m ) 1374871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1375871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClient* c; 1376871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClient* next = m->clients; 1377871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1378871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije while (next) { 1379871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c = next; 1380871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije next = c->next; /* disconnect frees c, remember next in advance */ 1381871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 138277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel > 0) { 138377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* skip control channel */ 1384871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: disconnecting client %d", 138577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, c->ProtocolSelector.Serial.channel); 1386871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: disconnecting client %d\n", 138777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, c->ProtocolSelector.Serial.channel); 138877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel = -1; /* do not send disconnect:<id> */ 1389871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_client_disconnect(c); 1390871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1391871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1392871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1393871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 13949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* handle control messages. This is used as the receive 13959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * callback for the special QemudClient setup to manage 13969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * channel 0. 13979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 13989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * note that the message is zero-terminated for convenience 13999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * (i.e. msg[msglen] is a valid memory read that returns '\0') 14009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 14019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 1402318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turnerqemud_multiplexer_control_recv( void* opaque, 1403318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner uint8_t* msg, 1404318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner int msglen, 1405318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner QemudClient* client ) 14069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 14079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudMultiplexer* mult = opaque; 14089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* msgend = msg + msglen; 14099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project char tmp[64], *p=tmp, *end=p+sizeof(tmp); 14109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* handle connection attempts. 14129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the client message must be "connect:<service-name>:<id>" 1413fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner * where <id> is a 2-char hexadecimal string, which must be > 0 14149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 14159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (msglen > 8 && !memcmp(msg, "connect:", 8)) 14169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project { 14179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const char* service_name = (const char*)msg + 8; 14189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel, ret; 14199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project char* q; 14209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project q = strchr(service_name, ':'); 1422fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner if (q == NULL || q+3 != (char*)msgend) { 14239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: malformed connect message: '%.*s' (offset=%d)", 14249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, msglen, (const char*)msg, q ? q-(char*)msg : -1); 14259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *q++ = 0; /* zero-terminate service name */ 1428fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner channel = hex2int((uint8_t*)q, 2); 14299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (channel <= 0) { 14309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: malformed channel id '%.*s", 1431fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner __FUNCTION__, 2, q); 14329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ret = qemud_multiplexer_connect(mult, service_name, channel); 14369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* the answer can be one of: 14379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * ok:connect:<id> 14389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * ko:connect:<id>:<reason-for-failure> 14399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 14409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (ret < 0) { 14419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (ret == -1) { 14429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* could not connect */ 1443fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner p = bufprint(tmp, end, "ko:connect:%02x:unknown service", channel); 14449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } else { 1445fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner p = bufprint(tmp, end, "ko:connect:%02x:service busy", channel); 14469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project else { 1449fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner p = bufprint(tmp, end, "ok:connect:%02x", channel); 14509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_send(mult->serial, 0, 0, (uint8_t*)tmp, p-tmp); 14529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* handle client disconnections, 14569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * this message arrives when the client has closed the connection. 1457fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner * format: "disconnect:<id>" where <id> is a 2-hex channel id > 0 14589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 1459fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner if (msglen == 13 && !memcmp(msg, "disconnect:", 11)) { 1460fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner int channel_id = hex2int(msg+11, 2); 14619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (channel_id <= 0) { 14629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: malformed disconnect channel id: '%.*s'", 1463fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner __FUNCTION__, 2, msg+11); 14649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_disconnect(mult, channel_id); 14679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1470791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 1471791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* an ok:connect:<service>:<id> message can be received if we're 1472791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * talking to a legacy qemud daemon, i.e. one running in a 1.0 or 1473791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 1.1 system image. 1474791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 1475791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * we should treat is as a normal "connect:" attempt, except that 1476791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * we must not send back any acknowledgment. 1477791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1478791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (msglen > 11 && !memcmp(msg, "ok:connect:", 11)) { 1479791d86195fedca3a8cba5d7fa3e3610302361a78David Turner const char* service_name = (const char*)msg + 11; 1480791d86195fedca3a8cba5d7fa3e3610302361a78David Turner char* q = strchr(service_name, ':'); 1481791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int channel; 1482791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1483791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (q == NULL || q+3 != (char*)msgend) { 1484791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: malformed legacy connect message: '%.*s' (offset=%d)", 1485791d86195fedca3a8cba5d7fa3e3610302361a78David Turner __FUNCTION__, msglen, (const char*)msg, q ? q-(char*)msg : -1); 1486791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1487791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1488791d86195fedca3a8cba5d7fa3e3610302361a78David Turner *q++ = 0; /* zero-terminate service name */ 1489791d86195fedca3a8cba5d7fa3e3610302361a78David Turner channel = hex2int((uint8_t*)q, 2); 1490791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (channel <= 0) { 1491791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: malformed legacy channel id '%.*s", 1492791d86195fedca3a8cba5d7fa3e3610302361a78David Turner __FUNCTION__, 2, q); 1493791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1494791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1495791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1496791d86195fedca3a8cba5d7fa3e3610302361a78David Turner switch (mult->serial->version) { 1497791d86195fedca3a8cba5d7fa3e3610302361a78David Turner case QEMUD_VERSION_UNKNOWN: 1498791d86195fedca3a8cba5d7fa3e3610302361a78David Turner mult->serial->version = QEMUD_VERSION_LEGACY; 1499791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: legacy qemud daemon detected.", __FUNCTION__); 1500791d86195fedca3a8cba5d7fa3e3610302361a78David Turner break; 1501791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1502791d86195fedca3a8cba5d7fa3e3610302361a78David Turner case QEMUD_VERSION_LEGACY: 1503791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* nothing unusual */ 1504791d86195fedca3a8cba5d7fa3e3610302361a78David Turner break; 1505791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1506791d86195fedca3a8cba5d7fa3e3610302361a78David Turner default: 1507791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: weird, ignoring legacy qemud control message: '%.*s'", 1508791d86195fedca3a8cba5d7fa3e3610302361a78David Turner __FUNCTION__, msglen, msg); 1509791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1510791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1511791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1512791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* "hw-control" was called "control" in 1.0/1.1 */ 1513791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (!strcmp(service_name,"control")) 1514791d86195fedca3a8cba5d7fa3e3610302361a78David Turner service_name = "hw-control"; 1515791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1516791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemud_multiplexer_connect(mult, service_name, channel); 1517791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1518791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1519791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1520791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* anything else, don't answer for legacy */ 1521791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (mult->serial->version == QEMUD_VERSION_LEGACY) 1522791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1523791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif /* SUPPORT_LEGACY_QEMUD */ 1524791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 15259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* anything else is a problem */ 15269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project p = bufprint(tmp, end, "ko:unknown command"); 15279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_send(mult->serial, 0, 0, (uint8_t*)tmp, p-tmp); 15289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 15299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* initialize the global QemudMultiplexer. 15319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 15329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 15339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_init( QemudMultiplexer* mult, 15349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* serial_cs ) 15359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 15369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* control; 15379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* initialize serial handler */ 15399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_init( mult->serial, 15409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project serial_cs, 15419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_serial_recv, 15429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project mult ); 15439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* setup listener for channel 0 */ 15459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project control = qemud_client_alloc( 0, 15464c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine NULL, 15479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project mult, 15489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_control_recv, 1549871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije NULL, NULL, NULL, 15509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project mult->serial, 15519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project &mult->clients ); 15529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 15539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* the global multiplexer state */ 15559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudMultiplexer _multiplexer[1]; 15569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** HIGH-LEVEL API 15589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 15599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this function must be used in the serv_connect callback 15619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * of a given QemudService object (see qemud_service_register() 15629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * below). It is used to register a new QemudClient to acknowledge 15639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * a new client connection. 15649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 15659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 'clie_opaque', 'clie_recv' and 'clie_close' are used to 15669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * send incoming client messages to the corresponding service 15679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * implementation, or notify the service that a client has 15689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * disconnected. 15699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 15709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source ProjectQemudClient* 15719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_new( QemudService* service, 15729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channelId, 15734c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param, 15749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* clie_opaque, 15759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientRecv clie_recv, 1576871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientClose clie_close, 1577871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientSave clie_save, 1578871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientLoad clie_load ) 15799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 15809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudMultiplexer* m = _multiplexer; 15819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = qemud_client_alloc( channelId, 15824c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_param, 15839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project clie_opaque, 15849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project clie_recv, 15859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project clie_close, 1586871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije clie_save, 1587871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije clie_load, 15889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project m->serial, 15899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project &m->clients ); 15909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_service_add_client(service, c); 15929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return c; 15939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 15949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 159577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Caches a service message into the client's descriptor. 159677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 159777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * See comments on QemudPipeMessage structure for more info. 159877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 159977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 160077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemud_pipe_cache_buffer(QemudClient* client, const uint8_t* msg, int msglen) 160177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 160277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* buf; 160377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage** ins_at = &client->ProtocolSelector.Pipe.messages; 160477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 160577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Allocate descriptor big enough to contain message as well. */ 160677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf = (QemudPipeMessage*)malloc(msglen + sizeof(QemudPipeMessage)); 160777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (buf != NULL) { 160877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message starts right after the descriptor. */ 160977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->message = (uint8_t*)buf + sizeof(QemudPipeMessage); 161077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->size = msglen; 161177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine memcpy(buf->message, msg, msglen); 161277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->offset = 0; 161377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->next = NULL; 161477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine while (*ins_at != NULL) { 161577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine ins_at = &(*ins_at)->next; 161677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 161777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine *ins_at = buf; 161877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Notify the pipe that there is data to read. */ 1619593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine goldfish_pipe_wake(client->ProtocolSelector.Pipe.qemud_pipe->hwpipe, 1620593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine PIPE_WAKE_READ); 162177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 162277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 162377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 162477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Sends service message to the client. 162577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 162677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 162777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemud_pipe_send(QemudClient* client, const uint8_t* msg, int msglen) 162877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 162977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine uint8_t frame[FRAME_HEADER_SIZE]; 163077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int avail, len = msglen; 163177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int framing = client->framing; 163277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 163377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (msglen <= 0) 163477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return; 163577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 163677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: len=%3d '%s'", 163777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, msglen, quote_bytes((const void*)msg, msglen)); 163877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 163977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (framing) { 164077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine len += FRAME_HEADER_SIZE; 164177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 164277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 164377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* packetize the payload for the serial MTU */ 164477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine while (len > 0) 164577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine { 164677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine avail = len; 164777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (avail > MAX_SERIAL_PAYLOAD) 164877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine avail = MAX_SERIAL_PAYLOAD; 164977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 165077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* insert frame header when needed */ 165177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (framing) { 165277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int2hex(frame, FRAME_HEADER_SIZE, msglen); 165377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine T("%s: '%.*s'", __FUNCTION__, FRAME_HEADER_SIZE, frame); 165477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_cache_buffer(client, frame, FRAME_HEADER_SIZE); 165577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine avail -= FRAME_HEADER_SIZE; 165677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine len -= FRAME_HEADER_SIZE; 165777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine framing = 0; 165877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 165977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 166077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* write message content */ 166177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine T("%s: '%.*s'", __FUNCTION__, avail, msg); 166277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_cache_buffer(client, msg, avail); 166377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine msg += avail; 166477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine len -= avail; 166577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 166677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 166777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 16689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this can be used by a service implementation to send an answer 16699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * or message to a specific client. 16709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 16719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectvoid 16729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_send ( QemudClient* client, const uint8_t* msg, int msglen ) 16739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 167477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (_is_pipe_client(client)) { 167577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_send(client, msg, msglen); 167677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else { 167777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_serial_send(client->ProtocolSelector.Serial.serial, 167877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine client->ProtocolSelector.Serial.channel, 167977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine client->framing != 0, msg, msglen); 168077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 16819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 16829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 16839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* enable framing for this client. When TRUE, this will 16849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * use internally a simple 4-hexchar header before each 16859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * message exchanged through the serial port. 16869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 16879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectvoid 16889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_set_framing( QemudClient* client, int framing ) 16899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 16909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* release dynamic buffer if we're disabling framing */ 16919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (client->framing) { 16929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!client->need_header) { 16939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project AFREE(client->payload->buff); 16949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project client->need_header = 1; 16959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 16969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 16979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project client->framing = !!framing; 16989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 16999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 17009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this can be used by a service implementation to close a 17019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * specific client connection. 17029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 17039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectvoid 17049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_close( QemudClient* client ) 17059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 17069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_disconnect(client); 17079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 17089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 17099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1710871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/** SNAPSHOT SUPPORT 1711871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije **/ 1712871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1713871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves the number of clients. 1714871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1715871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1716871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_client_save_count(QEMUFile* f, QemudClient* c) 1717871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1718871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije unsigned int client_count = 0; 1719871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for( ; c; c = c->next) // walk over linked list 172077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine // skip control channel, which is not saved 172177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (_is_pipe_client(c) || c->ProtocolSelector.Serial.channel > 0) 1722871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije client_count++; 1723871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1724871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, client_count); 1725871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1726871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1727871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves the number of services currently available. 1728871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1729871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1730871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_save_count(QEMUFile* f, QemudService* s) 1731871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1732871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije unsigned int service_count = 0; 1733871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for( ; s; s = s->next ) // walk over linked list 1734871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije service_count++; 1735871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1736871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, service_count); 1737871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1738871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1739871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Save QemuD state to snapshot. 1740871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1741871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * The control channel has no state of its own, other than the local variables 1742871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * in qemud_multiplexer_control_recv. We can therefore safely skip saving it, 1743871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * which spares us dealing with the exception of a client not connected to a 1744871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * service. 1745871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1746871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1747871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_save(QEMUFile* f, void* opaque) 1748871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1749871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudMultiplexer *m = opaque; 1750871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1751871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_serial_save(f, m->serial); 1752871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1753871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save service states */ 1754871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save_count(f, m->services); 1755871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService *s; 1756871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (s = m->services; s; s = s->next) 1757871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save(f, s); 1758871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1759871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save client channels */ 1760871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_client_save_count(f, m->clients); 1761871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClient *c; 1762871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (c = m->clients; c; c = c->next) { 176377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* skip control channel client */ 176477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (_is_pipe_client(c) || c->ProtocolSelector.Serial.channel > 0) { 1765871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_client_save(f, c); 1766871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1767871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1768871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1769871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1770871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1771871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1772871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Checks whether the same services are available at this point as when the 1773871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * snapshot was made. 1774871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1775871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1776871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_load_services( QEMUFile* f, QemudService* current_services ) 1777871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1778871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int i, ret; 1779871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int service_count = qemu_get_be32(f); 1780871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (i = 0; i < service_count; i++) { 1781871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_service_load(f, current_services))) 1782871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1783871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1784871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1785871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1786871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1787871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1788871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Removes all active non-control clients, then creates new ones with state 1789871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * taken from the snapshot. 1790871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1791871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * We do not send "disconnect" commands, over the channel. If we did, we might 1792871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * stop clients in the restored guest, resulting in an incorrect restore. 1793871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1794871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * Instead, we silently replace the clients that were running before the 1795871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * restore with new clients, whose state we copy from the snapshot. Since 1796871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * everything is multiplexed over one link, only the multiplexer notices the 1797871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * changes, there is no communication with the guest. 1798871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1799871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1800d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkineqemud_load_clients(QEMUFile* f, QemudMultiplexer* m, int version ) 1801871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1802871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* Remove all clients, except on the control channel.*/ 1803871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_multiplexer_disconnect_noncontrol(m); 1804871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1805871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* Load clients from snapshot */ 1806871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int client_count = qemu_get_be32(f); 1807871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int i, ret; 1808871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (i = 0; i < client_count; i++) { 1809d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine if ((ret = qemud_client_load(f, m->services, version))) { 1810871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1811871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1812871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1813871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1814871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1815871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1816871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1817871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Load QemuD state from file. 1818871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1819871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1820871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_load(QEMUFile *f, void* opaque, int version) 1821871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1822871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudMultiplexer *m = opaque; 1823871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1824871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1825871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1826871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_serial_load(f, m->serial))) 1827871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1828871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_load_services(f, m->services))) 1829871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1830d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine if ((ret = qemud_load_clients(f, m, version))) 1831871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1832871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1833871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1834871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1835871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 183677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/*------------------------------------------------------------------------------ 183777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 183877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * QEMUD PIPE service callbacks 183977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 184077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * ----------------------------------------------------------------------------*/ 184177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 184277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* This is a callback that gets invoked when guest is connecting to the service. 184377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 184477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * Here we will create a new client as well as pipe descriptor representing new 184577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * connection. 184677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 184777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void* 184877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_init(void* hwpipe, void* _looper, const char* args) 184977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 185077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudMultiplexer *m = _multiplexer; 185177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudService* sv = m->services; 185277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client; 185377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = NULL; 18544c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine char service_name[512]; 18554c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_args; 18564c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine size_t srv_name_len; 185777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 185877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* 'args' passed in this callback represents name of the service the guest is 185977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * connecting to. It can't be NULL. */ 186077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (args == NULL) { 186177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: Missing address!", __FUNCTION__); 186277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return NULL; 186377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 186477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 18654c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine /* 'args' contain service name, and optional parameters for the client that 18664c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine * is about to be created in this call. The parameters are separated from the 18674c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine * service name wit ':'. Separate service name from the client param. */ 18684c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_args = strchr(args, ':'); 18694c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (client_args != NULL) { 18704c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine srv_name_len = min(client_args - args, sizeof(service_name) - 1); 18714c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_args++; // Past the ':' 18724c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (*client_args == '\0') { 18734c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine /* No actual parameters. */ 18744c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_args = NULL; 18754c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 18764c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } else { 18774c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine srv_name_len = min(strlen(args), sizeof(service_name) - 1); 18784c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 18794c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine memcpy(service_name, args, srv_name_len); 18804c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine service_name[srv_name_len] = '\0'; 18814c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine 188277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Lookup registered service by its name. */ 18834c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine while (sv != NULL && strcmp(sv->name, service_name)) { 188477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine sv = sv->next; 188577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 188677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (sv == NULL) { 18874c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine D("%s: Service '%s' has not been registered!", __FUNCTION__, service_name); 188877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return NULL; 188977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 189077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 189177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Create a client for this connection. -1 as a channel ID signals that this 189277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * is a pipe client. */ 18934c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client = qemud_service_connect_client(sv, -1, client_args); 189477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (client != NULL) { 189577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine ANEW0(pipe); 189677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->hwpipe = hwpipe; 189777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->looper = _looper; 189877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->service = sv; 189977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->client = client; 1900593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine client->ProtocolSelector.Pipe.qemud_pipe = pipe; 190177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 190277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 190377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return pipe; 190477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 190577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 190677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Called when the guest wants to close the channel. 190777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine*/ 190877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 190977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_closeFromGuest( void* opaque ) 191077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 191177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 191277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 191377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s", __FUNCTION__); 1914593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client != NULL) { 1915593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine qemud_client_disconnect(client); 1916593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } else { 1917593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 1918593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 191977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 192077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 192177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Called when the guest has sent some data to the client. 192277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 192377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic int 192477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_sendBuffers(void* opaque, 192577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine const GoldfishPipeBuffer* buffers, 192677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int numBuffers) 192777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 192877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 192977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 193077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t transferred = 0; 193177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 1932593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client == NULL) { 1933593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 1934593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine return -1; 1935593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 1936593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 193777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (numBuffers == 1) { 193877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Simple case: all data are in one buffer. */ 193977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: %s", __FUNCTION__, quote_bytes((char*)buffers->data, buffers->size)); 194077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_client_recv(client, buffers->data, buffers->size); 194177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine transferred = buffers->size; 194277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else { 194377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* If there are multiple buffers involved, collect all data in one buffer 194477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * before calling the high level client. */ 194577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine uint8_t* msg, *wrk; 194677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int n; 194777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine for (n = 0; n < numBuffers; n++) { 194877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine transferred += buffers[n].size; 194977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 195077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine msg = malloc(transferred); 195177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine wrk = msg; 195277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine for (n = 0; n < numBuffers; n++) { 195377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine memcpy(wrk, buffers[n].data, buffers[n].size); 195477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine wrk += buffers[n].size; 195577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 195677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: %s", __FUNCTION__, quote_bytes((char*)msg, transferred)); 195777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_client_recv(client, msg, transferred); 195877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine free(msg); 195977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 196077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 196177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return transferred; 196277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 196377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 196477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Called when the guest is reading data from the client. 196577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 196677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic int 196777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_recvBuffers(void* opaque, GoldfishPipeBuffer* buffers, int numBuffers) 196877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 196977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 197077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 1971593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudPipeMessage** msg_list; 197277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine GoldfishPipeBuffer* buff = buffers; 197377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine GoldfishPipeBuffer* endbuff = buffers + numBuffers; 197477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t sent_bytes = 0; 197577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t off_in_buff = 0; 197677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 1977593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client == NULL) { 1978593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 1979593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine return -1; 1980593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 1981593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 1982593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine msg_list = &client->ProtocolSelector.Pipe.messages; 198377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (*msg_list == NULL) { 198477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* No data to send. Let it block until we wake it up with 198577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * PIPE_WAKE_READ when service sends data to the client. */ 198677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return PIPE_ERROR_AGAIN; 198777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 198877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 198977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Fill in goldfish buffers while they are still available, and there are 199077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * messages in the client's message list. */ 199177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine while (buff != endbuff && *msg_list != NULL) { 199277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* msg = *msg_list; 199377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message data fiting the current pipe's buffer. */ 19941875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine size_t to_copy = min(msg->size - msg->offset, buff->size - off_in_buff); 199577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine memcpy(buff->data + off_in_buff, msg->message + msg->offset, to_copy); 199677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Update offsets. */ 199777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine off_in_buff += to_copy; 199877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine msg->offset += to_copy; 199977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine sent_bytes += to_copy; 200077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (msg->size == msg->offset) { 200177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* We're done with the current message. Go to the next one. */ 200277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine *msg_list = msg->next; 200377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine free(msg); 200477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 200577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (off_in_buff == buff->size) { 200677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Current pipe buffer is full. Continue with the next one. */ 200777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buff++; 20081875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine off_in_buff = 0; 200977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 201077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 201177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 201277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: -> %u (of %u)", __FUNCTION__, sent_bytes, buffers->size); 201377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 201477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return sent_bytes; 201577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 201677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 201777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic unsigned 201877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_poll(void* opaque) 201977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 202077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 202177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 2022593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine unsigned ret = 0; 2023593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 2024593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client != NULL) { 2025fd16505ce923202f0abe74bfe7c3ba110d325ebeVladimir Chtchetkine ret |= PIPE_POLL_OUT; 2026593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client->ProtocolSelector.Pipe.messages != NULL) { 2027fd16505ce923202f0abe74bfe7c3ba110d325ebeVladimir Chtchetkine ret |= PIPE_POLL_IN; 2028593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 2029593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } else { 2030593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 203177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 203277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 203377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return ret; 203477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 203577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 203677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 203777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_wakeOn(void* opaque, int flags) 203877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 203977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: -> %X", __FUNCTION__, flags); 204077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 204177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 204277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* QEMUD pipe functions. 204377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 204477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic const GoldfishPipeFuncs _qemudPipe_funcs = { 204577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_init, 204677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_closeFromGuest, 204777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_sendBuffers, 204877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_recvBuffers, 204977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_poll, 205077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_wakeOn, 205177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine}; 205277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 205377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Initializes QEMUD pipe interface. 205477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 205577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 205677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_android_qemud_pipe_init(void) 205777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 205877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine static ABool _qemud_pipe_initialized = false; 205977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 206077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_qemud_pipe_initialized) { 206177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine goldfish_pipe_add_type( "qemud", looper_newCore(), &_qemudPipe_funcs ); 206277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_initialized = true; 206377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 206477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 20659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 20669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this is the end of the serial charpipe that must be passed 20679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to the emulated tty implementation. The other end of the 20689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * charpipe must be passed to qemud_multiplexer_init(). 20699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 20709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic CharDriverState* android_qemud_cs; 20719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 207277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Initializes QEMUD serial interface. 207377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 207477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 207577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_android_qemud_serial_init(void) 20769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 20779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; 20789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 20799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (android_qemud_cs != NULL) 20809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 20819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 20829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (qemu_chr_open_charpipe( &android_qemud_cs, &cs ) < 0) { 20839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project derror( "%s: can't create charpipe to serial port", 20849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__ ); 20859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project exit(1); 20869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 20879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 20889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_init(_multiplexer, cs); 2089871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 2090871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije register_savevm( "qemud", 0, QEMUD_SAVE_VERSION, 2091871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_save, qemud_load, _multiplexer); 20929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 20939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 209477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkineextern void 209577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkineandroid_qemud_init( void ) 209677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 209777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s", __FUNCTION__); 209877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* We don't know in advance whether the guest system supports qemud pipes, 209977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * so we will initialize both qemud machineries, the legacy (over serial 210077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * port), and the new one (over qemu pipe). Then we let the guest to connect 210177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * via one, or the other. */ 210277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _android_qemud_serial_init(); 210377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _android_qemud_pipe_init(); 210477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 210577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 21069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* return the serial charpipe endpoint that must be used 21079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * by the emulated tty implementation. 21089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 21099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source ProjectCharDriverState* android_qemud_get_cs( void ) 21109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 21119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (android_qemud_cs == NULL) 21129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project android_qemud_init(); 21139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return android_qemud_cs; 21159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 21169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this function is used to register a new named qemud-based 21189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * service. You must provide 'serv_opaque' and 'serv_connect' 21199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * which will be called whenever a new client tries to connect 21209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to the services. 21219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 21229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 'serv_connect' shall return NULL if the connection is refused, 21239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * or a handle to a new QemudClient otherwise. The latter can be 21249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * created through qemud_client_new() defined above. 21259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 21269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 'max_clients' is the maximum number of clients accepted by 21279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the service concurrently. If this value is 0, then any number 21289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * of clients can connect. 21299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 21309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source ProjectQemudService* 21319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_register( const char* service_name, 21329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int max_clients, 21339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* serv_opaque, 2134871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceConnect serv_connect, 2135871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceSave serv_save, 2136871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceLoad serv_load ) 21379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 21389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* sv; 213977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudMultiplexer* m = _multiplexer; 21409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 214177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine android_qemud_init(); 21429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project sv = qemud_service_new(service_name, 214477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine max_clients, 214577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_opaque, 214677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_connect, 214777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_save, 214877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_load, 214977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine &m->services); 215077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("Registered QEMUD service %s", service_name); 21519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return sv; 21529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 21539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* broadcast a given message to all clients of a given QemudService 21559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 21569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectextern void 21579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_broadcast( QemudService* sv, 21589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const uint8_t* msg, 21599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int msglen ) 21609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 21619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c; 21629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for (c = sv->clients; c; c = c->next_serv) 21649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_send(c, msg, msglen); 21659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 21669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* 21709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The following code is used for backwards compatibility reasons. 21719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It allows you to implement a given qemud-based service through 21729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * a charpipe. 21739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 21749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * In other words, this implements a QemudService and corresponding 21759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudClient that connects a qemud client running in the emulated 21769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * system, to a CharDriverState object implemented through a charpipe. 21779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 21789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudCharClient <===charpipe====> (char driver user) 21799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 21809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * For example, this is used to implement the "gsm" service when the 21819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * modem emulation is provided through an external serial device. 21829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 21839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * A QemudCharService can have only one client by definition. 21849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * There is no QemudCharClient object because we can store a single 21859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * CharDriverState handle in the 'opaque' field for simplicity. 21869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 21879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct { 21899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* service; 21909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; 21919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} QemudCharService; 21929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 21939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called whenever a new message arrives from a qemud client. 21949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * this simply sends the message through the charpipe to the user. 21959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 21969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 2197318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner_qemud_char_client_recv( void* opaque, uint8_t* msg, int msglen, 2198318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner QemudClient* client ) 21999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs = opaque; 22019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(cs, msg, msglen); 22029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* we don't expect clients of char. services to exit. Just 22059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * print an error to signal an unexpected situation. We should 22069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * be able to recover from these though, so don't panic. 22079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 22099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project_qemud_char_client_close( void* opaque ) 22105297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine 22119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22125297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine QemudClient* client = opaque; 22135297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine 22145297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine /* At this point modem driver still uses char pipe to communicate with 22155297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * hw-qemud, while communication with the guest is done over qemu pipe. 22165297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * So, when guest disconnects from the qemu pipe, and emulator-side client 22175297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * goes through the disconnection process, this routine is called, since it 22185297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * has been set to called during service registration. Unless modem driver 22195297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * is changed to drop char pipe communication, this routine will be called 22205297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * due to guest disconnection. As long as the client was a qemu pipe - based 22215297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * client, it's fine, since we don't really need to do anything in this case. 22225297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine */ 22235297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine if (!_is_pipe_client(client)) { 22245297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine derror("unexpected qemud char. channel close"); 22255297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine } 22269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called by the charpipe to know how much data can be read from 22309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the user. Since we send everything directly to the serial port 22319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * we can return an arbitrary number. 22329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 22349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project_qemud_char_service_can_read( void* opaque ) 22359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 8192; /* whatever */ 22379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called to read data from the charpipe and send it to the client. 22409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * used qemud_service_broadcast() even if there is a single client 22419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * because we don't need a QemudCharClient object this way. 22429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 22449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project_qemud_char_service_read( void* opaque, const uint8_t* from, int len ) 22459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* sv = opaque; 22479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_service_broadcast( sv, from, len ); 22489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called when a qemud client tries to connect to a char. service. 22519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * we simply create a new client and open the charpipe to receive 22529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * data from it. 22539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudClient* 22551875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine_qemud_char_service_connect(void* opaque, 22561875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine QemudService* sv, 22571875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine int channel, 22581875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine const char* client_param ) 22599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs = opaque; 22611875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine QemudClient* c = qemud_client_new( sv, channel, client_param, 22629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project cs, 22639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project _qemud_char_client_recv, 2264871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije _qemud_char_client_close, 2265871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije NULL, NULL ); 22669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* now we can open the gates :-) */ 22689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_add_handlers( cs, 22699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project _qemud_char_service_can_read, 22709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project _qemud_char_service_read, 22719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project NULL, 22729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project sv ); 22739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return c; 22759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* returns a charpipe endpoint that can be used by an emulated 22789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * device or external serial port to implement a char. service 22799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectint 22819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectandroid_qemud_get_channel( const char* name, CharDriverState* *pcs ) 22829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; 22849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (qemu_chr_open_charpipe(&cs, pcs) < 0) { 22869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project derror("can't open charpipe for '%s' qemud service", name); 22879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project exit(2); 22889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 2289871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_register(name, 1, cs, _qemud_char_service_connect, NULL, NULL); 22909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 0; 22919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* set the character driver state for a given qemud communication channel. this 22949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * is used to attach the channel to an external char driver device directly. 22959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * returns 0 on success, -1 on error 22969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectint 22989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectandroid_qemud_set_channel( const char* name, CharDriverState* peer_cs ) 22999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 2300fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner CharDriverState* char_buffer = qemu_chr_open_buffer(peer_cs); 2301fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner 2302fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner if (char_buffer == NULL) 2303fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner return -1; 2304fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner 2305871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_register(name, 1, char_buffer, _qemud_char_service_connect, 2306871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije NULL, NULL); 23079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 0; 23089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 2309