Populate gemalto_data structure.
Add sim_state callbacks.
Fix enable/disable return value.
---
plugins/gemalto.c | 89 +++++++++++++++++++++++++++++++++++++++++++++++++------
1 file changed, 80 insertions(+), 9 deletions(-)
diff --git a/plugins/gemalto.c b/plugins/gemalto.c
index ab0da8f..5473d2f 100644
--- a/plugins/gemalto.c
+++ b/plugins/gemalto.c
@@ -46,10 +46,14 @@
#include <drivers/atmodem/atutil.h>
#include <drivers/atmodem/vendor.h>
+static const char *none_prefix[] = { NULL };
struct gemalto_data {
GAtChat *app;
GAtChat *mdm;
+ struct ofono_sim *sim;
+ gboolean have_sim;
+ struct at_util_sim_state_query *sim_state_query;
};
static int gemalto_probe(struct ofono_modem *modem)
@@ -57,9 +61,12 @@ static int gemalto_probe(struct ofono_modem *modem)
struct gemalto_data *data;
data = g_try_new0(struct gemalto_data, 1);
+
if (data == NULL)
return -ENOMEM;
+ data->sim = NULL;
+
ofono_modem_set_data(modem, data);
return 0;
@@ -69,6 +76,8 @@ static void gemalto_remove(struct ofono_modem *modem)
{
struct gemalto_data *data = ofono_modem_get_data(modem);
+ /* Cleanup potential SIM state polling */
+ at_util_sim_state_query_free(data->sim_state_query);
ofono_modem_set_data(modem, NULL);
g_free(data);
}
@@ -89,6 +98,7 @@ static GAtChat *open_device(const char *device)
DBG("Opening device %s", device);
channel = g_at_tty_open(device, NULL);
+
if (channel == NULL)
return NULL;
@@ -103,6 +113,39 @@ static GAtChat *open_device(const char *device)
return chat;
}
+static void sim_state_cb(gboolean present, gpointer user_data)
+{
+ struct ofono_modem *modem = user_data;
+ struct gemalto_data *data = ofono_modem_get_data(modem);
+
+ at_util_sim_state_query_free(data->sim_state_query);
+ data->sim_state_query = NULL;
+
+ data->have_sim = present;
+ ofono_modem_set_powered(modem, TRUE);
+}
+
+static void cfun_enable(gboolean ok, GAtResult *result, gpointer user_data)
+{
+ struct ofono_modem *modem = user_data;
+ struct gemalto_data *data = ofono_modem_get_data(modem);
+
+ if (!ok) {
+ g_at_chat_unref(data->app);
+ data->app = NULL;
+
+ g_at_chat_unref(data->mdm);
+ data->mdm = NULL;
+
+ ofono_modem_set_powered(modem, FALSE);
+ return;
+ }
+
+ data->sim_state_query = at_util_sim_state_query_new(data->app,
+ 2, 20, sim_state_cb, modem,
+ NULL);
+}
+
static int gemalto_enable(struct ofono_modem *modem)
{
struct gemalto_data *data = ofono_modem_get_data(modem);
@@ -118,10 +161,12 @@ static int gemalto_enable(struct ofono_modem *modem)
/* Open devices */
data->app = open_device(app);
+
if (data->app == NULL)
return -EINVAL;
data->mdm = open_device(mdm);
+
if (data->mdm == NULL) {
g_at_chat_unref(data->app);
data->app = NULL;
@@ -133,7 +178,32 @@ static int gemalto_enable(struct ofono_modem *modem)
g_at_chat_set_debug(data->mdm, gemalto_debug, "Mdm");
}
- return 0;
+ g_at_chat_send(data->mdm, "ATE0", none_prefix, NULL, NULL, NULL);
+ g_at_chat_send(data->app, "ATE0 +CMEE=1", none_prefix,
+ NULL, NULL, NULL);
+ g_at_chat_send(data->mdm, "AT&C0", none_prefix, NULL, NULL, NULL);
+ g_at_chat_send(data->app, "AT&C0", none_prefix, NULL, NULL, NULL);
+
+ g_at_chat_send(data->app, "AT+CFUN=4", none_prefix,
+ cfun_enable, modem, NULL);
+
+ return -EINPROGRESS;
+}
+
+static void gemalto_smso_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+ struct ofono_modem *modem = user_data;
+ struct gemalto_data *data = ofono_modem_get_data(modem);
+
+ DBG("");
+
+ g_at_chat_unref(data->mdm);
+ data->mdm = NULL;
+ g_at_chat_unref(data->app);
+ data->app = NULL;
+
+ if (ok)
+ ofono_modem_set_powered(modem, FALSE);
}
static int gemalto_disable(struct ofono_modem *modem)
@@ -142,11 +212,14 @@ static int gemalto_disable(struct ofono_modem *modem)
DBG("%p", modem);
- g_at_chat_send(data->app, "AT^SMSO", NULL, NULL, NULL, NULL);
+ g_at_chat_cancel_all(data->app);
+ g_at_chat_unregister_all(data->app);
- ofono_modem_set_data(modem, NULL);
+ /* Shutdown the modem */
+ g_at_chat_send(data->app, "AT^SMSO", none_prefix, gemalto_smso_cb,
+ modem, NULL);
- return 0;
+ return -EINPROGRESS;
}
static void set_online_cb(gboolean ok, GAtResult *result, gpointer user_data)
@@ -156,11 +229,10 @@ static void set_online_cb(gboolean ok, GAtResult *result,
gpointer user_data)
struct ofono_error error;
decode_at_error(&error, g_at_result_final_response(result));
-
cb(&error, cbd->data);
}
-static void gemalto_set_online(struct ofono_modem *modem, ofono_bool_t online,
+static void gemalto_set_online(struct ofono_modem *modem, gboolean online,
ofono_modem_online_cb_t cb, void *user_data)
{
struct gemalto_data *data = ofono_modem_get_data(modem);
@@ -173,7 +245,6 @@ static void gemalto_set_online(struct ofono_modem *modem,
ofono_bool_t online,
return;
CALLBACK_WITH_FAILURE(cb, cbd->data);
-
g_free(cbd);
}
@@ -185,10 +256,10 @@ static void gemalto_pre_sim(struct ofono_modem *modem)
DBG("%p", modem);
ofono_devinfo_create(modem, 0, "atmodem", data->app);
- sim = ofono_sim_create(modem, 0, "atmodem", data->app);
ofono_location_reporting_create(modem, 0, "gemaltomodem", data->app);
+ sim = ofono_sim_create(modem, 0, "atmodem", data->app);
- if (sim)
+ if (sim && data->have_sim == TRUE)
ofono_sim_inserted_notify(sim, TRUE);
}
--
1.9.1
_______________________________________________
ofono mailing list
[email protected]
https://lists.ofono.org/mailman/listinfo/ofono
