sysmocom
/
ofono
mirror of git://git.sysmocom.de/ofono
11
0
Fork 0
Code Issues Releases Activity
ofono/src/stk.c

2866 lines
68 KiB
C
Raw Blame History

/*
*
* oFono - Open Source Telephony
*
* Copyright (C) 2008-2010 Intel Corporation. All rights reserved.
*
* 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
#define _GNU_SOURCE
#include <string.h>
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <glib.h>
#include <gdbus.h>
#include <errno.h>
#include <time.h>
#include <sys/time.h>
#include "ofono.h"
#include "common.h"
#include "smsutil.h"
#include "stkutil.h"
#include "stkagent.h"
#include "util.h"
static GSList *g_drivers = NULL;
struct stk_timer {
time_t expiry;
time_t start;
};
struct ofono_stk {
const struct ofono_stk_driver *driver;
void *driver_data;
struct ofono_atom *atom;
struct stk_command *pending_cmd;
void (*cancel_cmd)(struct ofono_stk *stk);
GQueue *envelope_q;
DBusMessage *pending;
struct stk_timer timers[8];
guint timers_source;
int timeout;
int short_timeout;
struct stk_agent *session_agent;
struct stk_agent *default_agent;
struct stk_agent *current_agent; /* Always equals one of the above */
struct stk_menu *main_menu, *select_item_menu;
gboolean respond_on_exit;
ofono_bool_t immediate_response;
guint remove_agent_source;
struct extern_req *extern_req;
char *idle_mode_text;
struct stk_icon_id idle_mode_icon;
struct timeval get_inkey_start_ts;
int dtmf_id;
__ofono_sms_sim_download_cb_t sms_pp_cb;
void *sms_pp_userdata;
};
struct envelope_op {
uint8_t tlv[256];
unsigned int tlv_len;
int retries;
void (*cb)(struct ofono_stk *stk, gboolean ok,
const unsigned char *data, int length);
};
struct extern_req {
struct ofono_stk *stk;
gboolean cancelled;
};
#define ENVELOPE_RETRIES_DEFAULT 5
static void envelope_queue_run(struct ofono_stk *stk);
static void timers_update(struct ofono_stk *stk);
#define ADD_ERROR_RESULT(result, error, addn_info) \
result.type = error; \
result.additional_len = sizeof(addn_info); \
result.additional = addn_info; \
static int stk_respond(struct ofono_stk *stk, struct stk_response *rsp,
ofono_stk_generic_cb_t cb)
{
const guint8 *tlv;
unsigned int tlv_len;
DBG("");
if (stk->driver->terminal_response == NULL)
return -ENOSYS;
rsp->src = STK_DEVICE_IDENTITY_TYPE_TERMINAL;
rsp->dst = STK_DEVICE_IDENTITY_TYPE_UICC;
rsp->number = stk->pending_cmd->number;
rsp->type = stk->pending_cmd->type;
rsp->qualifier = stk->pending_cmd->qualifier;
tlv = stk_pdu_from_response(rsp, &tlv_len);
if (tlv == NULL)
return -EINVAL;
stk_command_free(stk->pending_cmd);
stk->pending_cmd = NULL;
stk->cancel_cmd = NULL;
stk->driver->terminal_response(stk, tlv_len, tlv, cb, stk);
return 0;
}
static void stk_command_cb(const struct ofono_error *error, void *data)
{
if (error->type != OFONO_ERROR_TYPE_NO_ERROR) {
ofono_error("TERMINAL RESPONSE to a UICC command failed");
return;
}
DBG("TERMINAL RESPONSE to a command reported no errors");
}
static void send_simple_response(struct ofono_stk *stk,
enum stk_result_type result)
{
struct stk_response rsp;
static struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
DBG("result %d", result);
memset(&rsp, 0, sizeof(rsp));
rsp.result.type = result;
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
}
static void envelope_cb(const struct ofono_error *error, const uint8_t *data,
int length, void *user_data)
{
struct ofono_stk *stk = user_data;
struct envelope_op *op = g_queue_peek_head(stk->envelope_q);
gboolean result = TRUE;
DBG("length %d", length);
if (op->retries > 0 && error->type == OFONO_ERROR_TYPE_SIM &&
error->error == 0x9300) {
op->retries--;
goto out;
}
if (error->type != OFONO_ERROR_TYPE_NO_ERROR)
result = FALSE;
g_queue_pop_head(stk->envelope_q);
if (op->cb)
op->cb(stk, result, data, length);
g_free(op);
out:
envelope_queue_run(stk);
}
static void envelope_queue_run(struct ofono_stk *stk)
{
if (g_queue_get_length(stk->envelope_q) > 0) {
struct envelope_op *op = g_queue_peek_head(stk->envelope_q);
stk->driver->envelope(stk, op->tlv_len, op->tlv,
envelope_cb, stk);
}
}
static int stk_send_envelope(struct ofono_stk *stk, struct stk_envelope *e,
void (*cb)(struct ofono_stk *stk, gboolean ok,
const uint8_t *data,
int length), int retries)
{
const uint8_t *tlv;
unsigned int tlv_len;
struct envelope_op *op;
DBG("");
if (stk->driver->envelope == NULL)
return -ENOSYS;
e->dst = STK_DEVICE_IDENTITY_TYPE_UICC;
tlv = stk_pdu_from_envelope(e, &tlv_len);
if (tlv == NULL)
return -EINVAL;
op = g_new0(struct envelope_op, 1);
op->cb = cb;
op->retries = retries;
memcpy(op->tlv, tlv, tlv_len);
op->tlv_len = tlv_len;
g_queue_push_tail(stk->envelope_q, op);
if (g_queue_get_length(stk->envelope_q) == 1)
envelope_queue_run(stk);
return 0;
}
static void stk_cbs_download_cb(struct ofono_stk *stk, gboolean ok,
const unsigned char *data, int len)
{
if (!ok) {
ofono_error("CellBroadcast download to UICC failed");
return;
}
if (len)
ofono_error("CellBroadcast download returned %i bytes of data",
len);
DBG("CellBroadcast download to UICC reported no error");
}
void __ofono_cbs_sim_download(struct ofono_stk *stk, const struct cbs *msg)
{
struct stk_envelope e;
int err;
DBG("");
memset(&e, 0, sizeof(e));
e.type = STK_ENVELOPE_TYPE_CBS_PP_DOWNLOAD;
e.src = STK_DEVICE_IDENTITY_TYPE_NETWORK;
memcpy(&e.cbs_pp_download.page, msg, sizeof(msg));
err = stk_send_envelope(stk, &e, stk_cbs_download_cb,
ENVELOPE_RETRIES_DEFAULT);
if (err)
stk_cbs_download_cb(stk, FALSE, NULL, -1);
}
static void stk_sms_download_cb(struct ofono_stk *stk, gboolean ok,
const unsigned char *data, int len)
{
DBG("SMS-PP download to UICC reported %s", ok ? "success" : "error");
if (stk->sms_pp_cb)
stk->sms_pp_cb(ok, data, len, stk->sms_pp_userdata);
}
int __ofono_sms_sim_download(struct ofono_stk *stk, const struct sms *msg,
__ofono_sms_sim_download_cb_t cb, void *data)
{
struct stk_envelope e;
if (msg->type != SMS_TYPE_DELIVER)
return -EINVAL;
DBG("");
memset(&e, 0, sizeof(e));
e.type = STK_ENVELOPE_TYPE_SMS_PP_DOWNLOAD;
e.src = STK_DEVICE_IDENTITY_TYPE_NETWORK;
e.sms_pp_download.address.number = (char *) msg->sc_addr.address;
e.sms_pp_download.address.ton_npi = msg->sc_addr.numbering_plan |
(msg->sc_addr.number_type << 4);
memcpy(&e.sms_pp_download.message, &msg->deliver, sizeof(msg->deliver));
stk->sms_pp_cb = cb;
stk->sms_pp_userdata = data;
return stk_send_envelope(stk, &e, stk_sms_download_cb,
ENVELOPE_RETRIES_DEFAULT);
}
static char *dbus_apply_text_attributes(const char *text,
const struct stk_text_attribute *attr)
{
uint16_t buf[256], *i = buf;
const uint8_t *j = attr->attributes;
const uint8_t *end = j + attr->len;
if (text == NULL)
return NULL;
if (attr->len & 3)
return NULL;
while (j < end)
*i++ = *j++;
return stk_text_to_html(text, buf, attr->len / 4);
}
static struct stk_menu *stk_menu_create(const char *title,
const struct stk_text_attribute *title_attr,
const struct stk_icon_id *icon, GSList *items,
const struct stk_item_text_attribute_list *item_attrs,
const struct stk_item_icon_id_list *item_icon_ids,
int default_id, gboolean soft_key, gboolean has_help)
{
unsigned int len = g_slist_length(items);
struct stk_menu *ret;
GSList *l;
int i;
struct stk_text_attribute attr;
DBG("");
if (item_attrs && item_attrs->len && item_attrs->len != len * 4)
return NULL;
if (item_icon_ids && item_icon_ids->len && item_icon_ids->len != len)
return NULL;
ret = g_try_new(struct stk_menu, 1);
if (ret == NULL)
return NULL;
ret->title = dbus_apply_text_attributes(title ? title : "",
title_attr);
if (ret->title == NULL)
ret->title = g_strdup(title ? title : "");
memcpy(&ret->icon, icon, sizeof(ret->icon));
ret->items = g_new0(struct stk_menu_item, len + 1);
ret->default_item = -1;
ret->soft_key = soft_key;
ret->has_help = has_help;
for (l = items, i = 0; l; l = l->next, i++) {
struct stk_item *item = l->data;
char *text;
ret->items[i].item_id = item->id;
text = NULL;
if (item_attrs && item_attrs->len) {
memcpy(attr.attributes, &item_attrs->list[i * 4], 4);
attr.len = 4;
text = dbus_apply_text_attributes(item->text, &attr);
}
if (text == NULL)
text = strdup(item->text);
ret->items[i].text = text;
if (item_icon_ids && item_icon_ids->len)
ret->items[i].icon_id = item_icon_ids->list[i];
if (item->id == default_id)
ret->default_item = i;
}
return ret;
}
static struct stk_menu *stk_menu_create_from_set_up_menu(
const struct stk_command *cmd)
{
gboolean soft_key = (cmd->qualifier & (1 << 0)) != 0;
gboolean has_help = (cmd->qualifier & (1 << 7)) != 0;
return stk_menu_create(cmd->setup_menu.alpha_id,
&cmd->setup_menu.text_attr,
&cmd->setup_menu.icon_id,
cmd->setup_menu.items,
&cmd->setup_menu.item_text_attr_list,
&cmd->setup_menu.item_icon_id_list,
0, soft_key, has_help);
}
static struct stk_menu *stk_menu_create_from_select_item(
const struct stk_command *cmd)
{
gboolean soft_key = (cmd->qualifier & (1 << 2)) != 0;
gboolean has_help = (cmd->qualifier & (1 << 7)) != 0;
return stk_menu_create(cmd->select_item.alpha_id,
&cmd->select_item.text_attr,
&cmd->select_item.icon_id,
cmd->select_item.items,
&cmd->select_item.item_text_attr_list,
&cmd->select_item.item_icon_id_list,
cmd->select_item.item_id, soft_key, has_help);
}
static void stk_menu_free(struct stk_menu *menu)
{
struct stk_menu_item *i;
for (i = menu->items; i->text; i++)
g_free(i->text);
g_free(menu->items);
g_free(menu->title);
g_free(menu);
}
static void emit_menu_changed(struct ofono_stk *stk)
{
static struct stk_menu_item end_item = {};
static struct stk_menu no_menu = {
.title = "",
.items = &end_item,
.has_help = FALSE,
.default_item = -1,
};
static char *name = "MainMenu";
DBusConnection *conn = ofono_dbus_get_connection();
const char *path = __ofono_atom_get_path(stk->atom);
struct stk_menu *menu = stk->main_menu ? stk->main_menu : &no_menu;
DBusMessage *signal;
DBusMessageIter iter;
ofono_dbus_signal_property_changed(conn, path,
OFONO_STK_INTERFACE,
"MainMenuTitle",
DBUS_TYPE_STRING, &menu->title);
ofono_dbus_signal_property_changed(conn, path,
OFONO_STK_INTERFACE,
"MainMenuIcon",
DBUS_TYPE_BYTE, &menu->icon.id);
signal = dbus_message_new_signal(path, OFONO_STK_INTERFACE,
"PropertyChanged");
if (signal == NULL) {
ofono_error("Unable to allocate new %s.PropertyChanged signal",
OFONO_SIM_APP_INTERFACE);
return;
}
dbus_message_iter_init_append(signal, &iter);
dbus_message_iter_append_basic(&iter, DBUS_TYPE_STRING, &name);
append_menu_items_variant(&iter, menu->items);
g_dbus_send_message(conn, signal);
}
static void stk_alpha_id_set(struct ofono_stk *stk,
const char *text, const struct stk_text_attribute *attr,
const struct stk_icon_id *icon)
{
char *alpha = dbus_apply_text_attributes(text, attr);
/*
* Currently, we are treating null data object(len = 0, no value part)
* and no alpha identifier cases equally. This may be changed once
* better idea is found out.
*/
if (alpha != NULL)
stk_agent_display_action_info(stk->current_agent, alpha, icon);
g_free(alpha);
}
static void stk_alpha_id_unset(struct ofono_stk *stk)
{
stk_agent_request_cancel(stk->current_agent);
}
static int duration_to_msecs(const struct stk_duration *duration)
{
int msecs = duration->interval;
switch (duration->unit) {
case STK_DURATION_TYPE_MINUTES:
msecs *= 60;
/* Fall through. */
case STK_DURATION_TYPE_SECONDS:
msecs *= 10;
/* Fall through. */
case STK_DURATION_TYPE_SECOND_TENTHS:
msecs *= 100;
}
return msecs;
}
static DBusMessage *stk_get_properties(DBusConnection *conn,
DBusMessage *msg, void *data)
{
struct ofono_stk *stk = data;
DBusMessage *reply;
DBusMessageIter iter;
DBusMessageIter dict;
DBusMessageIter entry;
const char *key = "MainMenu";
const char *str;
unsigned char icon;
reply = dbus_message_new_method_return(msg);
if (reply == NULL)
return NULL;
dbus_message_iter_init_append(reply, &iter);
dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY,
OFONO_PROPERTIES_ARRAY_SIGNATURE,
&dict);
str = stk->idle_mode_text;
ofono_dbus_dict_append(&dict, "IdleModeText", DBUS_TYPE_STRING, &str);
icon = stk->idle_mode_icon.id;
ofono_dbus_dict_append(&dict, "IdleModeIcon", DBUS_TYPE_BYTE, &icon);
str = stk->main_menu ? stk->main_menu->title : "";
ofono_dbus_dict_append(&dict, "MainMenuTitle", DBUS_TYPE_STRING, &str);
icon = stk->main_menu ? stk->main_menu->icon.id : 0;
ofono_dbus_dict_append(&dict, "MainMenuIcon", DBUS_TYPE_BYTE, &icon);
dbus_message_iter_open_container(&dict, DBUS_TYPE_DICT_ENTRY,
NULL, &entry);
dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &key);
append_menu_items_variant(&entry,
stk->main_menu ? stk->main_menu->items : NULL);
dbus_message_iter_close_container(&dict, &entry);
dbus_message_iter_close_container(&iter, &dict);
return reply;
}
static void stk_request_cancel(struct ofono_stk *stk)
{
if (stk->session_agent)
stk_agent_request_cancel(stk->session_agent);
if (stk->default_agent)
stk_agent_request_cancel(stk->default_agent);
}
static void default_agent_notify(gpointer user_data)
{
struct ofono_stk *stk = user_data;
if (stk->current_agent == stk->default_agent && stk->respond_on_exit) {
if (stk->pending_cmd)
stk->cancel_cmd(stk);
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
}
stk->default_agent = NULL;
stk->current_agent = stk->session_agent;
stk->respond_on_exit = FALSE;
}
static void session_agent_notify(gpointer user_data)
{
struct ofono_stk *stk = user_data;
DBG("Session Agent removed");
if (stk->current_agent == stk->session_agent && stk->respond_on_exit) {
if (stk->pending_cmd)
stk->cancel_cmd(stk);
DBG("Sending Terminate response for session agent");
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
}
stk->session_agent = NULL;
stk->current_agent = stk->default_agent;
stk->respond_on_exit = FALSE;
if (stk->remove_agent_source) {
g_source_remove(stk->remove_agent_source);
stk->remove_agent_source = 0;
}
}
static gboolean session_agent_remove_cb(gpointer user_data)
{
struct ofono_stk *stk = user_data;
stk->remove_agent_source = 0;
stk_agent_free(stk->session_agent);
return FALSE;
}
/* Safely remove the agent even inside a callback */
static void session_agent_remove(struct ofono_stk *stk)
{
if (!stk->remove_agent_source)
stk->remove_agent_source =
g_timeout_add(0, session_agent_remove_cb, stk);
}
static DBusMessage *stk_register_agent(DBusConnection *conn,
DBusMessage *msg, void *data)
{
struct ofono_stk *stk = data;
const char *agent_path;
if (stk->default_agent)
return __ofono_error_busy(msg);
if (dbus_message_get_args(msg, NULL,
DBUS_TYPE_OBJECT_PATH, &agent_path,
DBUS_TYPE_INVALID) == FALSE)
return __ofono_error_invalid_args(msg);
if (!__ofono_dbus_valid_object_path(agent_path))
return __ofono_error_invalid_format(msg);
stk->default_agent = stk_agent_new(agent_path,
dbus_message_get_sender(msg),
FALSE);
if (stk->default_agent == NULL)
return __ofono_error_failed(msg);
stk_agent_set_removed_notify(stk->default_agent,
default_agent_notify, stk);
if (stk->session_agent == NULL)
stk->current_agent = stk->default_agent;
return dbus_message_new_method_return(msg);
}
static DBusMessage *stk_unregister_agent(DBusConnection *conn,
DBusMessage *msg, void *data)
{
struct ofono_stk *stk = data;
const char *agent_path;
const char *agent_bus = dbus_message_get_sender(msg);
if (dbus_message_get_args(msg, NULL,
DBUS_TYPE_OBJECT_PATH, &agent_path,
DBUS_TYPE_INVALID) == FALSE)
return __ofono_error_invalid_args(msg);
if (stk->default_agent == NULL)
return __ofono_error_failed(msg);
if (!stk_agent_matches(stk->default_agent, agent_path, agent_bus))
return __ofono_error_failed(msg);
stk_agent_free(stk->default_agent);
return dbus_message_new_method_return(msg);
}
static void menu_selection_envelope_cb(struct ofono_stk *stk, gboolean ok,
const unsigned char *data, int len)
{
unsigned char selection;
const char *agent_path;
DBusMessage *reply;
DBG("");
if (!ok) {
ofono_error("Sending Menu Selection to UICC failed");
reply = __ofono_error_failed(stk->pending);
goto out;
}
if (len)
ofono_error("Menu Selection returned %i bytes of unwanted data",
len);
DBG("Menu Selection envelope submission gave no error");
dbus_message_get_args(stk->pending, NULL,
DBUS_TYPE_BYTE, &selection,
DBUS_TYPE_OBJECT_PATH, &agent_path,
DBUS_TYPE_INVALID);
stk->session_agent = stk_agent_new(agent_path,
dbus_message_get_sender(stk->pending),
TRUE);
if (stk->session_agent == NULL) {
reply = __ofono_error_failed(stk->pending);
goto out;
}
stk_agent_set_removed_notify(stk->session_agent,
session_agent_notify, stk);
stk->current_agent = stk->session_agent;
reply = dbus_message_new_method_return(stk->pending);
out:
__ofono_dbus_pending_reply(&stk->pending, reply);
}
static DBusMessage *stk_select_item(DBusConnection *conn,
DBusMessage *msg, void *data)
{
struct ofono_stk *stk = data;
const char *agent_path;
unsigned char selection, i;
struct stk_envelope e;
struct stk_menu *menu = stk->main_menu;
DBG("");
if (stk->pending || stk->session_agent)
return __ofono_error_busy(msg);
if (menu == NULL)
return __ofono_error_not_supported(msg);
if (dbus_message_get_args(msg, NULL,
DBUS_TYPE_BYTE, &selection,
DBUS_TYPE_OBJECT_PATH, &agent_path,
DBUS_TYPE_INVALID) == FALSE)
return __ofono_error_invalid_args(msg);
if (!__ofono_dbus_valid_object_path(agent_path))
return __ofono_error_invalid_format(msg);
for (i = 0; i < selection && menu->items[i].text; i++);
if (i != selection)
return __ofono_error_invalid_format(msg);
memset(&e, 0, sizeof(e));
e.type = STK_ENVELOPE_TYPE_MENU_SELECTION;
e.src = STK_DEVICE_IDENTITY_TYPE_KEYPAD,
e.menu_selection.item_id = menu->items[selection].item_id;
e.menu_selection.help_request = FALSE;
DBG("");
if (stk_send_envelope(stk, &e, menu_selection_envelope_cb, 0))
return __ofono_error_failed(msg);
stk->pending = dbus_message_ref(msg);
return NULL;
}
static GDBusMethodTable stk_methods[] = {
{ "GetProperties", "", "a{sv}",stk_get_properties },
{ "SelectItem", "yo", "", stk_select_item,
G_DBUS_METHOD_FLAG_ASYNC },
{ "RegisterAgent", "o", "", stk_register_agent },
{ "UnregisterAgent", "o", "", stk_unregister_agent },
{ }
};
static GDBusSignalTable stk_signals[] = {
{ "PropertyChanged", "sv" },
{ }
};
static gboolean handle_command_more_time(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
/* Do nothing */
return TRUE;
}
static void send_sms_cancel(struct ofono_stk *stk)
{
stk->extern_req->cancelled = TRUE;
stk_alpha_id_unset(stk);
}
static void send_sms_submit_cb(gboolean ok, void *data)
{
struct extern_req *req = data;
struct ofono_stk *stk = req->stk;
struct ofono_error failure = { .type = OFONO_ERROR_TYPE_FAILURE };
struct stk_response rsp;
DBG("SMS submission %s", ok ? "successful" : "failed");
if (req->cancelled) {
DBG("Received an SMS submitted callback after the "
"proactive command was cancelled");
return;
}
stk_alpha_id_unset(stk);
memset(&rsp, 0, sizeof(rsp));
if (ok == FALSE)
rsp.result.type = STK_RESULT_TYPE_NETWORK_UNAVAILABLE;
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&failure, stk);
}
static void extern_req_start(struct ofono_stk *stk)
{
stk->extern_req = g_new0(struct extern_req, 1);
stk->extern_req->stk = stk;
}
static gboolean handle_command_send_sms(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
struct ofono_modem *modem = __ofono_atom_get_modem(stk->atom);
struct ofono_atom *sms_atom;
struct ofono_sms *sms;
GSList msg_list;
struct ofono_uuid uuid;
sms_atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_SMS);
if (sms_atom == NULL || !__ofono_atom_get_registered(sms_atom)) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
sms = __ofono_atom_get_data(sms_atom);
extern_req_start(stk);
msg_list.data = (void *) &cmd->send_sms.gsm_sms;
msg_list.next = NULL;
if (__ofono_sms_txq_submit(sms, &msg_list, 0, &uuid, NULL, NULL) < 0) {
unsigned char no_cause_result[] = { 0x00 };
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
__ofono_sms_txq_set_submit_notify(sms, &uuid, send_sms_submit_cb,
stk->extern_req, g_free);
stk->cancel_cmd = send_sms_cancel;
stk_alpha_id_set(stk, cmd->send_sms.alpha_id, &cmd->send_sms.text_attr,
&cmd->send_sms.icon_id);
return FALSE;
}
/* Note: may be called from ofono_stk_proactive_command_handled_notify */
static gboolean handle_command_set_idle_text(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
DBusConnection *conn = ofono_dbus_get_connection();
const char *path = __ofono_atom_get_path(stk->atom);
char *idle_mode_text;
idle_mode_text = dbus_apply_text_attributes(
cmd->setup_idle_mode_text.text,
&cmd->setup_idle_mode_text.text_attr);
if (idle_mode_text == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
if (stk->idle_mode_text)
g_free(stk->idle_mode_text);
stk->idle_mode_text = idle_mode_text;
ofono_dbus_signal_property_changed(conn, path, OFONO_STK_INTERFACE,
"IdleModeText",
DBUS_TYPE_STRING,
&idle_mode_text);
if (stk->idle_mode_icon.id != cmd->setup_idle_mode_text.icon_id.id) {
memcpy(&stk->idle_mode_icon, &cmd->setup_idle_mode_text.icon_id,
sizeof(stk->idle_mode_icon));
ofono_dbus_signal_property_changed(conn, path,
OFONO_STK_INTERFACE,
"IdleModeIcon", DBUS_TYPE_BYTE,
&stk->idle_mode_icon.id);
}
return TRUE;
}
static void timer_expiration_cb(struct ofono_stk *stk, gboolean ok,
const unsigned char *data, int len)
{
if (!ok) {
ofono_error("Timer Expiration reporting failed");
return;
}
if (len)
ofono_error("Timer Expiration returned %i bytes of data",
len);
DBG("Timer Expiration reporting to UICC reported no error");
}
static gboolean timers_cb(gpointer user_data)
{
struct ofono_stk *stk = user_data;
stk->timers_source = 0;
timers_update(stk);
return FALSE;
}
static void timer_value_from_seconds(struct stk_timer_value *val, int seconds)
{
val->has_value = TRUE;
val->hour = seconds / 3600;
seconds -= val->hour * 3600;
val->minute = seconds / 60;
seconds -= val->minute * 60;
val->second = seconds;
}
static void timers_update(struct ofono_stk *stk)
{
time_t min = 0, now = time(NULL);
int i;
if (stk->timers_source) {
g_source_remove(stk->timers_source);
stk->timers_source = 0;
}
for (i = 0; i < 8; i++) {
if (!stk->timers[i].expiry)
continue;
if (stk->timers[i].expiry <= now) {
struct stk_envelope e;
int seconds = now - stk->timers[i].start;
stk->timers[i].expiry = 0;
memset(&e, 0, sizeof(e));
e.type = STK_ENVELOPE_TYPE_TIMER_EXPIRATION;
e.src = STK_DEVICE_IDENTITY_TYPE_TERMINAL,
e.timer_expiration.id = i + 1;
timer_value_from_seconds(&e.timer_expiration.value,
seconds);
/*
* TODO: resubmit until success, providing current
* time difference every time we re-send.
*/
if (stk_send_envelope(stk, &e, timer_expiration_cb, 0))
timer_expiration_cb(stk, FALSE, NULL, -1);
continue;
}
if (stk->timers[i].expiry < now + min || min == 0)
min = stk->timers[i].expiry - now;
}
if (min)
stk->timers_source = g_timeout_add_seconds(min, timers_cb, stk);
}
static gboolean handle_command_timer_mgmt(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
int op = cmd->qualifier & 3;
time_t seconds, now = time(NULL);
struct stk_timer *tmr;
if (cmd->timer_mgmt.timer_id < 1 || cmd->timer_mgmt.timer_id > 8) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
tmr = &stk->timers[cmd->timer_mgmt.timer_id - 1];
switch (op) {
case 0: /* Start */
seconds = cmd->timer_mgmt.timer_value.second +
cmd->timer_mgmt.timer_value.minute * 60 +
cmd->timer_mgmt.timer_value.hour * 3600;
tmr->expiry = now + seconds;
tmr->start = now;
timers_update(stk);
break;
case 1: /* Deactivate */
if (!tmr->expiry) {
rsp->result.type = STK_RESULT_TYPE_TIMER_CONFLICT;
return TRUE;
}
seconds = MAX(0, tmr->expiry - now);
tmr->expiry = 0;
timers_update(stk);
timer_value_from_seconds(&rsp->timer_mgmt.value, seconds);
break;
case 2: /* Get current value */
if (!tmr->expiry) {
rsp->result.type = STK_RESULT_TYPE_TIMER_CONFLICT;
return TRUE;
}
seconds = MAX(0, tmr->expiry - now);
timer_value_from_seconds(&rsp->timer_mgmt.value, seconds);
break;
default:
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
rsp->timer_mgmt.id = cmd->timer_mgmt.timer_id;
return TRUE;
}
static gboolean handle_command_poll_interval(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
struct ofono_modem *modem = __ofono_atom_get_modem(stk->atom);
int seconds;
if (!cmd->poll_interval.duration.interval) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
seconds = MAX(duration_to_msecs(&cmd->poll_interval.duration) / 1000,
1);
ofono_modem_set_integer(modem, "status-poll-interval", seconds);
if (seconds > 255) {
rsp->poll_interval.max_interval.unit =
STK_DURATION_TYPE_MINUTES;
rsp->poll_interval.max_interval.interval = seconds / 60;
} else {
rsp->poll_interval.max_interval.unit =
STK_DURATION_TYPE_SECONDS;
rsp->poll_interval.max_interval.interval = seconds;
}
return TRUE;
}
/* Note: may be called from ofono_stk_proactive_command_handled_notify */
static gboolean handle_command_set_up_menu(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
struct stk_menu *menu = NULL;
if (cmd->setup_menu.items) {
menu = stk_menu_create_from_set_up_menu(cmd);
if (menu == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
}
if (menu == NULL && stk->main_menu == NULL)
return TRUE;
if (stk->main_menu)
stk_menu_free(stk->main_menu);
stk->main_menu = menu;
emit_menu_changed(stk);
return TRUE;
}
static void request_selection_destroy(void *user_data)
{
struct ofono_stk *stk = user_data;
stk_menu_free(stk->select_item_menu);
stk->select_item_menu = NULL;
}
static void request_selection_cb(enum stk_agent_result result, uint8_t id,
void *user_data)
{
struct ofono_stk *stk = user_data;
stk->respond_on_exit = FALSE;
switch (result) {
case STK_AGENT_RESULT_OK:
{
static struct ofono_error error =
{ .type = OFONO_ERROR_TYPE_FAILURE };
struct stk_response rsp;
memset(&rsp, 0, sizeof(rsp));
rsp.result.type = STK_RESULT_TYPE_SUCCESS;
rsp.select_item.item_id = id;
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
break;
}
case STK_AGENT_RESULT_BACK:
send_simple_response(stk, STK_RESULT_TYPE_GO_BACK);
break;
case STK_AGENT_RESULT_TIMEOUT:
send_simple_response(stk, STK_RESULT_TYPE_NO_RESPONSE);
break;
case STK_AGENT_RESULT_TERMINATE:
default:
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
break;
}
}
static gboolean handle_command_select_item(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
stk->select_item_menu = stk_menu_create_from_select_item(cmd);
if (stk->select_item_menu == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
/* We most likely got an out of memory error, tell SIM to retry */
if (stk_agent_request_selection(stk->current_agent,
stk->select_item_menu,
request_selection_cb, stk,
request_selection_destroy,
stk->timeout * 1000) < 0) {
unsigned char no_cause_result[] = { 0x00 };
request_selection_destroy(stk);
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
stk->cancel_cmd = stk_request_cancel;
stk->respond_on_exit = TRUE;
return FALSE;
}
static void display_text_destroy(void *user_data)
{
struct ofono_stk *stk = user_data;
stk->immediate_response = FALSE;
}
static void display_text_cb(enum stk_agent_result result, void *user_data)
{
struct ofono_stk *stk = user_data;
gboolean confirm;
struct stk_response rsp;
static unsigned char screen_busy_result[] = { 0x01 };
static struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
stk->respond_on_exit = FALSE;
/*
* There are four possible paths for DisplayText with immediate
* response flag set:
* 1. Agent drops off the bus. In that case regular removal
* semantics apply and the agent is removed.
*
* 2. A new SIM command arrives. In this case the agent is
* canceled and a new command is processed. This function is
* not called in this case.
*
* 3. The session is ended by the SIM. This case is ignored,
* and will result in either case 1, 2 or 4 occurring.
*
* 4. Agent reports an error or success. This function is called
* with the result.
*
* NOTE: If the agent reports a TERMINATE result, the agent will
* be removed. Since the response has been already sent, there
* is no way to signal the end of session to the SIM. Hence
* it is assumed that immediate response flagged commands will
* only occur at the end of session.
*/
if (stk->immediate_response) {
if (stk->session_agent)
session_agent_remove(stk);
return;
}
switch (result) {
case STK_AGENT_RESULT_OK:
send_simple_response(stk, STK_RESULT_TYPE_SUCCESS);
break;
case STK_AGENT_RESULT_BACK:
send_simple_response(stk, STK_RESULT_TYPE_GO_BACK);
break;
case STK_AGENT_RESULT_TIMEOUT:
confirm = (stk->pending_cmd->qualifier & (1 << 7)) != 0;
send_simple_response(stk, confirm ?
STK_RESULT_TYPE_NO_RESPONSE : STK_RESULT_TYPE_SUCCESS);
break;
case STK_AGENT_RESULT_BUSY:
memset(&rsp, 0, sizeof(rsp));
ADD_ERROR_RESULT(rsp.result, STK_RESULT_TYPE_TERMINAL_BUSY,
screen_busy_result);
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
break;
case STK_AGENT_RESULT_TERMINATE:
default:
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
break;
}
}
static gboolean handle_command_display_text(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
int timeout = stk->short_timeout * 1000;
struct stk_command_display_text *dt = &stk->pending_cmd->display_text;
uint8_t qualifier = stk->pending_cmd->qualifier;
ofono_bool_t priority = (qualifier & (1 << 0)) != 0;
char *text = dbus_apply_text_attributes(dt->text, &dt->text_attr);
int err;
if (text == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
if (qualifier & (1 << 7))
timeout = stk->timeout * 1000;
if (dt->duration.interval)
timeout = duration_to_msecs(&dt->duration);
err = stk_agent_display_text(stk->current_agent, text, &dt->icon_id,
priority, display_text_cb, stk,
display_text_destroy, timeout);
g_free(text);
/* We most likely got an out of memory error, tell SIM to retry */
if (err < 0) {
unsigned char no_cause_result[] = { 0x00 };
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
if (cmd->display_text.immediate_response)
stk->immediate_response = TRUE;
DBG("Immediate Response: %d", stk->immediate_response);
if (stk->immediate_response == FALSE) {
stk->respond_on_exit = TRUE;
stk->cancel_cmd = stk_request_cancel;
}
return stk->immediate_response;
}
static void set_get_inkey_duration(struct stk_duration *duration,
struct timeval *start_ts)
{
struct timeval end_ts;
int interval;
gettimeofday(&end_ts, NULL);
interval = (end_ts.tv_usec + 1099999 - start_ts->tv_usec) / 100000;
interval += (end_ts.tv_sec - start_ts->tv_sec) * 10;
interval -= 10;
switch (duration->unit) {
case STK_DURATION_TYPE_MINUTES:
interval = (interval + 59) / 60;
case STK_DURATION_TYPE_SECONDS:
interval = (interval + 9) / 10;
case STK_DURATION_TYPE_SECOND_TENTHS:
break;
}
duration->interval = interval;
}
static void request_confirmation_cb(enum stk_agent_result result,
gboolean confirm,
void *user_data)
{
struct ofono_stk *stk = user_data;
static struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
struct stk_command_get_inkey *cmd = &stk->pending_cmd->get_inkey;
struct stk_response rsp;
stk->respond_on_exit = FALSE;
switch (result) {
case STK_AGENT_RESULT_OK:
memset(&rsp, 0, sizeof(rsp));
rsp.result.type = STK_RESULT_TYPE_SUCCESS;
rsp.get_inkey.text.text = confirm ? "" : NULL;
rsp.get_inkey.text.yesno = TRUE;
if (cmd->duration.interval) {
rsp.get_inkey.duration.unit = cmd->duration.unit;
set_get_inkey_duration(&rsp.get_inkey.duration,
&stk->get_inkey_start_ts);
}
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
break;
case STK_AGENT_RESULT_BACK:
send_simple_response(stk, STK_RESULT_TYPE_GO_BACK);
break;
case STK_AGENT_RESULT_TIMEOUT:
send_simple_response(stk, STK_RESULT_TYPE_NO_RESPONSE);
break;
case STK_AGENT_RESULT_TERMINATE:
default:
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
break;
}
}
static void request_key_cb(enum stk_agent_result result, char *string,
void *user_data)
{
struct ofono_stk *stk = user_data;
static struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
struct stk_command_get_inkey *cmd = &stk->pending_cmd->get_inkey;
struct stk_response rsp;
stk->respond_on_exit = FALSE;
switch (result) {
case STK_AGENT_RESULT_OK:
memset(&rsp, 0, sizeof(rsp));
rsp.result.type = STK_RESULT_TYPE_SUCCESS;
rsp.get_inkey.text.text = string;
if (cmd->duration.interval) {
rsp.get_inkey.duration.unit = cmd->duration.unit;
set_get_inkey_duration(&rsp.get_inkey.duration,
&stk->get_inkey_start_ts);
}
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
break;
case STK_AGENT_RESULT_BACK:
send_simple_response(stk, STK_RESULT_TYPE_GO_BACK);
break;
case STK_AGENT_RESULT_TIMEOUT:
send_simple_response(stk, STK_RESULT_TYPE_NO_RESPONSE);
break;
case STK_AGENT_RESULT_TERMINATE:
default:
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
break;
}
}
static gboolean handle_command_get_inkey(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
int timeout = stk->timeout * 1000;
const struct stk_command_get_inkey *gi = &cmd->get_inkey;
char *text = dbus_apply_text_attributes(gi->text, &gi->text_attr);
uint8_t qualifier = stk->pending_cmd->qualifier;
gboolean alphabet = (qualifier & (1 << 0)) != 0;
gboolean ucs2 = (qualifier & (1 << 1)) != 0;
gboolean yesno = (qualifier & (1 << 2)) != 0;
/*
* Note: immediate response and help parameter values are not
* provided by current api.
*/
int err;
if (text == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
if (gi->duration.interval)
timeout = duration_to_msecs(&gi->duration);
gettimeofday(&stk->get_inkey_start_ts, NULL);
if (yesno)
err = stk_agent_request_confirmation(stk->current_agent,
text, &gi->icon_id,
request_confirmation_cb,
stk, NULL, timeout);
else if (alphabet)
err = stk_agent_request_key(stk->current_agent, text,
&gi->icon_id, ucs2,
request_key_cb, stk, NULL,
timeout);
else
err = stk_agent_request_digit(stk->current_agent, text,
&gi->icon_id, request_key_cb,
stk, NULL, timeout);
g_free(text);
if (err < 0) {
unsigned char no_cause_result[] = { 0x00 };
/*
* We most likely got an out of memory error, tell SIM
* to retry
*/
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
stk->respond_on_exit = TRUE;
stk->cancel_cmd = stk_request_cancel;
return FALSE;
}
static void request_string_cb(enum stk_agent_result result, char *string,
void *user_data)
{
struct ofono_stk *stk = user_data;
static struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
uint8_t qualifier = stk->pending_cmd->qualifier;
gboolean packed = (qualifier & (1 << 3)) != 0;
struct stk_response rsp;
stk->respond_on_exit = FALSE;
switch (result) {
case STK_AGENT_RESULT_OK:
memset(&rsp, 0, sizeof(rsp));
rsp.result.type = STK_RESULT_TYPE_SUCCESS;
rsp.get_input.text.text = string;
rsp.get_input.text.packed = packed;
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
break;
case STK_AGENT_RESULT_BACK:
send_simple_response(stk, STK_RESULT_TYPE_GO_BACK);
break;
case STK_AGENT_RESULT_TIMEOUT:
send_simple_response(stk, STK_RESULT_TYPE_NO_RESPONSE);
break;
case STK_AGENT_RESULT_TERMINATE:
default:
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
break;
}
}
static gboolean handle_command_get_input(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
int timeout = stk->timeout * 1000;
const struct stk_command_get_input *gi = &cmd->get_input;
char *text = dbus_apply_text_attributes(gi->text, &gi->text_attr);
uint8_t qualifier = stk->pending_cmd->qualifier;
gboolean alphabet = (qualifier & (1 << 0)) != 0;
gboolean ucs2 = (qualifier & (1 << 1)) != 0;
gboolean hidden = (qualifier & (1 << 2)) != 0;
int err;
if (text == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
if (alphabet)
err = stk_agent_request_input(stk->current_agent, text,
&gi->icon_id, gi->default_text,
ucs2, gi->resp_len.min,
gi->resp_len.max, hidden,
request_string_cb,
stk, NULL, timeout);
else
err = stk_agent_request_digits(stk->current_agent, text,
&gi->icon_id, gi->default_text,
gi->resp_len.min,
gi->resp_len.max, hidden,
request_string_cb,
stk, NULL, timeout);
g_free(text);
if (err < 0) {
unsigned char no_cause_result[] = { 0x00 };
/*
* We most likely got an out of memory error, tell SIM
* to retry
*/
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
stk->respond_on_exit = TRUE;
stk->cancel_cmd = stk_request_cancel;
return FALSE;
}
static void call_setup_connected(struct ofono_call *call, void *data)
{
struct ofono_stk *stk = data;
struct stk_response rsp;
static struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
static unsigned char facility_rejected_result[] = { 0x9d };
if (call == NULL || call->status == CALL_STATUS_DISCONNECTED) {
memset(&rsp, 0, sizeof(rsp));
ADD_ERROR_RESULT(rsp.result,
STK_RESULT_TYPE_NETWORK_UNAVAILABLE,
facility_rejected_result);
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
return;
}
if (call->status == CALL_STATUS_ACTIVE)
send_simple_response(stk, STK_RESULT_TYPE_SUCCESS);
else
send_simple_response(stk, STK_RESULT_TYPE_USER_CANCEL);
}
static void call_setup_cancel(struct ofono_stk *stk)
{
struct ofono_voicecall *vc;
struct ofono_atom *vc_atom;
vc_atom = __ofono_modem_find_atom(__ofono_atom_get_modem(stk->atom),
OFONO_ATOM_TYPE_VOICECALL);
if (vc_atom == NULL)
return;
vc = __ofono_atom_get_data(vc_atom);
if (vc)
__ofono_voicecall_dial_cancel(vc);
}
static void confirm_call_cb(enum stk_agent_result result, gboolean confirm,
void *user_data)
{
struct ofono_stk *stk = user_data;
static struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
const struct stk_command_setup_call *sc = &stk->pending_cmd->setup_call;
uint8_t qualifier = stk->pending_cmd->qualifier;
static unsigned char busy_on_call_result[] = { 0x02 };
static unsigned char no_cause_result[] = { 0x00 };
char *alpha_id = NULL;
struct ofono_voicecall *vc = NULL;
struct ofono_atom *vc_atom;
struct stk_response rsp;
int err;
stk->respond_on_exit = FALSE;
switch (result) {
case STK_AGENT_RESULT_TIMEOUT:
confirm = FALSE;
/* Fall through */
case STK_AGENT_RESULT_OK:
if (confirm)
break;
send_simple_response(stk, STK_RESULT_TYPE_USER_REJECT);
return;
case STK_AGENT_RESULT_TERMINATE:
default:
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
return;
}
vc_atom = __ofono_modem_find_atom(__ofono_atom_get_modem(stk->atom),
OFONO_ATOM_TYPE_VOICECALL);
if (vc_atom)
vc = __ofono_atom_get_data(vc_atom);
if (vc == NULL) {
send_simple_response(stk, STK_RESULT_TYPE_NOT_CAPABLE);
return;
}
if (sc->alpha_id_call_setup) {
alpha_id = dbus_apply_text_attributes(sc->alpha_id_call_setup,
&sc->text_attr_call_setup);
if (alpha_id == NULL) {
send_simple_response(stk,
STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD);
return;
}
}
err = __ofono_voicecall_dial(vc, sc->addr.number, sc->addr.ton_npi,
alpha_id, sc->icon_id_call_setup.id,
qualifier >> 1, call_setup_connected,
stk);
g_free(alpha_id);
if (err >= 0) {
stk->cancel_cmd = call_setup_cancel;
return;
}
if (err == -EBUSY) {
memset(&rsp, 0, sizeof(rsp));
ADD_ERROR_RESULT(rsp.result, STK_RESULT_TYPE_TERMINAL_BUSY,
busy_on_call_result);
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
return;
}
if (err == -ENOSYS) {
send_simple_response(stk, STK_RESULT_TYPE_NOT_CAPABLE);
return;
}
memset(&rsp, 0, sizeof(rsp));
ADD_ERROR_RESULT(rsp.result, STK_RESULT_TYPE_NETWORK_UNAVAILABLE,
no_cause_result);
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&error, stk);
}
static gboolean handle_command_set_up_call(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
const struct stk_command_setup_call *sc = &cmd->setup_call;
uint8_t qualifier = cmd->qualifier;
static unsigned char busy_on_call_result[] = { 0x02 };
char *alpha_id = NULL;
struct ofono_voicecall *vc = NULL;
struct ofono_atom *vc_atom;
int err;
if (qualifier > 5) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
/*
* Passing called party subaddress and establishing non-speech
* calls are not supported.
*/
if (sc->ccp.len || sc->subaddr.len) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
vc_atom = __ofono_modem_find_atom(__ofono_atom_get_modem(stk->atom),
OFONO_ATOM_TYPE_VOICECALL);
if (vc_atom)
vc = __ofono_atom_get_data(vc_atom);
if (vc == NULL) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
if (__ofono_voicecall_is_busy(vc, qualifier >> 1)) {
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
busy_on_call_result);
return TRUE;
}
alpha_id = dbus_apply_text_attributes(sc->alpha_id_usr_cfm ?
sc->alpha_id_usr_cfm : "",
&sc->text_attr_usr_cfm);
if (alpha_id == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
err = stk_agent_confirm_call(stk->current_agent, alpha_id,
&sc->icon_id_usr_cfm, confirm_call_cb,
stk, NULL, stk->timeout * 1000);
g_free(alpha_id);
if (err < 0) {
unsigned char no_cause_result[] = { 0x00 };
/*
* We most likely got an out of memory error, tell SIM
* to retry
*/
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
stk->respond_on_exit = TRUE;
stk->cancel_cmd = stk_request_cancel;
return FALSE;
}
static void send_ussd_cancel(struct ofono_stk *stk)
{
struct ofono_ussd *ussd;
struct ofono_atom *atom;
atom = __ofono_modem_find_atom(__ofono_atom_get_modem(stk->atom),
OFONO_ATOM_TYPE_USSD);
if (atom == NULL)
return;
ussd = __ofono_atom_get_data(atom);
if (ussd)
__ofono_ussd_initiate_cancel(ussd);
stk_alpha_id_unset(stk);
}
static void send_ussd_callback(int error, int dcs, const unsigned char *msg,
int msg_len, void *userdata)
{
struct ofono_stk *stk = userdata;
struct ofono_error failure = { .type = OFONO_ERROR_TYPE_FAILURE };
struct stk_response rsp;
enum sms_charset charset;
unsigned char no_cause[] = { 0x00 };
stk_alpha_id_unset(stk);
memset(&rsp, 0, sizeof(rsp));
switch (error) {
case 0:
if (cbs_dcs_decode(dcs, NULL, NULL, &charset,
NULL, NULL, NULL)) {
if (charset == SMS_CHARSET_7BIT)
rsp.send_ussd.text.dcs = 0x00;
else if (charset == SMS_CHARSET_8BIT)
rsp.send_ussd.text.dcs = 0x04;
else if (charset == SMS_CHARSET_UCS2)
rsp.send_ussd.text.dcs = 0x08;
rsp.result.type = STK_RESULT_TYPE_SUCCESS;
rsp.send_ussd.text.text = msg;
rsp.send_ussd.text.len = msg_len;
rsp.send_ussd.text.has_text = TRUE;
} else
rsp.result.type = STK_RESULT_TYPE_USSD_RETURN_ERROR;
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&failure, stk);
break;
case -ECANCELED:
send_simple_response(stk,
STK_RESULT_TYPE_USSD_OR_SS_USER_TERMINATION);
break;
case -ETIMEDOUT:
send_simple_response(stk, STK_RESULT_TYPE_NETWORK_UNAVAILABLE);
break;
default:
ADD_ERROR_RESULT(rsp.result, STK_RESULT_TYPE_USSD_RETURN_ERROR,
no_cause);
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&failure, stk);
break;
}
}
static gboolean handle_command_send_ussd(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
struct ofono_modem *modem = __ofono_atom_get_modem(stk->atom);
static unsigned char busy_on_ss_result[] = { 0x03 };
static unsigned char busy_on_ussd_result[] = { 0x08 };
struct ofono_atom *atom;
struct ofono_ussd *ussd;
int err;
atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_CALL_FORWARDING);
if (atom && __ofono_atom_get_registered(atom)) {
struct ofono_call_forwarding *cf = __ofono_atom_get_data(atom);
if (__ofono_call_forwarding_is_busy(cf)) {
ADD_ERROR_RESULT(rsp->result,
STK_RESULT_TYPE_TERMINAL_BUSY,
busy_on_ss_result);
return TRUE;
}
}
atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_CALL_BARRING);
if (atom && __ofono_atom_get_registered(atom)) {
struct ofono_call_barring *cb = __ofono_atom_get_data(atom);
if (__ofono_call_barring_is_busy(cb)) {
ADD_ERROR_RESULT(rsp->result,
STK_RESULT_TYPE_TERMINAL_BUSY,
busy_on_ss_result);
return TRUE;
}
}
atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_CALL_SETTINGS);
if (atom && __ofono_atom_get_registered(atom)) {
struct ofono_call_settings *cs = __ofono_atom_get_data(atom);
if (__ofono_call_settings_is_busy(cs)) {
ADD_ERROR_RESULT(rsp->result,
STK_RESULT_TYPE_TERMINAL_BUSY,
busy_on_ss_result);
return TRUE;
}
}
atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_USSD);
if (atom == NULL || !__ofono_atom_get_registered(atom)) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
ussd = __ofono_atom_get_data(atom);
if (__ofono_ussd_is_busy(ussd)) {
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
busy_on_ussd_result);
return TRUE;
}
err = __ofono_ussd_initiate(ussd, cmd->send_ussd.ussd_string.dcs,
cmd->send_ussd.ussd_string.string,
cmd->send_ussd.ussd_string.len,
send_ussd_callback, stk);
if (err >= 0) {
stk->cancel_cmd = send_ussd_cancel;
return FALSE;
}
if (err == -ENOSYS) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
if (err == -EBUSY) {
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
busy_on_ussd_result);
return TRUE;
}
stk_alpha_id_set(stk, cmd->send_ussd.alpha_id,
&cmd->send_ussd.text_attr,
&cmd->send_ussd.icon_id);
return FALSE;
}
static gboolean handle_command_refresh(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
GSList *l;
DBG("");
switch (cmd->qualifier) {
case 0:
DBG("NAA Initialization and "
"Full File Change Notification");
break;
case 1:
DBG("File Change Notification");
break;
case 2:
DBG("NAA Initialization and File Change Notification");
break;
case 3:
DBG("NAA Initialization");
break;
case 4:
DBG("UICC Reset");
break;
case 5:
DBG("NAA Application Reset");
break;
case 6:
DBG("NAA Session Reset");
break;
default:
ofono_info("Undefined Refresh qualifier: %d", cmd->qualifier);
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
DBG("Files:");
for (l = cmd->refresh.file_list; l; l = l->next) {
struct stk_file *file = l->data;
char buf[17];
encode_hex_own_buf(file->file, file->len, 0, buf);
DBG("%s", buf);
}
DBG("Icon: %d, qualifier: %d", cmd->refresh.icon_id.id,
cmd->refresh.icon_id.qualifier);
DBG("Alpha ID: %s", cmd->refresh.alpha_id);
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
static void get_time(struct stk_response *rsp)
{
time_t now;
struct tm *t;
time(&now);
t = localtime(&now);
rsp->result.type = STK_RESULT_TYPE_SUCCESS;
if (t->tm_year > 100)
rsp->provide_local_info.datetime.year = t->tm_year - 100;
else
rsp->provide_local_info.datetime.year = t->tm_year;
rsp->provide_local_info.datetime.month = t->tm_mon + 1;
rsp->provide_local_info.datetime.day = t->tm_mday;
rsp->provide_local_info.datetime.hour = t->tm_hour;
rsp->provide_local_info.datetime.minute = t->tm_min;
rsp->provide_local_info.datetime.second = t->tm_sec;
rsp->provide_local_info.datetime.timezone = t->tm_gmtoff / 900;
rsp->provide_local_info.datetime.has_timezone = TRUE;
return;
}
static void get_lang(struct stk_response *rsp, struct ofono_stk *stk)
{
char *l;
char lang[3];
struct ofono_error failure = { .type = OFONO_ERROR_TYPE_FAILURE };
l = getenv("LANG");
if (l == NULL) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
goto out;
}
memcpy(lang, l, 2);
lang[2] = '\0';
rsp->result.type = STK_RESULT_TYPE_SUCCESS;
rsp->provide_local_info.language = lang;
out:
if (stk_respond(stk, rsp, stk_command_cb))
stk_command_cb(&failure, stk);
}
static gboolean handle_command_provide_local_info(const struct stk_command *cmd,
struct stk_response *rsp, struct ofono_stk *stk)
{
switch (cmd->qualifier) {
case 3:
DBG("Date, time and time zone");
get_time(rsp);
return TRUE;
case 4:
DBG("Language setting");
get_lang(rsp, stk);
return FALSE;
default:
ofono_info("Unsupported Provide Local Info qualifier: %d",
cmd->qualifier);
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
}
static void send_dtmf_cancel(struct ofono_stk *stk)
{
struct ofono_voicecall *vc = NULL;
struct ofono_atom *vc_atom;
stk->respond_on_exit = FALSE;
vc_atom = __ofono_modem_find_atom(__ofono_atom_get_modem(stk->atom),
OFONO_ATOM_TYPE_VOICECALL);
if (vc_atom)
vc = __ofono_atom_get_data(vc_atom);
if (vc) /* Should be always true here */
__ofono_voicecall_tone_cancel(vc, stk->dtmf_id);
stk_alpha_id_unset(stk);
}
static void dtmf_sent_cb(int error, void *user_data)
{
struct ofono_stk *stk = user_data;
stk->respond_on_exit = FALSE;
stk_alpha_id_unset(stk);
if (error == ENOENT) {
struct stk_response rsp;
static unsigned char not_in_speech_call_result[] = { 0x07 };
static struct ofono_error failure =
{ .type = OFONO_ERROR_TYPE_FAILURE };
memset(&rsp, 0, sizeof(rsp));
ADD_ERROR_RESULT(rsp.result, STK_RESULT_TYPE_TERMINAL_BUSY,
not_in_speech_call_result);
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&failure, stk);
return;
}
if (error != 0)
send_simple_response(stk, STK_RESULT_TYPE_NOT_CAPABLE);
else
send_simple_response(stk, STK_RESULT_TYPE_SUCCESS);
}
static gboolean handle_command_send_dtmf(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
static unsigned char not_in_speech_call_result[] = { 0x07 };
struct ofono_voicecall *vc = NULL;
struct ofono_atom *vc_atom;
char dtmf[256], *digit;
char *dtmf_from = "01234567890abcABC";
char *dtmf_to = "01234567890*#p*#p";
int err, pos;
vc_atom = __ofono_modem_find_atom(__ofono_atom_get_modem(stk->atom),
OFONO_ATOM_TYPE_VOICECALL);
if (vc_atom)
vc = __ofono_atom_get_data(vc_atom);
if (vc == NULL) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
/* Convert the DTMF string to phone number format */
for (pos = 0; cmd->send_dtmf.dtmf[pos] != '\0'; pos++) {
digit = strchr(dtmf_from, cmd->send_dtmf.dtmf[pos]);
if (digit == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
dtmf[pos] = dtmf_to[digit - dtmf_from];
}
dtmf[pos] = '\0';
err = __ofono_voicecall_tone_send(vc, dtmf, dtmf_sent_cb, stk);
if (err == -ENOSYS) {
rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
return TRUE;
}
if (err == -ENOENT) {
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
not_in_speech_call_result);
return TRUE;
}
if (err == -EINVAL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
if (err < 0) {
unsigned char no_cause_result[] = { 0x00 };
/*
* We most likely got an out of memory error, tell SIM
* to retry
*/
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
stk_alpha_id_set(stk, cmd->send_dtmf.alpha_id,
&cmd->send_dtmf.text_attr,
&cmd->send_dtmf.icon_id);
/*
* Note that we don't strictly require an agent to be connected,
* but to comply with 6.4.24 we need to send a End Session when
* the user decides so.
*/
stk->respond_on_exit = TRUE;
stk->cancel_cmd = send_dtmf_cancel;
stk->dtmf_id = err;
return FALSE;
}
static void play_tone_cb(enum stk_agent_result result, void *user_data)
{
struct ofono_stk *stk = user_data;
stk->respond_on_exit = FALSE;
switch (result) {
case STK_AGENT_RESULT_OK:
case STK_AGENT_RESULT_TIMEOUT:
send_simple_response(stk, STK_RESULT_TYPE_SUCCESS);
break;
default:
send_simple_response(stk, STK_RESULT_TYPE_USER_TERMINATED);
break;
}
}
static gboolean handle_command_play_tone(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
static int manufacturer_timeout = 10000; /* 10 seconds */
static const struct {
const char *name;
/* Continuous true/false according to 02.40 */
gboolean continuous;
} tone_infos[] = {
/* Default */
[0x00] = { "general-beep", FALSE },
/* Standard */
[0x01] = { "dial-tone", TRUE },
[0x02] = { "busy", TRUE },
[0x03] = { "congestion", TRUE },
[0x04] = { "radio-path-acknowledge", FALSE },
[0x05] = { "radio-path-not-available", FALSE },
[0x06] = { "error", TRUE },
[0x07] = { "call-waiting", FALSE },
[0x08] = { "ringing-tone", TRUE },
/* Proprietary */
[0x10] = { "general-beep", FALSE },
[0x11] = { "positive-acknowledgement", FALSE },
[0x12] = { "negative-acknowledgement", FALSE },
[0x13] = { "user-ringing-tone", TRUE },
[0x14] = { "user-sms-alert", FALSE },
[0x15] = { "critical", FALSE },
[0x20] = { "vibrate", TRUE },
/* Themed */
[0x30] = { "happy", FALSE },
[0x31] = { "sad", FALSE },
[0x32] = { "urgent-action", FALSE },
[0x33] = { "question", FALSE },
[0x34] = { "message-received", FALSE },
/* Melody */
[0x40] = { "melody-1", FALSE },
[0x41] = { "melody-2", FALSE },
[0x42] = { "melody-3", FALSE },
[0x43] = { "melody-4", FALSE },
[0x44] = { "melody-5", FALSE },
[0x45] = { "melody-6", FALSE },
[0x46] = { "melody-7", FALSE },
[0x47] = { "melody-8", FALSE },
};
const struct stk_command_play_tone *pt = &cmd->play_tone;
uint8_t qualifier = stk->pending_cmd->qualifier;
gboolean vibrate = (qualifier & (1 << 0)) != 0;
char *text;
int timeout;
int err;
if (pt->tone > sizeof(tone_infos) / sizeof(*tone_infos) ||
tone_infos[pt->tone].name == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
text = dbus_apply_text_attributes(pt->alpha_id ? pt->alpha_id : "",
&pt->text_attr);
if (text == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
if (pt->duration.interval)
timeout = duration_to_msecs(&pt->duration);
else
timeout = manufacturer_timeout;
if (!tone_infos[pt->tone].continuous)
/* Duration ignored */
err = stk_agent_play_tone(stk->current_agent, text,
&pt->icon_id, vibrate,
tone_infos[pt->tone].name,
play_tone_cb, stk, NULL,
stk->timeout * 1000);
else
err = stk_agent_loop_tone(stk->current_agent, text,
&pt->icon_id, vibrate,
tone_infos[pt->tone].name,
play_tone_cb, stk, NULL,
timeout);
g_free(text);
if (err < 0) {
unsigned char no_cause_result[] = { 0x00 };
/*
* We most likely got an out of memory error, tell SIM
* to retry
*/
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
stk->respond_on_exit = TRUE;
stk->cancel_cmd = stk_request_cancel;
return FALSE;
}
static void confirm_launch_browser_cb(enum stk_agent_result result,
gboolean confirm,
void *user_data)
{
struct ofono_stk *stk = user_data;
unsigned char no_cause[] = { 0x00 };
struct ofono_error failure = { .type = OFONO_ERROR_TYPE_FAILURE };
struct stk_response rsp;
stk->respond_on_exit = FALSE;
switch (result) {
case STK_AGENT_RESULT_TIMEOUT:
confirm = FALSE;
/* Fall through */
case STK_AGENT_RESULT_OK:
if (confirm)
break;
/* Fall through */
default:
memset(&rsp, 0, sizeof(rsp));
ADD_ERROR_RESULT(rsp.result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause);
if (stk_respond(stk, &rsp, stk_command_cb))
stk_command_cb(&failure, stk);
return;
}
send_simple_response(stk, STK_RESULT_TYPE_SUCCESS);
}
static gboolean handle_command_launch_browser(const struct stk_command *cmd,
struct stk_response *rsp,
struct ofono_stk *stk)
{
const struct stk_command_launch_browser *lb = &cmd->launch_browser;
char *alpha_id;
int err;
alpha_id = dbus_apply_text_attributes(lb->alpha_id ? lb->alpha_id : "",
&lb->text_attr);
if (alpha_id == NULL) {
rsp->result.type = STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD;
return TRUE;
}
err = stk_agent_confirm_launch_browser(stk->current_agent, alpha_id,
lb->icon_id.id, lb->url,
confirm_launch_browser_cb,
stk, NULL, stk->timeout * 1000);
g_free(alpha_id);
if (err < 0) {
unsigned char no_cause_result[] = { 0x00 };
/*
* We most likely got an out of memory error, tell SIM
* to retry
*/
ADD_ERROR_RESULT(rsp->result, STK_RESULT_TYPE_TERMINAL_BUSY,
no_cause_result);
return TRUE;
}
stk->respond_on_exit = TRUE;
stk->cancel_cmd = stk_request_cancel;
return FALSE;
}
static void stk_proactive_command_cancel(struct ofono_stk *stk)
{
if (stk->immediate_response)
stk_request_cancel(stk);
if (stk->pending_cmd) {
stk->cancel_cmd(stk);
stk_command_free(stk->pending_cmd);
stk->pending_cmd = NULL;
stk->cancel_cmd = NULL;
}
}
void ofono_stk_proactive_session_end_notify(struct ofono_stk *stk)
{
/* Wait until we receive the next command */
if (stk->immediate_response)
return;
stk_proactive_command_cancel(stk);
if (stk->session_agent)
stk_agent_free(stk->session_agent);
}
void ofono_stk_proactive_command_notify(struct ofono_stk *stk,
int length, const unsigned char *pdu)
{
struct ofono_error error = { .type = OFONO_ERROR_TYPE_FAILURE };
struct stk_response rsp;
int err;
gboolean respond = TRUE;
/*
* Depending on the hardware we may have received a new
* command before we managed to send a TERMINAL RESPONSE to
* the previous one. 3GPP says in the current revision only
* one command can be executing at any time, so assume that
* the previous one is being cancelled and the card just
* expects a response to the new one.
*/
stk_proactive_command_cancel(stk);
stk->pending_cmd = stk_command_new_from_pdu(pdu, length);
if (stk->pending_cmd == NULL) {
ofono_error("Can't parse proactive command");
/*
* Nothing we can do, we'd need at least Command Details
* to be able to respond with an error.
*/
return;
}
switch (stk->pending_cmd->status) {
case STK_PARSE_RESULT_OK:
break;
case STK_PARSE_RESULT_MISSING_VALUE:
send_simple_response(stk, STK_RESULT_TYPE_MINIMUM_NOT_MET);
return;
case STK_PARSE_RESULT_DATA_NOT_UNDERSTOOD:
send_simple_response(stk, STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD);
return;
case STK_PARSE_RESULT_TYPE_NOT_UNDERSTOOD:
default:
send_simple_response(stk,
STK_RESULT_TYPE_COMMAND_NOT_UNDERSTOOD);
return;
}
/*
* In case no agent is registered, we should reject commands destined
* to the Agent with a NOT_CAPABLE error.
*/
if (stk->current_agent == NULL) {
switch (stk->pending_cmd->type) {
case STK_COMMAND_TYPE_SELECT_ITEM:
case STK_COMMAND_TYPE_DISPLAY_TEXT:
case STK_COMMAND_TYPE_GET_INKEY:
case STK_COMMAND_TYPE_GET_INPUT:
case STK_COMMAND_TYPE_PLAY_TONE:
case STK_COMMAND_TYPE_SETUP_CALL:
send_simple_response(stk, STK_RESULT_TYPE_NOT_CAPABLE);
return;
default:
break;
}
}
memset(&rsp, 0, sizeof(rsp));
switch (stk->pending_cmd->type) {
case STK_COMMAND_TYPE_MORE_TIME:
respond = handle_command_more_time(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_SEND_SMS:
respond = handle_command_send_sms(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_SETUP_IDLE_MODE_TEXT:
respond = handle_command_set_idle_text(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_TIMER_MANAGEMENT:
respond = handle_command_timer_mgmt(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_POLL_INTERVAL:
respond = handle_command_poll_interval(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_SETUP_MENU:
respond = handle_command_set_up_menu(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_SELECT_ITEM:
respond = handle_command_select_item(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_DISPLAY_TEXT:
respond = handle_command_display_text(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_GET_INKEY:
respond = handle_command_get_inkey(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_GET_INPUT:
respond = handle_command_get_input(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_SETUP_CALL:
respond = handle_command_set_up_call(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_SEND_USSD:
respond = handle_command_send_ussd(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_LANGUAGE_NOTIFICATION:
/*
* If any clients are interested, then the ISO639
* 2-letter codes has to be convered to language strings.
* Converted language strings has to be added to the
* property list.
*/
ofono_info("Language Code: %s",
stk->pending_cmd->language_notification.language);
break;
case STK_COMMAND_TYPE_REFRESH:
respond = handle_command_refresh(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_PROVIDE_LOCAL_INFO:
respond = handle_command_provide_local_info(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_SEND_DTMF:
respond = handle_command_send_dtmf(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_PLAY_TONE:
respond = handle_command_play_tone(stk->pending_cmd,
&rsp, stk);
break;
case STK_COMMAND_TYPE_LAUNCH_BROWSER:
respond = handle_command_launch_browser(stk->pending_cmd,
&rsp, stk);
break;
default:
rsp.result.type = STK_RESULT_TYPE_COMMAND_NOT_UNDERSTOOD;
break;
}
if (respond == FALSE)
return;
err = stk_respond(stk, &rsp, stk_command_cb);
if (err)
stk_command_cb(&error, stk);
}
void ofono_stk_proactive_command_handled_notify(struct ofono_stk *stk,
int length,
const unsigned char *pdu)
{
struct stk_command *cmd;
struct stk_response dummyrsp;
/*
* Modems send us the proactive command details and terminal responses
* sent by the modem as a response to the command. Terminal responses
* start with the Command Details CTLV tag (0x81). We filter terminal
* responses here
*/
if (length > 0 && pdu[0] == 0x81) {
stk_alpha_id_unset(stk);
return;
}
stk_proactive_command_cancel(stk);
cmd = stk_command_new_from_pdu(pdu, length);
if (cmd == NULL || cmd->status != STK_PARSE_RESULT_OK) {
ofono_error("Can't parse proactive command");
if (cmd)
stk_command_free(cmd);
return;
}
DBG("type: %d", cmd->type);
switch (cmd->type) {
case STK_COMMAND_TYPE_MORE_TIME:
break;
case STK_COMMAND_TYPE_SEND_SMS:
stk_alpha_id_set(stk, cmd->send_sms.alpha_id,
&cmd->send_sms.text_attr,
&cmd->send_sms.icon_id);
break;
case STK_COMMAND_TYPE_SETUP_IDLE_MODE_TEXT:
handle_command_set_idle_text(cmd, &dummyrsp, stk);
break;
case STK_COMMAND_TYPE_SETUP_MENU:
handle_command_set_up_menu(cmd, &dummyrsp, stk);
break;
case STK_COMMAND_TYPE_SETUP_CALL:
/* TODO */
break;
case STK_COMMAND_TYPE_SEND_USSD:
stk_alpha_id_set(stk, cmd->send_ussd.alpha_id,
&cmd->send_ussd.text_attr,
&cmd->send_ussd.icon_id);
break;
case STK_COMMAND_TYPE_SEND_SS:
stk_alpha_id_set(stk, cmd->send_ss.alpha_id,
&cmd->send_ss.text_attr,
&cmd->send_ss.icon_id);
case STK_COMMAND_TYPE_SEND_DTMF:
stk_alpha_id_set(stk, cmd->send_dtmf.alpha_id,
&cmd->send_dtmf.text_attr,
&cmd->send_dtmf.icon_id);
break;
}
stk_command_free(cmd);
}
int ofono_stk_driver_register(const struct ofono_stk_driver *d)
{
DBG("driver: %p, name: %s", d, d->name);
if (d->probe == NULL)
return -EINVAL;
g_drivers = g_slist_prepend(g_drivers, (void *) d);
return 0;
}
void ofono_stk_driver_unregister(const struct ofono_stk_driver *d)
{
DBG("driver: %p, name: %s", d, d->name);
g_drivers = g_slist_remove(g_drivers, (void *) d);
}
static void stk_unregister(struct ofono_atom *atom)
{
struct ofono_stk *stk = __ofono_atom_get_data(atom);
DBusConnection *conn = ofono_dbus_get_connection();
struct ofono_modem *modem = __ofono_atom_get_modem(atom);
const char *path = __ofono_atom_get_path(atom);
if (stk->session_agent)
stk_agent_free(stk->session_agent);
if (stk->default_agent)
stk_agent_free(stk->default_agent);
if (stk->pending_cmd) {
stk_command_free(stk->pending_cmd);
stk->pending_cmd = NULL;
stk->cancel_cmd = NULL;
}
g_free(stk->idle_mode_text);
stk->idle_mode_text = NULL;
if (stk->timers_source) {
g_source_remove(stk->timers_source);
stk->timers_source = 0;
}
if (stk->main_menu) {
stk_menu_free(stk->main_menu);
stk->main_menu = NULL;
}
g_queue_foreach(stk->envelope_q, (GFunc) g_free, NULL);
g_queue_free(stk->envelope_q);
ofono_modem_remove_interface(modem, OFONO_STK_INTERFACE);
g_dbus_unregister_interface(conn, path, OFONO_STK_INTERFACE);
}
static void stk_remove(struct ofono_atom *atom)
{
struct ofono_stk *stk = __ofono_atom_get_data(atom);
DBG("atom: %p", atom);
if (stk == NULL)
return;
if (stk->driver && stk->driver->remove)
stk->driver->remove(stk);
g_free(stk);
}
struct ofono_stk *ofono_stk_create(struct ofono_modem *modem,
unsigned int vendor,
const char *driver,
void *data)
{
struct ofono_stk *stk;
GSList *l;
if (driver == NULL)
return NULL;
stk = g_try_new0(struct ofono_stk, 1);
if (stk == NULL)
return NULL;
stk->atom = __ofono_modem_add_atom(modem, OFONO_ATOM_TYPE_STK,
stk_remove, stk);
for (l = g_drivers; l; l = l->next) {
const struct ofono_stk_driver *drv = l->data;
if (g_strcmp0(drv->name, driver))
continue;
if (drv->probe(stk, vendor, data) < 0)
continue;
stk->driver = drv;
break;
}
return stk;
}
void ofono_stk_register(struct ofono_stk *stk)
{
DBusConnection *conn = ofono_dbus_get_connection();
struct ofono_modem *modem = __ofono_atom_get_modem(stk->atom);
const char *path = __ofono_atom_get_path(stk->atom);
if (!g_dbus_register_interface(conn, path, OFONO_STK_INTERFACE,
stk_methods, stk_signals, NULL,
stk, NULL)) {
ofono_error("Could not create %s interface",
OFONO_STK_INTERFACE);
return;
}
ofono_modem_add_interface(modem, OFONO_STK_INTERFACE);
__ofono_atom_register(stk->atom, stk_unregister);
stk->timeout = 180; /* 3 minutes */
stk->short_timeout = 20; /* 20 seconds */
stk->envelope_q = g_queue_new();
}
void ofono_stk_remove(struct ofono_stk *stk)
{
__ofono_atom_free(stk->atom);
}
void ofono_stk_set_data(struct ofono_stk *stk, void *data)
{
stk->driver_data = data;
}
void *ofono_stk_get_data(struct ofono_stk *stk)
{
return stk->driver_data;
}
Reference in New Issue View Git Blame Copy Permalink