---
 drivers/mbmmodem/stk.c |   28 +++++++++++++++++++++++++---
 1 files changed, 25 insertions(+), 3 deletions(-)

diff --git a/drivers/mbmmodem/stk.c b/drivers/mbmmodem/stk.c
index f279057..a7633ee 100644
--- a/drivers/mbmmodem/stk.c
+++ b/drivers/mbmmodem/stk.c
@@ -179,12 +179,34 @@ static void stki_notify(GAtResult *result, gpointer 
user_data)
 
 static void stkn_notify(GAtResult *result, gpointer user_data)
 {
+       struct ofono_stk *stk = user_data;
+       GAtResultIter iter;
+       const guint8 *pdu;
+       gint len;
+       gboolean ret;
+
        DBG("");
 
-       /* Proactive command has been handled by the modem.  Should
-        * the core be notified?  For now we just ignore it because
-        * we must not respond to the command.
+       /* Proactive command has been handled by the modem.  */
+
+       g_at_result_iter_init(&iter, result);
+
+       if (!g_at_result_iter_next(&iter, "*STKN:"))
+               return;
+
+       ret = g_at_result_iter_next_hexstring(&iter, &pdu, &len);
+       if (!ret || len == 0)
+               return;
+
+       /*
+        * A proactive command starts with a Proactive UICC Command BER-TLV
+        * short tag (0xd0) with optional pad bytes, a Terminal Response
+        * starts with the Command Details CTLV tag (0x81).
         */
+       if (pdu[0] != 0x81)
+               ofono_stk_proactive_command_handled_notify(stk, len, pdu);
+       else
+               ofono_stk_terminal_response_sent_notify(stk, len, pdu);
 }
 
 static void stkend_notify(GAtResult *result, gpointer user_data)
-- 
1.7.1.86.g0e460.dirty

_______________________________________________
ofono mailing list
[email protected]
http://lists.ofono.org/listinfo/ofono

Reply via email to