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" 233e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner#include "utils/panic.h" 249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 257ffddd66de46c27c4e24d9af9b47fc0b9a8da8d1Vladimir Chtchetkine#define D(...) VERBOSE_PRINT(qemud,__VA_ARGS__) 269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define D_ACTIVE VERBOSE_CHECK(qemud) 279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* the T(...) macro is used to dump traffic */ 299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define T_ACTIVE 0 309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#if T_ACTIVE 329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define T(...) VERBOSE_PRINT(qemud,__VA_ARGS__) 339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#else 349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define T(...) ((void)0) 359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#endif 369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* max serial MTU. Don't change this without modifying 389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * development/emulator/qemud/qemud.c as well. 399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define MAX_SERIAL_PAYLOAD 4000 419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* max framed data payload. Must be < (1 << 16) 439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define MAX_FRAME_PAYLOAD 65535 459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 46871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Version number of snapshots code. Increment whenever the data saved 47871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * or the layout in which it is saved is changed. 48871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 49d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine#define QEMUD_SAVE_VERSION 2 50871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 514c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine#define min(a, b) (((a) < (b)) ? (a) : (b)) 524c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine 539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 54791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* define SUPPORT_LEGACY_QEMUD to 1 if you want to support 55791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * talking to a legacy qemud daemon. See docs/ANDROID-QEMUD.TXT 56791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * for details. 57791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 58334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#ifdef TARGET_ARM 59791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#define SUPPORT_LEGACY_QEMUD 1 60334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#endif 61334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#ifdef TARGET_I386 62334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#define SUPPORT_LEGACY_QEMUD 0 /* no legacy support */ 63334ab475d2f27dbf6fbf836c2d4fb86dbb02a15cJun Nakajima#endif 64fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#if SUPPORT_LEGACY_QEMUD 65fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#include "telephony/android_modem.h" 66fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#include "telephony/modem_driver.h" 67fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner#endif 68fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner 699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* 70791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * This implements support for the 'qemud' multiplexing communication 71791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * channel between clients running in the emulated system and 'services' 72791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * provided by the emulator. 739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 74791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * For additional details, please read docs/ANDROID-QEMUD.TXT 759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* 799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * IMPLEMENTATION DETAILS: 809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * We use one charpipe to connect the emulated serial port to the 'QemudSerial' 829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * object. This object is used to receive data from the serial port, and 839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * unframe messages (i.e. extract payload length + channel id from header, 849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * then the payload itself), before sending them to a generic receiver. 859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The QemudSerial object can also be used to send messages to the daemon 879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * through the serial port (see qemud_serial_send()) 889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The multiplexer is connected to one or more 'service' objects. 909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * are themselves connected through a charpipe to an emulated device or 919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * control sub-module in the emulator. 929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * tty <==charpipe==> QemudSerial ---> QemudMultiplexer ----> QemudClient 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 1009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** HANDLING INCOMING DATA FRAMES 1019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 1029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 103791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* A QemudSink is just a handly data structure that is used to 104791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * read a fixed amount of bytes into a buffer 105791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct QemudSink { 107871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int used; /* number of bytes already used */ 108871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int size; /* total number of bytes in buff */ 1099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* buff; 1109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} QemudSink; 1119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 112871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* save the state of a QemudSink to a snapshot. 113871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 114871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * The buffer pointer is not saved, since it usually points to buffer 115871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * fields in other structs, which have save functions themselves. It 116871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * is up to the caller to make sure the buffer is correctly saved and 117871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * restored. 118871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 119871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 120871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_sink_save(QEMUFile* f, QemudSink* s) 121871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 122871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->used); 123871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->size); 124871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 125871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 126871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* load the state of a QemudSink from a snapshot. 127871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 128871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 129871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_sink_load(QEMUFile* f, QemudSink* s) 130871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 131871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->used = qemu_get_be32(f); 132871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->size = qemu_get_be32(f); 133871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 134871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 135871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 136871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 137791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* reset a QemudSink, i.e. provide a new destination buffer address 138791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * and its size in bytes. 139791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 1419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_sink_reset( QemudSink* ss, int size, uint8_t* buffer ) 1429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 143871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije ss->used = 0; 1449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ss->size = size; 1459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ss->buff = buffer; 1469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 1479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 148791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* try to fill the sink by reading bytes from the source buffer 149791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * '*pmsg' which contains '*plen' bytes 150791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 151791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * this functions updates '*pmsg' and '*plen', and returns 152791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 1 if the sink's destination buffer is full, or 0 otherwise. 153791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 1559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_sink_fill( QemudSink* ss, const uint8_t* *pmsg, int *plen) 1569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 157871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int avail = ss->size - ss->used; 1589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail <= 0) 1609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 1; 1619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail > *plen) 1639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = *plen; 1649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 165871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije memcpy(ss->buff + ss->used, *pmsg, avail); 1669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *pmsg += avail; 1679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *plen -= avail; 168871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije ss->used += avail; 1699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 170871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return (ss->used == ss->size); 1719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 1729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 173791d86195fedca3a8cba5d7fa3e3610302361a78David Turner/* returns the number of bytes needed to fill a sink's destination 174791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * buffer. 175791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 1779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_sink_needed( QemudSink* ss ) 1789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 179871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ss->size - ss->used; 1809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 1819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** HANDLING SERIAL PORT CONNECTION 1839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 1849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* The QemudSerial object receives data from the serial port charpipe. 1869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It parses the header to extract the channel id and payload length, 1879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * then the message itself. 1889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 1899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Incoming messages are sent to a generic receiver identified by 1909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the 'recv_opaque' and 'recv_func' parameters to qemud_serial_init() 1919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 1929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It also provides qemud_serial_send() which can be used to send 1939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * messages back through the serial port. 1949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 1959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define HEADER_SIZE 6 1979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define LENGTH_OFFSET 2 1999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define LENGTH_SIZE 4 2009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define CHANNEL_OFFSET 0 2029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define CHANNEL_SIZE 2 2039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 204791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 205791d86195fedca3a8cba5d7fa3e3610302361a78David Turnertypedef enum { 206791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QEMUD_VERSION_UNKNOWN, 207791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QEMUD_VERSION_LEGACY, 208791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QEMUD_VERSION_NORMAL 209791d86195fedca3a8cba5d7fa3e3610302361a78David Turner} QemudVersion; 210791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 211791d86195fedca3a8cba5d7fa3e3610302361a78David Turner# define LEGACY_LENGTH_OFFSET 0 212791d86195fedca3a8cba5d7fa3e3610302361a78David Turner# define LEGACY_CHANNEL_OFFSET 4 213791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 214791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 2159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* length of the framed header */ 2169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define FRAME_HEADER_SIZE 4 2179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#define BUFFER_SIZE MAX_SERIAL_PAYLOAD 2199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* out of convenience, the incoming message is zero-terminated 2219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * and can be modified by the receiver (e.g. for tokenization). 2229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 2239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef void (*QemudSerialReceive)( void* opaque, int channel, uint8_t* msg, int msglen); 2249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct QemudSerial { 2269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; /* serial charpipe endpoint */ 2279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* managing incoming packets from the serial port */ 2299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ABool need_header; 2309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int overflow; 2319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int in_size; 2329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int in_channel; 233791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 234791d86195fedca3a8cba5d7fa3e3610302361a78David Turner QemudVersion version; 235791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 2369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink header[1]; 2379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink payload[1]; 2389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t data0[MAX_SERIAL_PAYLOAD+1]; 2399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* receiver */ 2419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerialReceive recv_func; /* receiver callback */ 2429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* recv_opaque; /* receiver user-specific data */ 2439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} QemudSerial; 2449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 2459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 246871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Save the state of a QemudSerial to a snapshot file. 247871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 248871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 249871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_serial_save(QEMUFile* f, QemudSerial* s) 250871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 251871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* cs, recv_func and recv_opaque are not saved, as these are assigned only 252871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * during emulator init. A load within a session can re-use the values 253871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * already assigned, a newly launched emulator has freshly assigned values. 254871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 255871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 256871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* state of incoming packets from the serial port */ 257871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->need_header); 258871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->overflow); 259871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->in_size); 260871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->in_channel); 261871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#if SUPPORT_LEGACY_QEMUD 262871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->version); 263871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#endif 264871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_save(f, s->header); 265871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_save(f, s->payload); 266871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, MAX_SERIAL_PAYLOAD+1); 267871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, s->data0, MAX_SERIAL_PAYLOAD+1); 268871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 269871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 270871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Load the state of a QemudSerial from a snapshot file. 271871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 272871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 273871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_serial_load(QEMUFile* f, QemudSerial* s) 274871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 275871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* state of incoming packets from the serial port */ 276871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->need_header = qemu_get_be32(f); 277871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->overflow = qemu_get_be32(f); 278871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->in_size = qemu_get_be32(f); 279871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->in_channel = qemu_get_be32(f); 280871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#if SUPPORT_LEGACY_QEMUD 281871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->version = qemu_get_be32(f); 282871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije#endif 283871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_load(f, s->header); 284871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_load(f, s->payload); 285871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 286871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* s->header and s->payload are only ever connected to s->data0 */ 287871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->header->buff = s->payload->buff = s->data0; 288871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 289871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int len = qemu_get_be32(f); 290871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (len - 1 > MAX_SERIAL_PAYLOAD) { 291871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: load failed: size of saved payload buffer (%d) exceeds " 292871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije "current maximum (%d)\n", 293871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, len - 1, MAX_SERIAL_PAYLOAD); 294871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 295871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 296871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 297871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, s->data0, len)) != len) { 298871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: failed to load serial buffer contents (tried reading %d bytes, got %d)\n", 299871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, len, ret); 300871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 301871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 302871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 303871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 304871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 305871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 3069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called by the charpipe to see how much bytes can be 3079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * read from the serial port. 3089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 3099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 3109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_can_read( void* opaque ) 3119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 3129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial* s = opaque; 3139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->overflow > 0) { 3159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return s->overflow; 3169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* if in_size is 0, we're reading the header */ 3199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->need_header) 3209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return qemud_sink_needed(s->header); 3219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* otherwise, we're reading the payload */ 3239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return qemud_sink_needed(s->payload); 3249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 3259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called by the charpipe to read data from the serial 3279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * port. 'len' cannot be more than the value returned 3289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * by 'qemud_serial_can_read'. 3299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 3309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 3319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_read( void* opaque, const uint8_t* from, int len ) 3329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 3339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial* s = opaque; 3349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project T("%s: received %3d bytes: '%s'", __FUNCTION__, len, quote_bytes((const void*)from, len)); 3369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project while (len > 0) { 3389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int avail; 3399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* skip overflow bytes */ 3419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->overflow > 0) { 3429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = s->overflow; 3439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail > len) 3449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = len; 3459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project from += avail; 3479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len -= avail; 3489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 3499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read header if needed */ 3529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->need_header) { 3539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(s->header, (const uint8_t**)&from, &len)) 3549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 3559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 356791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 357791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (s->version == QEMUD_VERSION_UNKNOWN) { 358791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* if we receive "001200" as the first header, then we 359791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * detected a legacy qemud daemon. See the comments 360791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * in qemud_serial_send_legacy_probe() for details. 361791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 362791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if ( !memcmp(s->data0, "001200", 6) ) { 363791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: legacy qemud detected.", __FUNCTION__); 364791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->version = QEMUD_VERSION_LEGACY; 365fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner /* tell the modem to use legacy emulation mode */ 366fbcbf4201b9b56b72e9a06d292ae94360dd66b9eDavid Turner amodem_set_legacy(android_modem); 367791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } else { 368791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: normal qemud detected.", __FUNCTION__); 369791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->version = QEMUD_VERSION_NORMAL; 370791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 371791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 372791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 373791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (s->version == QEMUD_VERSION_LEGACY) { 374791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_size = hex2int( s->data0 + LEGACY_LENGTH_OFFSET, LENGTH_SIZE ); 375791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_channel = hex2int( s->data0 + LEGACY_CHANNEL_OFFSET, CHANNEL_SIZE ); 376791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } else { 377791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_size = hex2int( s->data0 + LENGTH_OFFSET, LENGTH_SIZE ); 378791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->in_channel = hex2int( s->data0 + CHANNEL_OFFSET, CHANNEL_SIZE ); 379791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 380791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#else 3819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* extract payload length + channel id */ 3829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_size = hex2int( s->data0 + LENGTH_OFFSET, LENGTH_SIZE ); 3839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_channel = hex2int( s->data0 + CHANNEL_OFFSET, CHANNEL_SIZE ); 384791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 385871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->header->used = 0; 3869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->in_size <= 0 || s->in_channel < 0) { 3889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: bad header: '%.*s'", __FUNCTION__, HEADER_SIZE, s->data0); 3899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 3909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (s->in_size > MAX_SERIAL_PAYLOAD) { 3939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring huge serial packet: length=%d channel=%1", 3949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, s->in_size, s->in_channel); 3959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->overflow = s->in_size; 3969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 3979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 3989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 3999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* prepare 'in_data' for payload */ 4009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->need_header = 0; 4019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset(s->payload, s->in_size, s->data0); 4029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 4039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read payload bytes */ 4059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(s->payload, &from, &len)) 4069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 4079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* zero-terminate payload, then send it to receiver */ 4099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->payload->buff[s->payload->size] = 0; 4109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: channel=%2d len=%3d '%s'", __FUNCTION__, 4119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_channel, s->payload->size, 4129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project quote_bytes((const void*)s->payload->buff, s->payload->size)); 4139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->recv_func( s->recv_opaque, s->in_channel, s->payload->buff, s->payload->size ); 4159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* prepare for new header */ 4179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->need_header = 1; 4189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 4199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 4209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 421791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 422791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 423791d86195fedca3a8cba5d7fa3e3610302361a78David Turnerstatic void 424791d86195fedca3a8cba5d7fa3e3610302361a78David Turnerqemud_serial_send_legacy_probe( QemudSerial* s ) 425791d86195fedca3a8cba5d7fa3e3610302361a78David Turner{ 426791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* we're going to send a specially crafted packet to the qemud 427791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * daemon, this will help us determine whether we're talking 428791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * to a legacy or a normal daemon. 429791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 430791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * the trick is to known that a legacy daemon uses the following 431791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * header: 432791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 433791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * <length><channel><payload> 434791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 435791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * while the normal one uses: 436791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 437791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * <channel><length><payload> 438791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 439791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * where <channel> is a 2-hexchar string, and <length> a 4-hexchar 440791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * string. 441791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 442791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * if we send a header of "000100", it is interpreted: 443791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 444791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * - as the header of a 1-byte payload by the legacy daemon 445791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * - as the header of a 256-byte payload by the normal one. 446791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 447791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * we're going to send something that looks like: 448791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 449791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000100" + "X" + 450791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000b00" + "connect:gsm" + 451791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000b00" + "connect:gps" + 452791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "000f00" + "connect:control" + 453791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * "00c210" + "0"*194 454791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 455791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * the normal daemon will interpret this as a 256-byte payload 456791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * for channel 0, with garbage content ("X000b00conn...") which 457791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * will be silently ignored. 458791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 459791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * on the other hand, the legacy daemon will see it as a 460791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * series of packets: 461791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 462791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * one message "X" on channel 0, which will force the daemon 463791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * to send back "001200ko:unknown command" as its first answer. 464791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 465791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * three "connect:<xxx>" messages used to receive the channel 466791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * numbers of the three legacy services implemented by the daemon. 467791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 468791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * a garbage packet of 194 zeroes for channel 16, which will be 469791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * silently ignored. 470791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 471791d86195fedca3a8cba5d7fa3e3610302361a78David Turner uint8_t tab[194]; 472791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 473791d86195fedca3a8cba5d7fa3e3610302361a78David Turner memset(tab, 0, sizeof(tab)); 474791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000100X", 7); 475791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000b00connect:gsm", 17); 476791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000b00connect:gps", 17); 477791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"000f00connect:control", 21); 478791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, (uint8_t*)"00c210", 6); 479791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemu_chr_write(s->cs, tab, sizeof(tab)); 480791d86195fedca3a8cba5d7fa3e3610302361a78David Turner} 481791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif /* SUPPORT_LEGACY_QEMUD */ 482791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 4839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* intialize a QemudSerial object with a charpipe endpoint 4849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * and a receiver. 4859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 4869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 4879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_init( QemudSerial* s, 4889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs, 4899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerialReceive recv_func, 4909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* recv_opaque ) 4919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 4929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->cs = cs; 4939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->recv_func = recv_func; 4949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->recv_opaque = recv_opaque; 4959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->need_header = 1; 4969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->overflow = 0; 4979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 4989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset( s->header, HEADER_SIZE, s->data0 ); 4999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_size = 0; 5009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->in_channel = -1; 5019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 502791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 503791d86195fedca3a8cba5d7fa3e3610302361a78David Turner s->version = QEMUD_VERSION_UNKNOWN; 504791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemud_serial_send_legacy_probe(s); 505791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 506791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 5079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_add_handlers( cs, 5089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_can_read, 5099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_read, 5109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project NULL, 5119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s ); 5129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 5139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* send a message to the serial port. This will add the necessary 5159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * header. 5169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 5179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 5189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_serial_send( QemudSerial* s, 5199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel, 5209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ABool framing, 5219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const uint8_t* msg, 5229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int msglen ) 5239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 5249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t header[HEADER_SIZE]; 5259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t frame[FRAME_HEADER_SIZE]; 5269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int avail, len = msglen; 5279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (msglen <= 0 || channel < 0) 5299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 5309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: channel=%2d len=%3d '%s'", 5329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, channel, msglen, 5339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project quote_bytes((const void*)msg, msglen)); 5349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (framing) { 5369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len += FRAME_HEADER_SIZE; 5379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 5389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* packetize the payload for the serial MTU */ 540bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner while (len > 0) 5419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project { 5429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = len; 5439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (avail > MAX_SERIAL_PAYLOAD) 5449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail = MAX_SERIAL_PAYLOAD; 5459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* write this packet's header */ 547791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 548791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (s->version == QEMUD_VERSION_LEGACY) { 549791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + LEGACY_LENGTH_OFFSET, LENGTH_SIZE, avail); 550791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + LEGACY_CHANNEL_OFFSET, CHANNEL_SIZE, channel); 551791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } else { 552791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + LENGTH_OFFSET, LENGTH_SIZE, avail); 553791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int2hex(header + CHANNEL_OFFSET, CHANNEL_SIZE, channel); 554791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 555791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#else 5569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int2hex(header + LENGTH_OFFSET, LENGTH_SIZE, avail); 5579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int2hex(header + CHANNEL_OFFSET, CHANNEL_SIZE, channel); 558791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif 559791d86195fedca3a8cba5d7fa3e3610302361a78David Turner T("%s: '%.*s'", __FUNCTION__, HEADER_SIZE, header); 5609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(s->cs, header, HEADER_SIZE); 5619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* insert frame header when needed */ 5639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (framing) { 5649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int2hex(frame, FRAME_HEADER_SIZE, msglen); 565791d86195fedca3a8cba5d7fa3e3610302361a78David Turner T("%s: '%.*s'", __FUNCTION__, FRAME_HEADER_SIZE, frame); 5669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(s->cs, frame, FRAME_HEADER_SIZE); 5679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project avail -= FRAME_HEADER_SIZE; 5689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len -= FRAME_HEADER_SIZE; 5699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project framing = 0; 5709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 5719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* write message content */ 573791d86195fedca3a8cba5d7fa3e3610302361a78David Turner T("%s: '%.*s'", __FUNCTION__, avail, msg); 5749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(s->cs, msg, avail); 5759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project msg += avail; 5769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project len -= avail; 5779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 5789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 5799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 5809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** CLIENTS 5819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 5829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 58377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Descriptor for a data buffer pending to be sent to a qemud pipe client. 58477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 58577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * When a service decides to send data to the client, there could be cases when 58677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * client is not ready to read them. In this case there is no GoldfishPipeBuffer 58777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * available to write service's data to, So, we need to cache that data into the 58877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * client descriptor, and "send" them over to the client in _qemudPipe_recvBuffers 58977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * callback. Pending service data is stored in the client descriptor as a list 59077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * of QemudPipeMessage instances. 59177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 59277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinetypedef struct QemudPipeMessage QemudPipeMessage; 59377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestruct QemudPipeMessage { 59477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message to send. */ 59577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine uint8_t* message; 59677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message size. */ 59777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t size; 59877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Offset in the message buffer of the chunk, that has not been sent 59977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * to the pipe yet. */ 60077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t offset; 60177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Links next message in the client. */ 60277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* next; 60377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine}; 60477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 60577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 6069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* A QemudClient models a single client as seen by the emulator. 60777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * Each client has its own channel id (for the serial qemud), or pipe descriptor 60877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * (for the pipe based qemud), and belongs to a given QemudService (see below). 6099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 61077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * There is a global list of serial clients used to multiplex incoming 61177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * messages from the channel id (see qemud_multiplexer_serial_recv()). Pipe 61277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * clients don't need multiplexing, because they are communicated via qemud pipes 61377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * that are unique for each client. 6149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 6159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 6169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 61777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Defines type of the client: pipe, or serial. 61877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 61977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinetypedef enum QemudProtocol { 62077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Client is communicating via pipe. */ 62177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QEMUD_PROTOCOL_PIPE, 62277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Client is communicating via serial port. */ 62377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QEMUD_PROTOCOL_SERIAL 62477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} QemudProtocol; 62577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 626593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine/* Descriptor for a QEMUD pipe connection. 627593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * 628593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * Every time a client connects to the QEMUD via pipe, an instance of this 629593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * structure is created to represent a connection used by new pipe client. 630593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine */ 631593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkinetypedef struct QemudPipe { 632593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Pipe descriptor. */ 633593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine void* hwpipe; 634593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Looper used for I/O */ 635593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine void* looper; 636593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Service for this pipe. */ 637593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudService* service; 638593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* Client for this pipe. */ 639593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudClient* client; 640593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine} QemudPipe; 641593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 6429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstruct QemudClient { 64377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Defines protocol, used by the client. */ 64477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudProtocol protocol; 64577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 64677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Fields that are common for all protocols. */ 6474c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine char* param; 6489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* clie_opaque; 6499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientRecv clie_recv; 6509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientClose clie_close; 651871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientSave clie_save; 652871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientLoad clie_load; 6539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* service; 6549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* next_serv; /* next in same service */ 6559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* next; 6569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient** pref; 6579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 6589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* framing support */ 6599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int framing; 6609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ABool need_header; 661bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner ABool closing; 6629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink header[1]; 6639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t header0[FRAME_HEADER_SIZE]; 6649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSink payload[1]; 66577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 66677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Fields that are protocol-specific. */ 66777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine union { 66877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Serial-specific fields. */ 66977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine struct { 67077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int channel; 67177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudSerial* serial; 67277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } Serial; 67377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Pipe-specific fields. */ 67477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine struct { 675593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudPipe* qemud_pipe; 67677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* messages; 67777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } Pipe; 67877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } ProtocolSelector; 6799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project}; 6809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 68177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic ABool 68277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_is_pipe_client(QemudClient* client) 68377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 68477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return (client-> protocol == QEMUD_PROTOCOL_PIPE) ? true : false; 68577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 68677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 6879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void qemud_service_remove_client( QemudService* service, 6889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* client ); 6899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 6909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* remove a QemudClient from global list */ 6919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 6929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_remove( QemudClient* c ) 6939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 6949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->pref[0] = c->next; 6959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->next) 6969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next->pref = c->pref; 6979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 6989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next = NULL; 6999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->pref = &c->next; 7009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 7019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* add a QemudClient to global list */ 7039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 7049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_prepend( QemudClient* c, QemudClient** plist ) 7059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 7069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next = *plist; 7079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->pref = plist; 7089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *plist = c; 7099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->next) 7109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next->pref = &c->next; 7119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 7129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* receive a new message from a client, and dispatch it to 7149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the real service implementation. 7159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 7169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 7179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_recv( void* opaque, uint8_t* msg, int msglen ) 7189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 7199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = opaque; 7209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* no framing, things are simple */ 7229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!c->framing) { 7239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_recv) 724318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner c->clie_recv( c->clie_opaque, msg, msglen, c ); 7259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 7269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* framing */ 7299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#if 1 7319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* special case, in 99% of cases, everything is in 7329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the incoming message, and we can do all we need 7339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * directly without dynamic allocation. 7349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 7359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (msglen > FRAME_HEADER_SIZE && 7369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->need_header == 1 && 7379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_needed(c->header) == 0) 7389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project { 7399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int len = hex2int( msg, FRAME_HEADER_SIZE ); 7409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (len >= 0 && msglen == len + FRAME_HEADER_SIZE) { 7429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_recv) 743bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner c->clie_recv( c->clie_opaque, 7449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project msg+FRAME_HEADER_SIZE, 745318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner msglen-FRAME_HEADER_SIZE, c ); 7469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 7479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project#endif 7509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project while (msglen > 0) { 75283f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner uint8_t *data; 75383f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner 7549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read the header */ 7559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->need_header) { 7569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int frame_size; 7579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* data; 7589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(c->header, (const uint8_t**)&msg, &msglen)) 7609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 7619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project frame_size = hex2int(c->header0, 4); 7639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (frame_size == 0) { 7649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring empty frame", __FUNCTION__); 7659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 7669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (frame_size < 0) { 7689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring corrupted frame header '.*s'", 7699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, FRAME_HEADER_SIZE, c->header0 ); 7709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project continue; 7719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project AARRAY_NEW(data, frame_size+1); /* +1 for terminating zero */ 7749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset(c->payload, frame_size, data); 7759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->need_header = 0; 776871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->header->used = 0; 7779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* read the payload */ 7809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!qemud_sink_fill(c->payload, (const uint8_t**)&msg, &msglen)) 7819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 7829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 7839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->payload->buff[c->payload->size] = 0; 78483f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner c->need_header = 1; 78583f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner data = c->payload->buff; 7869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 78783f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner /* Technically, calling 'clie_recv' can destroy client object 'c' 78883f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner * if it decides to close the connection, so ensure we don't 78983f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner * use/dereference it after the call. */ 7909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_recv) 791318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner c->clie_recv( c->clie_opaque, c->payload->buff, c->payload->size, c ); 7929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 79383f82216024e9b5623d9f2b3b90e9c2e954412e9David 'Digit' Turner AFREE(data); 7949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 7959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 7969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 79777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Sends data to a pipe-based client. 79877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 79977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 80077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemud_pipe_send(QemudClient* client, const uint8_t* msg, int msglen); 80177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 8024c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine/* Frees memory allocated for the qemud client. 8034c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine */ 8044c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkinestatic void 8054c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine_qemud_client_free(QemudClient* c) 8064c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine{ 8074c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if ( c != NULL) { 8084c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (_is_pipe_client(c)) { 8094c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine /* Free outstanding messages. */ 8104c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine QemudPipeMessage** msg_list = &c->ProtocolSelector.Pipe.messages; 8114c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine while (*msg_list != NULL) { 8124c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine QemudPipeMessage* to_free = *msg_list; 8134c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine *msg_list = to_free->next; 8144c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine free(to_free); 8154c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8164c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8174c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (c->param != NULL) { 8184c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine free(c->param); 8194c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8204c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine AFREE(c); 8214c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 8224c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine} 8234c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine 8249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* disconnect a client. this automatically frees the QemudClient. 8259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * note that this also removes the client from the global list 8269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * and from its service's list, if any. 827ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * Param: 828ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * opaque - QemuClient instance 829ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * guest_close - For pipe clients control whether or not the disconnect is 830ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * caused by guest closing the pipe handle (in which case 1 is passed in 831ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * this parameter). For serial clients this parameter is ignored. 8329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 8339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 834ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkineqemud_client_disconnect( void* opaque, int guest_close ) 8359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 8369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = opaque; 8379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 838bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner if (c->closing) { /* recursive call, exit immediately */ 839bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner return; 840bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner } 841ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine 842ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine if (_is_pipe_client(c) && !guest_close) { 843ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine /* This is emulator component (rather than the guest) closing a pipe 844ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * client. Since pipe clients are controlled strictly by the guest, we 845ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * don't actually close the client here, but notify the guest about the 846ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * client being disconnected. Then we will do the real client close when 847ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * the guest explicitly closes the pipe, in which case this routine will 848ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * be called from the _qemudPipe_closeFromGuest callback with guest_close 849ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine * set to 1. */ 850ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine char tmp[128], *p=tmp, *end=p+sizeof(tmp); 851ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine p = bufprint(tmp, end, "disconnect:00"); 852ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine _qemud_pipe_send(c, (uint8_t*)tmp, p-tmp); 853ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine return; 854ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine } 855ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine 856bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner c->closing = 1; 857bb1f432421288dae208c7189356643023ccbffbcDavid 'Digit' Turner 8589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* remove from current list */ 8599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_remove(c); 8609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 86177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (_is_pipe_client(c)) { 862593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine /* We must NULL the client reference in the QemuPipe for this connection, 863593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * so if a sudden receive request comes after client has been closed, we 864593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine * don't blow up. */ 865593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine c->ProtocolSelector.Pipe.qemud_pipe->client = NULL; 86677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else if (c->ProtocolSelector.Serial.channel > 0) { 867ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine /* send a disconnect command to the daemon */ 86877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine char tmp[128], *p=tmp, *end=p+sizeof(tmp); 86977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine p = bufprint(tmp, end, "disconnect:%02x", 87077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel); 87177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_serial_send(c->ProtocolSelector.Serial.serial, 0, 0, (uint8_t*)tmp, p-tmp); 8729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 8739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* call the client close callback */ 8759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->clie_close) { 8769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_close(c->clie_opaque); 8779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_close = NULL; 8789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 8799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_recv = NULL; 8809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* remove from service list, if any */ 8829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (c->service) { 8839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_service_remove_client(c->service, c); 8849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->service = NULL; 8859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 8869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 8874c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine _qemud_client_free(c); 8889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 8899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 89077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* allocate a new QemudClient object 89177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * NOTE: channel_id valie is used as a selector between serial and pipe clients. 89277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * Since channel_id < 0 is an invalid value for a serial client, it would 89377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * indicate that creating client is a pipe client. */ 8949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudClient* 8959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_alloc( int channel_id, 8964c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param, 8979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* clie_opaque, 8989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientRecv clie_recv, 8999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientClose clie_close, 900871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientSave clie_save, 901871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientLoad clie_load, 9029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial* serial, 9039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient** pclients ) 9049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 9059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c; 9069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 9079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ANEW0(c); 9089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 90977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (channel_id < 0) { 91077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Allocating a pipe client. */ 91177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->protocol = QEMUD_PROTOCOL_PIPE; 91277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Pipe.messages = NULL; 913593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine c->ProtocolSelector.Pipe.qemud_pipe = NULL; 91477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else { 91577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Allocating a serial client. */ 91677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->protocol = QEMUD_PROTOCOL_SERIAL; 91777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.serial = serial; 91877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel = channel_id; 91977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 9204c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine c->param = client_param ? ASTRDUP(client_param) : NULL; 9219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_opaque = clie_opaque; 9229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_recv = clie_recv; 9239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->clie_close = clie_close; 924871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->clie_save = clie_save; 925871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->clie_load = clie_load; 92677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->service = NULL; 92777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->next_serv = NULL; 92877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->next = NULL; 9299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->framing = 0; 9309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->need_header = 1; 9319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_sink_reset(c->header, FRAME_HEADER_SIZE, c->header0); 9329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 9339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_prepend(c, pclients); 9349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 9359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return c; 9369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 9379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 938871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* forward */ 939871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void qemud_service_save_name( QEMUFile* f, QemudService* s ); 940871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic char* qemud_service_load_name( QEMUFile* f ); 941871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudService* qemud_service_find( QemudService* service_list, 942871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije const char* service_name ); 943871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudClient* qemud_service_connect_client( QemudService *sv, 9444c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine int channel_id, 9454c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param); 946871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 947871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves the client state needed to re-establish connections on load. 9483e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * Note that we save only serial clients here. The pipe clients will be 9493e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * saved along with the pipe to which they are attached. 950871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 951871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 9523e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turnerqemud_serial_client_save(QEMUFile* f, QemudClient* c) 953871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 954871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save generic information */ 955871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save_name(f, c->service); 9563e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_string(f, c->param); 9573e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_be32(f, c->ProtocolSelector.Serial.channel); 958871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 959871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save client-specific state */ 960871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->clie_save) 961871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->clie_save(f, c, c->clie_opaque); 962871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 963871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save framing configuration */ 964871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, c->framing); 965871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->framing) { 966871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, c->need_header); 967871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* header sink always connected to c->header0, no need to save */ 968871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, FRAME_HEADER_SIZE); 969871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, c->header0, FRAME_HEADER_SIZE); 970871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* payload sink */ 971871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_sink_save(f, c->payload); 972871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, c->payload->buff, c->payload->size); 973871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 974871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 975871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 976871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Loads client state from file, then starts a new client connected to the 977871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * corresponding service. 9783e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * Note that we load only serial clients here. The pipe clients will be 9793e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * loaded along with the pipe to which they were attached. 980871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 981871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 9823e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turnerqemud_serial_client_load(QEMUFile* f, QemudService* current_services, int version ) 983871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 984871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char *service_name = qemud_service_load_name(f); 985871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (service_name == NULL) 986871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 9873e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner char* param = qemu_get_string(f); 988871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* get current service instance */ 989871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService *sv = qemud_service_find(current_services, service_name); 990871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (sv == NULL) { 991871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: load failed: unknown service \"%s\"\n", 992871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, service_name); 993871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 994871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 995871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 9963e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner int channel = qemu_get_be32(f); 997d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine 998871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (channel == 0) { 999871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: illegal snapshot: client for control channel must no be saved\n", 1000871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__); 1001871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1002871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1003871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1004871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* re-connect client */ 10053e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudClient* c = qemud_service_connect_client(sv, channel, param); 1006871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if(c == NULL) 1007871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1008871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1009871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* load client-specific state */ 1010871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1011871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->clie_load) 1012871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = c->clie_load(f, c, c->clie_opaque))) 1013871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; /* load failure */ 1014871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1015871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* load framing configuration */ 1016871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->framing = qemu_get_be32(f); 1017871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->framing) { 1018871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1019871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* header buffer */ 1020871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c->need_header = qemu_get_be32(f); 1021871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int header_size = qemu_get_be32(f); 1022871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (header_size > FRAME_HEADER_SIZE) { 1023871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: load failed: payload buffer requires %d bytes, %d available\n", 1024871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, header_size, FRAME_HEADER_SIZE); 1025871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1026871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1027871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1028871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, c->header0, header_size)) != header_size) { 1029871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: frame header buffer load failed: expected %d bytes, got %d\n", 1030871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, header_size, ret); 1031871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1032871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1033871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1034871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* payload sink */ 1035871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_sink_load(f, c->payload))) 1036871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1037871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1038871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* replace payload buffer by saved data */ 1039871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (c->payload->buff) { 1040871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(c->payload->buff); 1041871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1042871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AARRAY_NEW(c->payload->buff, c->payload->size+1); /* +1 for terminating zero */ 1043871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, c->payload->buff, c->payload->size)) != c->payload->size) { 1044871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: frame payload buffer load failed: expected %d bytes, got %d\n", 1045871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, c->payload->size, ret); 1046871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(c->payload->buff); 1047871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1048871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1049871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1050871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1051871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1052871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1053871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1054871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 10559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** SERVICES 10569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 10579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* A QemudService models a _named_ service facility implemented 10599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * by the emulator, that clients in the emulated system can connect 10609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to. 10619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 10629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Each service can have a limit on the number of clients they 10639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * accept (this number if unlimited if 'max_clients' is 0). 10649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 10659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Each service maintains a list of active QemudClients and 10669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * can also be used to create new QemudClient objects through 10679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * its 'serv_opaque' and 'serv_connect' fields. 10689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 10699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstruct QemudService { 10709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const char* name; 10719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int max_clients; 10729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int num_clients; 10739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* clients; 10749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudServiceConnect serv_connect; 1075871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceSave serv_save; 1076871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceLoad serv_load; 10779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* serv_opaque; 10789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* next; 10799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project}; 10809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* Create a new QemudService object */ 10829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudService* 10839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_new( const char* name, 10849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int max_clients, 10859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* serv_opaque, 10869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudServiceConnect serv_connect, 1087871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceSave serv_save, 1088871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceLoad serv_load, 10899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService** pservices ) 10909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 10919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* s; 10929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ANEW0(s); 10949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->name = ASTRDUP(name); 10959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->max_clients = max_clients; 10969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->num_clients = 0; 10979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->clients = NULL; 10989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 10999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->serv_opaque = serv_opaque; 11009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->serv_connect = serv_connect; 1101871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->serv_save = serv_save; 1102871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->serv_load = serv_load; 11039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->next = *pservices; 11059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *pservices = s; 11069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return s; 11089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 11099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* used internally to populate a QemudService object with a 11119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * new QemudClient */ 11129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 11139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_add_client( QemudService* s, QemudClient* c ) 11149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 11159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->service = s; 11169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project c->next_serv = s->clients; 11179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->clients = c; 11189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->num_clients += 1; 11199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 11209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* used internally to remove a QemudClient from a QemudService */ 11229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 11239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_remove_client( QemudService* s, QemudClient* c ) 11249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 11259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient** pnode = &s->clients; 11269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* node; 11279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* remove from clients linked-list */ 11299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for (;;) { 11309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project node = *pnode; 11319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (node == NULL) { 113277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: could not find client for service '%s'", 113377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, s->name); 11349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 11359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 11369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (node == c) 11379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project break; 11389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project pnode = &node->next_serv; 11399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 11409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 11419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *pnode = node->next_serv; 11429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project s->num_clients -= 1; 11439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 11449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1145871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* ask the service to create a new QemudClient. Note that we 1146871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * assume that this calls qemud_client_new() which will add 1147871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * the client to the service's list automatically. 1148871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1149871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * returns the client or NULL if an error occurred 1150871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1151871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudClient* 11524c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkineqemud_service_connect_client(QemudService *sv, 11534c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine int channel_id, 11544c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param) 1155871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 11564c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine QemudClient* client = 11574c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine sv->serv_connect( sv->serv_opaque, sv, channel_id, client_param ); 1158871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (client == NULL) { 1159871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: registration failed for '%s' service", 1160871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, sv->name); 1161871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return NULL; 1162871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1163871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: registered client channel %d for '%s' service", 1164871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, channel_id, sv->name); 1165871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return client; 1166871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1167871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1168871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* find a registered service by name. 1169871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1170871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic QemudService* 1171871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_find( QemudService* service_list, const char* service_name) 1172871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1173871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService* sv = NULL; 1174871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (sv = service_list; sv != NULL; sv = sv->next) { 1175871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (!strcmp(sv->name, service_name)) { 1176871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije break; 1177871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1178871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1179871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return sv; 1180871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1181871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1182871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Save the name of the given service. 1183871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1184871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1185871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_save_name(QEMUFile* f, QemudService* s) 1186871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1187871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int len = strlen(s->name) + 1; // include '\0' terminator 1188871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, len); 1189871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_buffer(f, (const uint8_t *) s->name, len); 1190871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1191871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1192871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Load the name of a service. Returns a pointer to the loaded name, or NULL 1193871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * on failure. 1194871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1195871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic char* 1196871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_load_name( QEMUFile* f ) 1197871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1198871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1199871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int name_len = qemu_get_be32(f); 1200871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char *service_name = android_alloc(name_len); 1201871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemu_get_buffer(f, (uint8_t*)service_name, name_len) != name_len)) { 1202871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: service name load failed: expected %d bytes, got %d\n", 1203871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, name_len, ret); 1204871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(service_name); 1205871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return NULL; 1206871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1207871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (service_name[name_len - 1] != '\0') { 1208871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char last = service_name[name_len - 1]; 1209871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije service_name[name_len - 1] = '\0'; /* make buffer contents printable */ 1210871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: service name load failed: expecting NULL-terminated string, but " 1211871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije "last char is '%c' (buffer contents: '%s%c')\n", 1212871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, name_len, last, service_name, last); 1213871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije AFREE(service_name); 1214871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return NULL; 1215871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1216871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1217871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return service_name; 1218871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1219871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1220871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves state of a service. 1221871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1222871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1223871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_save(QEMUFile* f, QemudService* s) 1224871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1225871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save_name(f, s); 1226871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->max_clients); 1227871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, s->num_clients); 1228871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1229871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (s->serv_save) 1230871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije s->serv_save(f, s, s->serv_opaque); 1231871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1232871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1233871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Loads service state from file, then updates the currently running instance 1234871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * of that service to mirror the loaded state. If the service is not running, 1235871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * the load process is aborted. 1236871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1237871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * Parameter 'current_services' should be the list of active services. 1238871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1239871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1240871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_load( QEMUFile* f, QemudService* current_services ) 1241871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1242871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije char* service_name = qemud_service_load_name(f); 1243871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (service_name == NULL) 1244871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1245871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1246871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* get current service instance */ 1247871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService *sv = qemud_service_find(current_services, service_name); 1248871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (sv == NULL) { 1249871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: loading failed: service \"%s\" not available\n", 1250871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije __FUNCTION__, service_name); 1251871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return -EIO; 1252871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1253871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1254871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* reconfigure service as required */ 1255871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije sv->max_clients = qemu_get_be32(f); 1256871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije sv->num_clients = qemu_get_be32(f); 1257871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1258871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* load service specific data */ 1259871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1260871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if (sv->serv_load) 1261871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = sv->serv_load(f, sv, sv->serv_opaque))) 1262871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; /* load failure */ 1263871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1264871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1265871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1266871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1267871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 12689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** MULTIPLEXER 12699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 12709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 12719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* A QemudMultiplexer object maintains the global state of the 12729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * qemud service facility. It holds a QemudSerial object to 12739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * maintain the state of the serial port connection. 12749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 12759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The QemudMultiplexer receives all incoming messages from 12769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the serial port, and dispatches them to the appropriate 12779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudClient. 12789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 12799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It also has a global list of clients, and a global list of 12809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * services. 12819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 12829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * Finally, the QemudMultiplexer has a special QemudClient used 12839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to handle channel 0, i.e. the control channel used to handle 12849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * connections and disconnections of clients. 12859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 12869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct QemudMultiplexer QemudMultiplexer; 12879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 12889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstruct QemudMultiplexer { 12899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudSerial serial[1]; 12909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* clients; 12919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* services; 12929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project}; 12939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 12949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this is the serial_recv callback that is called 12959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * whenever an incoming message arrives through the serial port 12969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 12979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 12989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_serial_recv( void* opaque, 12999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel, 13009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* msg, 13019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int msglen ) 13029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 13039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudMultiplexer* m = opaque; 13049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = m->clients; 13059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* dispatch to an existing client if possible 13079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * note that channel 0 is handled by a special 13089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudClient that is setup in qemud_multiplexer_init() 13099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 13109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for ( ; c != NULL; c = c->next ) { 131177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel == channel) { 13129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_recv(c, msg, msglen); 13139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 13149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: ignoring %d bytes for unknown channel %d", 13189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, msglen, channel); 13199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 13209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* handle a new connection attempt. This returns 0 on 13229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * success, -1 if the service name is unknown, or -2 13239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * if the service's maximum number of clients has been 13249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * reached. 13259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 13269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 13279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_connect( QemudMultiplexer* m, 13289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const char* service_name, 13299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel_id ) 13309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 13319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* find the corresponding registered service by name */ 1332871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService* sv = qemud_service_find(m->services, service_name); 13339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (sv == NULL) { 13349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: no registered '%s' service", __FUNCTION__, service_name); 13359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return -1; 13369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* check service's client count */ 13399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (sv->max_clients > 0 && sv->num_clients >= sv->max_clients) { 13409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: registration failed for '%s' service: too many clients (%d)", 13419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, service_name, sv->num_clients); 13429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return -2; 13439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1345871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* connect a new client to the service on the given channel */ 13464c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (qemud_service_connect_client(sv, channel_id, NULL) == NULL) 13479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return -1; 13489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 0; 13509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 13519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* disconnect a given client from its channel id */ 13539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 13549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_disconnect( QemudMultiplexer* m, 13559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel ) 13569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 13579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c; 13589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 13599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* find the client by its channel id, then disconnect it */ 13609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for (c = m->clients; c; c = c->next) { 136177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel == channel) { 13629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: disconnecting client %d", 13639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, channel); 13649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* note thatt this removes the client from 13659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * m->clients automatically. 13669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 136777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel = -1; /* no need to send disconnect:<id> */ 1368ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine qemud_client_disconnect(c, 0); 13699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 13709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 13729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: disconnecting unknown channel %d", 13739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, channel); 13749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 13759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1376871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* disconnects all channels, except for the control channel, without informing 1377871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * the daemon in the guest that disconnection has occurred. 1378871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1379871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * Used to silently kill clients when restoring emulator state snapshots. 1380871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1381871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1382871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_multiplexer_disconnect_noncontrol( QemudMultiplexer* m ) 1383871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1384871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClient* c; 1385871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClient* next = m->clients; 1386871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1387871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije while (next) { 1388871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije c = next; 1389871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije next = c->next; /* disconnect frees c, remember next in advance */ 1390871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 139177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel > 0) { 139277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* skip control channel */ 1393871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: disconnecting client %d", 139477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, c->ProtocolSelector.Serial.channel); 1395871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije D("%s: disconnecting client %d\n", 139677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, c->ProtocolSelector.Serial.channel); 139777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine c->ProtocolSelector.Serial.channel = -1; /* do not send disconnect:<id> */ 1398ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine qemud_client_disconnect(c, 0); 1399871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1400871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1401871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1402871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 14039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* handle control messages. This is used as the receive 14049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * callback for the special QemudClient setup to manage 14059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * channel 0. 14069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 14079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * note that the message is zero-terminated for convenience 14089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * (i.e. msg[msglen] is a valid memory read that returns '\0') 14099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 14109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 1411318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turnerqemud_multiplexer_control_recv( void* opaque, 1412318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner uint8_t* msg, 1413318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner int msglen, 1414318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner QemudClient* client ) 14159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 14169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudMultiplexer* mult = opaque; 14179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project uint8_t* msgend = msg + msglen; 14189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project char tmp[64], *p=tmp, *end=p+sizeof(tmp); 14199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* handle connection attempts. 14219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the client message must be "connect:<service-name>:<id>" 1422fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner * where <id> is a 2-char hexadecimal string, which must be > 0 14239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 14249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (msglen > 8 && !memcmp(msg, "connect:", 8)) 14259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project { 14269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const char* service_name = (const char*)msg + 8; 14279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channel, ret; 14289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project char* q; 14299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project q = strchr(service_name, ':'); 1431fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner if (q == NULL || q+3 != (char*)msgend) { 14329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: malformed connect message: '%.*s' (offset=%d)", 14339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__, msglen, (const char*)msg, q ? q-(char*)msg : -1); 14349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project *q++ = 0; /* zero-terminate service name */ 1437fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner channel = hex2int((uint8_t*)q, 2); 14389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (channel <= 0) { 14399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: malformed channel id '%.*s", 1440fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner __FUNCTION__, 2, q); 14419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project ret = qemud_multiplexer_connect(mult, service_name, channel); 14459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* the answer can be one of: 14469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * ok:connect:<id> 14479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * ko:connect:<id>:<reason-for-failure> 14489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 14499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (ret < 0) { 14509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (ret == -1) { 14519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* could not connect */ 1452fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner p = bufprint(tmp, end, "ko:connect:%02x:unknown service", channel); 14539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } else { 1454fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner p = bufprint(tmp, end, "ko:connect:%02x:service busy", channel); 14559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project else { 1458fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner p = bufprint(tmp, end, "ok:connect:%02x", channel); 14599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_send(mult->serial, 0, 0, (uint8_t*)tmp, p-tmp); 14619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 14649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* handle client disconnections, 14659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * this message arrives when the client has closed the connection. 1466fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner * format: "disconnect:<id>" where <id> is a 2-hex channel id > 0 14679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 1468fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner if (msglen == 13 && !memcmp(msg, "disconnect:", 11)) { 1469fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner int channel_id = hex2int(msg+11, 2); 14709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (channel_id <= 0) { 14719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project D("%s: malformed disconnect channel id: '%.*s'", 1472fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner __FUNCTION__, 2, msg+11); 14739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_disconnect(mult, channel_id); 14769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 14779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 14789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1479791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#if SUPPORT_LEGACY_QEMUD 1480791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* an ok:connect:<service>:<id> message can be received if we're 1481791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * talking to a legacy qemud daemon, i.e. one running in a 1.0 or 1482791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 1.1 system image. 1483791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * 1484791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * we should treat is as a normal "connect:" attempt, except that 1485791d86195fedca3a8cba5d7fa3e3610302361a78David Turner * we must not send back any acknowledgment. 1486791d86195fedca3a8cba5d7fa3e3610302361a78David Turner */ 1487791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (msglen > 11 && !memcmp(msg, "ok:connect:", 11)) { 1488791d86195fedca3a8cba5d7fa3e3610302361a78David Turner const char* service_name = (const char*)msg + 11; 1489791d86195fedca3a8cba5d7fa3e3610302361a78David Turner char* q = strchr(service_name, ':'); 1490791d86195fedca3a8cba5d7fa3e3610302361a78David Turner int channel; 1491791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1492791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (q == NULL || q+3 != (char*)msgend) { 1493791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: malformed legacy connect message: '%.*s' (offset=%d)", 1494791d86195fedca3a8cba5d7fa3e3610302361a78David Turner __FUNCTION__, msglen, (const char*)msg, q ? q-(char*)msg : -1); 1495791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1496791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1497791d86195fedca3a8cba5d7fa3e3610302361a78David Turner *q++ = 0; /* zero-terminate service name */ 1498791d86195fedca3a8cba5d7fa3e3610302361a78David Turner channel = hex2int((uint8_t*)q, 2); 1499791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (channel <= 0) { 1500791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: malformed legacy channel id '%.*s", 1501791d86195fedca3a8cba5d7fa3e3610302361a78David Turner __FUNCTION__, 2, q); 1502791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1503791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1504791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1505791d86195fedca3a8cba5d7fa3e3610302361a78David Turner switch (mult->serial->version) { 1506791d86195fedca3a8cba5d7fa3e3610302361a78David Turner case QEMUD_VERSION_UNKNOWN: 1507791d86195fedca3a8cba5d7fa3e3610302361a78David Turner mult->serial->version = QEMUD_VERSION_LEGACY; 1508791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: legacy qemud daemon detected.", __FUNCTION__); 1509791d86195fedca3a8cba5d7fa3e3610302361a78David Turner break; 1510791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1511791d86195fedca3a8cba5d7fa3e3610302361a78David Turner case QEMUD_VERSION_LEGACY: 1512791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* nothing unusual */ 1513791d86195fedca3a8cba5d7fa3e3610302361a78David Turner break; 1514791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1515791d86195fedca3a8cba5d7fa3e3610302361a78David Turner default: 1516791d86195fedca3a8cba5d7fa3e3610302361a78David Turner D("%s: weird, ignoring legacy qemud control message: '%.*s'", 1517791d86195fedca3a8cba5d7fa3e3610302361a78David Turner __FUNCTION__, msglen, msg); 1518791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1519791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1520791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1521791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* "hw-control" was called "control" in 1.0/1.1 */ 1522791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (!strcmp(service_name,"control")) 1523791d86195fedca3a8cba5d7fa3e3610302361a78David Turner service_name = "hw-control"; 1524791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1525791d86195fedca3a8cba5d7fa3e3610302361a78David Turner qemud_multiplexer_connect(mult, service_name, channel); 1526791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1527791d86195fedca3a8cba5d7fa3e3610302361a78David Turner } 1528791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 1529791d86195fedca3a8cba5d7fa3e3610302361a78David Turner /* anything else, don't answer for legacy */ 1530791d86195fedca3a8cba5d7fa3e3610302361a78David Turner if (mult->serial->version == QEMUD_VERSION_LEGACY) 1531791d86195fedca3a8cba5d7fa3e3610302361a78David Turner return; 1532791d86195fedca3a8cba5d7fa3e3610302361a78David Turner#endif /* SUPPORT_LEGACY_QEMUD */ 1533791d86195fedca3a8cba5d7fa3e3610302361a78David Turner 15349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* anything else is a problem */ 15359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project p = bufprint(tmp, end, "ko:unknown command"); 15369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_send(mult->serial, 0, 0, (uint8_t*)tmp, p-tmp); 15379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 15389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* initialize the global QemudMultiplexer. 15409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 15419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 15429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_multiplexer_init( QemudMultiplexer* mult, 15439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* serial_cs ) 15449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 15459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* control; 15469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* initialize serial handler */ 15489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_serial_init( mult->serial, 15499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project serial_cs, 15509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_serial_recv, 15519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project mult ); 15529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* setup listener for channel 0 */ 15549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project control = qemud_client_alloc( 0, 15554c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine NULL, 15569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project mult, 15579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_control_recv, 1558871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije NULL, NULL, NULL, 15599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project mult->serial, 15609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project &mult->clients ); 15619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 15629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* the global multiplexer state */ 15649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudMultiplexer _multiplexer[1]; 15659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/** HIGH-LEVEL API 15679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project **/ 15689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 15699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this function must be used in the serv_connect callback 15709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * of a given QemudService object (see qemud_service_register() 15719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * below). It is used to register a new QemudClient to acknowledge 15729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * a new client connection. 15739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 15749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 'clie_opaque', 'clie_recv' and 'clie_close' are used to 15759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * send incoming client messages to the corresponding service 15769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * implementation, or notify the service that a client has 15779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * disconnected. 15789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 15799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source ProjectQemudClient* 15809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_new( QemudService* service, 15819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int channelId, 15824c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_param, 15839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* clie_opaque, 15849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClientRecv clie_recv, 1585871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientClose clie_close, 1586871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientSave clie_save, 1587871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClientLoad clie_load ) 15889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 15899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudMultiplexer* m = _multiplexer; 15909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c = qemud_client_alloc( channelId, 15914c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_param, 15929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project clie_opaque, 15939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project clie_recv, 15949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project clie_close, 1595871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije clie_save, 1596871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije clie_load, 15979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project m->serial, 15989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project &m->clients ); 15999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 16009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_service_add_client(service, c); 16019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return c; 16029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 16039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 160477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Caches a service message into the client's descriptor. 160577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 160677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * See comments on QemudPipeMessage structure for more info. 160777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 160877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 160977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemud_pipe_cache_buffer(QemudClient* client, const uint8_t* msg, int msglen) 161077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 161177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* buf; 161277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage** ins_at = &client->ProtocolSelector.Pipe.messages; 161377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 161477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Allocate descriptor big enough to contain message as well. */ 161577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf = (QemudPipeMessage*)malloc(msglen + sizeof(QemudPipeMessage)); 161677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (buf != NULL) { 161777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message starts right after the descriptor. */ 161877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->message = (uint8_t*)buf + sizeof(QemudPipeMessage); 161977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->size = msglen; 162077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine memcpy(buf->message, msg, msglen); 162177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->offset = 0; 162277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buf->next = NULL; 162377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine while (*ins_at != NULL) { 162477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine ins_at = &(*ins_at)->next; 162577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 162677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine *ins_at = buf; 162777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Notify the pipe that there is data to read. */ 1628593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine goldfish_pipe_wake(client->ProtocolSelector.Pipe.qemud_pipe->hwpipe, 1629593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine PIPE_WAKE_READ); 163077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 163177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 163277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 163377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Sends service message to the client. 163477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 163577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 163677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemud_pipe_send(QemudClient* client, const uint8_t* msg, int msglen) 163777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 163877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine uint8_t frame[FRAME_HEADER_SIZE]; 163977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int avail, len = msglen; 164077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int framing = client->framing; 164177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 164277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (msglen <= 0) 164377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return; 164477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 164577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: len=%3d '%s'", 164677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine __FUNCTION__, msglen, quote_bytes((const void*)msg, msglen)); 164777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 164877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (framing) { 164977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine len += FRAME_HEADER_SIZE; 165077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 165177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 165277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* packetize the payload for the serial MTU */ 165377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine while (len > 0) 165477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine { 165577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine avail = len; 165677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (avail > MAX_SERIAL_PAYLOAD) 165777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine avail = MAX_SERIAL_PAYLOAD; 165877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 165977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* insert frame header when needed */ 166077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (framing) { 166177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int2hex(frame, FRAME_HEADER_SIZE, msglen); 166277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine T("%s: '%.*s'", __FUNCTION__, FRAME_HEADER_SIZE, frame); 166377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_cache_buffer(client, frame, FRAME_HEADER_SIZE); 166477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine avail -= FRAME_HEADER_SIZE; 166577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine len -= FRAME_HEADER_SIZE; 166677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine framing = 0; 166777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 166877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 166977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* write message content */ 167077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine T("%s: '%.*s'", __FUNCTION__, avail, msg); 167177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_cache_buffer(client, msg, avail); 167277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine msg += avail; 167377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine len -= avail; 167477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 167577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 167677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 16779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this can be used by a service implementation to send an answer 16789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * or message to a specific client. 16799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 16809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectvoid 16819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_send ( QemudClient* client, const uint8_t* msg, int msglen ) 16829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 168377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (_is_pipe_client(client)) { 168477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_send(client, msg, msglen); 168577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else { 168677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_serial_send(client->ProtocolSelector.Serial.serial, 168777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine client->ProtocolSelector.Serial.channel, 168877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine client->framing != 0, msg, msglen); 168977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 16909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 16919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 16929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* enable framing for this client. When TRUE, this will 16939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * use internally a simple 4-hexchar header before each 16949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * message exchanged through the serial port. 16959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 16969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectvoid 16979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_set_framing( QemudClient* client, int framing ) 16989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 16999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* release dynamic buffer if we're disabling framing */ 17009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (client->framing) { 17019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (!client->need_header) { 17029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project AFREE(client->payload->buff); 17039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project client->need_header = 1; 17049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 17059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 17069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project client->framing = !!framing; 17079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 17089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 17099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this can be used by a service implementation to close a 17109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * specific client connection. 17119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 17129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectvoid 17139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_client_close( QemudClient* client ) 17149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 1715ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine qemud_client_disconnect(client, 0); 17169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 17179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 17189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 1719871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/** SNAPSHOT SUPPORT 1720871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije **/ 1721871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1722871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves the number of clients. 1723871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1724871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1725871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_client_save_count(QEMUFile* f, QemudClient* c) 1726871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1727871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije unsigned int client_count = 0; 1728871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for( ; c; c = c->next) // walk over linked list 17293e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* skip control channel, which is not saved, and pipe channels that 17303e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * are saved along with the pipe. */ 17313e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel > 0) 1732871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije client_count++; 1733871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1734871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, client_count); 1735871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1736871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1737871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Saves the number of services currently available. 1738871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1739871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1740871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_service_save_count(QEMUFile* f, QemudService* s) 1741871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1742871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije unsigned int service_count = 0; 1743871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for( ; s; s = s->next ) // walk over linked list 1744871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije service_count++; 1745871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1746871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemu_put_be32(f, service_count); 1747871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1748871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1749871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Save QemuD state to snapshot. 1750871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1751871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * The control channel has no state of its own, other than the local variables 1752871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * in qemud_multiplexer_control_recv. We can therefore safely skip saving it, 1753871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * which spares us dealing with the exception of a client not connected to a 1754871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * service. 1755871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1756871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic void 1757871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_save(QEMUFile* f, void* opaque) 1758871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1759871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudMultiplexer *m = opaque; 1760871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1761871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_serial_save(f, m->serial); 1762871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1763871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save service states */ 1764871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save_count(f, m->services); 1765871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudService *s; 1766871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (s = m->services; s; s = s->next) 1767871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_save(f, s); 1768871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1769871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* save client channels */ 1770871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_client_save_count(f, m->clients); 1771871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudClient *c; 1772871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (c = m->clients; c; c = c->next) { 17733e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* skip control channel, and pipe clients */ 17743e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (!_is_pipe_client(c) && c->ProtocolSelector.Serial.channel > 0) { 17753e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemud_serial_client_save(f, c); 1776871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1777871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1778871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1779871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1780871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1781871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1782871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Checks whether the same services are available at this point as when the 1783871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * snapshot was made. 1784871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1785871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1786871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_load_services( QEMUFile* f, QemudService* current_services ) 1787871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1788871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int i, ret; 1789871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int service_count = qemu_get_be32(f); 1790871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (i = 0; i < service_count; i++) { 1791871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_service_load(f, current_services))) 1792871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1793871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1794871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1795871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1796871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1797871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1798871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Removes all active non-control clients, then creates new ones with state 1799871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * taken from the snapshot. 1800871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1801871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * We do not send "disconnect" commands, over the channel. If we did, we might 1802871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * stop clients in the restored guest, resulting in an incorrect restore. 1803871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * 1804871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * Instead, we silently replace the clients that were running before the 1805871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * restore with new clients, whose state we copy from the snapshot. Since 1806871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * everything is multiplexed over one link, only the multiplexer notices the 1807871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije * changes, there is no communication with the guest. 1808871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1809871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1810d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkineqemud_load_clients(QEMUFile* f, QemudMultiplexer* m, int version ) 1811871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1812871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* Remove all clients, except on the control channel.*/ 1813871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_multiplexer_disconnect_noncontrol(m); 1814871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1815871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije /* Load clients from snapshot */ 1816871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int client_count = qemu_get_be32(f); 1817871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int i, ret; 1818871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije for (i = 0; i < client_count; i++) { 18193e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if ((ret = qemud_serial_client_load(f, m->services, version))) { 1820871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1821871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1822871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije } 1823871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1824871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1825871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1826871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1827871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije/* Load QemuD state from file. 1828871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije */ 1829871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijestatic int 1830871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thijeqemud_load(QEMUFile *f, void* opaque, int version) 1831871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije{ 1832871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudMultiplexer *m = opaque; 1833871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1834871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije int ret; 1835871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1836871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_serial_load(f, m->serial))) 1837871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1838871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije if ((ret = qemud_load_services(f, m->services))) 1839871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1840d0e2872813e1d37e8233befdfd13a4d6cb0d7431Vladimir Chtchetkine if ((ret = qemud_load_clients(f, m, version))) 1841871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return ret; 1842871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 1843871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije return 0; 1844871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije} 1845871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 184677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/*------------------------------------------------------------------------------ 184777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 184877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * QEMUD PIPE service callbacks 184977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 185077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * ----------------------------------------------------------------------------*/ 185177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 18523e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner/* Saves pending pipe message to the snapshot file. */ 18533e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turnerstatic void 18543e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner_save_pipe_message(QEMUFile* f, QemudPipeMessage* msg) 18553e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner{ 18563e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_be32(f, msg->size); 18573e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_be32(f, msg->offset); 18583e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_buffer(f, msg->message, msg->size); 18593e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner} 18603e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 18613e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner/* Loads pending pipe messages from the snapshot file. 18623e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * Return: 18633e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * List of pending pipe messages loaded from snapshot, or NULL if snapshot didn't 18643e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner * contain saved messages. 18653e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner */ 18663e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turnerstatic QemudPipeMessage* 18673e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner_load_pipe_message(QEMUFile* f) 18683e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner{ 18693e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudPipeMessage* ret = NULL; 18703e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudPipeMessage** next = &ret; 18713e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 18723e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner uint32_t size = qemu_get_be32(f); 18733e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner while (size != 0) { 18743e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudPipeMessage* wrk; 18753e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner ANEW0(wrk); 18763e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner *next = wrk; 18773e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner wrk->size = size; 18783e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner wrk->offset = qemu_get_be32(f); 18793e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner wrk->message = malloc(wrk->size); 18803e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (wrk->message == NULL) { 18813e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner APANIC("Unable to allocate buffer for pipe's pending message."); 18823e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 18833e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_get_buffer(f, wrk->message, wrk->size); 18843e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner next = &wrk->next; 18853e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner *next = NULL; 18863e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner size = qemu_get_be32(f); 18873e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 18883e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 18893e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return ret; 18903e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner} 18913e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 189277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* This is a callback that gets invoked when guest is connecting to the service. 189377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * 189477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * Here we will create a new client as well as pipe descriptor representing new 189577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * connection. 189677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 189777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void* 189877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_init(void* hwpipe, void* _looper, const char* args) 189977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 190077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudMultiplexer *m = _multiplexer; 190177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudService* sv = m->services; 190277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client; 190377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = NULL; 19044c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine char service_name[512]; 19054c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine const char* client_args; 19064c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine size_t srv_name_len; 190777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 190877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* 'args' passed in this callback represents name of the service the guest is 190977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * connecting to. It can't be NULL. */ 191077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (args == NULL) { 191177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: Missing address!", __FUNCTION__); 191277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return NULL; 191377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 191477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 19154c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine /* 'args' contain service name, and optional parameters for the client that 19164c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine * is about to be created in this call. The parameters are separated from the 19174c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine * service name wit ':'. Separate service name from the client param. */ 19184c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_args = strchr(args, ':'); 19194c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (client_args != NULL) { 19204c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine srv_name_len = min(client_args - args, sizeof(service_name) - 1); 19214c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_args++; // Past the ':' 19224c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine if (*client_args == '\0') { 19234c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine /* No actual parameters. */ 19244c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client_args = NULL; 19254c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 19264c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } else { 19274c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine srv_name_len = min(strlen(args), sizeof(service_name) - 1); 19284c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine } 19294c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine memcpy(service_name, args, srv_name_len); 19304c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine service_name[srv_name_len] = '\0'; 19314c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine 193277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Lookup registered service by its name. */ 19334c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine while (sv != NULL && strcmp(sv->name, service_name)) { 193477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine sv = sv->next; 193577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 193677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (sv == NULL) { 19374c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine D("%s: Service '%s' has not been registered!", __FUNCTION__, service_name); 193877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return NULL; 193977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 194077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 194177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Create a client for this connection. -1 as a channel ID signals that this 194277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * is a pipe client. */ 19434c414820910ba8553cab7ff30188575f972a9896Vladimir Chtchetkine client = qemud_service_connect_client(sv, -1, client_args); 194477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (client != NULL) { 194577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine ANEW0(pipe); 194677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->hwpipe = hwpipe; 194777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->looper = _looper; 194877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->service = sv; 194977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine pipe->client = client; 1950593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine client->ProtocolSelector.Pipe.qemud_pipe = pipe; 195177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 195277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 195377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return pipe; 195477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 195577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 195677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Called when the guest wants to close the channel. 195777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine*/ 195877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 195977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_closeFromGuest( void* opaque ) 196077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 196177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 196277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 196377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s", __FUNCTION__); 1964593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client != NULL) { 1965ef71cb8b3f97b6c985bda997759ce2113cdb893eVladimir Chtchetkine qemud_client_disconnect(client, 1); 1966593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } else { 1967593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 1968593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 196977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 197077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 197177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Called when the guest has sent some data to the client. 197277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 197377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic int 197477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_sendBuffers(void* opaque, 197577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine const GoldfishPipeBuffer* buffers, 197677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int numBuffers) 197777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 197877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 197977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 198077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t transferred = 0; 198177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 1982593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client == NULL) { 1983593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 1984593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine return -1; 1985593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 1986593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 198777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (numBuffers == 1) { 198877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Simple case: all data are in one buffer. */ 198977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: %s", __FUNCTION__, quote_bytes((char*)buffers->data, buffers->size)); 199077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_client_recv(client, buffers->data, buffers->size); 199177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine transferred = buffers->size; 199277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } else { 199377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* If there are multiple buffers involved, collect all data in one buffer 199477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * before calling the high level client. */ 199577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine uint8_t* msg, *wrk; 199677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine int n; 199777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine for (n = 0; n < numBuffers; n++) { 199877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine transferred += buffers[n].size; 199977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 200077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine msg = malloc(transferred); 200177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine wrk = msg; 200277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine for (n = 0; n < numBuffers; n++) { 200377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine memcpy(wrk, buffers[n].data, buffers[n].size); 200477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine wrk += buffers[n].size; 200577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 200677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: %s", __FUNCTION__, quote_bytes((char*)msg, transferred)); 200777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine qemud_client_recv(client, msg, transferred); 200877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine free(msg); 200977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 201077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 201177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return transferred; 201277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 201377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 201477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Called when the guest is reading data from the client. 201577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 201677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic int 201777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_recvBuffers(void* opaque, GoldfishPipeBuffer* buffers, int numBuffers) 201877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 201977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 202077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 2021593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine QemudPipeMessage** msg_list; 202277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine GoldfishPipeBuffer* buff = buffers; 202377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine GoldfishPipeBuffer* endbuff = buffers + numBuffers; 202477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t sent_bytes = 0; 202577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine size_t off_in_buff = 0; 202677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 2027593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client == NULL) { 2028593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 2029593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine return -1; 2030593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 2031593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 2032593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine msg_list = &client->ProtocolSelector.Pipe.messages; 203377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (*msg_list == NULL) { 203477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* No data to send. Let it block until we wake it up with 203577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * PIPE_WAKE_READ when service sends data to the client. */ 203677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return PIPE_ERROR_AGAIN; 203777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 203877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 203977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Fill in goldfish buffers while they are still available, and there are 204077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * messages in the client's message list. */ 204177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine while (buff != endbuff && *msg_list != NULL) { 204277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipeMessage* msg = *msg_list; 204377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Message data fiting the current pipe's buffer. */ 20441875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine size_t to_copy = min(msg->size - msg->offset, buff->size - off_in_buff); 204577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine memcpy(buff->data + off_in_buff, msg->message + msg->offset, to_copy); 204677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Update offsets. */ 204777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine off_in_buff += to_copy; 204877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine msg->offset += to_copy; 204977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine sent_bytes += to_copy; 205077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (msg->size == msg->offset) { 205177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* We're done with the current message. Go to the next one. */ 205277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine *msg_list = msg->next; 205377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine free(msg); 205477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 205577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (off_in_buff == buff->size) { 205677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* Current pipe buffer is full. Continue with the next one. */ 205777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine buff++; 20581875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine off_in_buff = 0; 205977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 206077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 206177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 206277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: -> %u (of %u)", __FUNCTION__, sent_bytes, buffers->size); 206377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 206477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return sent_bytes; 206577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 206677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 206777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic unsigned 206877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_poll(void* opaque) 206977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 207077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudPipe* pipe = opaque; 207177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudClient* client = pipe->client; 2072593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine unsigned ret = 0; 2073593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine 2074593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client != NULL) { 2075fd16505ce923202f0abe74bfe7c3ba110d325ebeVladimir Chtchetkine ret |= PIPE_POLL_OUT; 2076593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine if (client->ProtocolSelector.Pipe.messages != NULL) { 2077fd16505ce923202f0abe74bfe7c3ba110d325ebeVladimir Chtchetkine ret |= PIPE_POLL_IN; 2078593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } 2079593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine } else { 2080593853248510bda1bdb064780ef6046f3a50e582Vladimir Chtchetkine D("%s: Unexpected NULL client", __FUNCTION__); 208177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 208277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 208377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine return ret; 208477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 208577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 208677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 208777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_qemudPipe_wakeOn(void* opaque, int flags) 208877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 208977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s: -> %X", __FUNCTION__, flags); 209077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 209177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 20923e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turnerstatic void 20933e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner_qemudPipe_save(void* opaque, QEMUFile* f ) 20943e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner{ 20953e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudPipe* qemud_pipe = (QemudPipe*)opaque; 20963e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudClient* c = qemud_pipe->client; 20973e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudPipeMessage* msg = c->ProtocolSelector.Pipe.messages; 20983e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 20993e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* save generic information */ 21003e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemud_service_save_name(f, c->service); 21013e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_string(f, c->param); 21023e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21033e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* Save pending messages. */ 21043e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner while (msg != NULL) { 21053e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner _save_pipe_message(f, msg); 21063e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner msg = msg->next; 21073e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21083e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* End of pending messages. */ 21093e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_be32(f, 0); 21103e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21113e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* save client-specific state */ 21123e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (c->clie_save) 21133e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner c->clie_save(f, c, c->clie_opaque); 21143e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21153e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* save framing configuration */ 21163e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_be32(f, c->framing); 21173e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (c->framing) { 21183e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_be32(f, c->need_header); 21193e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* header sink always connected to c->header0, no need to save */ 21203e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_be32(f, FRAME_HEADER_SIZE); 21213e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_buffer(f, c->header0, FRAME_HEADER_SIZE); 21223e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* payload sink */ 21233e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemud_sink_save(f, c->payload); 21243e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemu_put_buffer(f, c->payload->buff, c->payload->size); 21253e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21263e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner} 21273e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21283e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turnerstatic void* 21293e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner_qemudPipe_load(void* hwpipe, void* pipeOpaque, const char* args, QEMUFile* f) 21303e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner{ 21313e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudPipe* qemud_pipe = NULL; 21323e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner char* param; 21333e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner char *service_name = qemud_service_load_name(f); 21343e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (service_name == NULL) 21353e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21363e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* get service instance for the loading client*/ 21373e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudService *sv = qemud_service_find(_multiplexer->services, service_name); 21383e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (sv == NULL) { 21393e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner D("%s: load failed: unknown service \"%s\"\n", 21403e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner __FUNCTION__, service_name); 21413e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21423e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21433e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21443e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* Load saved parameters. */ 21453e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner param = qemu_get_string(f); 21463e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21473e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* re-connect client */ 21483e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner QemudClient* c = qemud_service_connect_client(sv, -1, param); 21493e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if(c == NULL) 21503e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21513e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21523e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* Load pending messages. */ 21533e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner c->ProtocolSelector.Pipe.messages = _load_pipe_message(f); 21543e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21553e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* load client-specific state */ 21563e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (c->clie_load && c->clie_load(f, c, c->clie_opaque)) { 21573e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* load failure */ 21583e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21593e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21603e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21613e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* load framing configuration */ 21623e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner c->framing = qemu_get_be32(f); 21633e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (c->framing) { 21643e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21653e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* header buffer */ 21663e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner c->need_header = qemu_get_be32(f); 21673e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner int header_size = qemu_get_be32(f); 21683e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (header_size > FRAME_HEADER_SIZE) { 21693e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner D("%s: load failed: payload buffer requires %d bytes, %d available\n", 21703e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner __FUNCTION__, header_size, FRAME_HEADER_SIZE); 21713e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21723e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21733e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner int ret; 21743e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if ((ret = qemu_get_buffer(f, c->header0, header_size)) != header_size) { 21753e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner D("%s: frame header buffer load failed: expected %d bytes, got %d\n", 21763e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner __FUNCTION__, header_size, ret); 21773e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21783e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21793e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21803e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* payload sink */ 21813e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if ((ret = qemud_sink_load(f, c->payload))) 21823e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21833e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21843e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* replace payload buffer by saved data */ 21853e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if (c->payload->buff) { 21863e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner AFREE(c->payload->buff); 21873e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21883e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner AARRAY_NEW(c->payload->buff, c->payload->size+1); /* +1 for terminating zero */ 21893e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner if ((ret = qemu_get_buffer(f, c->payload->buff, c->payload->size)) != c->payload->size) { 21903e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner D("%s: frame payload buffer load failed: expected %d bytes, got %d\n", 21913e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner __FUNCTION__, c->payload->size, ret); 21923e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner AFREE(c->payload->buff); 21933e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return NULL; 21943e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21953e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner } 21963e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 21973e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner /* Associate the client with the pipe. */ 21983e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner ANEW0(qemud_pipe); 21993e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemud_pipe->hwpipe = hwpipe; 22003e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemud_pipe->looper = pipeOpaque; 22013e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemud_pipe->service = sv; 22023e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner qemud_pipe->client = c; 22033e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner c->ProtocolSelector.Pipe.qemud_pipe = qemud_pipe; 22043e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 22053e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner return qemud_pipe; 22063e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner} 22073e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner 220877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* QEMUD pipe functions. 220977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 221077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic const GoldfishPipeFuncs _qemudPipe_funcs = { 221177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_init, 221277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_closeFromGuest, 221377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_sendBuffers, 221477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_recvBuffers, 221577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_poll, 221677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemudPipe_wakeOn, 22173e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner _qemudPipe_save, 22183e92c2d49cb0e8752ce8c9a3c879c84ac3299061David 'Digit' Turner _qemudPipe_load, 221977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine}; 222077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 222177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Initializes QEMUD pipe interface. 222277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 222377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 222477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_android_qemud_pipe_init(void) 222577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 222677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine static ABool _qemud_pipe_initialized = false; 222777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 222877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine if (!_qemud_pipe_initialized) { 222977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine goldfish_pipe_add_type( "qemud", looper_newCore(), &_qemudPipe_funcs ); 223077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _qemud_pipe_initialized = true; 223177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine } 223277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 22339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this is the end of the serial charpipe that must be passed 22359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to the emulated tty implementation. The other end of the 22369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * charpipe must be passed to qemud_multiplexer_init(). 22379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic CharDriverState* android_qemud_cs; 22399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 224077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine/* Initializes QEMUD serial interface. 224177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine */ 224277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkinestatic void 224377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine_android_qemud_serial_init(void) 22449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; 22469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (android_qemud_cs != NULL) 22489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return; 22499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (qemu_chr_open_charpipe( &android_qemud_cs, &cs ) < 0) { 22519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project derror( "%s: can't create charpipe to serial port", 22529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project __FUNCTION__ ); 22539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project exit(1); 22549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 22559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_multiplexer_init(_multiplexer, cs); 2257871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije 2258871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije register_savevm( "qemud", 0, QEMUD_SAVE_VERSION, 2259871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_save, qemud_load, _multiplexer); 22609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 226277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkineextern void 226377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkineandroid_qemud_init( void ) 226477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine{ 226577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("%s", __FUNCTION__); 226677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine /* We don't know in advance whether the guest system supports qemud pipes, 226777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * so we will initialize both qemud machineries, the legacy (over serial 226877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * port), and the new one (over qemu pipe). Then we let the guest to connect 226977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine * via one, or the other. */ 227077e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _android_qemud_serial_init(); 227177e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine _android_qemud_pipe_init(); 227277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine} 227377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine 22749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* return the serial charpipe endpoint that must be used 22759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * by the emulated tty implementation. 22769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source ProjectCharDriverState* android_qemud_get_cs( void ) 22789877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 22799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (android_qemud_cs == NULL) 22809877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project android_qemud_init(); 22819877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22829877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return android_qemud_cs; 22839877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 22849877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 22859877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* this function is used to register a new named qemud-based 22869877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * service. You must provide 'serv_opaque' and 'serv_connect' 22879877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * which will be called whenever a new client tries to connect 22889877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * to the services. 22899877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 22909877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 'serv_connect' shall return NULL if the connection is refused, 22919877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * or a handle to a new QemudClient otherwise. The latter can be 22929877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * created through qemud_client_new() defined above. 22939877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 22949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 'max_clients' is the maximum number of clients accepted by 22959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the service concurrently. If this value is 0, then any number 22969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * of clients can connect. 22979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 22989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source ProjectQemudService* 22999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_register( const char* service_name, 23009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int max_clients, 23019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project void* serv_opaque, 2302871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceConnect serv_connect, 2303871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceSave serv_save, 2304871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije QemudServiceLoad serv_load ) 23059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 23069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* sv; 230777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine QemudMultiplexer* m = _multiplexer; 23089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 230977e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine android_qemud_init(); 23109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project sv = qemud_service_new(service_name, 231277e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine max_clients, 231377e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_opaque, 231477e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_connect, 231577e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_save, 231677e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine serv_load, 231777e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine &m->services); 231877e61ceb3ecd53d6c4de9631c9450b6183d9244bVladimir Chtchetkine D("Registered QEMUD service %s", service_name); 23199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return sv; 23209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 23219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* broadcast a given message to all clients of a given QemudService 23239877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 23249877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectextern void 23259877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectqemud_service_broadcast( QemudService* sv, 23269877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project const uint8_t* msg, 23279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project int msglen ) 23289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 23299877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudClient* c; 23309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project for (c = sv->clients; c; c = c->next_serv) 23329877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_client_send(c, msg, msglen); 23339877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 23349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* 23389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * The following code is used for backwards compatibility reasons. 23399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * It allows you to implement a given qemud-based service through 23409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * a charpipe. 23419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 23429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * In other words, this implements a QemudService and corresponding 23439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudClient that connects a qemud client running in the emulated 23449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * system, to a CharDriverState object implemented through a charpipe. 23459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 23469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * QemudCharClient <===charpipe====> (char driver user) 23479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 23489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * For example, this is used to implement the "gsm" service when the 23499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * modem emulation is provided through an external serial device. 23509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * 23519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * A QemudCharService can have only one client by definition. 23529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * There is no QemudCharClient object because we can store a single 23539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * CharDriverState handle in the 'opaque' field for simplicity. 23549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 23559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projecttypedef struct { 23579877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* service; 23589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; 23599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} QemudCharService; 23609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called whenever a new message arrives from a qemud client. 23629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * this simply sends the message through the charpipe to the user. 23639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 23649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 2365318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner_qemud_char_client_recv( void* opaque, uint8_t* msg, int msglen, 2366318e4f294c181df33cf2541763904565b29bcccbDavid 'Digit' Turner QemudClient* client ) 23679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 23689877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs = opaque; 23699877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_write(cs, msg, msglen); 23709877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 23719877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23729877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* we don't expect clients of char. services to exit. Just 23739877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * print an error to signal an unexpected situation. We should 23749877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * be able to recover from these though, so don't panic. 23759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 23769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 23779877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project_qemud_char_client_close( void* opaque ) 23785297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine 23799877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 23805297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine QemudClient* client = opaque; 23815297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine 23825297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine /* At this point modem driver still uses char pipe to communicate with 23835297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * hw-qemud, while communication with the guest is done over qemu pipe. 23845297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * So, when guest disconnects from the qemu pipe, and emulator-side client 23855297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * goes through the disconnection process, this routine is called, since it 23865297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * has been set to called during service registration. Unless modem driver 23875297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * is changed to drop char pipe communication, this routine will be called 23885297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * due to guest disconnection. As long as the client was a qemu pipe - based 23895297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine * client, it's fine, since we don't really need to do anything in this case. 23905297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine */ 23915297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine if (!_is_pipe_client(client)) { 23925297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine derror("unexpected qemud char. channel close"); 23935297e197c131258f3b115d1fc4ab608224b39bb9Vladimir Chtchetkine } 23949877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 23959877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23969877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 23979877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called by the charpipe to know how much data can be read from 23989877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * the user. Since we send everything directly to the serial port 23999877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * we can return an arbitrary number. 24009877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 24019877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic int 24029877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project_qemud_char_service_can_read( void* opaque ) 24039877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 24049877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 8192; /* whatever */ 24059877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 24069877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 24079877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called to read data from the charpipe and send it to the client. 24089877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * used qemud_service_broadcast() even if there is a single client 24099877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * because we don't need a QemudCharClient object this way. 24109877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 24119877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic void 24129877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project_qemud_char_service_read( void* opaque, const uint8_t* from, int len ) 24139877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 24149877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project QemudService* sv = opaque; 24159877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemud_service_broadcast( sv, from, len ); 24169877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 24179877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 24189877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* called when a qemud client tries to connect to a char. service. 24199877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * we simply create a new client and open the charpipe to receive 24209877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * data from it. 24219877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 24229877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectstatic QemudClient* 24231875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine_qemud_char_service_connect(void* opaque, 24241875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine QemudService* sv, 24251875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine int channel, 24261875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine const char* client_param ) 24279877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 24289877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs = opaque; 24291875d374acc7412b8b0aacaff073c8080d532924Vladimir Chtchetkine QemudClient* c = qemud_client_new( sv, channel, client_param, 24309877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project cs, 24319877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project _qemud_char_client_recv, 2432871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije _qemud_char_client_close, 2433871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije NULL, NULL ); 24349877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 24359877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project /* now we can open the gates :-) */ 24369877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project qemu_chr_add_handlers( cs, 24379877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project _qemud_char_service_can_read, 24389877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project _qemud_char_service_read, 24399877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project NULL, 24409877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project sv ); 24419877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 24429877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return c; 24439877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 24449877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 24459877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* returns a charpipe endpoint that can be used by an emulated 24469877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * device or external serial port to implement a char. service 24479877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 24489877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectint 24499877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectandroid_qemud_get_channel( const char* name, CharDriverState* *pcs ) 24509877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 24519877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project CharDriverState* cs; 24529877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 24539877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project if (qemu_chr_open_charpipe(&cs, pcs) < 0) { 24549877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project derror("can't open charpipe for '%s' qemud service", name); 24559877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project exit(2); 24569877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project } 2457871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_register(name, 1, cs, _qemud_char_service_connect, NULL, NULL); 24589877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 0; 24599877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 24609877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project 24619877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project/* set the character driver state for a given qemud communication channel. this 24629877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * is used to attach the channel to an external char driver device directly. 24639877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project * returns 0 on success, -1 on error 24649877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project */ 24659877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectint 24669877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Projectandroid_qemud_set_channel( const char* name, CharDriverState* peer_cs ) 24679877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project{ 2468fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner CharDriverState* char_buffer = qemu_chr_open_buffer(peer_cs); 2469fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner 2470fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner if (char_buffer == NULL) 2471fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner return -1; 2472fff1ae51e389c25e2b19cd087c5e19cd27d40163David Turner 2473871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije qemud_service_register(name, 1, char_buffer, _qemud_char_service_connect, 2474871da2aa80687142bec00ef7c1112253c76c32bbOt ten Thije NULL, NULL); 24759877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project return 0; 24769877e2e3e3c2df64de306b48f80a4f5d0b028d95The Android Open Source Project} 2477