diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/cbs.c | 10 | ||||
| -rw-r--r-- | src/modem.c | 1 | ||||
| -rw-r--r-- | src/ofono.h | 4 | ||||
| -rw-r--r-- | src/sim.c | 37 | ||||
| -rw-r--r-- | src/stk.c | 201 |
5 files changed, 214 insertions, 39 deletions
@@ -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); diff --git a/src/modem.c b/src/modem.c index df74be31..7cdd9c4e 100644 --- a/src/modem.c +++ b/src/modem.c @@ -31,6 +31,7 @@ #include <gdbus.h> #include "ofono.h" +#include "sim.h" #include "common.h" diff --git a/src/ofono.h b/src/ofono.h index ff67728a..7b13ccee 100644 --- a/src/ofono.h +++ b/src/ofono.h @@ -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> @@ -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 index 00000000..74b6b347 --- /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; +} |