---
 src/stk.c     |  137 +++++++++++++++++++++++++++++++++++++++++++++++++++++++-
 src/stkutil.c |   22 +++++++++
 src/stkutil.h |   13 +++++
 3 files changed, 169 insertions(+), 3 deletions(-)

diff --git a/src/stk.c b/src/stk.c
index 3fda2af..5d84141 100644
--- a/src/stk.c
+++ b/src/stk.c
@@ -56,10 +56,8 @@ struct ofono_stk {
        void (*cancel_cmd)(struct ofono_stk *stk);
        GQueue *envelope_q;
        DBusMessage *pending;
-
        struct stk_timer timers[8];
        guint timers_source;
-
        int timeout;
        int short_timeout;
        struct stk_agent *session_agent;
@@ -1590,6 +1588,136 @@ static gboolean handle_command_set_up_call(const struct 
stk_command *cmd,
        return FALSE;
 }
 
+static void send_ussd_callback( int error, int dcs, const unsigned char *msg,
+                                int msg_len, void *userdata)
+{
+       struct ofono_stk *stk = userdata;
+       struct ofono_error failure = { .type = OFONO_ERROR_TYPE_FAILURE };
+       struct stk_response rsp;
+       enum sms_charset charset;
+       
+       if (stk->pending_cmd->send_ussd.alpha_id &&
+               stk->pending_cmd->send_ussd.alpha_id[0])
+               stk_alpha_id_unset(stk);
+
+       switch (error) {
+       case OFONO_USSD_FAILURE_NONE:
+               memset(&rsp, 0, sizeof(rsp));
+
+               rsp.result.type = STK_RESULT_TYPE_SUCCESS;
+
+               if (!cbs_dcs_decode(dcs, NULL, NULL, &charset,
+                                       NULL, NULL, NULL))
+                       rsp.send_ussd.text.dcs = -1;
+               else
+                       rsp.send_ussd.text.dcs = charset;
+
+               rsp.send_ussd.text.text = msg;
+               rsp.send_ussd.text.len = msg_len;
+
+               if (stk_respond(stk, &rsp, stk_command_cb))
+                       stk_command_cb(&failure, stk);
+
+               break;
+       case OFONO_USSD_FAILURE_USER_TERMINATED:
+               send_simple_response(stk, 
STK_RESULT_TYPE_USSD_OR_SS_USER_TERMINATION);
+               break;
+       case OFONO_USSD_FAILURE_TIMED_OUT:
+               send_simple_response(stk, STK_RESULT_TYPE_NETWORK_UNAVAILABLE);
+               break;
+       case OFONO_USSD_FAILURE_RETURN_ERROR:
+               send_simple_response(stk, STK_RESULT_TYPE_USSD_RETURN_ERROR);
+               break;
+       }
+}
+
+static gboolean handle_command_send_ussd(const struct stk_command *cmd,
+                                        struct stk_response *rsp,
+                                        struct ofono_stk *stk)
+{
+       struct ofono_modem *modem = __ofono_atom_get_modem(stk->atom);
+       static unsigned char busy_on_ss_result[] = { 0x03 };
+       static unsigned char busy_on_ussd_result[] = { 0x08 };
+       int err;
+
+       struct ofono_atom *cf_atom;
+       struct ofono_atom *cb_atom;
+       struct ofono_atom *cs_atom;
+       struct ofono_atom *ussd_atom;
+
+       struct ofono_call_forwarding *cf;
+       struct ofono_call_barring *cb;
+       struct ofono_call_settings *cs;
+       struct ofono_ussd *ussd;
+
+       cf_atom = __ofono_modem_find_atom(modem, 
OFONO_ATOM_TYPE_CALL_FORWARDING);
+       cb_atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_CALL_BARRING);
+       cs_atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_CALL_SETTINGS);
+       ussd_atom = __ofono_modem_find_atom(modem, OFONO_ATOM_TYPE_USSD);
+
+       if (cf_atom && __ofono_atom_get_registered(cf_atom)) {
+               cf = __ofono_atom_get_data(cf_atom);
+               if (__ofono_call_forwarding_is_busy(cf)) {
+                   rsp->result.type = STK_RESULT_TYPE_TERMINAL_BUSY;
+                   rsp->result.additional_len = sizeof(busy_on_ss_result);
+                   rsp->result.additional = busy_on_ss_result;
+                   return TRUE;
+               }
+       }
+
+       if (cb_atom && __ofono_atom_get_registered(cb_atom)) {
+               cb = __ofono_atom_get_data(cb_atom);
+               if (__ofono_call_barring_is_busy(cb)) {
+                   rsp->result.type = STK_RESULT_TYPE_TERMINAL_BUSY;
+                   rsp->result.additional_len = sizeof(busy_on_ss_result);
+                   rsp->result.additional = busy_on_ss_result;
+                   return TRUE;
+               }
+       }
+
+       if (cs_atom && __ofono_atom_get_registered(cs_atom)) {
+               cs = __ofono_atom_get_data(cs_atom);
+               if (__ofono_call_settings_is_busy(cs)) {
+                   rsp->result.type = STK_RESULT_TYPE_TERMINAL_BUSY;
+                   rsp->result.additional_len = sizeof(busy_on_ss_result);
+                   rsp->result.additional = busy_on_ss_result;
+                   return TRUE;
+               }
+       }
+
+       if (!ussd_atom || !__ofono_atom_get_registered(ussd_atom)) {
+               rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
+               return TRUE;
+       }
+
+       ussd = __ofono_atom_get_data(ussd_atom);
+
+       if (__ofono_ussd_is_busy(ussd)) {
+               rsp->result.type = STK_RESULT_TYPE_TERMINAL_BUSY;
+               rsp->result.additional_len = sizeof(busy_on_ussd_result);
+               rsp->result.additional = busy_on_ussd_result;
+               return TRUE;
+       }
+
+       err = __ofono_ussd_initiate( ussd, cmd->send_ussd.ussd_string.dcs,
+                                cmd->send_ussd.ussd_string.string,
+                                cmd->send_ussd.ussd_string.len,
+                                send_ussd_callback, stk);
+
+       if (err >= 0) 
+               return FALSE;
+
+       if (err == -ENOSYS) {
+               rsp->result.type = STK_RESULT_TYPE_NOT_CAPABLE;
+               return TRUE;
+       }
+
+       if (cmd->send_ussd.alpha_id && cmd->send_ussd.alpha_id[0])
+               stk_alpha_id_set(stk, cmd->send_ussd.alpha_id);
+
+       return FALSE;
+}
+
 static void stk_proactive_command_cancel(struct ofono_stk *stk)
 {
        if (stk->immediate_response)
@@ -1740,7 +1868,10 @@ void ofono_stk_proactive_command_notify(struct ofono_stk 
*stk,
                respond = handle_command_set_up_call(stk->pending_cmd,
                                                        &rsp, stk);
                break;
-
+       case STK_COMMAND_TYPE_SEND_USSD:
+               respond = handle_command_send_ussd(stk->pending_cmd,
+                                                       &rsp, stk);
+               break;
        default:
                rsp.result.type = STK_RESULT_TYPE_COMMAND_NOT_UNDERSTOOD;
                break;
diff --git a/src/stkutil.c b/src/stkutil.c
index ae4cc32..48d409b 100644
--- a/src/stkutil.c
+++ b/src/stkutil.c
@@ -4170,6 +4170,22 @@ static gboolean build_dataobj_text(struct 
stk_tlv_builder *tlv,
        return stk_tlv_builder_close_container(tlv);
 }
 
+/* Defined in TS 102.223 Section 8.15 - USSD specific case*/
+static gboolean build_dataobj_ussd_text(struct stk_tlv_builder *tlv,
+                                       const void *data, gboolean cr)
+{
+       const struct stk_ussd_text *text = data;
+       unsigned char tag = STK_DATA_OBJECT_TYPE_TEXT;
+
+       if (!text->text || !text->len)
+               return TRUE;
+
+       return stk_tlv_builder_open_container(tlv, cr, tag, FALSE) &&
+               stk_tlv_builder_append_byte(tlv, text->dcs) &&
+               stk_tlv_builder_append_bytes(tlv, text->text, text->len) &&
+               stk_tlv_builder_close_container(tlv);
+}
+
 /* Described in TS 131.111 Section 8.17 */
 static gboolean build_dataobj_ussd_string(struct stk_tlv_builder *tlv,
                                        const void *data, gboolean cr)
@@ -5459,6 +5475,12 @@ const unsigned char *stk_pdu_from_response(const struct 
stk_response *response,
        case STK_COMMAND_TYPE_LANGUAGE_NOTIFICATION:
        case STK_COMMAND_TYPE_LAUNCH_BROWSER:
                break;
+       case STK_COMMAND_TYPE_SEND_USSD:
+               ok = build_dataobj(&builder,
+                               build_dataobj_ussd_text, DATAOBJ_FLAG_CR,
+                               &response->send_ussd.text,
+                               NULL);
+               break;
        default:
                return NULL;
        };
diff --git a/src/stkutil.h b/src/stkutil.h
index 44d167a..fac0553 100644
--- a/src/stkutil.h
+++ b/src/stkutil.h
@@ -237,6 +237,7 @@ enum stk_result_type {
        STK_RESULT_TYPE_GO_BACK =                       0x11,
        STK_RESULT_TYPE_NO_RESPONSE =                   0x12,
        STK_RESULT_TYPE_HELP_REQUESTED =                0x13,
+       STK_RESULT_TYPE_USSD_OR_SS_USER_TERMINATION =   0x14,
 
        /* 0x20 to 0x2F are used to indicate that SIM should retry */
        STK_RESULT_TYPE_TERMINAL_BUSY =                 0x20,
@@ -254,6 +255,7 @@ enum stk_result_type {
        STK_RESULT_TYPE_DATA_NOT_UNDERSTOOD =           0x32,
        STK_RESULT_TYPE_COMMAND_ID_UNKNOWN =            0x33,
        STK_RESULT_TYPE_MINIMUM_NOT_MET =               0x36,
+       STK_RESULT_TYPE_USSD_RETURN_ERROR =             0x37,
        STK_RESULT_TYPE_CALL_CONTROL_PERMANENT =        0x39,
        STK_RESULT_TYPE_BIP_ERROR =                     0x3A,
        STK_RESULT_TYPE_ACCESS_TECHNOLOGY_ERROR =       0x3B,
@@ -1374,6 +1376,12 @@ struct stk_answer_text {
         */
 };
 
+struct stk_ussd_text {
+       const unsigned char *text;
+       int dcs;
+       int len;
+};
+
 struct stk_response_get_inkey {
        struct stk_answer_text text;
        struct stk_duration duration;
@@ -1445,6 +1453,10 @@ struct stk_response_run_at_command {
        const char *at_response;
 };
 
+struct stk_response_send_ussd {
+        struct stk_ussd_text text;
+};
+
 struct stk_response {
        unsigned char number;
        unsigned char type;
@@ -1474,6 +1486,7 @@ struct stk_response {
                struct stk_response_generic send_dtmf;
                struct stk_response_generic language_notification;
                struct stk_response_generic launch_browser;
+               struct stk_response_send_ussd send_ussd;
        };
 
        void (*destructor)(struct stk_response *response);
-- 
1.7.0.4



----------------------------------------------------------------
Please note: This e-mail may contain confidential information
intended solely for the addressee. If you have received this
e-mail in error, please do not disclose it to anyone, notify
the sender promptly, and delete the message from your system.
Thank you.

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

Reply via email to