/* * * oFono - Open Source Telephony * * Copyright (C) 2008-2011 Intel Corporation. All rights reserved. * Copyright (C) 2013 Jolla Ltd * Copyright (C) 2013 Canonical Ltd * Contact: Jussi Kangas * * 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 #endif #define _GNU_SOURCE #include #include #include #include #include #include #include #include #include "common.h" #include "gril.h" #include "rilmodem.h" struct settings_data { GRil *ril; }; static void ril_set_cb(struct ril_msg *message, gpointer user_data) { struct cb_data *cbd = user_data; struct ofono_call_settings *cs = cbd->user; struct settings_data *sd = ofono_call_settings_get_data(cs); ofono_call_settings_set_cb_t cb = cbd->cb; if (message->error == RIL_E_SUCCESS) { g_ril_print_response_no_args(sd->ril, message); CALLBACK_WITH_SUCCESS(cb, cbd->data); } else { CALLBACK_WITH_FAILURE(cb, cbd->data); } } static void ril_cw_set(struct ofono_call_settings *cs, int mode, int cls, ofono_call_settings_set_cb_t cb, void *data) { struct settings_data *sd = ofono_call_settings_get_data(cs); struct cb_data *cbd = cb_data_new(cb, data, cs); int ret; struct parcel rilp; /* * Modem seems to respond with error to all queries * or settings made with bearer class * BEARER_CLASS_DEFAULT. Design decision: If given * class is BEARER_CLASS_DEFAULT let's map it to * SERVICE_CLASS_VOICE effectively making it the * default bearer. */ if (cls == BEARER_CLASS_DEFAULT) cls = BEARER_CLASS_VOICE; parcel_init(&rilp); parcel_w_int32(&rilp, 2); /* Number of params */ parcel_w_int32(&rilp, mode); /* on/off */ parcel_w_int32(&rilp, cls); /* Service class */ g_ril_append_print_buf(sd->ril, "(%d, 0x%x)", mode, cls); ret = g_ril_send(sd->ril, RIL_REQUEST_SET_CALL_WAITING, &rilp, ril_set_cb, cbd, g_free); /* In case of error free cbd and return the cb with failure */ if (ret <= 0) { g_free(cbd); CALLBACK_WITH_FAILURE(cb, data); } } static void ril_cw_query_cb(struct ril_msg *message, gpointer user_data) { struct cb_data *cbd = user_data; struct ofono_call_settings *cs = cbd->user; struct settings_data *sd = ofono_call_settings_get_data(cs); ofono_call_settings_status_cb_t cb = cbd->cb; struct parcel rilp; int numparams; int enabled; int cls; if (message->error != RIL_E_SUCCESS) goto error; g_ril_init_parcel(message, &rilp); numparams = parcel_r_int32(&rilp); if (numparams < 1) goto error; enabled = parcel_r_int32(&rilp); if (enabled && numparams < 2) goto error; if (enabled > 0) cls = parcel_r_int32(&rilp); else cls = 0; g_ril_append_print_buf(sd->ril, "{%d,0x%x}", enabled, cls); g_ril_print_response(sd->ril, message); CALLBACK_WITH_SUCCESS(cb, cls, cbd->data); return; error: CALLBACK_WITH_FAILURE(cb, -1, cbd->data); } static void ril_cw_query(struct ofono_call_settings *cs, int cls, ofono_call_settings_status_cb_t cb, void *data) { struct settings_data *sd = ofono_call_settings_get_data(cs); struct cb_data *cbd = cb_data_new(cb, data, cs); int ret; struct parcel rilp; /* * RILD expects service class to be 0 as certain carriers can reject the * query with specific service class */ cls = 0; parcel_init(&rilp); parcel_w_int32(&rilp, 1); /* Number of params */ parcel_w_int32(&rilp, cls); /* Service Class */ g_ril_append_print_buf(sd->ril, "(0)"); ret = g_ril_send(sd->ril, RIL_REQUEST_QUERY_CALL_WAITING, &rilp, ril_cw_query_cb, cbd, g_free); /* In case of error free cbd and return the cb with failure */ if (ret <= 0) { g_free(cbd); CALLBACK_WITH_FAILURE(cb, -1, data); } } static void ril_clip_query_cb(struct ril_msg *message, gpointer user_data) { struct cb_data *cbd = user_data; struct ofono_call_settings *cs = cbd->user; struct settings_data *sd = ofono_call_settings_get_data(cs); ofono_call_settings_status_cb_t cb = cbd->cb; struct parcel rilp; int clip_status; if (message->error != RIL_E_SUCCESS) goto error; g_ril_init_parcel(message, &rilp); if (parcel_r_int32(&rilp) != 1) goto error; clip_status = parcel_r_int32(&rilp); g_ril_append_print_buf(sd->ril, "{%d}", clip_status); g_ril_print_response(sd->ril, message); CALLBACK_WITH_SUCCESS(cb, clip_status, cbd->data); return; error: CALLBACK_WITH_FAILURE(cb, -1, cbd->data); } static void ril_clip_query(struct ofono_call_settings *cs, ofono_call_settings_status_cb_t cb, void *data) { struct settings_data *sd = ofono_call_settings_get_data(cs); struct cb_data *cbd = cb_data_new(cb, data, cs); int ret; ret = g_ril_send(sd->ril, RIL_REQUEST_QUERY_CLIP, NULL, ril_clip_query_cb, cbd, g_free); /* In case of error free cbd and return the cb with failure */ if (ret <= 0) { g_free(cbd); CALLBACK_WITH_FAILURE(cb, -1, data); } } static void ril_clir_query_cb(struct ril_msg *message, gpointer user_data) { struct cb_data *cbd = user_data; struct ofono_call_settings *cs = cbd->user; struct settings_data *sd = ofono_call_settings_get_data(cs); ofono_call_settings_clir_cb_t cb = cbd->cb; struct parcel rilp; int override; int network; if (message->error != RIL_E_SUCCESS) { ofono_error("%s: Reply failure: %s", __func__, ril_error_to_string(message->error)); goto error; } g_ril_init_parcel(message, &rilp); if (parcel_r_int32(&rilp) != 2) goto error; override = parcel_r_int32(&rilp); network = parcel_r_int32(&rilp); g_ril_append_print_buf(sd->ril, "{%d,%d}", override, network); g_ril_print_response(sd->ril, message); CALLBACK_WITH_SUCCESS(cb, override, network, cbd->data); return; error: CALLBACK_WITH_FAILURE(cb, -1, -1, cbd->data); } static void ril_clir_query(struct ofono_call_settings *cs, ofono_call_settings_clir_cb_t cb, void *data) { struct settings_data *sd = ofono_call_settings_get_data(cs); struct cb_data *cbd = cb_data_new(cb, data, cs); int ret; ret = g_ril_send(sd->ril, RIL_REQUEST_GET_CLIR, NULL, ril_clir_query_cb, cbd, g_free); if (ret <= 0) { g_free(cbd); CALLBACK_WITH_FAILURE(cb, -1, -1, data); } } static void ril_clir_set(struct ofono_call_settings *cs, int mode, ofono_call_settings_set_cb_t cb, void *data) { struct settings_data *sd = ofono_call_settings_get_data(cs); struct cb_data *cbd = cb_data_new(cb, data, cs); struct parcel rilp; int ret; parcel_init(&rilp); parcel_w_int32(&rilp, 1); /* Number of params */ parcel_w_int32(&rilp, mode); g_ril_append_print_buf(sd->ril, "(%d)", mode); ret = g_ril_send(sd->ril, RIL_REQUEST_SET_CLIR, &rilp, ril_set_cb, cbd, g_free); if (ret <= 0) { g_free(cbd); CALLBACK_WITH_FAILURE(cb, data); } } static gboolean ril_delayed_register(gpointer user_data) { struct ofono_call_settings *cs = user_data; ofono_call_settings_register(cs); return FALSE; } static int ril_call_settings_probe(struct ofono_call_settings *cs, unsigned int vendor, void *user) { GRil *ril = user; struct settings_data *sd = g_new0(struct settings_data, 1); sd->ril = g_ril_clone(ril); ofono_call_settings_set_data(cs, sd); g_idle_add(ril_delayed_register, cs); return 0; } static void ril_call_settings_remove(struct ofono_call_settings *cs) { struct settings_data *sd = ofono_call_settings_get_data(cs); ofono_call_settings_set_data(cs, NULL); g_ril_unref(sd->ril); g_free(sd); } static struct ofono_call_settings_driver driver = { .name = RILMODEM, .probe = ril_call_settings_probe, .remove = ril_call_settings_remove, .clip_query = ril_clip_query, .cw_query = ril_cw_query, .cw_set = ril_cw_set, .clir_query = ril_clir_query, .clir_set = ril_clir_set /* * Not supported in RIL API * .colp_query = ril_colp_query, * .colr_query = ril_colr_query */ }; void ril_call_settings_init(void) { ofono_call_settings_driver_register(&driver); } void ril_call_settings_exit(void) { ofono_call_settings_driver_unregister(&driver); }