[PATCH 2/3] Support phonesim proactive command notification

[Yang Gu]

---
 drivers/atmodem/stk.c |   25 +++++++++++++++++++++++++
 1 files changed, 25 insertions(+), 0 deletions(-)

diff --git a/drivers/atmodem/stk.c b/drivers/atmodem/stk.c
index 1283cca..3850f15 100644
--- a/drivers/atmodem/stk.c
+++ b/drivers/atmodem/stk.c
@@ -39,9 +39,11 @@
 
 #include "atmodem.h"
 #include "stk.h"
+#include "vendor.h"
 
 struct stk_data {
        GAtChat *chat;
+       unsigned int vendor;
 };
 
 static const char *csim_prefix[] = { "+CSIM:", NULL };
@@ -262,10 +264,32 @@ error:
        CALLBACK_WITH_FAILURE(cb, data);
 }
 
+static void phonesim_tcmd_notify(GAtResult *result, gpointer user_data)
+{
+       struct ofono_stk *stk = user_data;
+       struct stk_data *data = ofono_stk_get_data(stk);
+       GAtResultIter iter;
+       int length;
+
+       g_at_result_iter_init(&iter, result);
+
+       if (!g_at_result_iter_next(&iter, "*TCMD:"))
+               return;
+
+       if (!g_at_result_iter_next_number(&iter, &length))
+               return;
+
+       at_sim_fetch_command(data->chat, stk, length);
+}
+
 static gboolean at_stk_register(gpointer user)
 {
        struct ofono_stk *stk = user;
+       struct stk_data *sd = ofono_stk_get_data(stk);
 
+       if (sd->vendor == OFONO_VENDOR_PHONESIM)
+               g_at_chat_register(sd->chat, "*TCMD", phonesim_tcmd_notify,
+                                                       FALSE, stk, NULL);
        ofono_stk_register(stk);
 
        return FALSE;
@@ -278,6 +302,7 @@ static int at_stk_probe(struct ofono_stk *stk, unsigned int 
vendor, void *data)
 
        sd = g_new0(struct stk_data, 1);
        sd->chat = chat;
+       sd->vendor = vendor;
 
        ofono_stk_set_data(stk, sd);
        g_idle_add(at_stk_register, stk);
-- 
1.7.0.4

_______________________________________________
ofono mailing list
ofono@ofono.org
http://lists.ofono.org/listinfo/ofono