/** * @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