summaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
authorPaul Kocialkowski <contact@paulk.fr>2013-08-25 21:23:39 +0200
committerPaul Kocialkowski <contact@paulk.fr>2013-08-25 21:23:39 +0200
commitf8ea100031eb02e119637884b85f5527ecb4634a (patch)
tree804d34de82020273417c21b638be7b92c3f11b8a
parent55d665ac856a85e91060291b4c695ea4e06975e5 (diff)
downloadhardware_ril_samsung-ril-f8ea100031eb02e119637884b85f5527ecb4634a.zip
hardware_ril_samsung-ril-f8ea100031eb02e119637884b85f5527ecb4634a.tar.gz
hardware_ril_samsung-ril-f8ea100031eb02e119637884b85f5527ecb4634a.tar.bz2
svc: Implement Samsung Service Mode OEM Hook
Signed-off-by: Paul Kocialkowski <contact@paulk.fr>
-rw-r--r--Android.mk1
-rw-r--r--samsung-ril.c8
-rw-r--r--samsung-ril.h43
-rw-r--r--svc.c241
4 files changed, 293 insertions, 0 deletions
diff --git a/Android.mk b/Android.mk
index 7b11c84..08b4f48 100644
--- a/Android.mk
+++ b/Android.mk
@@ -33,6 +33,7 @@ LOCAL_SRC_FILES := \
sat.c \
ss.c \
sec.c \
+ svc.c \
net.c \
sms.c \
call.c \
diff --git a/samsung-ril.c b/samsung-ril.c
index 09ed161..e1bf2cc 100644
--- a/samsung-ril.c
+++ b/samsung-ril.c
@@ -366,6 +366,10 @@ void ipc_fmt_dispatch(struct ipc_message_info *info)
case IPC_SMS_DEVICE_READY:
ipc_sms_device_ready(info);
break;
+ /* SVC */
+ case IPC_SVC_DISPLAY_SCREEN:
+ ipc_svc_display_screen(info);
+ break;
/* CALL */
case IPC_CALL_INCOMING:
ipc_call_incoming(info);
@@ -521,6 +525,10 @@ void ril_on_request(int request, void *data, size_t length, RIL_Token t)
case RIL_REQUEST_SET_FACILITY_LOCK:
ril_request_set_facility_lock(t, data, length);
break;
+ /* SVC */
+ case RIL_REQUEST_OEM_HOOK_RAW:
+ ril_request_oem_hook_raw(t, data, length);
+ break;
/* NET */
case RIL_REQUEST_OPERATOR:
ril_request_operator(t);
diff --git a/samsung-ril.h b/samsung-ril.h
index f5d94b1..49e1d0b 100644
--- a/samsung-ril.h
+++ b/samsung-ril.h
@@ -193,6 +193,7 @@ struct ril_data {
struct ril_state state;
struct ril_tokens tokens;
+ struct ril_oem_hook_svc_session *oem_hook_svc_session;
struct list_head *gprs_connections;
struct list_head *incoming_sms;
struct list_head *outgoing_sms;
@@ -311,6 +312,48 @@ void ipc_sec_phone_lock(struct ipc_message_info *info);
void ipc_sec_phone_lock_complete(struct ipc_message_info *info);
void ril_request_set_facility_lock(RIL_Token t, void *data, size_t length);
+/* SVC */
+
+typedef enum {
+ RIL_OEM_HOOK_TAG_SVC = 1,
+} RIL_OEMHookTag;
+
+typedef enum {
+ RIL_OEM_COMMAND_SVC_ENTER_MODE = 1,
+ RIL_OEM_COMMAND_SVC_END_MODE = 2,
+ RIL_OEM_COMMAND_SVC_KEY = 3,
+} RIL_OEMCommandSvc;
+
+typedef struct {
+ unsigned char tag;
+ unsigned char command;
+ unsigned short length;
+} RIL_OEMHookHeader;
+
+typedef struct {
+ unsigned char mode;
+ unsigned char type;
+ unsigned char query;
+} RIL_OEMHookSvcEnterMode;
+
+typedef struct {
+ unsigned char mode;
+} RIL_OEMHookSvcEndMode;
+
+typedef struct {
+ unsigned char key;
+ unsigned char query;
+} RIL_OEMHookSvcKey;
+
+struct ril_oem_hook_svc_session {
+ RIL_Token token;
+ void *display_screen;
+ size_t display_screen_length;
+};
+
+void ipc_svc_display_screen(struct ipc_message_info *info);
+void ril_request_oem_hook_raw(RIL_Token t, void *data, int length);
+
/* NET */
void ril_plmn_split(char *plmn_data, char **plmn, unsigned int *mcc, unsigned int *mnc);
diff --git a/svc.c b/svc.c
new file mode 100644
index 0000000..ae466b9
--- /dev/null
+++ b/svc.c
@@ -0,0 +1,241 @@
+/*
+ * This file is part of Samsung-RIL.
+ *
+ * Copyright (C) 2013 Paul Kocialkowski <contact@paulk.fr>
+ *
+ * Samsung-RIL is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * Samsung-RIL is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with Samsung-RIL. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#define LOG_TAG "RIL-SVC"
+#include <utils/Log.h>
+
+#include "samsung-ril.h"
+#include "util.h"
+
+int ril_oem_hook_svc_session_start(void)
+{
+ if (ril_data.oem_hook_svc_session != NULL) {
+ LOGE("OEM hook SVC session was already started");
+ return -1;
+ }
+
+ ril_data.oem_hook_svc_session = calloc(1, sizeof(struct ril_oem_hook_svc_session));
+
+ return 0;
+}
+
+void ril_oem_hook_svc_session_stop(void)
+{
+ if (ril_data.oem_hook_svc_session == NULL) {
+ LOGE("OEM hook SVC session was already stopped");
+ return;
+ }
+
+ if (ril_data.oem_hook_svc_session->display_screen != NULL)
+ free(ril_data.oem_hook_svc_session->display_screen);
+
+ free(ril_data.oem_hook_svc_session);
+ ril_data.oem_hook_svc_session = NULL;
+}
+
+void ipc_svc_display_screen(struct ipc_message_info *info)
+{
+ char svc_end_message[] = "Samsung-RIL is asking you to End service mode";
+ struct ipc_svc_display_screen_header *header;
+ struct ipc_svc_display_screen_data *data;
+
+ if (info == NULL || info->data == NULL || info->length < sizeof(header->count))
+ return;
+
+ if (ril_data.oem_hook_svc_session == NULL)
+ goto error;
+
+ header = (struct ipc_svc_display_screen_header *) info->data;
+
+ if (header->count == 0) {
+ if (ril_data.oem_hook_svc_session->token != RIL_TOKEN_NULL) {
+ ril_request_complete(ril_data.oem_hook_svc_session->token, RIL_E_SUCCESS, &svc_end_message, sizeof(svc_end_message));
+ ril_data.oem_hook_svc_session->token = RIL_TOKEN_NULL;
+ }
+
+ ril_oem_hook_svc_session_stop();
+
+ return;
+ }
+
+ data = (struct ipc_svc_display_screen_data *) ((unsigned char *) info->data + sizeof(struct ipc_svc_display_screen_header));
+
+ // Invalid responses don't start at index 0
+ if (data->index != 0)
+ return;
+
+ if (ril_data.oem_hook_svc_session->display_screen != NULL) {
+ free(ril_data.oem_hook_svc_session->display_screen);
+ ril_data.oem_hook_svc_session->display_screen = NULL;
+ ril_data.oem_hook_svc_session->display_screen_length = 0;
+ }
+
+ ril_data.oem_hook_svc_session->display_screen_length = header->count * sizeof(struct ipc_svc_display_screen_data);
+ ril_data.oem_hook_svc_session->display_screen = malloc(ril_data.oem_hook_svc_session->display_screen_length);
+ memcpy(ril_data.oem_hook_svc_session->display_screen, data, ril_data.oem_hook_svc_session->display_screen_length);
+
+ if (ril_data.oem_hook_svc_session->token != RIL_TOKEN_NULL) {
+ ril_request_complete(ril_data.oem_hook_svc_session->token, RIL_E_SUCCESS, ril_data.oem_hook_svc_session->display_screen, ril_data.oem_hook_svc_session->display_screen_length);
+
+ ril_data.oem_hook_svc_session->token = RIL_TOKEN_NULL;
+ }
+
+ return;
+
+error:
+ ril_request_complete(ril_request_get_token(info->aseq), RIL_E_GENERIC_FAILURE, NULL, 0);
+}
+
+void ipc_svc_callback(struct ipc_message_info *info)
+{
+ struct ipc_gen_phone_res *phone_res;
+ int rc;
+
+ if (info == NULL || info->data == NULL || info->length < (int) sizeof(struct ipc_gen_phone_res))
+ return;
+
+ if (ril_data.oem_hook_svc_session == NULL)
+ goto error;
+
+ phone_res = (struct ipc_gen_phone_res *) info->data;
+
+ rc = ipc_gen_phone_res_check(phone_res);
+ if (rc < 0)
+ goto error;
+
+ if (ril_data.oem_hook_svc_session->token != RIL_TOKEN_NULL) {
+ LOGE("%s: Another token is waiting", __func__);
+ goto error;
+ }
+
+ ril_data.oem_hook_svc_session->token = ril_request_get_token(info->aseq);
+
+ return;
+
+error:
+ ril_request_complete(ril_request_get_token(info->aseq), RIL_E_GENERIC_FAILURE, NULL, 0);
+}
+
+void ril_request_oem_hook_raw(RIL_Token token, void *data, int length)
+{
+ RIL_OEMHookHeader *header;
+ RIL_OEMHookSvcEnterMode *svc_enter_mode;
+ RIL_OEMHookSvcEndMode *svc_end_mode;
+ RIL_OEMHookSvcKey *svc_key;
+ struct ipc_svc_enter_data svc_enter_data;
+ struct ipc_svc_end_data svc_end_data;
+ struct ipc_svc_pro_keycode_data svc_pro_keycode_data;
+ int svc_length;
+ int rc;
+
+ if (data == NULL || length < (int) sizeof(RIL_OEMHookHeader))
+ goto error;
+
+ header = (RIL_OEMHookHeader *) data;
+
+ // Only SVC is supported
+ if (header->tag != RIL_OEM_HOOK_TAG_SVC)
+ goto error;
+
+ svc_length = (header->length & 0xff) << 8 | (header->length & 0xff00) >> 8;
+
+ switch (header->command) {
+ case RIL_OEM_COMMAND_SVC_ENTER_MODE:
+ if (svc_length < (int) (sizeof(RIL_OEMHookHeader) + sizeof(RIL_OEMHookSvcEnterMode)))
+ goto error;
+
+ svc_enter_mode = (RIL_OEMHookSvcEnterMode *) ((unsigned char *) data + sizeof(RIL_OEMHookHeader));
+
+ if (svc_enter_mode->query) {
+ if (ril_data.oem_hook_svc_session == NULL)
+ goto error;
+
+ if (ril_data.oem_hook_svc_session->display_screen != NULL && ril_data.oem_hook_svc_session->display_screen_length > 0)
+ ril_request_complete(token, RIL_E_SUCCESS, ril_data.oem_hook_svc_session->display_screen, ril_data.oem_hook_svc_session->display_screen_length);
+ else
+ goto error;
+ } else {
+ rc = ril_oem_hook_svc_session_start();
+ if (rc < 0) {
+ LOGE("%s: Unable to start OEM hook SVC session", __func__);
+ goto error;
+ }
+
+ memset(&svc_enter_data, 0, sizeof(svc_enter_data));
+ svc_enter_data.mode = svc_enter_mode->mode;
+ svc_enter_data.type = svc_enter_mode->type;
+
+ if (svc_enter_data.mode == IPC_SVC_MODE_MONITOR)
+ svc_enter_data.unknown = 0x00;
+ else
+ svc_enter_data.unknown = 0x10;
+
+ ipc_gen_phone_res_expect_to_func(ril_request_get_id(token), IPC_SVC_ENTER, ipc_svc_callback);
+
+ ipc_fmt_send(IPC_SVC_ENTER, IPC_TYPE_SET, (unsigned char *) &svc_enter_data, sizeof(svc_enter_data), ril_request_get_id(token));
+ }
+ break;
+ case RIL_OEM_COMMAND_SVC_END_MODE:
+ if (svc_length < (int) (sizeof(RIL_OEMHookHeader) + sizeof(RIL_OEMHookSvcEndMode)))
+ goto error;
+
+ svc_end_mode = (RIL_OEMHookSvcEndMode *) ((unsigned char *) data + sizeof(RIL_OEMHookHeader));
+
+ ril_oem_hook_svc_session_stop();
+
+ memset(&svc_end_data, 0, sizeof(svc_end_data));
+ svc_end_data.mode = svc_end_mode->mode;
+
+ ipc_gen_phone_res_expect_to_complete(ril_request_get_id(token), IPC_SVC_END);
+
+ ipc_fmt_send(IPC_SVC_END, IPC_TYPE_SET, (unsigned char *) &svc_end_data, sizeof(svc_end_data), ril_request_get_id(token));
+ break;
+ case RIL_OEM_COMMAND_SVC_KEY:
+ if (svc_length < (int) (sizeof(RIL_OEMHookHeader) + sizeof(RIL_OEMHookSvcKey)))
+ goto error;
+
+ svc_key = (RIL_OEMHookSvcKey *) ((unsigned char *) data + sizeof(RIL_OEMHookHeader));
+
+ if (svc_key->query) {
+ if (ril_data.oem_hook_svc_session == NULL)
+ goto error;
+
+ if (ril_data.oem_hook_svc_session->display_screen != NULL && ril_data.oem_hook_svc_session->display_screen_length > 0)
+ ril_request_complete(token, RIL_E_SUCCESS, ril_data.oem_hook_svc_session->display_screen, ril_data.oem_hook_svc_session->display_screen_length);
+ else
+ goto error;
+ } else {
+ if (ril_data.oem_hook_svc_session == NULL)
+ goto error;
+
+ memset(&svc_pro_keycode_data, 0, sizeof(svc_pro_keycode_data));
+ svc_pro_keycode_data.key = svc_key->key;
+
+ ipc_gen_phone_res_expect_to_func(ril_request_get_id(token), IPC_SVC_PRO_KEYCODE, ipc_svc_callback);
+
+ ipc_fmt_send(IPC_SVC_PRO_KEYCODE, IPC_TYPE_SET, (unsigned char *) &svc_pro_keycode_data, sizeof(svc_pro_keycode_data), ril_request_get_id(token));
+ }
+ break;
+ }
+
+ return;
+
+error:
+ ril_request_complete(token, RIL_E_GENERIC_FAILURE, NULL, 0);
+}