From 49de0338018bc67b82ef17ce17520c4b79b8948f Mon Sep 17 00:00:00 2001 From: Andreas Blaesius Date: Sat, 10 Sep 2016 17:29:56 +0200 Subject: espresso3g: import libsecril-client Import from CyanogenMod cm-13.0 branch of hardware/samsung repo. - removed unused modem types and unneeded ifdefs Change-Id: Ifa792dbf60276426c27555bbb3d2b15c5a66ca2a --- rilsrc/libsecril-client/Android.mk | 19 + rilsrc/libsecril-client/secril-client.cpp | 1570 +++++++++++++++++++++++++++++ rilsrc/libsecril-client/secril-client.h | 285 ++++++ 3 files changed, 1874 insertions(+) create mode 100755 rilsrc/libsecril-client/Android.mk create mode 100755 rilsrc/libsecril-client/secril-client.cpp create mode 100755 rilsrc/libsecril-client/secril-client.h diff --git a/rilsrc/libsecril-client/Android.mk b/rilsrc/libsecril-client/Android.mk new file mode 100755 index 0000000..7793ee9 --- /dev/null +++ b/rilsrc/libsecril-client/Android.mk @@ -0,0 +1,19 @@ +# Copyright 2006 The Android Open Source Project + +LOCAL_PATH:= $(call my-dir) +include $(CLEAR_VARS) + +LOCAL_MODULE_TAGS := optional + +LOCAL_SRC_FILES:= \ + secril-client.cpp + +LOCAL_SHARED_LIBRARIES := \ + libutils \ + libbinder \ + libcutils \ + libhardware_legacy + +LOCAL_MODULE:= libsecril-client + +include $(BUILD_SHARED_LIBRARY) diff --git a/rilsrc/libsecril-client/secril-client.cpp b/rilsrc/libsecril-client/secril-client.cpp new file mode 100755 index 0000000..cbf6ffb --- /dev/null +++ b/rilsrc/libsecril-client/secril-client.cpp @@ -0,0 +1,1570 @@ +/** + * @file secril-client.cpp + * + * @author Myeongcheol Kim (mcmount.kim@samsung.com) + * + * @brief RIL client library for multi-client support + */ + +#define LOG_TAG "RILClient" +#define LOG_NDEBUG 0 + +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "secril-client.h" +#include // For wakelock + + +#define RIL_CLIENT_WAKE_LOCK "client-interface" + +namespace android { + +//--------------------------------------------------------------------------- +// Defines +//--------------------------------------------------------------------------- +#define DBG 1 +#define RILD_PORT 7777 +#define MULTI_CLIENT_SOCKET_NAME "Multiclient" +#define MULTI_CLIENT_Q_SOCKET_NAME "QMulticlient" +#if defined(SEC_PRODUCT_FEATURE_RIL_CALL_DUALMODE_CDMAGSM) +#define MULTI_CLIENT_SOCKET_NAME_2 "Multiclient2" +#endif + +#define MAX_COMMAND_BYTES (8 * 1024) +#define REQ_POOL_SIZE 32 +#define TOKEN_POOL_SIZE 32 + +// Constants for response types +#define RESPONSE_SOLICITED 0 +#define RESPONSE_UNSOLICITED 1 + +#define max(a, b) ((a) > (b) ? (a) : (b)) + +#define REQ_OEM_HOOK_RAW RIL_REQUEST_OEM_HOOK_RAW +#define REQ_SET_CALL_VOLUME 101 +#define REQ_SET_AUDIO_PATH 102 +#define REQ_SET_CALL_CLOCK_SYNC 103 +#define REQ_SET_CALL_RECORDING 104 +#define REQ_SET_CALL_MUTE 105 +#define REQ_GET_CALL_MUTE 106 +#define REQ_SET_CALL_VT_CTRL 107 +#define REQ_SET_TWO_MIC_CTRL 108 +#define REQ_SET_DHA_CTRL 109 +#define REQ_SET_LOOPBACK 110 + +// OEM request function ID +#define OEM_FUNC_SOUND 0x08 + +// OEM request sub function ID +#define OEM_SND_SET_VOLUME_CTRL 0x03 +#define OEM_SND_SET_AUDIO_PATH 0x05 +#define OEM_SND_GET_AUDIO_PATH 0x06 +#define OEM_SND_SET_VIDEO_CALL_CTRL 0x07 +#define OEM_SND_SET_LOOPBACK_CTRL 0x08 +#define OEM_SND_SET_VOICE_RECORDING_CTRL 0x09 +#define OEM_SND_SET_CLOCK_CTRL 0x0A +#define OEM_SND_SET_MUTE 0x0B +#define OEM_SND_GET_MUTE 0x0C +#define OEM_SND_SET_TWO_MIC_CTL 0x0D +#define OEM_SND_SET_DHA_CTL 0x0E + +#define OEM_SND_TYPE_VOICE 0x01 // Receiver(0x00) + Voice(0x01) +#define OEM_SND_TYPE_SPEAKER 0x11 // SpeakerPhone(0x10) + Voice(0x01) +#define OEM_SND_TYPE_HEADSET 0x31 // Headset(0x30) + Voice(0x01) +#define OEM_SND_TYPE_BTVOICE 0x41 // BT(0x40) + Voice(0x01) + +#define OEM_SND_AUDIO_PATH_HANDSET 0x01 +#define OEM_SND_AUDIO_PATH_HEADSET 0x02 +#define OEM_SND_AUDIO_PATH_HFK 0x03 +#define OEM_SND_AUDIO_PATH_BLUETOOTH 0x04 +#define OEM_SND_AUDIO_PATH_STEREO_BLUETOOTH 0x05 +#define OEM_SND_AUDIO_PATH_SPEAKER 0x06 +#define OEM_SND_AUDIO_PATH_HEADPHONE 0x07 +#define OEM_SND_AUDIO_PATH_BT_NSEC_OFF 0x08 +#define OEM_SND_AUDIO_PATH_MIC1 0x09 +#define OEM_SND_AUDIO_PATH_MIC2 0x0A +#define OEM_SND_AUDIO_PATH_BT_WB 0x0B +#define OEM_SND_AUDIO_PATH_BT_WB_NSEC_OFF 0x0C + +//--------------------------------------------------------------------------- +// Type definitions +//--------------------------------------------------------------------------- +typedef struct _ReqHistory { + int token; // token used for request + uint32_t id; // request ID +} ReqHistory; + +typedef struct _ReqRespHandler { + uint32_t id; // request ID + RilOnComplete handler; // handler function +} ReqRespHandler; + +typedef struct _UnsolHandler { + uint32_t id; // unsolicited response ID + RilOnUnsolicited handler; // handler function +} UnsolHandler; + +typedef struct _RilClientPrv { + HRilClient parent; + uint8_t b_connect; // connected to server? + int sock; // socket + int pipefd[2]; + fd_set sock_rfds; // for read with select() + RecordStream *p_rs; + uint32_t token_pool; // each bit in token_pool used for token. + // so, pool size is 32. + pthread_t tid_reader; // socket reader thread id + ReqHistory history[TOKEN_POOL_SIZE]; // request history + ReqRespHandler req_handlers[REQ_POOL_SIZE]; // request response handler list + UnsolHandler unsol_handlers[REQ_POOL_SIZE]; // unsolicited response handler list + RilOnError err_cb; // error callback + void *err_cb_data; // error callback data + uint8_t b_del_handler; +} RilClientPrv; + + +//--------------------------------------------------------------------------- +// Local static function prototypes +//--------------------------------------------------------------------------- +static void * RxReaderFunc(void *param); +static int processRxBuffer(RilClientPrv *prv, void *buffer, size_t buflen); +static uint32_t AllocateToken(uint32_t *token_pool); +static void FreeToken(uint32_t *token_pool, uint32_t token); +static uint8_t IsValidToken(uint32_t *token_pool, uint32_t token); +static void DeallocateToken(uint32_t *token_pool, uint32_t token); +static int blockingWrite(int fd, const void *buffer, size_t len); +static int RecordReqHistory(RilClientPrv *prv, int token, uint32_t id); +static void ClearReqHistory(RilClientPrv *prv, int token); +static RilOnComplete FindReqHandler(RilClientPrv *prv, int token, uint32_t *id); +static RilOnUnsolicited FindUnsolHandler(RilClientPrv *prv, uint32_t id); +static int SendOemRequestHookRaw(HRilClient client, int req_id, char *data, size_t len); +static bool isValidSoundType(SoundType type); +static bool isValidAudioPath(AudioPath path); +static bool isValidSoundClockCondition(SoundClockCondition condition); +static bool isValidCallRecCondition(CallRecCondition condition); +static bool isValidMuteCondition(MuteCondition condition); +static bool isValidTwoMicCtrl(TwoMicSolDevice device, TwoMicSolReport report); +static char ConvertSoundType(SoundType type); +static char ConvertAudioPath(AudioPath path); + + +/** + * @fn int RegisterUnsolicitedHandler(HRilClient client, uint32_t id, RilOnUnsolicited handler) + * + * @params client: Client handle. + * id: Unsolicited response ID to which handler is registered. + * handler: Unsolicited handler. NULL for deregistration. + * + * @return 0 on success or error code. + */ +extern "C" +int RegisterUnsolicitedHandler(HRilClient client, uint32_t id, RilOnUnsolicited handler) { + RilClientPrv *client_prv; + int match_slot = -1; + int first_empty_slot = -1; + int i; + + if (client == NULL || client->prv == NULL) + return RIL_CLIENT_ERR_INVAL; + + client_prv = (RilClientPrv *)(client->prv); + + for (i = 0; i < REQ_POOL_SIZE; i++) { + // Check if there is matched handler. + if (id == client_prv->unsol_handlers[i].id) { + match_slot = i; + } + // Find first empty handler slot. + if (first_empty_slot == -1 && client_prv->unsol_handlers[i].id == 0) { + first_empty_slot = i; + } + } + + if (handler == NULL) { // Unregister. + if (match_slot >= 0) { + memset(&(client_prv->unsol_handlers[match_slot]), 0, sizeof(UnsolHandler)); + return RIL_CLIENT_ERR_SUCCESS; + } + else { + return RIL_CLIENT_ERR_SUCCESS; + } + } + else {// Register. + if (match_slot >= 0) { + client_prv->unsol_handlers[match_slot].handler = handler; // Just update. + } + else if (first_empty_slot >= 0) { + client_prv->unsol_handlers[first_empty_slot].id = id; + client_prv->unsol_handlers[first_empty_slot].handler = handler; + } + else { + return RIL_CLIENT_ERR_RESOURCE; + } + } + + return RIL_CLIENT_ERR_SUCCESS; +} + + +/** + * @fn int RegisterRequestCompleteHandler(HRilClient client, uint32_t id, RilOnComplete handler) + * + * @params client: Client handle. + * id: Request ID to which handler is registered. + * handler: Request complete handler. NULL for deregistration. + * + * @return 0 on success or error code. + */ +extern "C" +int RegisterRequestCompleteHandler(HRilClient client, uint32_t id, RilOnComplete handler) { + RilClientPrv *client_prv; + int match_slot = -1; + int first_empty_slot = -1; + int i; + + if (client == NULL || client->prv == NULL) + return RIL_CLIENT_ERR_INVAL; + + client_prv = (RilClientPrv *)(client->prv); + + for (i = 0; i < REQ_POOL_SIZE; i++) { + // Check if there is matched handler. + if (id == client_prv->req_handlers[i].id) { + match_slot = i; + } + // Find first empty handler slot. + if (first_empty_slot == -1 && client_prv->req_handlers[i].id == 0) { + first_empty_slot = i; + } + } + + if (handler == NULL) { // Unregister. + if (match_slot >= 0) { + memset(&(client_prv->req_handlers[match_slot]), 0, sizeof(ReqRespHandler)); + return RIL_CLIENT_ERR_SUCCESS; + } + else { + return RIL_CLIENT_ERR_SUCCESS; + } + } + else { // Register. + if (match_slot >= 0) { + client_prv->req_handlers[match_slot].handler = handler; // Just update. + } + else if (first_empty_slot >= 0) { + client_prv->req_handlers[first_empty_slot].id = id; + client_prv->req_handlers[first_empty_slot].handler = handler; + } + else { + return RIL_CLIENT_ERR_RESOURCE; + } + } + + return RIL_CLIENT_ERR_SUCCESS; +} + + +/** + * @fn int RegisterErrorCallback(HRilClient client, RilOnError cb, void *data) + * + * @params client: Client handle. + * cb: Error callback. NULL for unregistration. + * data: Callback data. + * + * @return 0 for success or error code. + */ +extern "C" +int RegisterErrorCallback(HRilClient client, RilOnError cb, void *data) { + RilClientPrv *client_prv; + + if (client == NULL || client->prv == NULL) + return RIL_CLIENT_ERR_INVAL; + + client_prv = (RilClientPrv *)(client->prv); + + client_prv->err_cb = cb; + client_prv->err_cb_data = data; + + return RIL_CLIENT_ERR_SUCCESS; +} + + +/** + * @fn HRilClient OpenClient_RILD(void) + * + * @params None. + * + * @return Client handle, NULL on error. + */ +extern "C" +HRilClient OpenClient_RILD(void) { + HRilClient client = (HRilClient)malloc(sizeof(struct RilClient)); + if (client == NULL) + return NULL; + + client->prv = (RilClientPrv *)malloc(sizeof(RilClientPrv)); + if (client->prv == NULL) { + free(client); + return NULL; + } + + memset(client->prv, 0, sizeof(RilClientPrv)); + + ((RilClientPrv *)(client->prv))->parent = client; + ((RilClientPrv *)(client->prv))->sock = -1; + + return client; +} + + +/** + * @fn int Connect_RILD(void) + * + * @params client: Client handle. + * + * @return 0, or error code. + */ +extern "C" +int Connect_RILD(HRilClient client) { + RilClientPrv *client_prv; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + // Open client socket and connect to server. + //client_prv->sock = socket_loopback_client(RILD_PORT, SOCK_STREAM); + client_prv->sock = socket_local_client(MULTI_CLIENT_SOCKET_NAME, ANDROID_SOCKET_NAMESPACE_ABSTRACT, SOCK_STREAM ); + + if (client_prv->sock < 0) { + ALOGE("%s: Connecting failed. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_CONNECT; + } + + client_prv->b_connect = 1; + + if (fcntl(client_prv->sock, F_SETFL, O_NONBLOCK) < 0) { + close(client_prv->sock); + return RIL_CLIENT_ERR_IO; + } + + client_prv->p_rs = record_stream_new(client_prv->sock, MAX_COMMAND_BYTES); + + if (pipe(client_prv->pipefd) < 0) { + close(client_prv->sock); + ALOGE("%s: Creating command pipe failed. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_IO; + } + + if (fcntl(client_prv->pipefd[0], F_SETFL, O_NONBLOCK) < 0) { + close(client_prv->sock); + close(client_prv->pipefd[0]); + close(client_prv->pipefd[1]); + return RIL_CLIENT_ERR_IO; + } + + // Start socket read thread. + if (pthread_create(&(client_prv->tid_reader), NULL, RxReaderFunc, (void *)client_prv) != 0) { + close(client_prv->sock); + close(client_prv->pipefd[0]); + close(client_prv->pipefd[1]); + + memset(client_prv, 0, sizeof(RilClientPrv)); + client_prv->sock = -1; + ALOGE("%s: Can't create Reader thread. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_CONNECT; + } + + return RIL_CLIENT_ERR_SUCCESS; +} + +/** + * @fn int Connect_QRILD(void) + * + * @params client: Client handle. + * + * @return 0, or error code. + */ +extern "C" +int Connect_QRILD(HRilClient client) { + RilClientPrv *client_prv; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + // Open client socket and connect to server. + //client_prv->sock = socket_loopback_client(RILD_PORT, SOCK_STREAM); + client_prv->sock = socket_local_client(MULTI_CLIENT_Q_SOCKET_NAME, ANDROID_SOCKET_NAMESPACE_ABSTRACT, SOCK_STREAM ); + + if (client_prv->sock < 0) { + ALOGE("%s: Connecting failed. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_CONNECT; + } + + client_prv->b_connect = 1; + + if (fcntl(client_prv->sock, F_SETFL, O_NONBLOCK) < 0) { + close(client_prv->sock); + return RIL_CLIENT_ERR_IO; + } + + client_prv->p_rs = record_stream_new(client_prv->sock, MAX_COMMAND_BYTES); + + if (pipe(client_prv->pipefd) < 0) { + close(client_prv->sock); + ALOGE("%s: Creating command pipe failed. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_IO; + } + + if (fcntl(client_prv->pipefd[0], F_SETFL, O_NONBLOCK) < 0) { + close(client_prv->sock); + close(client_prv->pipefd[0]); + close(client_prv->pipefd[1]); + return RIL_CLIENT_ERR_IO; + } + + // Start socket read thread. + if (pthread_create(&(client_prv->tid_reader), NULL, RxReaderFunc, (void *)client_prv) != 0) { + close(client_prv->sock); + close(client_prv->pipefd[0]); + close(client_prv->pipefd[1]); + + memset(client_prv, 0, sizeof(RilClientPrv)); + client_prv->sock = -1; + ALOGE("%s: Can't create Reader thread. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_CONNECT; + } + + return RIL_CLIENT_ERR_SUCCESS; +} + +#if defined(SEC_PRODUCT_FEATURE_RIL_CALL_DUALMODE_CDMAGSM) // mook_120209 Enable multiclient +/** + * @fn int Connect_RILD_Second(void) + * + * @params client: Client handle. + * + * @return 0, or error code. + */ +extern "C" +int Connect_RILD_Second(HRilClient client) { + RilClientPrv *client_prv; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + // Open client socket and connect to server. + //client_prv->sock = socket_loopback_client(RILD_PORT, SOCK_STREAM); + client_prv->sock = socket_local_client(MULTI_CLIENT_SOCKET_NAME_2, ANDROID_SOCKET_NAMESPACE_ABSTRACT, SOCK_STREAM ); + + if (client_prv->sock < 0) { + ALOGE("%s: Connecting failed. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_CONNECT; + } + + client_prv->b_connect = 1; + + if (fcntl(client_prv->sock, F_SETFL, O_NONBLOCK) < 0) { + close(client_prv->sock); + return RIL_CLIENT_ERR_IO; + } + + client_prv->p_rs = record_stream_new(client_prv->sock, MAX_COMMAND_BYTES); + + if (pipe(client_prv->pipefd) < 0) { + close(client_prv->sock); + ALOGE("%s: Creating command pipe failed. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_IO; + } + + if (fcntl(client_prv->pipefd[0], F_SETFL, O_NONBLOCK) < 0) { + close(client_prv->sock); + close(client_prv->pipefd[0]); + close(client_prv->pipefd[1]); + return RIL_CLIENT_ERR_IO; + } + + // Start socket read thread. + if (pthread_create(&(client_prv->tid_reader), NULL, RxReaderFunc, (void *)client_prv) != 0) { + close(client_prv->sock); + close(client_prv->pipefd[0]); + close(client_prv->pipefd[1]); + + memset(client_prv, 0, sizeof(RilClientPrv)); + client_prv->sock = -1; + ALOGE("%s: Can't create Reader thread. %s(%d)", __FUNCTION__, strerror(errno), errno); + return RIL_CLIENT_ERR_CONNECT; + } + + return RIL_CLIENT_ERR_SUCCESS; +} +#endif + +/** + * @fn int isConnected_RILD(HRilClient client) + * + * @params client: Client handle. + * + * @return 0, or 1. + */ +extern "C" +int isConnected_RILD(HRilClient client) { + RilClientPrv *client_prv; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + return client_prv->b_connect == 1; +} + +/** + * @fn int Disconnect_RILD(HRilClient client) + * + * @params client: Client handle. + * + * @return 0 on success, or error code. + */ +extern "C" +int Disconnect_RILD(HRilClient client) { + RilClientPrv *client_prv; + int ret = 0; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock == -1) + return RIL_CLIENT_ERR_SUCCESS; + + printf("[*] %s(): sock=%d\n", __FUNCTION__, client_prv->sock); + + if (client_prv->sock > 0) { + do { + ret = write(client_prv->pipefd[1], "close", strlen("close")); + } while (ret < 0 && errno == EINTR); + } + + client_prv->b_connect = 0; + + pthread_join(client_prv->tid_reader, NULL); + + return RIL_CLIENT_ERR_SUCCESS; +} + + +/** + * @fn int CloseClient_RILD(HRilClient client) + * + * @params client: Client handle. + * + * @return 0 on success, or error code. + */ +extern "C" +int CloseClient_RILD(HRilClient client) { + if (client == NULL || client->prv == NULL) { + ALOGE("%s: invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + Disconnect_RILD(client); + + free(client->prv); + free(client); + + return RIL_CLIENT_ERR_SUCCESS; +} + + +/** + * Set in-call volume. + */ +extern "C" +int SetCallVolume(HRilClient client, SoundType type, int vol_level) { + RilClientPrv *client_prv; + int ret; + char data[6] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + if (isValidSoundType(type) == false) { + ALOGE("%s: Invalid sound type", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_VOLUME_CTRL; + data[2] = 0x00; // data length + data[3] = 0x06; // data length + data[4] = ConvertSoundType(type); // volume type + data[5] = vol_level; // volume level + + RegisterRequestCompleteHandler(client, REQ_SET_CALL_VOLUME, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_CALL_VOLUME, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_CALL_VOLUME, NULL); + } + + return ret; +} + + +/** + * Set external sound device path for noise reduction. + */ +extern "C" +int SetCallAudioPath(HRilClient client, AudioPath path) +{ + RilClientPrv *client_prv; + int ret; + char data[6] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + if (isValidAudioPath(path) == false) { + ALOGE("%s: Invalid audio path", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_AUDIO_PATH; + data[2] = 0x00; // data length + data[3] = 0x06; // data length + data[4] = ConvertAudioPath(path); // audio path + + RegisterRequestCompleteHandler(client, REQ_SET_AUDIO_PATH, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_AUDIO_PATH, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_AUDIO_PATH, NULL); + } + + return ret; +} + + +/** + * Set modem clock to master or slave. + */ +extern "C" +int SetCallClockSync(HRilClient client, SoundClockCondition condition) { + RilClientPrv *client_prv; + int ret; + char data[5] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + if (isValidSoundClockCondition(condition) == false) { + ALOGE("%s: Invalid sound clock condition", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_CLOCK_CTRL; + data[2] = 0x00; // data length + data[3] = 0x05; // data length + data[4] = condition; + + RegisterRequestCompleteHandler(client, REQ_SET_CALL_CLOCK_SYNC, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_CALL_CLOCK_SYNC, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_CALL_CLOCK_SYNC, NULL); + } + + return ret; +} + +/** + * Set modem VTCall clock to master or slave. + */ +extern "C" +int SetVideoCallClockSync(HRilClient client, SoundClockCondition condition) { + RilClientPrv *client_prv; + int ret; + char data[5] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + if (isValidSoundClockCondition(condition) == false) { + ALOGE("%s: Invalid sound clock condition", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_VIDEO_CALL_CTRL; + data[2] = 0x00; // data length + data[3] = 0x05; // data length + data[4] = condition; + + RegisterRequestCompleteHandler(client, REQ_SET_CALL_VT_CTRL, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_CALL_VT_CTRL, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_CALL_VT_CTRL, NULL); + } + + return ret; +} + +/** + * Set voice recording. + */ +extern "C" +int SetCallRecord(HRilClient client, CallRecCondition condition) { + RilClientPrv *client_prv; + int ret; + char data[5] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + if (isValidCallRecCondition(condition) == false) { + ALOGE("%s: Invalid sound clock condition", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_VOICE_RECORDING_CTRL; + data[2] = 0x00; // data length + data[3] = 0x05; // data length + data[4] = condition; + + RegisterRequestCompleteHandler(client, REQ_SET_CALL_RECORDING, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_CALL_RECORDING, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_CALL_RECORDING, NULL); + } + + return ret; +} + +/** + * Set mute or unmute. + */ +extern "C" +int SetMute(HRilClient client, MuteCondition condition) { + RilClientPrv *client_prv; + int ret; + char data[5] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + if (isValidMuteCondition(condition) == false) { + ALOGE("%s: Invalid sound clock condition", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_MUTE; + data[2] = 0x00; // data length + data[3] = 0x05; // data length + data[4] = condition; + + RegisterRequestCompleteHandler(client, REQ_SET_CALL_MUTE, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_CALL_MUTE, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_CALL_MUTE, NULL); + } + + return ret; +} + +/** + * Get mute state. + */ +extern "C" +int GetMute(HRilClient client, RilOnComplete handler) { + RilClientPrv *client_prv; + int ret; + char data[4] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + client_prv->b_del_handler = 1; + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_GET_MUTE; + data[2] = 0x00; // data length + data[3] = 0x04; // data length + + RegisterRequestCompleteHandler(client, REQ_GET_CALL_MUTE, handler); + + ret = SendOemRequestHookRaw(client, REQ_GET_CALL_MUTE, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_GET_CALL_MUTE, NULL); + } + + return ret; +} + +extern "C" +int SetTwoMicControl(HRilClient client, TwoMicSolDevice device, TwoMicSolReport report) { + RilClientPrv *client_prv; + int ret; + char data[6] = {0,}; + + ALOGE(" + %s", __FUNCTION__); + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + if (isValidTwoMicCtrl(device, report) == false) { + ALOGE("%s: Invalid sound set two params", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_TWO_MIC_CTL; + data[2] = 0x00; // data length + data[3] = 0x06; // data length + data[4] = device; + data[5] = report; + + RegisterRequestCompleteHandler(client, REQ_SET_TWO_MIC_CTRL, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_TWO_MIC_CTRL, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_TWO_MIC_CTRL, NULL); + } + + ALOGE(" - %s", __FUNCTION__); + + return ret; +} + +extern "C" +int SetDhaSolution(HRilClient client, DhaSolMode mode, DhaSolSelect select, char *parameter) { + RilClientPrv *client_prv; + int ret; + char data[30] = {0,}; + char tempPara[24]={0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + ALOGE("%s: DHA mode=%d, select=%d", __FUNCTION__,mode, select); + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_DHA_CTL; + data[2] = 0x00; // data length + data[3] = 0x1E; // data length + data[4] = mode; + data[5] = select; + + memcpy(tempPara, parameter, 24); + for(int i=0; i<24; i++) + data[6+i]= tempPara[i]; + + RegisterRequestCompleteHandler(client, REQ_SET_DHA_CTRL, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_DHA_CTRL, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_DHA_CTRL, NULL); + } + + return ret; +} + +/** + * Set LoopbackTest mode, path. + */ +extern "C" +int SetLoopbackTest(HRilClient client, LoopbackMode mode, AudioPath path) { + RilClientPrv *client_prv; + int ret; + char data[6] = {0,}; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + // Make raw data + data[0] = OEM_FUNC_SOUND; + data[1] = OEM_SND_SET_LOOPBACK_CTRL; + data[2] = 0x00; // data length + data[3] = 0x06; // data length + data[4] = mode; // Loopback Mode + data[5] = ConvertAudioPath(path); // Loopback path + + RegisterRequestCompleteHandler(client, REQ_SET_LOOPBACK, NULL); + + ret = SendOemRequestHookRaw(client, REQ_SET_LOOPBACK, data, sizeof(data)); + if (ret != RIL_CLIENT_ERR_SUCCESS) { + RegisterRequestCompleteHandler(client, REQ_SET_LOOPBACK, NULL); + } + + return ret; +} + + +/** + * @fn int InvokeOemRequestHookRaw(HRilClient client, char *data, size_t len) + * + * @params client: Client handle. + * data: Request data. + * len: Request data length. + * + * @return 0 for success or error code. On receiving RIL_CLIENT_ERR_AGAIN, + * caller should retry. + */ +extern "C" +int InvokeOemRequestHookRaw(HRilClient client, char *data, size_t len) { + RilClientPrv *client_prv; + + if (client == NULL || client->prv == NULL) { + ALOGE("%s: Invalid client %p", __FUNCTION__, client); + return RIL_CLIENT_ERR_INVAL; + } + + client_prv = (RilClientPrv *)(client->prv); + + if (client_prv->sock < 0 ) { + ALOGE("%s: Not connected.", __FUNCTION__); + return RIL_CLIENT_ERR_CONNECT; + } + + return SendOemRequestHookRaw(client, REQ_OEM_HOOK_RAW, data, len); +} + + +static int SendOemRequestHookRaw(HRilClient client, int req_id, char *data, size_t len) { + int token = 0; + int ret = 0; + uint32_t header = 0; + android::Parcel p; + RilClientPrv *client_prv; + int maxfd = -1; + + client_prv = (RilClientPrv *)(client->prv); + + // Allocate a token. + token = AllocateToken(&(client_prv->token_pool)); + if (token == 0) { + ALOGE("%s: No token.", __FUNCTION__); + return RIL_CLIENT_ERR_AGAIN; + } + + // Record token for the request sent. + if (RecordReqHistory(client_prv, token, req_id) != RIL_CLIENT_ERR_SUCCESS) { + goto error; + } + + // Make OEM request data. + p.writeInt32(RIL_REQUEST_OEM_HOOK_RAW); + p.writeInt32(token); + p.writeInt32(len); + p.write((void *)data, len); + + // DO TX: header(size). + header = htonl(p.dataSize()); + + if (DBG) ALOGD("%s(): token = %d\n", __FUNCTION__, token); + + ret = blockingWrite(client_prv->sock, (void *)&header, sizeof(header)); + if (ret < 0) { + ALOGE("%s: send request header failed. (%d)", __FUNCTION__, ret); + goto error; + } + + // Do TX: response data. + ret = blockingWrite(client_prv->sock, p.data(), p.dataSize()); + if (ret < 0) { + ALOGE("%s: send request data failed. (%d)", __FUNCTION__, ret); + goto error; + } + + return RIL_CLIENT_ERR_SUCCESS; + +error: + FreeToken(&(client_prv->token_pool), token); + ClearReqHistory(client_prv, token); + + return RIL_CLIENT_ERR_UNKNOWN; +} + + +static bool isValidSoundType(SoundType type) { + return (type >= SOUND_TYPE_VOICE && type <= SOUND_TYPE_BTVOICE); +} + + +static bool isValidAudioPath(AudioPath path) { + return (path >= SOUND_AUDIO_PATH_HANDSET && path <= OEM_SND_AUDIO_PATH_BT_WB_NSEC_OFF); +} + + +static bool isValidSoundClockCondition(SoundClockCondition condition) { + return (condition >= SOUND_CLOCK_STOP && condition <= SOUND_CLOCK_START); +} + +static bool isValidCallRecCondition(CallRecCondition condition) { + return (condition >= CALL_REC_STOP && condition <= CALL_REC_START); +} + +static bool isValidMuteCondition(MuteCondition condition) { + return (condition >= TX_UNMUTE && condition <= RXTX_MUTE); +} + +static bool isValidTwoMicCtrl(TwoMicSolDevice device, TwoMicSolReport report) { + return (device >= AUDIENCE && device <= FORTEMEDIA && report >= TWO_MIC_SOLUTION_OFF && report <= TWO_MIC_SOLUTION_ON ); +} + + +static char ConvertSoundType(SoundType type) { + switch (type) { + case SOUND_TYPE_VOICE: + return OEM_SND_TYPE_VOICE; + case SOUND_TYPE_SPEAKER: + return OEM_SND_TYPE_SPEAKER; + case SOUND_TYPE_HEADSET: + return OEM_SND_TYPE_HEADSET; + case SOUND_TYPE_BTVOICE: + return OEM_SND_TYPE_BTVOICE; + default: + return OEM_SND_TYPE_VOICE; + } +} + + +static char ConvertAudioPath(AudioPath path) { + switch (path) { + case SOUND_AUDIO_PATH_HANDSET: + return OEM_SND_AUDIO_PATH_HANDSET; + case SOUND_AUDIO_PATH_HEADSET: + return OEM_SND_AUDIO_PATH_HEADSET; + case SOUND_AUDIO_PATH_SPEAKER: + return OEM_SND_AUDIO_PATH_SPEAKER; + case SOUND_AUDIO_PATH_BLUETOOTH: + return OEM_SND_AUDIO_PATH_BLUETOOTH; + case SOUND_AUDIO_PATH_STEREO_BT: + return OEM_SND_AUDIO_PATH_STEREO_BLUETOOTH; + case SOUND_AUDIO_PATH_HEADPHONE: + return OEM_SND_AUDIO_PATH_HEADPHONE; + case SOUND_AUDIO_PATH_BLUETOOTH_NO_NR: + return OEM_SND_AUDIO_PATH_BT_NSEC_OFF; + case SOUND_AUDIO_PATH_MIC1: + return OEM_SND_AUDIO_PATH_MIC1; + case SOUND_AUDIO_PATH_MIC2: + return OEM_SND_AUDIO_PATH_MIC2; + case SOUND_AUDIO_PATH_BLUETOOTH_WB: + return OEM_SND_AUDIO_PATH_BT_WB; + case SOUND_AUDIO_PATH_BLUETOOTH_WB_NO_NR: + return OEM_SND_AUDIO_PATH_BT_WB_NSEC_OFF; + + default: + return OEM_SND_AUDIO_PATH_HANDSET; + } +} + + +static void * RxReaderFunc(void *param) { + RilClientPrv *client_prv = (RilClientPrv *)param; + int maxfd = 0; + int token = 0; + void *p_record = NULL; + size_t recordlen = 0; + int ret = 0; + int n; + + if (client_prv == NULL) + return NULL; + + maxfd = max(client_prv->sock, client_prv->pipefd[0]) + 1; + + printf("[*] %s() b_connect=%d, maxfd=%d\n", __FUNCTION__, client_prv->b_connect, maxfd); + while (client_prv->b_connect) { + FD_ZERO(&(client_prv->sock_rfds)); + + FD_SET(client_prv->sock, &(client_prv->sock_rfds)); + FD_SET(client_prv->pipefd[0], &(client_prv->sock_rfds)); + + if (DBG) ALOGD("[*] %s() b_connect=%d\n", __FUNCTION__, client_prv->b_connect); + if (select(maxfd, &(client_prv->sock_rfds), NULL, NULL, NULL) > 0) { + if (FD_ISSET(client_prv->sock, &(client_prv->sock_rfds))) { + // Read incoming data + for (;;) { + // loop until EAGAIN/EINTR, end of stream, or other error + ret = record_stream_get_next(client_prv->p_rs, &p_record, &recordlen); + if (ret == 0 && p_record == NULL) { // end-of-stream + break; + } + else if (ret < 0) { + break; + } + else if (ret == 0) { // && p_record != NULL + n = processRxBuffer(client_prv, p_record, recordlen); + if (n != RIL_CLIENT_ERR_SUCCESS) { + ALOGE("%s: processRXBuffer returns %d", __FUNCTION__, n); + } + } + else { + printf("[*] %s()\n", __FUNCTION__); + } + } + + if (ret == 0 || !(errno == EAGAIN || errno == EINTR)) { + // fatal error or end-of-stream + if (client_prv->sock > 0) { + close(client_prv->sock); + client_prv->sock = -1; + client_prv->b_connect = 0; + } + + if (client_prv->p_rs) + record_stream_free(client_prv->p_rs); + + // EOS + if (client_prv->err_cb) { + client_prv->err_cb(client_prv->err_cb_data, RIL_CLIENT_ERR_CONNECT); + return NULL; + } + + break; + } + } + if (FD_ISSET(client_prv->pipefd[0], &(client_prv->sock_rfds))) { + char end_cmd[10]; + + if (DBG) ALOGD("%s(): close\n", __FUNCTION__); + + if (read(client_prv->pipefd[0], end_cmd, sizeof(end_cmd)) > 0) { + close(client_prv->sock); + close(client_prv->pipefd[0]); + close(client_prv->pipefd[1]); + + client_prv->sock = -1; + client_prv->b_connect = 0; + } + } + } + } + + return NULL; +} + + +static int processUnsolicited(RilClientPrv *prv, Parcel &p) { + int32_t resp_id, len; + status_t status; + const void *data = NULL; + RilOnUnsolicited unsol_func = NULL; + + status = p.readInt32(&resp_id); + if (status != NO_ERROR) { + ALOGE("%s: read resp_id failed.", __FUNCTION__); + return RIL_CLIENT_ERR_IO; + } + + status = p.readInt32(&len); + if (status != NO_ERROR) { + //ALOGE("%s: read length failed. assume zero length.", __FUNCTION__); + len = 0; + } + + ALOGD("%s(): resp_id (%d), len(%d)\n", __FUNCTION__, resp_id, len); + + if (len) + data = p.readInplace(len); + + // Find unsolicited response handler. + unsol_func = FindUnsolHandler(prv, (uint32_t)resp_id); + if (unsol_func) { + unsol_func(prv->parent, data, len); + } + + return RIL_CLIENT_ERR_SUCCESS; +} + + +static int processSolicited(RilClientPrv *prv, Parcel &p) { + int32_t token, err, len; + status_t status; + const void *data = NULL; + RilOnComplete req_func = NULL; + int ret = RIL_CLIENT_ERR_SUCCESS; + uint32_t req_id = 0; + + if (DBG) ALOGD("%s()", __FUNCTION__); + + status = p.readInt32(&token); + if (status != NO_ERROR) { + ALOGE("%s: Read token fail. Status %d\n", __FUNCTION__, status); + return RIL_CLIENT_ERR_IO; + } + + if (IsValidToken(&(prv->token_pool), token) == 0) { + ALOGE("%s: Invalid Token", __FUNCTION__); + return RIL_CLIENT_ERR_INVAL; // Invalid token. + } + + status = p.readInt32(&err); + if (status != NO_ERROR) { + ALOGE("%s: Read err fail. Status %d\n", __FUNCTION__, status); + ret = RIL_CLIENT_ERR_IO; + goto error; + } + + // Don't go further for error response. + if (err != RIL_CLIENT_ERR_SUCCESS) { + ALOGE("%s: Error %d\n", __FUNCTION__, err); + if (prv->err_cb) + prv->err_cb(prv->err_cb_data, err); + ret = RIL_CLIENT_ERR_SUCCESS; + goto error; + } + + status = p.readInt32(&len); + if (status != NO_ERROR) { + /* no length field */ + len = 0; + } + + if (len) + data = p.readInplace(len); + + // Find request handler for the token. + // First, FindReqHandler() searches request history with the token + // and finds out a request ID. Then, it search request handler table + // with the request ID. + req_func = FindReqHandler(prv, token, &req_id); + if (req_func) + { + if (DBG) ALOGD("[*] Call handler"); + req_func(prv->parent, data, len); + + if(prv->b_del_handler) { + prv->b_del_handler = 0; + RegisterRequestCompleteHandler(prv->parent, req_id, NULL); + } + } else { + if (DBG) ALOGD("%s: No handler for token %d\n", __FUNCTION__, token); + } + +error: + FreeToken(&(prv->token_pool), token); + ClearReqHistory(prv, token); + return ret; +} + + +static int processRxBuffer(RilClientPrv *prv, void *buffer, size_t buflen) { + Parcel p; + int32_t response_type; + status_t status; + int ret = RIL_CLIENT_ERR_SUCCESS; + + acquire_wake_lock(PARTIAL_WAKE_LOCK, RIL_CLIENT_WAKE_LOCK); + + p.setData((uint8_t *)buffer, buflen); + + status = p.readInt32(&response_type); + if (DBG) ALOGD("%s: status %d response_type %d", __FUNCTION__, status, response_type); + + if (status != NO_ERROR) { + ret = RIL_CLIENT_ERR_IO; + goto EXIT; + } + + // FOr unsolicited response. + if (response_type == RESPONSE_UNSOLICITED) { + ret = processUnsolicited(prv, p); + } + // For solicited response. + else if (response_type == RESPONSE_SOLICITED) { + ret = processSolicited(prv, p); + if (ret != RIL_CLIENT_ERR_SUCCESS && prv->err_cb) { + prv->err_cb(prv->err_cb_data, ret); + } + } + else { + ret = RIL_CLIENT_ERR_INVAL; + } + +EXIT: + release_wake_lock(RIL_CLIENT_WAKE_LOCK); + return ret; +} + + +static uint32_t AllocateToken(uint32_t *token_pool) { + int i; + + // Token pool is full. + if (*token_pool == 0xFFFFFFFF) + return 0; + + for (i = 0; i < 32; i++) { + uint32_t new_token = 0x00000001 << i; + + if ((*token_pool & new_token) == 0) { + *token_pool |= new_token; + return new_token; + } + } + + return 0; +} + + +static void FreeToken(uint32_t *token_pool, uint32_t token) { + *token_pool &= ~token; +} + + +static uint8_t IsValidToken(uint32_t *token_pool, uint32_t token) { + if (token == 0) + return 0; + + if ((*token_pool & token) == token) + return 1; + else + return 0; +} + + +static int RecordReqHistory(RilClientPrv *prv, int token, uint32_t id) { + int i = 0; + + if (DBG) ALOGD("[*] %s(): token(%d), ID(%d)\n", __FUNCTION__, token, id); + for (i = 0; i < TOKEN_POOL_SIZE; i++) { + if (prv->history[i].token == 0) { + prv->history[i].token = token; + prv->history[i].id = id; + + if (DBG) ALOGD("[*] %s(): token(%d), ID(%d)\n", __FUNCTION__, token, id); + + return RIL_CLIENT_ERR_SUCCESS; + } + } + + ALOGE("%s: No free record for token %d", __FUNCTION__, token); + + return RIL_CLIENT_ERR_RESOURCE; +} + +static void ClearReqHistory(RilClientPrv *prv, int token) { + int i = 0; + + if (DBG) ALOGD("[*] %s(): token(%d)\n", __FUNCTION__, token); + for (i = 0; i < TOKEN_POOL_SIZE; i++) { + if (prv->history[i].token == token) { + memset(&(prv->history[i]), 0, sizeof(ReqHistory)); + break; + } + } +} + + +static RilOnUnsolicited FindUnsolHandler(RilClientPrv *prv, uint32_t id) { + int i; + + // Search unsolicited handler table. + for (i = 0; i < REQ_POOL_SIZE; i++) { + if (prv->unsol_handlers[i].id == id) + return prv->unsol_handlers[i].handler; + } + + return (RilOnUnsolicited)NULL; +} + + +static RilOnComplete FindReqHandler(RilClientPrv *prv, int token, uint32_t *id) { + int i = 0; + int j = 0; + + if (DBG) ALOGD("[*] %s(): token(%d)\n", __FUNCTION__, token); + + // Search request history. + for (i = 0; i < TOKEN_POOL_SIZE; i++) { + printf("[*] %s(): history_token(%d)\n", __FUNCTION__, prv->history[i].token); + if (prv->history[i].token == token) { + // Search request handler with request ID found. + for (j = 0; j < REQ_POOL_SIZE; j++) { + printf("[*] %s(): token(%d), req_id(%d), history_id(%d)\n", __FUNCTION__, token, prv->history[i].id, prv->history[i].id); + if (prv->req_handlers[j].id == prv->history[i].id) { + *id = prv->req_handlers[j].id; + return prv->req_handlers[j].handler; + } + } + } + } + + return NULL; +} + + +static void DeallocateToken(uint32_t *token_pool, uint32_t token) { + *token_pool &= !token; +} + + +static int blockingWrite(int fd, const void *buffer, size_t len) { + size_t writeOffset = 0; + const uint8_t *toWrite; + ssize_t written = 0; + + if (buffer == NULL) + return -1; + + toWrite = (const uint8_t *)buffer; + + while (writeOffset < len) { + do + { + written = write(fd, toWrite + writeOffset, len - writeOffset); + } while (written < 0 && errno == EINTR); + + if (written >= 0) { + writeOffset += written; + } + else { + ALOGE ("RIL Response: unexpected error on write errno:%d", errno); + printf("RIL Response: unexpected error on write errno:%d\n", errno); + close(fd); + return -1; + } + } + + return 0; +} + +} // namespace android + +// end of file + diff --git a/rilsrc/libsecril-client/secril-client.h b/rilsrc/libsecril-client/secril-client.h new file mode 100755 index 0000000..01ff89b --- /dev/null +++ b/rilsrc/libsecril-client/secril-client.h @@ -0,0 +1,285 @@ +/** + * @file secril-client.h + * + * @author Myeongcheol Kim (mcmount.kim@samsung.com) + * + * @brief RIL client library for multi-client support + */ + +#ifndef __SECRIL_CLIENT_H__ +#define __SECRIL_CLIENT_H__ + +#include +//#include "SecProductFeature_RIL.h" + +#ifdef __cplusplus +extern "C" { +#endif + +struct RilClient { + void *prv; +}; + +typedef struct RilClient * HRilClient; + + +//--------------------------------------------------------------------------- +// Defines +//--------------------------------------------------------------------------- +#define RIL_CLIENT_ERR_SUCCESS 0 +#define RIL_CLIENT_ERR_AGAIN 1 +#define RIL_CLIENT_ERR_INIT 2 // Client is not initialized +#define RIL_CLIENT_ERR_INVAL 3 // Invalid value +#define RIL_CLIENT_ERR_CONNECT 4 // Connection error +#define RIL_CLIENT_ERR_IO 5 // IO error +#define RIL_CLIENT_ERR_RESOURCE 6 // Resource not available +#define RIL_CLIENT_ERR_UNKNOWN 7 + + +//--------------------------------------------------------------------------- +// Type definitions +//--------------------------------------------------------------------------- + +typedef int (*RilOnComplete)(HRilClient handle, const void *data, size_t datalen); + +typedef int (*RilOnUnsolicited)(HRilClient handle, const void *data, size_t datalen); + +typedef int (*RilOnError)(void *data, int error); + + +//--------------------------------------------------------------------------- +// Client APIs +//--------------------------------------------------------------------------- + +/** + * Open RILD multi-client. + * Return is client handle, NULL on error. + */ +HRilClient OpenClient_RILD(void); + +/** + * Stop RILD multi-client. If client socket was connected, + * it will be disconnected. + */ +int CloseClient_RILD(HRilClient client); + +/** + * Connect to RIL deamon. One client task starts. + * Return is 0 or error code. + */ +int Connect_RILD(HRilClient client); + +/** + * Connect to QRIL deamon. One client task starts. + * Return is 0 or error code. + */ +int Connect_QRILD(HRilClient client); + +#if defined(SEC_PRODUCT_FEATURE_RIL_CALL_DUALMODE_CDMAGSM) +/** + * Connect to RIL deamon. One client task starts. + * Return is 0 or error code. + */ +int Connect_RILD_Second(HRilClient client); +#endif +/** + * check whether RILD is connected + * Returns 0 or 1 + */ +int isConnected_RILD(HRilClient client); + +/** + * Disconnect connection to RIL deamon(socket close). + * Return is 0 or error code. + */ +int Disconnect_RILD(HRilClient client); + +/** + * Register unsolicited response handler. If handler is NULL, + * the handler for the request ID is unregistered. + * The response handler is invoked in the client task context. + * Return is 0 or error code. + */ +int RegisterUnsolicitedHandler(HRilClient client, uint32_t id, RilOnUnsolicited handler); + +/** + * Register solicited response handler. If handler is NULL, + * the handler for the ID is unregistered. + * The response handler is invoked in the client task context. + * Return is 0 or error code. + */ +int RegisterRequestCompleteHandler(HRilClient client, uint32_t id, RilOnComplete handler); + +/** + * Register error callback. If handler is NULL, + * the callback is unregistered. + * The response handler is invoked in the client task context. + * Return is 0 or error code. + */ +int RegisterErrorCallback(HRilClient client, RilOnError cb, void *data); + +/** + * Invoke OEM request. Request ID is RIL_REQUEST_OEM_HOOK_RAW. + * Return is 0 or error code. For RIL_CLIENT_ERR_AGAIN caller should retry. + */ +int InvokeOemRequestHookRaw(HRilClient client, char *data, size_t len); + +/** + * Sound device types. + */ +typedef enum _SoundType { + SOUND_TYPE_VOICE, + SOUND_TYPE_SPEAKER, + SOUND_TYPE_HEADSET, + SOUND_TYPE_BTVOICE +} SoundType; + +/** + * External sound device path. + */ +typedef enum _AudioPath { + SOUND_AUDIO_PATH_HANDSET, + SOUND_AUDIO_PATH_HEADSET, + SOUND_AUDIO_PATH_SPEAKER, + SOUND_AUDIO_PATH_BLUETOOTH, + SOUND_AUDIO_PATH_STEREO_BT, + SOUND_AUDIO_PATH_HEADPHONE, + SOUND_AUDIO_PATH_BLUETOOTH_NO_NR, + SOUND_AUDIO_PATH_MIC1, + SOUND_AUDIO_PATH_MIC2, + SOUND_AUDIO_PATH_BLUETOOTH_WB, + SOUND_AUDIO_PATH_BLUETOOTH_WB_NO_NR +} AudioPath; + +/** + * Clock adjustment parameters. + */ +typedef enum _SoundClockCondition { + SOUND_CLOCK_STOP, + SOUND_CLOCK_START +} SoundClockCondition; + +/** + * Call record adjustment parameters. + */ +typedef enum _CallRecCondition { + CALL_REC_STOP, + CALL_REC_START +} CallRecCondition; + +/** + * Mute adjustment parameters. + */ +typedef enum _MuteCondition { + TX_UNMUTE, /* 0x00: TX UnMute */ + TX_MUTE, /* 0x01: TX Mute */ + RX_UNMUTE, /* 0x02: RX UnMute */ + RX_MUTE, /* 0x03: RX Mute */ + RXTX_UNMUTE, /* 0x04: RXTX UnMute */ + RXTX_MUTE, /* 0x05: RXTX Mute */ +} MuteCondition; + +/** + * Two mic Solution control + * Two MIC Solution Device + */ +typedef enum __TwoMicSolDevice { + AUDIENCE, + FORTEMEDIA +} TwoMicSolDevice; + +/** + * Two MIC Solution Report + */ +typedef enum __TwoMicSolReport { + TWO_MIC_SOLUTION_OFF, + TWO_MIC_SOLUTION_ON +} TwoMicSolReport; + +/** + * DHA Mode + */ +typedef enum __DhaSolMode { + DHA_MODE_OFF, + DHA_MODE_ON +} DhaSolMode; + +/** + * DHA Select + */ +typedef enum __DhaSolSelect { + DHA_SEL_LEFT, + DHA_SEL_RIGHT +} DhaSolSelect; + +/** + * LoopbackTest parameters. + */ +typedef enum __LoopbackMode { + LOOPBACK_END, + LOOPBACK_ON_PCM, + LOOPBACK_ON_PACKET +} LoopbackMode; + +typedef enum __LoopbackPath { + RECEIVER, + EARPHONE, + LOUDSPEAKER +} LoopbackPath; + + +/** + * Set in-call volume. + */ +int SetCallVolume(HRilClient client, SoundType type, int vol_level); + +/** + * Set external sound device path for noise reduction. + */ +int SetCallAudioPath(HRilClient client, AudioPath path); + +/** + * Set modem clock to master or slave. + */ +int SetCallClockSync(HRilClient client, SoundClockCondition condition); + +/** + * Set modem vtcall clock to master or slave. + */ +int SetVideoCallClockSync(HRilClient client, SoundClockCondition condition); + +/** + * Set voice call record + */ +int SetCallRecord(HRilClient client, CallRecCondition condition); + +/** + * Set mute or unmute + */ +int SetMute(HRilClient client, MuteCondition condition); + +/** + * Get mute state + */ +int GetMute(HRilClient client, RilOnComplete handler); + +int SetTwoMicControl(HRilClient client, TwoMicSolDevice device, TwoMicSolReport report); + +/** + * DHA Solution Set + */ +int SetDhaSolution(HRilClient client, DhaSolMode mode, DhaSolSelect select, char *parameter); + +/** + * Set Loopback Test Mode and Path + */ +int SetLoopbackTest(HRilClient client, LoopbackMode mode, AudioPath path); + +#ifdef __cplusplus +}; +#endif + +#endif // __SECRIL_CLIENT_H__ + +// end of file + -- cgit v1.1