Add Sim Toolkit atom
authorAndrzej Zaborowski <andrew.zaborowski@intel.com>
Fri, 9 Apr 2010 06:49:01 +0000 (08:49 +0200)
committerDenis Kenzior <denkenz@gmail.com>
Thu, 15 Apr 2010 21:49:40 +0000 (16:49 -0500)
- Add ofono_stk atom in stk.c
- Move envelope command from sim driver to stk driver

Makefile.am
drivers/atmodem/sim.c
include/sim.h
include/stk.h [new file with mode: 0644]
src/cbs.c
src/modem.c
src/ofono.h
src/sim.c
src/stk.c [new file with mode: 0644]

index 20dff39..0ebc559 100644 (file)
@@ -12,7 +12,7 @@ include_HEADERS = include/log.h include/plugin.h include/history.h \
                        include/netreg.h include/voicecall.h include/devinfo.h \
                        include/cbs.h include/call-volume.h \
                        include/gprs.h include/gprs-context.h \
-                       include/radio-settings.h
+                       include/radio-settings.h include/stk.h
 
 nodist_include_HEADERS = include/version.h
 
@@ -233,7 +233,7 @@ src_ofonod_SOURCES = $(gdbus_sources) $(builtin_sources) \
                        src/network.c src/voicecall.c src/ussd.c src/sms.c \
                        src/call-settings.c src/call-forwarding.c \
                        src/call-meter.c src/smsutil.h src/smsutil.c \
-                       src/ssn.c src/call-barring.c src/sim.c \
+                       src/ssn.c src/call-barring.c src/sim.c src/stk.c \
                        src/phonebook.c src/history.c src/message-waiting.c \
                        src/simutil.h src/simutil.c src/storage.h \
                        src/storage.c src/cbs.c src/watch.c src/call-volume.c \
index 89ddcc6..13e7459 100644 (file)
@@ -709,82 +709,6 @@ error:
        CALLBACK_WITH_FAILURE(cb, -1, data);
 }
 
-static void at_csim_envelope_cb(gboolean ok, GAtResult *result,
-               gpointer user_data)
-{
-       struct cb_data *cbd = user_data;
-       GAtResultIter iter;
-       ofono_sim_read_cb_t cb = cbd->cb;
-       struct ofono_error error;
-       const guint8 *response;
-       gint rlen, len;
-
-       decode_at_error(&error, g_at_result_final_response(result));
-
-       if (!ok)
-               goto error;
-
-       g_at_result_iter_init(&iter, result);
-
-       if (!g_at_result_iter_next(&iter, "+CSIM:"))
-               goto error;
-
-       if (!g_at_result_iter_next_number(&iter, &rlen))
-               goto error;
-
-       if (!g_at_result_iter_next_hexstring(&iter, &response, &len))
-               goto error;
-
-       if (rlen != len * 2 || len < 2 ||
-                       response[len - 2] != 0x90 || response[len - 1] != 0)
-               goto error;
-
-       DBG("csim_envelope_cb: %i", len);
-
-       cb(&error, response, len - 2, cbd->data);
-       return;
-
-error:
-       CALLBACK_WITH_FAILURE(cb, NULL, 0, cbd->data);
-}
-
-static void at_sim_envelope(struct ofono_sim *sim, int length,
-                               const guint8 *command,
-                               ofono_sim_read_cb_t cb, void *data)
-{
-       struct sim_data *sd = ofono_sim_get_data(sim);
-       struct cb_data *cbd = cb_data_new(cb, data);
-       char *buf = g_try_new(char, 64 + length * 2);
-       int len, ret;
-
-       if (!cbd || !buf)
-               goto error;
-
-       len = sprintf(buf, "AT+CSIM=%i,A0C20000%02hhX",
-                       10 + length * 2, length);
-
-       for (; length; length--)
-               len += sprintf(buf + len, "%02hhX", *command++);
-
-       ret = g_at_chat_send(sd->chat, buf, crsm_prefix,
-                               at_csim_envelope_cb, cbd, g_free);
-
-       g_free(buf);
-       buf = NULL;
-
-       if (ret > 0)
-               return;
-
-error:
-       if (buf)
-               g_free(buf);
-
-       if (cbd)
-               g_free(cbd);
-
-       CALLBACK_WITH_FAILURE(cb, NULL, 0, data);
-}
-
 static gboolean at_sim_register(gpointer user)
 {
        struct ofono_sim *sim = user;
@@ -840,7 +764,6 @@ static struct ofono_sim_driver driver = {
        .lock                   = at_pin_enable,
        .change_passwd          = at_change_passwd,
        .query_locked           = at_pin_query_enabled,
-       .envelope               = at_sim_envelope,
 };
 
 void at_sim_init()
index 2218564..36a99b9 100644 (file)
@@ -156,9 +156,6 @@ struct ofono_sim_driver {
        void (*query_locked)(struct ofono_sim *sim,
                        enum ofono_sim_password_type type,
                        ofono_sim_locked_cb_t cb, void *data);
-       void (*envelope)(struct ofono_sim *sim, int length,
-                               const guint8 *command,
-                               ofono_sim_read_cb_t cb, void *data);
 };
 
 int ofono_sim_driver_register(const struct ofono_sim_driver *d);
diff --git a/include/stk.h b/include/stk.h
new file mode 100644 (file)
index 0000000..dfae261
--- /dev/null
@@ -0,0 +1,71 @@
+/*
+ *
+ *  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
+ *
+ */
+
+#ifndef __OFONO_STK_H
+#define __OFONO_STK_H
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include <ofono/types.h>
+
+struct ofono_stk;
+
+typedef void (*ofono_stk_envelope_cb_t)(const struct ofono_error *error,
+               const unsigned char *rdata, int length, void *data);
+
+typedef void (*ofono_stk_generic_cb_t)(const struct ofono_error *error,
+               void *data);
+
+struct ofono_stk_driver {
+       const char *name;
+       int (*probe)(struct ofono_stk *stk, unsigned int vendor, void *data);
+       void (*remove)(struct ofono_stk *stk);
+       void (*envelope)(struct ofono_stk *stk, int length,
+                       const guint8 *command, ofono_stk_envelope_cb_t cb,
+                       void *data);
+       void (*terminal_response)(struct ofono_stk *stk, int length,
+                       const unsigned char *value, ofono_stk_generic_cb_t cb,
+                       void *data);
+};
+
+int ofono_stk_driver_register(const struct ofono_stk_driver *d);
+void ofono_stk_driver_unregister(const struct ofono_stk_driver *d);
+
+struct ofono_stk *ofono_stk_create(struct ofono_modem *modem,
+                                       unsigned int vendor,
+                                       const char *driver, void *data);
+
+void ofono_stk_register(struct ofono_stk *stk);
+void ofono_stk_remove(struct ofono_stk *stk);
+
+void ofono_stk_set_data(struct ofono_stk *stk, void *data);
+void *ofono_stk_get_data(struct ofono_stk *stk);
+
+void ofono_stk_proactive_command_notify(struct ofono_stk *stk,
+               int length, const guint8 *pdu);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* __OFONO_STK_H */
index 2fa33c1..ff343e3 100644 (file)
--- a/src/cbs.c
+++ b/src/cbs.c
@@ -57,6 +57,7 @@ struct ofono_cbs {
        GSList *topics;
        GSList *new_topics;
        struct ofono_sim *sim;
+       struct ofono_stk *stk;
        struct ofono_netreg *netreg;
        unsigned int netreg_watch;
        unsigned int location_watch;
@@ -195,7 +196,7 @@ void ofono_cbs_notify(struct ofono_cbs *cbs, const unsigned char *pdu,
        }
 
        if (cbs_topic_in_range(c.message_identifier, cbs->efcbmid_contents)) {
-               __ofono_cbs_sim_download(cbs->sim, pdu, pdu_len);
+               __ofono_cbs_sim_download(cbs->stk, pdu, pdu_len);
                return;
        }
 
@@ -590,6 +591,7 @@ static void cbs_unregister(struct ofono_atom *atom)
        }
 
        cbs->sim = NULL;
+       cbs->stk = NULL;
 
        if (cbs->reset_source) {
                g_source_remove(cbs->reset_source);
@@ -1027,6 +1029,7 @@ void ofono_cbs_register(struct ofono_cbs *cbs)
        struct ofono_modem *modem = __ofono_atom_get_modem(cbs->atom);
        const char *path = __ofono_atom_get_path(cbs->atom);
        struct ofono_atom *sim_atom;
+       struct ofono_atom *stk_atom;
        struct ofono_atom *netreg_atom;
 
        if (!g_dbus_register_interface(conn, path,
@@ -1050,6 +1053,11 @@ void ofono_cbs_register(struct ofono_cbs *cbs)
                        cbs_got_imsi(cbs);
        }
 
+       stk_atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_SIM);
+
+       if (stk_atom)
+               cbs->stk = __ofono_atom_get_data(stk_atom);
+
        cbs->netreg_watch = __ofono_modem_add_atom_watch(modem,
                                        OFONO_ATOM_TYPE_NETREG,
                                        netreg_watch, cbs, NULL);
index df74be3..7cdd9c4 100644 (file)
@@ -31,6 +31,7 @@
 #include <gdbus.h>
 
 #include "ofono.h"
+#include "sim.h"
 
 #include "common.h"
 
index ff67728..7b13cce 100644 (file)
@@ -114,6 +114,7 @@ enum ofono_atom_type {
        OFONO_ATOM_TYPE_GPRS = 16,
        OFONO_ATOM_TYPE_GPRS_CONTEXT = 17,
        OFONO_ATOM_TYPE_RADIO_SETTINGS = 18,
+       OFONO_ATOM_TYPE_STK = 19,
 };
 
 enum ofono_atom_watch_condition {
@@ -172,8 +173,9 @@ void __ofono_atom_free(struct ofono_atom *atom);
 #include <ofono/radio-settings.h>
 
 #include <ofono/sim.h>
+#include <ofono/stk.h>
 
-void __ofono_cbs_sim_download(struct ofono_sim *sim,
+void __ofono_cbs_sim_download(struct ofono_stk *stk,
                                const guint8 *pdu, int pdu_len);
 
 #include <ofono/ssn.h>
index bf285ee..47df9a2 100644 (file)
--- a/src/sim.c
+++ b/src/sim.c
@@ -42,7 +42,6 @@
 #include "smsutil.h"
 #include "simutil.h"
 #include "storage.h"
-#include "stkutil.h"
 
 #define SIM_CACHE_MODE 0600
 #define SIM_CACHE_PATH STORAGEDIR "/%s-%i/%04x"
@@ -1960,42 +1959,6 @@ static void sim_set_ready(struct ofono_sim *sim)
        }
 }
 
-static void sim_cb_download_cb(const struct ofono_error *error,
-                               const unsigned char *data, int len, void *user)
-{
-       if (error->type != OFONO_ERROR_TYPE_NO_ERROR) {
-               ofono_error("CellBroadcast download to UICC failed");
-               return;
-       }
-
-       DBG("CellBroadcast download to UICC reported no error");
-}
-
-void __ofono_cbs_sim_download(struct ofono_sim *sim,
-                               const guint8 *pdu, int pdu_len)
-{
-       guint8 tlv[pdu_len + 8];
-
-       if (sim->state != OFONO_SIM_STATE_READY)
-               return;
-
-       if (sim->driver->envelope == NULL)
-               return;
-
-       tlv[0] = STK_ENVELOPE_TYPE_CBS_PP_DOWNLOAD;
-       tlv[1] = 6 + pdu_len;
-       tlv[2] = 0x80 | STK_DATA_OBJECT_TYPE_DEVICE_IDENTITIES;
-       tlv[3] = 0x02; /* Device Identities length */
-       tlv[4] = STK_DEVICE_IDENTITY_TYPE_NETWORK;
-       tlv[5] = STK_DEVICE_IDENTITY_TYPE_UICC;
-       tlv[6] = 0x80 | STK_DATA_OBJECT_TYPE_CBS_PAGE;
-       tlv[7] = pdu_len;
-
-       memcpy(tlv + 8, pdu, pdu_len);
-
-       sim->driver->envelope(sim, pdu_len + 8, tlv, sim_cb_download_cb, sim);
-}
-
 int ofono_sim_driver_register(const struct ofono_sim_driver *d)
 {
        DBG("driver: %p, name: %s", d, d->name);
diff --git a/src/stk.c b/src/stk.c
new file mode 100644 (file)
index 0000000..74b6b34
--- /dev/null
+++ b/src/stk.c
@@ -0,0 +1,201 @@
+/*
+ *
+ *  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 <glib.h>
+#include <gdbus.h>
+#include <errno.h>
+
+#include "ofono.h"
+
+#include "smsutil.h"
+#include "stkutil.h"
+
+static GSList *g_drivers = NULL;
+
+struct ofono_stk {
+       const struct ofono_stk_driver *driver;
+       void *driver_data;
+       struct ofono_atom *atom;
+};
+
+static void stk_cb_download_cb(const struct ofono_error *error,
+                               const unsigned char *data, int len, void *user)
+{
+       if (error->type != OFONO_ERROR_TYPE_NO_ERROR) {
+               ofono_error("CellBroadcast download to UICC failed");
+               return;
+       }
+
+       DBG("CellBroadcast download to UICC reported no error");
+}
+
+void __ofono_cbs_sim_download(struct ofono_stk *stk,
+                               const guint8 *pdu, int pdu_len)
+{
+       guint8 tlv[pdu_len + 8];
+
+       if (stk == NULL)
+               return;
+
+       if (stk->driver->envelope == NULL)
+               return;
+
+       tlv[0] = STK_ENVELOPE_TYPE_CBS_PP_DOWNLOAD;
+       tlv[1] = 6 + pdu_len;
+       tlv[2] = 0x80 | STK_DATA_OBJECT_TYPE_DEVICE_IDENTITIES;
+       tlv[3] = 0x02; /* Device Identities length */
+       tlv[4] = STK_DEVICE_IDENTITY_TYPE_NETWORK;
+       tlv[5] = STK_DEVICE_IDENTITY_TYPE_UICC;
+       tlv[6] = 0x80 | STK_DATA_OBJECT_TYPE_CBS_PAGE;
+       tlv[7] = pdu_len;
+
+       memcpy(tlv + 8, pdu, pdu_len);
+
+       stk->driver->envelope(stk, pdu_len + 8, tlv, stk_cb_download_cb, stk);
+}
+
+void ofono_stk_proactive_command_notify(struct ofono_stk *stk,
+               int length, const guint8 *pdu)
+{
+       struct stk_command *cmd;
+       char *buf;
+       int i;
+
+       buf = g_try_new(char, length * 2 + 1);
+       for (i = 0; i < length; i ++)
+               sprintf(buf + i * 2, "%02hhx", pdu[i]);
+       DBG("Proactive command PDU: %s", buf);
+
+       cmd = stk_command_new_from_pdu(pdu, length);
+       if (!cmd) {
+               ofono_error("Can't parse proactive command: %s", buf);
+               g_free(buf);
+
+               /* TODO: return TERMINAL RESPONSE with permanent error */
+               return;
+       }
+
+       /* TODO: execute */
+
+       g_free(buf);
+       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)
+{
+}
+
+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)
+{
+       __ofono_atom_register(stk->atom, stk_unregister);
+}
+
+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;
+}