ofono/gril/grilreply.c

1451 lines
32 KiB
C

/*
*
* RIL library with GLib integration
*
* Copyright (C) 2008-2011 Intel Corporation. All rights reserved.
* Copyright (C) 2013 Jolla Ltd
* Contact: Jussi Kangas <jussi.kangas@tieto.com>
* Copyright (C) 2012-2014 Canonical Ltd.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
* This program 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 this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#include <stdio.h>
#include <ctype.h>
#include <errno.h>
#include <string.h>
#include <glib.h>
#include <ofono/log.h>
#include <ofono/modem.h>
#include <ofono/call-forwarding.h>
#include <ofono/gprs-context.h>
#include "common.h"
#include "util.h"
#include "grilreply.h"
#include "grilutil.h"
#define OPERATOR_NUM_PARAMS 3
/* Indexes for registration state replies */
#define RST_IX_STATE 0
#define RST_IX_LAC 1
#define RST_IX_CID 2
#define RST_IX_RAT 3
#define RDST_IX_MAXDC 5
#define MTK_MODEM_MAX_CIDS 3
static void ril_reply_free_operator(gpointer data)
{
struct reply_operator *reply = data;
if (reply) {
g_free(reply->lalpha);
g_free(reply->salpha);
g_free(reply->numeric);
g_free(reply->status);
g_free(reply);
}
}
void g_ril_reply_free_avail_ops(struct reply_avail_ops *reply)
{
if (reply) {
g_slist_free_full(reply->list, ril_reply_free_operator);
g_free(reply);
}
}
struct reply_avail_ops *g_ril_reply_parse_avail_ops(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
struct reply_operator *operator;
struct reply_avail_ops *reply = NULL;
unsigned int num_ops, num_strings;
unsigned int i;
int strings_per_opt;
if (g_ril_vendor(gril) == OFONO_RIL_VENDOR_MTK)
strings_per_opt = 5;
else
strings_per_opt = 4;
/*
* Minimum message length is 4:
* - array size
*/
if (message->buf_len < 4) {
ofono_error("%s: invalid QUERY_AVAIL_NETWORKS reply: "
"size too small (< 4): %d ",
__func__,
(int) message->buf_len);
goto error;
}
g_ril_init_parcel(message, &rilp);
g_ril_append_print_buf(gril, "{");
/* Number of operators at the list */
num_strings = (unsigned int) parcel_r_int32(&rilp);
if (num_strings % strings_per_opt) {
ofono_error("%s: invalid QUERY_AVAIL_NETWORKS reply: "
"num_strings (%d) MOD %d != 0",
__func__,
num_strings, strings_per_opt);
goto error;
}
num_ops = num_strings / strings_per_opt;
DBG("noperators = %d", num_ops);
reply = g_try_new0(struct reply_avail_ops, 1);
if (reply == NULL) {
ofono_error("%s: can't allocate reply struct", __func__);
goto error;
}
reply->num_ops = num_ops;
for (i = 0; i < num_ops; i++) {
operator = g_try_new0(struct reply_operator, 1);
if (operator == NULL) {
ofono_error("%s: can't allocate reply struct",
__func__);
goto error;
}
operator->lalpha = parcel_r_string(&rilp);
operator->salpha = parcel_r_string(&rilp);
operator->numeric = parcel_r_string(&rilp);
operator->status = parcel_r_string(&rilp);
/*
* MTK: additional string with technology: 2G/3G are the only
* valid values currently.
*/
if (g_ril_vendor(gril) == OFONO_RIL_VENDOR_MTK) {
char *tech = parcel_r_string(&rilp);
if (strcmp(tech, "3G") == 0)
operator->tech = RADIO_TECH_UMTS;
else
operator->tech = RADIO_TECH_GSM;
g_free(tech);
} else {
operator->tech = RADIO_TECH_GSM;
}
if (operator->lalpha == NULL && operator->salpha == NULL) {
ofono_error("%s: operator (%s) doesn't specify names",
operator->numeric,
__func__);
g_ril_reply_free_operator(operator);
continue;
}
if (operator->numeric == NULL) {
ofono_error("%s: operator (%s/%s) "
"doesn't specify numeric",
operator->lalpha,
operator->salpha,
__func__);
g_ril_reply_free_operator(operator);
continue;
}
if (operator->status == NULL) {
ofono_error("%s: operator (%s/%s) "
"doesn't specify status",
operator->lalpha,
operator->salpha,
__func__);
g_ril_reply_free_operator(operator);
continue;
}
reply->list = g_slist_append(reply->list, operator);
g_ril_append_print_buf(gril, "%s [lalpha=%s, salpha=%s, "
" numeric=%s status=%s tech=%s]",
print_buf,
operator->lalpha,
operator->salpha,
operator->numeric,
operator->status,
ril_radio_tech_to_string(operator->tech));
}
g_ril_append_print_buf(gril, "%s}", print_buf);
g_ril_print_response(gril, message);
return reply;
error:
if (reply)
g_ril_reply_free_avail_ops(reply);
return NULL;
}
void g_ril_reply_free_operator(struct reply_operator *reply)
{
ril_reply_free_operator(reply);
}
struct reply_operator *g_ril_reply_parse_operator(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
int num_params;
struct reply_operator *reply = NULL;
/*
* Minimum message length is 16:
* - array size
* - 3 NULL strings
*/
if (message->buf_len < 16) {
ofono_error("%s: invalid OPERATOR reply: "
"size too small (< 16): %d ",
__func__,
(int) message->buf_len);
goto error;
}
g_ril_init_parcel(message, &rilp);
num_params = parcel_r_int32(&rilp);
if (num_params != OPERATOR_NUM_PARAMS) {
ofono_error("%s: invalid OPERATOR reply: "
"number of params is %d; should be 3.",
__func__,
num_params);
goto error;
}
reply = g_new0(struct reply_operator, 1);
reply->lalpha = parcel_r_string(&rilp);
reply->salpha = parcel_r_string(&rilp);
reply->numeric = parcel_r_string(&rilp);
if (reply->lalpha == NULL && reply->salpha == NULL) {
ofono_error("%s: invalid OPERATOR reply: "
" no names returned.",
__func__);
goto error;
}
if (reply->numeric == NULL) {
ofono_error("%s: invalid OPERATOR reply: "
" no numeric returned.",
__func__);
goto error;
}
g_ril_append_print_buf(gril,
"(lalpha=%s, salpha=%s, numeric=%s)",
reply->lalpha, reply->salpha, reply->numeric);
g_ril_print_response(gril, message);
return reply;
error:
if (reply)
g_ril_reply_free_operator(reply);
return NULL;
}
static void set_reg_state(GRil *gril, struct reply_reg_state *reply,
int i, const char *str)
{
int val;
char *endp;
int base;
const char *strstate;
if (str == NULL || *str == '\0')
goto no_val;
if (i == RST_IX_LAC || i == RST_IX_CID)
base = 16;
else
base = 10;
val = (int) strtol(str, &endp, base);
if (*endp != '\0')
goto no_val;
switch (i) {
case RST_IX_STATE:
switch (val) {
case RIL_REG_STATE_NOT_REGISTERED:
case RIL_REG_STATE_REGISTERED:
case RIL_REG_STATE_SEARCHING:
case RIL_REG_STATE_DENIED:
case RIL_REG_STATE_UNKNOWN:
case RIL_REG_STATE_ROAMING:
/* Only valid values for ofono */
strstate = registration_status_to_string(val);
break;
case RIL_REG_STATE_EMERGENCY_NOT_REGISTERED:
case RIL_REG_STATE_EMERGENCY_SEARCHING:
case RIL_REG_STATE_EMERGENCY_DENIED:
case RIL_REG_STATE_EMERGENCY_UNKNOWN:
/* Map to states valid for ofono core */
val -= RIL_REG_STATE_EMERGENCY_NOT_REGISTERED;
strstate = str;
break;
default:
val = NETWORK_REGISTRATION_STATUS_UNKNOWN;
strstate = str;
}
reply->status = val;
g_ril_append_print_buf(gril, "%s%s", print_buf, strstate);
break;
case RST_IX_LAC:
reply->lac = val;
g_ril_append_print_buf(gril, "%s0x%x", print_buf, val);
break;
case RST_IX_CID:
reply->ci = val;
g_ril_append_print_buf(gril, "%s0x%x", print_buf, val);
break;
case RST_IX_RAT:
g_ril_append_print_buf(gril, "%s%s", print_buf,
ril_radio_tech_to_string(val));
if (g_ril_vendor(gril) == OFONO_RIL_VENDOR_MTK) {
switch (val) {
case MTK_RADIO_TECH_HSDPAP:
case MTK_RADIO_TECH_HSDPAP_UPA:
case MTK_RADIO_TECH_HSUPAP:
case MTK_RADIO_TECH_HSUPAP_DPA:
val = RADIO_TECH_HSPAP;
break;
case MTK_RADIO_TECH_DC_DPA:
val = RADIO_TECH_HSDPA;
break;
case MTK_RADIO_TECH_DC_UPA:
val = RADIO_TECH_HSUPA;
break;
case MTK_RADIO_TECH_DC_HSDPAP:
case MTK_RADIO_TECH_DC_HSDPAP_UPA:
case MTK_RADIO_TECH_DC_HSDPAP_DPA:
case MTK_RADIO_TECH_DC_HSPAP:
val = RADIO_TECH_HSPAP;
break;
}
}
reply->tech = val;
break;
default:
goto no_val;
}
return;
no_val:
g_ril_append_print_buf(gril, "%s%s", print_buf, str ? str : "(null)");
}
struct reply_reg_state *g_ril_reply_parse_voice_reg_state(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
struct parcel_str_array *str_arr;
struct reply_reg_state *reply = NULL;
int i;
g_ril_init_parcel(message, &rilp);
str_arr = parcel_r_str_array(&rilp);
if (str_arr == NULL) {
ofono_error("%s: parse error for %s", __func__,
ril_request_id_to_string(message->req));
goto out;
}
reply = g_try_malloc0(sizeof(*reply));
if (reply == NULL) {
ofono_error("%s: out of memory", __func__);
goto out;
}
reply->status = -1;
reply->lac = -1;
reply->ci = -1;
g_ril_append_print_buf(gril, "{");
for (i = 0; i < str_arr->num_str; ++i) {
char *str = str_arr->str[i];
if (i > 0)
g_ril_append_print_buf(gril, "%s,", print_buf);
switch (i) {
case RST_IX_STATE: case RST_IX_LAC:
case RST_IX_CID: case RST_IX_RAT:
set_reg_state(gril, reply, i, str);
break;
default:
g_ril_append_print_buf(gril, "%s%s", print_buf,
str ? str : "(null)");
}
}
g_ril_append_print_buf(gril, "%s}", print_buf);
g_ril_print_response(gril, message);
/* As a minimum we require a valid status string */
if (reply->status == -1) {
ofono_error("%s: invalid status", __func__);
g_free(reply);
reply = NULL;
}
out:
parcel_free_str_array(str_arr);
return reply;
}
static void set_data_reg_state(GRil *gril, struct reply_data_reg_state *reply,
int i, const char *str)
{
unsigned val;
char *endp;
if (str == NULL || *str == '\0')
goto no_val;
val = (unsigned) strtoul(str, &endp, 10);
if (*endp != '\0')
goto no_val;
switch (i) {
case RDST_IX_MAXDC:
/*
* MTK modem does not return max_cids, string for this index
* actually contains the maximum data bearer capability.
*/
if (g_ril_vendor(gril) == OFONO_RIL_VENDOR_MTK)
reply->max_cids = MTK_MODEM_MAX_CIDS;
else
reply->max_cids = val;
g_ril_append_print_buf(gril, "%s%u", print_buf, val);
break;
default:
goto no_val;
}
return;
no_val:
g_ril_append_print_buf(gril, "%s%s", print_buf, str ? str : "(null)");
}
struct reply_data_reg_state *g_ril_reply_parse_data_reg_state(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
struct parcel_str_array *str_arr;
struct reply_data_reg_state *reply = NULL;
int i;
g_ril_init_parcel(message, &rilp);
str_arr = parcel_r_str_array(&rilp);
if (str_arr == NULL) {
ofono_error("%s: parse error for %s", __func__,
ril_request_id_to_string(message->req));
goto out;
}
reply = g_try_malloc0(sizeof(*reply));
if (reply == NULL) {
ofono_error("%s: out of memory", __func__);
goto out;
}
reply->reg_state.status = -1;
reply->reg_state.lac = -1;
reply->reg_state.ci = -1;
g_ril_append_print_buf(gril, "{");
for (i = 0; i < str_arr->num_str; ++i) {
char *str = str_arr->str[i];
if (i > 0)
g_ril_append_print_buf(gril, "%s,", print_buf);
switch (i) {
case RST_IX_STATE: case RST_IX_LAC:
case RST_IX_CID: case RST_IX_RAT:
set_reg_state(gril, &reply->reg_state, i, str);
break;
case RDST_IX_MAXDC:
set_data_reg_state(gril, reply, i, str);
break;
default:
g_ril_append_print_buf(gril, "%s%s", print_buf,
str ? str : "(null)");
}
}
g_ril_append_print_buf(gril, "%s}", print_buf);
g_ril_print_response(gril, message);
/* As a minimum we require a valid status string */
if (reply->reg_state.status == -1) {
ofono_error("%s: invalid status", __func__);
g_free(reply);
reply = NULL;
}
out:
parcel_free_str_array(str_arr);
return reply;
}
void g_ril_reply_free_sim_io(struct reply_sim_io *reply)
{
if (reply) {
g_free(reply->hex_response);
g_free(reply);
}
}
struct reply_sim_io *g_ril_reply_parse_sim_io(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
char *response = NULL;
struct reply_sim_io *reply;
/*
* Minimum length of SIM_IO_Response is 12:
* sw1 (int32)
* sw2 (int32)
* simResponse (string)
*/
if (message->buf_len < 12) {
ofono_error("Invalid SIM IO reply: size too small (< 12): %d ",
(int) message->buf_len);
return NULL;
}
reply = g_new0(struct reply_sim_io, 1);
g_ril_init_parcel(message, &rilp);
reply->sw1 = parcel_r_int32(&rilp);
reply->sw2 = parcel_r_int32(&rilp);
response = parcel_r_string(&rilp);
g_ril_append_print_buf(gril,
"(sw1=0x%.2X,sw2=0x%.2X,%s)",
reply->sw1,
reply->sw2,
response);
g_ril_print_response(gril, message);
if (rilp.malformed)
goto error;
if (response != NULL) {
reply->hex_response =
decode_hex(response, strlen(response),
(long *) &reply->hex_len, -1);
g_free(response);
if (reply->hex_response == NULL)
goto error;
}
return reply;
error:
g_free(reply);
return NULL;
}
gchar *g_ril_reply_parse_imsi(GRil *gril, const struct ril_msg *message)
{
struct parcel rilp;
gchar *imsi;
g_ril_init_parcel(message, &rilp);
imsi = parcel_r_string(&rilp);
g_ril_append_print_buf(gril, "{%s}", imsi ? imsi : "NULL");
g_ril_print_response(gril, message);
return imsi;
}
void g_ril_reply_free_sim_status(struct reply_sim_status *status)
{
if (status) {
guint i;
for (i = 0; i < status->num_apps; i++) {
if (status->apps[i] != NULL) {
g_free(status->apps[i]->aid_str);
g_free(status->apps[i]->app_str);
g_free(status->apps[i]);
}
}
g_free(status);
}
}
struct reply_sim_status *g_ril_reply_parse_sim_status(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
unsigned int i;
struct reply_sim_status *status;
g_ril_append_print_buf(gril, "[%d,%04d]< %s",
g_ril_get_slot(gril), message->serial_no,
ril_request_id_to_string(message->req));
g_ril_init_parcel(message, &rilp);
status = g_new0(struct reply_sim_status, 1);
status->card_state = parcel_r_int32(&rilp);
/*
* NOTE:
*
* The global pin_status is used for multi-application
* UICC cards. For example, there are SIM cards that
* can be used in both GSM and CDMA phones. Instead
* of managed PINs for both applications, a global PIN
* is set instead. It's not clear at this point if
* such SIM cards are supported by ofono or RILD.
*/
status->pin_state = parcel_r_int32(&rilp);
status->gsm_umts_index = parcel_r_int32(&rilp);
status->cdma_index = parcel_r_int32(&rilp);
status->ims_index = parcel_r_int32(&rilp);
status->num_apps = parcel_r_int32(&rilp);
if (rilp.malformed)
goto error;
g_ril_append_print_buf(gril,
"(card_state=%d,universal_pin_state=%d,"
"gsm_umts_index=%d,cdma_index=%d,"
"ims_index=%d, ",
status->card_state,
status->pin_state,
status->gsm_umts_index,
status->cdma_index,
status->ims_index);
if (status->card_state != RIL_CARDSTATE_PRESENT)
goto done;
if (status->num_apps > MAX_UICC_APPS) {
ofono_error("SIM error; too many apps: %d", status->num_apps);
status->num_apps = MAX_UICC_APPS;
}
for (i = 0; i < status->num_apps; i++) {
struct reply_sim_app *app;
DBG("processing app[%d]", i);
status->apps[i] = g_try_new0(struct reply_sim_app, 1);
app = status->apps[i];
if (app == NULL) {
ofono_error("Can't allocate app_data");
goto error;
}
app->app_type = parcel_r_int32(&rilp);
app->app_state = parcel_r_int32(&rilp);
app->perso_substate = parcel_r_int32(&rilp);
/*
* TODO: we need a way to instruct parcel to skip
* a string, without allocating memory...
*/
/* application ID (AID) */
app->aid_str = parcel_r_string(&rilp);
/* application label */
app->app_str = parcel_r_string(&rilp);
app->pin_replaced = parcel_r_int32(&rilp);
app->pin1_state = parcel_r_int32(&rilp);
app->pin2_state = parcel_r_int32(&rilp);
g_ril_append_print_buf(gril,
"%s[app_type=%d,app_state=%d,"
"perso_substate=%d,aid_ptr=%s,"
"app_label_ptr=%s,pin1_replaced=%d,"
"pin1=%d,pin2=%d],",
print_buf,
app->app_type,
app->app_state,
app->perso_substate,
app->aid_str ? app->aid_str : "NULL",
app->app_str ? app->app_str : "NULL",
app->pin_replaced,
app->pin1_state,
app->pin2_state);
}
if (rilp.malformed)
goto error;
done:
g_ril_append_print_buf(gril, "%s}", print_buf);
g_ril_print_response(gril, message);
return status;
error:
g_ril_reply_free_sim_status(status);
return NULL;
}
struct ofono_phone_number *g_ril_reply_parse_get_smsc_address(
GRil *gril,
const struct ril_msg *message)
{
struct ofono_phone_number *sca;
struct parcel rilp;
char *number, *temp_buf;
sca = g_new0(struct ofono_phone_number, 1);
if (sca == NULL) {
ofono_error("%s Out of memory", __func__);
goto err_alloc;
}
g_ril_init_parcel(message, &rilp);
temp_buf = parcel_r_string(&rilp);
if (temp_buf == NULL) {
ofono_error("%s Cannot read SMSC address", __func__);
goto err_readsca;
}
/* RIL gives address in quotes */
number = strtok(temp_buf, "\"");
if (number == NULL || *number == '\0') {
ofono_error("%s Invalid SMSC address", __func__);
goto err_scaformat;
}
if (number[0] == '+') {
number = number + 1;
sca->type = OFONO_NUMBER_TYPE_INTERNATIONAL;
} else {
sca->type = OFONO_NUMBER_TYPE_UNKNOWN;
}
strncpy(sca->number, number, OFONO_MAX_PHONE_NUMBER_LENGTH);
sca->number[OFONO_MAX_PHONE_NUMBER_LENGTH] = '\0';
g_ril_append_print_buf(gril, "{type=%d,number=%s}",
sca->type, sca->number);
g_ril_print_response(gril, message);
g_free(temp_buf);
return sca;
err_scaformat:
g_free(temp_buf);
err_readsca:
g_free(sca);
err_alloc:
return NULL;
}
int g_ril_reply_parse_sms_response(GRil *gril, const struct ril_msg *message)
{
struct parcel rilp;
int error, mr;
char *ack_pdu;
/* Set up Parcel struct for proper parsing */
g_ril_init_parcel(message, &rilp);
/*
* TP-Message-Reference for GSM/
* BearerData MessageId for CDMA
*/
mr = parcel_r_int32(&rilp);
ack_pdu = parcel_r_string(&rilp);
error = parcel_r_int32(&rilp);
g_ril_append_print_buf(gril, "{%d,%s,%d}",
mr, ack_pdu, error);
g_ril_print_response(gril, message);
g_free(ack_pdu);
return mr;
}
static gint g_ril_call_compare(gconstpointer a, gconstpointer b)
{
const struct ofono_call *ca = a;
const struct ofono_call *cb = b;
if (ca->id < cb->id)
return -1;
if (ca->id > cb->id)
return 1;
return 0;
}
GSList *g_ril_reply_parse_get_calls(GRil *gril, const struct ril_msg *message)
{
struct ofono_call *call;
struct parcel rilp;
GSList *l = NULL;
int num, i;
gchar *number, *name;
g_ril_init_parcel(message, &rilp);
g_ril_append_print_buf(gril, "{");
/* maguro signals no calls with empty event data */
if (rilp.size < sizeof(int32_t))
goto no_calls;
/* Number of RIL_Call structs */
num = parcel_r_int32(&rilp);
for (i = 0; i < num; i++) {
call = g_try_new(struct ofono_call, 1);
if (call == NULL)
break;
ofono_call_init(call);
call->status = parcel_r_int32(&rilp);
call->id = parcel_r_int32(&rilp);
call->phone_number.type = parcel_r_int32(&rilp);
parcel_r_int32(&rilp); /* isMpty */
parcel_r_int32(&rilp); /* isMT */
parcel_r_int32(&rilp); /* als */
call->type = parcel_r_int32(&rilp); /* isVoice */
parcel_r_int32(&rilp); /* isVoicePrivacy */
number = parcel_r_string(&rilp);
if (number) {
strncpy(call->phone_number.number, number,
OFONO_MAX_PHONE_NUMBER_LENGTH);
g_free(number);
}
parcel_r_int32(&rilp); /* numberPresentation */
name = parcel_r_string(&rilp);
if (name) {
strncpy(call->name, name,
OFONO_MAX_CALLER_NAME_LENGTH);
g_free(name);
}
parcel_r_int32(&rilp); /* namePresentation */
parcel_r_int32(&rilp); /* uusInfo */
if (strlen(call->phone_number.number) > 0)
call->clip_validity = 0;
else
call->clip_validity = 2;
g_ril_append_print_buf(gril,
"%s [id=%d,status=%d,type=%d,"
"number=%s,name=%s]",
print_buf,
call->id, call->status, call->type,
call->phone_number.number, call->name);
l = g_slist_insert_sorted(l, call, g_ril_call_compare);
}
no_calls:
g_ril_append_print_buf(gril, "%s}", print_buf);
g_ril_print_response(gril, message);
return l;
}
enum ofono_disconnect_reason g_ril_reply_parse_call_fail_cause(
GRil *gril, const struct ril_msg *message)
{
enum ofono_disconnect_reason reason = OFONO_DISCONNECT_REASON_ERROR;
int last_cause = CALL_FAIL_ERROR_UNSPECIFIED;
struct parcel rilp;
g_ril_init_parcel(message, &rilp);
if (rilp.size < sizeof(int32_t))
ofono_error("%s: Parcel is too small", __func__);
else if (parcel_r_int32(&rilp) > 0)
last_cause = parcel_r_int32(&rilp);
if (last_cause == CALL_FAIL_NORMAL || last_cause == CALL_FAIL_BUSY)
reason = OFONO_DISCONNECT_REASON_REMOTE_HANGUP;
g_ril_append_print_buf(gril, "{%d}", last_cause);
g_ril_print_response(gril, message);
return reason;
}
int g_ril_reply_parse_get_mute(GRil *gril, const struct ril_msg *message)
{
struct parcel rilp;
int muted;
g_ril_init_parcel(message, &rilp);
/* skip length of int[] */
parcel_r_int32(&rilp);
muted = parcel_r_int32(&rilp);
g_ril_append_print_buf(gril, "{%d}", muted);
g_ril_print_response(gril, message);
return muted;
}
char *g_ril_reply_parse_baseband_version(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
char *version;
g_ril_init_parcel(message, &rilp);
version = parcel_r_string(&rilp);
g_ril_append_print_buf(gril, "{%s}", version);
g_ril_print_response(gril, message);
return version;
}
char *g_ril_reply_parse_get_imei(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
char *imei;
g_ril_init_parcel(message, &rilp);
imei = parcel_r_string(&rilp);
g_ril_append_print_buf(gril, "{%s}", imei);
g_ril_print_response(gril, message);
return imei;
}
int g_ril_reply_parse_query_call_waiting(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
int numint, enabled, cls;
g_ril_init_parcel(message, &rilp);
numint = parcel_r_int32(&rilp);
if (numint < 1) {
ofono_error("%s Wrong format", __func__);
goto error;
}
enabled = parcel_r_int32(&rilp);
if (enabled > 0)
cls = parcel_r_int32(&rilp);
else
cls = 0;
g_ril_append_print_buf(gril, "{%d,0x%x}", enabled, cls);
g_ril_print_response(gril, message);
return cls;
error:
return -1;
}
int g_ril_reply_parse_query_clip(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
int clip_status, numint;
g_ril_init_parcel(message, &rilp);
numint = parcel_r_int32(&rilp);
if (numint != 1) {
ofono_error("%s Wrong format", __func__);
goto error;
}
clip_status = parcel_r_int32(&rilp);
g_ril_append_print_buf(gril, "{%d}", clip_status);
g_ril_print_response(gril, message);
return clip_status;
error:
return -1;
}
void g_ril_reply_free_get_clir(struct reply_clir *rclir)
{
g_free(rclir);
}
struct reply_clir *g_ril_reply_parse_get_clir(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
struct reply_clir *rclir;
int numint;
rclir = g_try_malloc0(sizeof(*rclir));
if (rclir == NULL) {
ofono_error("%s Out of memory", __func__);
goto error;
}
g_ril_init_parcel(message, &rilp);
/* Length */
numint = parcel_r_int32(&rilp);
if (numint != 2) {
ofono_error("%s Wrong format", __func__);
goto error;
}
/* Set HideCallerId property from network */
rclir->status = parcel_r_int32(&rilp);
/* State of the CLIR supplementary service in the network */
rclir->provisioned = parcel_r_int32(&rilp);
g_ril_append_print_buf(gril, "{%d,%d}",
rclir->status, rclir->provisioned);
g_ril_print_response(gril, message);
return rclir;
error:
g_free(rclir);
return NULL;
}
struct ofono_call_forwarding_condition
*g_ril_reply_parse_query_call_fwd(GRil *gril,
const struct ril_msg *message,
unsigned int *list_size)
{
struct ofono_call_forwarding_condition *list;
struct parcel rilp;
unsigned int i;
if (list_size == NULL) {
ofono_error("%s: list_size is NULL!", __func__);
goto error;
}
g_ril_init_parcel(message, &rilp);
if (rilp.size < sizeof(int32_t)) {
ofono_error("%s: malformed parcel, can't read num params",
__func__);
goto error;
}
*list_size = parcel_r_int32(&rilp);
if (*list_size == 0) {
/* not really an error; handled in caller */
goto error;
}
list = g_try_new0(struct ofono_call_forwarding_condition, *list_size);
if (list == NULL) {
ofono_error("%s: Out of memory", __func__);
goto error;
}
g_ril_append_print_buf(gril, "{");
for (i = 0; i < *list_size; i++) {
char *str;
list[i].status = parcel_r_int32(&rilp);
parcel_r_int32(&rilp); /* skip reason */
list[i].cls = parcel_r_int32(&rilp);
list[i].phone_number.type = parcel_r_int32(&rilp);
str = parcel_r_string(&rilp);
if (str != NULL) {
strncpy(list[i].phone_number.number, str,
OFONO_MAX_PHONE_NUMBER_LENGTH);
g_free(str);
list[i].phone_number.number[
OFONO_MAX_PHONE_NUMBER_LENGTH] = '\0';
}
list[i].time = parcel_r_int32(&rilp);
if (rilp.malformed) {
ofono_error("%s: malformed parcel", __func__);
g_free(list);
goto error;
}
g_ril_append_print_buf(gril, "%s [%d,%d,%d,%s,%d]",
print_buf,
list[i].status,
list[i].cls,
list[i].phone_number.type,
list[i].phone_number.number,
list[i].time);
}
g_ril_append_print_buf(gril, "%s}", print_buf);
g_ril_print_response(gril, message);
return list;
error:
return NULL;
}
int g_ril_reply_parse_get_preferred_network_type(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
int numint, parcel_net_type, net_type;
g_ril_init_parcel(message, &rilp);
numint = parcel_r_int32(&rilp);
if (numint != 1) {
ofono_error("%s: Wrong format", __func__);
goto error;
}
parcel_net_type = parcel_r_int32(&rilp);
net_type = parcel_net_type;
/* Try to translate special MTK settings */
if (g_ril_vendor(gril) == OFONO_RIL_VENDOR_MTK) {
switch (net_type) {
/* 4G preferred */
case MTK_PREF_NET_TYPE_LTE_GSM_WCDMA:
case MTK_PREF_NET_TYPE_LTE_GSM_WCDMA_MMDC:
case MTK_PREF_NET_TYPE_LTE_GSM_TYPE:
case MTK_PREF_NET_TYPE_LTE_GSM_MMDC_TYPE:
net_type = PREF_NET_TYPE_LTE_GSM_WCDMA;
break;
/* 3G or 2G preferred over LTE */
case MTK_PREF_NET_TYPE_GSM_WCDMA_LTE:
case MTK_PREF_NET_TYPE_GSM_WCDMA_LTE_MMDC:
net_type = PREF_NET_TYPE_GSM_WCDMA;
break;
}
}
if (net_type < 0 || net_type > PREF_NET_TYPE_LTE_ONLY) {
ofono_error("%s: unknown network type", __func__);
goto error;
}
if (rilp.malformed) {
ofono_error("%s: malformed parcel", __func__);
goto error;
}
g_ril_append_print_buf(gril, "{%d}", parcel_net_type);
g_ril_print_response(gril, message);
return net_type;
error:
return -1;
}
int g_ril_reply_parse_query_facility_lock(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
int status, numint;
g_ril_init_parcel(message, &rilp);
/* infineon returns two integers */
numint = parcel_r_int32(&rilp);
if (numint < 1) {
ofono_error("%s: wrong format", __func__);
goto error;
}
status = parcel_r_int32(&rilp);
if (rilp.malformed) {
ofono_error("%s: malformed parcel", __func__);
goto error;
}
g_ril_append_print_buf(gril, "{%d}", status);
g_ril_print_response(gril, message);
return status;
error:
return -1;
}
int g_ril_reply_parse_set_facility_lock(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
int retries = -1, numint;
g_ril_init_parcel(message, &rilp);
/* mako reply has no payload for call barring */
if (parcel_data_avail(&rilp) == 0)
goto end;
numint = parcel_r_int32(&rilp);
if (numint != 1) {
ofono_error("%s: wrong format", __func__);
goto end;
}
retries = parcel_r_int32(&rilp);
if (rilp.malformed) {
ofono_error("%s: malformed parcel", __func__);
goto end;
}
end:
g_ril_append_print_buf(gril, "{%d}", retries);
g_ril_print_response(gril, message);
return retries;
}
int *g_ril_reply_parse_retries(GRil *gril, const struct ril_msg *message,
enum ofono_sim_password_type passwd_type)
{
struct parcel rilp;
int i, numint;
int *retries = g_try_malloc0(sizeof(int) * OFONO_SIM_PASSWORD_INVALID);
if (retries == NULL) {
ofono_error("%s: out of memory", __func__);
goto no_data;
}
for (i = 0; i < OFONO_SIM_PASSWORD_INVALID; ++i)
retries[i] = -1;
g_ril_init_parcel(message, &rilp);
/* maguro/infineon: no data is returned */
if (parcel_data_avail(&rilp) == 0)
goto no_data;
numint = parcel_r_int32(&rilp);
switch (g_ril_vendor(gril)) {
case OFONO_RIL_VENDOR_AOSP:
case OFONO_RIL_VENDOR_QCOM_MSIM:
/*
* The number of retries is valid only when a wrong password has
* been introduced in Nexus 4. TODO: check Nexus 5 behaviour.
*/
if (message->error == RIL_E_PASSWORD_INCORRECT)
retries[passwd_type] = parcel_r_int32(&rilp);
g_ril_append_print_buf(gril, "{%d}", retries[passwd_type]);
break;
case OFONO_RIL_VENDOR_MTK:
/*
* Some versions of MTK modem return just the retries for the
* password just entered while others return the retries for all
* passwords.
*/
if (numint == 1) {
retries[passwd_type] = parcel_r_int32(&rilp);
g_ril_append_print_buf(gril, "{%d}",
retries[passwd_type]);
} else if (numint == 4) {
retries[OFONO_SIM_PASSWORD_SIM_PIN] =
parcel_r_int32(&rilp);
retries[OFONO_SIM_PASSWORD_SIM_PIN2] =
parcel_r_int32(&rilp);
retries[OFONO_SIM_PASSWORD_SIM_PUK] =
parcel_r_int32(&rilp);
retries[OFONO_SIM_PASSWORD_SIM_PUK2] =
parcel_r_int32(&rilp);
g_ril_append_print_buf(gril,
"{pin %d, pin2 %d, puk %d, puk2 %d}",
retries[OFONO_SIM_PASSWORD_SIM_PIN],
retries[OFONO_SIM_PASSWORD_SIM_PIN2],
retries[OFONO_SIM_PASSWORD_SIM_PUK],
retries[OFONO_SIM_PASSWORD_SIM_PUK2]);
} else {
ofono_error("%s: wrong format", __func__);
goto no_data;
}
break;
case OFONO_RIL_VENDOR_INFINEON:
ofono_error("%s: infineon type should not arrive here",
__func__);
g_assert(FALSE);
break;
}
if (rilp.malformed) {
ofono_error("%s: malformed parcel", __func__);
goto no_data;
}
g_ril_print_response(gril, message);
return retries;
no_data:
g_free(retries);
return NULL;
}
void g_ril_reply_free_oem_hook(struct reply_oem_hook *oem_hook)
{
if (oem_hook) {
g_free(oem_hook->data);
g_free(oem_hook);
}
}
struct reply_oem_hook *g_ril_reply_oem_hook_raw(GRil *gril,
const struct ril_msg *message)
{
struct reply_oem_hook *reply = NULL;
struct parcel rilp;
reply = g_try_malloc0(sizeof(*reply));
if (reply == NULL) {
ofono_error("%s: out of memory", __func__);
goto end;
}
g_ril_init_parcel(message, &rilp);
reply->data = parcel_r_raw(&rilp, &(reply->length));
if (rilp.malformed) {
ofono_error("%s: malformed parcel", __func__);
g_ril_reply_free_oem_hook(reply);
reply = NULL;
goto end;
}
g_ril_append_print_buf(gril, "{%d", reply->length);
if (reply->data != NULL) {
char *hex_dump;
hex_dump = encode_hex(reply->data, reply->length, '\0');
g_ril_append_print_buf(gril, "%s,%s", print_buf, hex_dump);
g_free(hex_dump);
}
g_ril_append_print_buf(gril, "%s}", print_buf);
g_ril_print_response(gril, message);
end:
return reply;
}
struct parcel_str_array *g_ril_reply_oem_hook_strings(GRil *gril,
const struct ril_msg *message)
{
struct parcel rilp;
struct parcel_str_array *str_arr;
int i;
g_ril_init_parcel(message, &rilp);
str_arr = parcel_r_str_array(&rilp);
if (str_arr == NULL) {
ofono_error("%s: no strings", __func__);
goto out;
}
g_ril_append_print_buf(gril, "{");
for (i = 0; i < str_arr->num_str; ++i) {
if (i + 1 == str_arr->num_str)
g_ril_append_print_buf(gril, "%s%s}", print_buf,
str_arr->str[i]);
else
g_ril_append_print_buf(gril, "%s%s, ", print_buf,
str_arr->str[i]);
}
g_ril_print_response(gril, message);
out:
return str_arr;
}