diff options
Diffstat (limited to 'rilsrc/libsecril-client/secril-client.cpp')
| -rwxr-xr-x | rilsrc/libsecril-client/secril-client.cpp | 1570 |
1 files changed, 0 insertions, 1570 deletions
diff --git a/rilsrc/libsecril-client/secril-client.cpp b/rilsrc/libsecril-client/secril-client.cpp deleted file mode 100755 index cbf6ffb..0000000 --- a/rilsrc/libsecril-client/secril-client.cpp +++ /dev/null @@ -1,1570 +0,0 @@ -/** - * @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 <binder/Parcel.h> -#include <telephony/ril.h> -#include <cutils/record_stream.h> - -#include <unistd.h> -#include <errno.h> -#include <cutils/sockets.h> -#include <netinet/in.h> -#include <sys/types.h> -#include <string.h> -#include <fcntl.h> -#include <utils/Log.h> -#include <pthread.h> -#include "secril-client.h" -#include <hardware_legacy/power.h> // 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 - |