/* * * oFono - Open Source Telephony * * Copyright (C) 2009-2011 Nokia Corporation and/or its subsidiary(-ies). * * 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 #endif #include #include #include #include #include #include #include #include #include #include #include #include "smsutil.h" #include "util.h" #include "isimodem.h" #include "isiutil.h" #include "ss.h" #include "debug.h" struct ussd_info { uint8_t dcs; uint8_t type; uint8_t len; }; struct ussd_data { GIsiClient *client; GIsiVersion version; int mt_session; }; static gboolean check_response_status(const GIsiMessage *msg, uint8_t msgid) { if (g_isi_msg_error(msg) < 0) { DBG("Error: %s", g_isi_msg_strerror(msg)); return FALSE; } if (g_isi_msg_id(msg) != msgid) { DBG("Unexpected msg: %s", ss_message_id_name(g_isi_msg_id(msg))); return FALSE; } return TRUE; } static void ussd_notify_ack(struct ussd_data *ud) { const uint8_t msg[] = { SS_GSM_USSD_SEND_REQ, SS_GSM_USSD_NOTIFY, 0, /* subblock count */ }; g_isi_client_send(ud->client, msg, sizeof(msg), NULL, NULL, NULL); } static void ussd_ind_cb(const GIsiMessage *msg, void *data) { struct ofono_ussd *ussd = data; struct ussd_data *ud = ofono_ussd_get_data(ussd); struct ussd_info *info; size_t len = sizeof(struct ussd_info); uint8_t *string; int status; if (g_isi_msg_id(msg) != SS_GSM_USSD_RECEIVE_IND) return; if (!g_isi_msg_data_get_struct(msg, 0, (const void **) &info, len)) return; if (!g_isi_msg_data_get_struct(msg, len, (const void **) &string, info->len)) return; switch (info->type) { case 0: /* Nothing - this is response to NOTIFY_ACK REQ */ return; case SS_GSM_USSD_MT_REPLY: /* This never happens, but.. */ status = OFONO_USSD_STATUS_LOCAL_CLIENT_RESPONDED; break; case SS_GSM_USSD_COMMAND: /* Ignore, we get SS_GSM_USSD_REQUEST, too */ if (ud->mt_session) return; status = OFONO_USSD_STATUS_ACTION_REQUIRED; break; case SS_GSM_USSD_NOTIFY: status = OFONO_USSD_STATUS_NOTIFY; ussd_notify_ack(ud); break; case SS_GSM_USSD_END: status = OFONO_USSD_STATUS_TERMINATED; ud->mt_session = 0; break; case SS_GSM_USSD_REQUEST: ud->mt_session = 1; status = OFONO_USSD_STATUS_ACTION_REQUIRED; break; default: status = OFONO_USSD_STATUS_NOT_SUPPORTED; } DBG("type: %u %s, dcs: 0x%02x, len: %u", info->type, ss_ussd_type_name(info->type), info->dcs, info->len); ofono_ussd_notify(ussd, status, info->dcs, string, info->len); } static void ussd_send_resp_cb(const GIsiMessage *msg, void *data) { struct isi_cb_data *cbd = data; ofono_ussd_cb_t cb = cbd->cb; if (check_response_status(msg, SS_GSM_USSD_SEND_RESP)) CALLBACK_WITH_SUCCESS(cb, cbd->data); else CALLBACK_WITH_FAILURE(cb, cbd->data); } static void isi_request(struct ofono_ussd *ussd, int dcs, const unsigned char *pdu, int len, ofono_ussd_cb_t cb, void *data) { struct ussd_data *ud = ofono_ussd_get_data(ussd); struct isi_cb_data *cbd = isi_cb_data_new(ussd, cb, data); size_t sb_len = ALIGN4(4 + len); size_t pad_len = sb_len - (4 + len); const uint8_t padding[4] = { 0 }; const uint8_t msg[] = { SS_GSM_USSD_SEND_REQ, ud->mt_session ? SS_GSM_USSD_MT_REPLY : SS_GSM_USSD_COMMAND, 1, /* subblock count */ SS_GSM_USSD_STRING, sb_len, dcs, /* DCS */ len, /* string length */ /* USSD string goes here */ }; struct iovec iov[3] = { { (uint8_t *) msg, sizeof(msg) }, { (uint8_t *) pdu, len }, { (uint8_t *) padding, pad_len }, }; if (cbd == NULL || ud == NULL) goto error; if (g_isi_client_vsend(ud->client, iov, 3, ussd_send_resp_cb, cbd, g_free)) return; error: CALLBACK_WITH_FAILURE(cb, data); g_free(cbd); } static void isi_cancel(struct ofono_ussd *ussd, ofono_ussd_cb_t cb, void *data) { struct ussd_data *ud = ofono_ussd_get_data(ussd); struct isi_cb_data *cbd = isi_cb_data_new(ussd, cb, data); const uint8_t msg[] = { SS_GSM_USSD_SEND_REQ, SS_GSM_USSD_END, 0, /* subblock count */ }; if (cbd == NULL || ud == NULL) goto error; if (g_isi_client_send(ud->client, msg, sizeof(msg), ussd_send_resp_cb, cbd, g_free)) return; error: CALLBACK_WITH_FAILURE(cb, data); g_free(cbd); } static void ussd_reachable_cb(const GIsiMessage *msg, void *data) { struct ofono_ussd *ussd = data; struct ussd_data *ud = ofono_ussd_get_data(ussd); if (g_isi_msg_error(msg) < 0) { ofono_ussd_remove(ussd); return; } ISI_RESOURCE_DBG(msg); g_isi_client_ind_subscribe(ud->client, SS_GSM_USSD_RECEIVE_IND, ussd_ind_cb, ussd); ofono_ussd_register(ussd); } static int isi_ussd_probe(struct ofono_ussd *ussd, unsigned int vendor, void *user) { GIsiModem *modem = user; struct ussd_data *ud; ud = g_try_new0(struct ussd_data, 1); if (ud == NULL) return -ENOMEM; ud->client = g_isi_client_create(modem, PN_SS); if (ud->client == NULL) { g_free(ud); return -ENOMEM; } ofono_ussd_set_data(ussd, ud); g_isi_client_verify(ud->client, ussd_reachable_cb, ussd, NULL); return 0; } static void isi_ussd_remove(struct ofono_ussd *ussd) { struct ussd_data *data = ofono_ussd_get_data(ussd); ofono_ussd_set_data(ussd, NULL); if (data == NULL) return; g_isi_client_destroy(data->client); g_free(data); } static const struct ofono_ussd_driver driver = { .name = "isimodem", .probe = isi_ussd_probe, .remove = isi_ussd_remove, .request = isi_request, .cancel = isi_cancel }; void isi_ussd_init(void) { ofono_ussd_driver_register(&driver); } void isi_ussd_exit(void) { ofono_ussd_driver_unregister(&driver); }