mirror of git://git.sysmocom.de/ofono
qmi: add USSD support for MO services
This commit is contained in:
parent
66972ab467
commit
f7544d87a3
|
@ -3,6 +3,7 @@
|
||||||
* oFono - Open Source Telephony
|
* oFono - Open Source Telephony
|
||||||
*
|
*
|
||||||
* Copyright (C) 2011-2012 Intel Corporation. All rights reserved.
|
* Copyright (C) 2011-2012 Intel Corporation. All rights reserved.
|
||||||
|
* Copyright (C) 2017 by sysmocom s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
* 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
|
* it under the terms of the GNU General Public License version 2 as
|
||||||
|
@ -23,20 +24,103 @@
|
||||||
#include <config.h>
|
#include <config.h>
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#define _GNU_SOURCE
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include <glib.h>
|
||||||
|
|
||||||
#include <ofono/log.h>
|
#include <ofono/log.h>
|
||||||
#include <ofono/modem.h>
|
#include <ofono/modem.h>
|
||||||
#include <ofono/ussd.h>
|
#include <ofono/ussd.h>
|
||||||
|
#include <smsutil.h>
|
||||||
#include "qmi.h"
|
#include "qmi.h"
|
||||||
|
|
||||||
#include "qmimodem.h"
|
#include "qmimodem.h"
|
||||||
|
|
||||||
|
#include "voice.h"
|
||||||
|
|
||||||
struct ussd_data {
|
struct ussd_data {
|
||||||
struct qmi_service *voice;
|
struct qmi_service *voice;
|
||||||
uint16_t major;
|
uint16_t major;
|
||||||
uint16_t minor;
|
uint16_t minor;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static int validate_ussd_data(const struct qmi_ussd_data *data, uint16_t size)
|
||||||
|
{
|
||||||
|
if (data == NULL)
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
if (size < sizeof(*data))
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
if (size < sizeof(*data) + data->length)
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
if (data->dcs < QMI_USSD_DCS_ASCII || data->dcs > QMI_USSD_DCS_UCS2)
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int convert_qmi_dcs_gsm_dcs(int qmi_dcs, int *gsm_dcs)
|
||||||
|
{
|
||||||
|
switch (qmi_dcs) {
|
||||||
|
case QMI_USSD_DCS_ASCII:
|
||||||
|
*gsm_dcs = USSD_DCS_8BIT;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void async_orig_ind(struct qmi_result *result, void *user_data)
|
||||||
|
{
|
||||||
|
struct ofono_ussd *ussd = user_data;
|
||||||
|
const struct qmi_ussd_data *qmi_ussd;
|
||||||
|
uint16_t error = 0;
|
||||||
|
uint16_t len;
|
||||||
|
int gsm_dcs;
|
||||||
|
|
||||||
|
DBG("");
|
||||||
|
|
||||||
|
qmi_result_get_uint16(result, QMI_VOICE_PARAM_ASYNC_USSD_ERROR, &error);
|
||||||
|
|
||||||
|
switch (error) {
|
||||||
|
case 0:
|
||||||
|
/* no error */
|
||||||
|
break;
|
||||||
|
case 92:
|
||||||
|
qmi_result_get_uint16(result,
|
||||||
|
QMI_VOICE_PARAM_ASYNC_USSD_FAILURE_CASE,
|
||||||
|
&error);
|
||||||
|
DBG("Failure Cause: 0x%04x", error);
|
||||||
|
goto error;
|
||||||
|
default:
|
||||||
|
DBG("USSD Error 0x%04x", error);
|
||||||
|
goto error;
|
||||||
|
}
|
||||||
|
|
||||||
|
qmi_ussd = qmi_result_get(result, QMI_VOICE_PARAM_ASYNC_USSD_DATA,
|
||||||
|
&len);
|
||||||
|
if (qmi_ussd == NULL)
|
||||||
|
return;
|
||||||
|
|
||||||
|
if (validate_ussd_data(qmi_ussd, len))
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
if (convert_qmi_dcs_gsm_dcs(qmi_ussd->dcs, &gsm_dcs))
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
ofono_ussd_notify(ussd, OFONO_USSD_STATUS_NOTIFY, gsm_dcs,
|
||||||
|
qmi_ussd->data, qmi_ussd->length);
|
||||||
|
return;
|
||||||
|
|
||||||
|
error:
|
||||||
|
ofono_ussd_notify(ussd, OFONO_USSD_STATUS_TERMINATED, 0, NULL, 0);
|
||||||
|
}
|
||||||
|
|
||||||
static void create_voice_cb(struct qmi_service *service, void *user_data)
|
static void create_voice_cb(struct qmi_service *service, void *user_data)
|
||||||
{
|
{
|
||||||
struct ofono_ussd *ussd = user_data;
|
struct ofono_ussd *ussd = user_data;
|
||||||
|
@ -44,7 +128,7 @@ static void create_voice_cb(struct qmi_service *service, void *user_data)
|
||||||
|
|
||||||
DBG("");
|
DBG("");
|
||||||
|
|
||||||
if (!service) {
|
if (service == NULL) {
|
||||||
ofono_error("Failed to request Voice service");
|
ofono_error("Failed to request Voice service");
|
||||||
ofono_ussd_remove(ussd);
|
ofono_ussd_remove(ussd);
|
||||||
return;
|
return;
|
||||||
|
@ -58,6 +142,9 @@ static void create_voice_cb(struct qmi_service *service, void *user_data)
|
||||||
|
|
||||||
data->voice = qmi_service_ref(service);
|
data->voice = qmi_service_ref(service);
|
||||||
|
|
||||||
|
qmi_service_register(data->voice, QMI_VOICE_ASYNC_ORIG_USSD,
|
||||||
|
async_orig_ind, ussd, NULL);
|
||||||
|
|
||||||
ofono_ussd_register(ussd);
|
ofono_ussd_register(ussd);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -77,7 +164,6 @@ static int qmi_ussd_probe(struct ofono_ussd *ussd,
|
||||||
create_voice_cb, ussd, NULL);
|
create_voice_cb, ussd, NULL);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void qmi_ussd_remove(struct ofono_ussd *ussd)
|
static void qmi_ussd_remove(struct ofono_ussd *ussd)
|
||||||
|
@ -93,10 +179,103 @@ static void qmi_ussd_remove(struct ofono_ussd *ussd)
|
||||||
g_free(data);
|
g_free(data);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void qmi_ussd_cancel(struct ofono_ussd *ussd,
|
||||||
|
ofono_ussd_cb_t cb, void *user_data)
|
||||||
|
{
|
||||||
|
struct ussd_data *ud = ofono_ussd_get_data(ussd);
|
||||||
|
|
||||||
|
DBG("");
|
||||||
|
|
||||||
|
if (qmi_service_send(ud->voice, QMI_VOICE_CANCEL_USSD, NULL,
|
||||||
|
NULL, NULL, NULL) > 0)
|
||||||
|
CALLBACK_WITH_SUCCESS(cb, user_data);
|
||||||
|
else
|
||||||
|
CALLBACK_WITH_FAILURE(cb, user_data);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The cb is called when the request (on modem layer) reports success or
|
||||||
|
* failure. It doesn't contain a network result. We get the network answer
|
||||||
|
* via VOICE_IND.
|
||||||
|
*/
|
||||||
|
static void qmi_ussd_request_cb(struct qmi_result *result, void *user_data)
|
||||||
|
{
|
||||||
|
struct cb_data *cbd = user_data;
|
||||||
|
ofono_ussd_cb_t cb = cbd->cb;
|
||||||
|
|
||||||
|
DBG("");
|
||||||
|
|
||||||
|
qmi_result_print_tlvs(result);
|
||||||
|
|
||||||
|
if (qmi_result_set_error(result, NULL)) {
|
||||||
|
CALLBACK_WITH_FAILURE(cb, cbd->data);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
CALLBACK_WITH_SUCCESS(cb, cbd->data);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void qmi_ussd_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 cb_data *cbd = cb_data_new(cb, data);
|
||||||
|
struct qmi_ussd_data *qmi_ussd;
|
||||||
|
struct qmi_param *param;
|
||||||
|
char *utf8 = NULL;
|
||||||
|
long utf8_len = 0;
|
||||||
|
|
||||||
|
DBG("");
|
||||||
|
|
||||||
|
switch (dcs) {
|
||||||
|
case 0xf: /* 7bit GSM unspecific */
|
||||||
|
utf8 = ussd_decode(dcs, len, pdu);
|
||||||
|
if (!utf8)
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
utf8_len = strlen(utf8);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
DBG("Unsupported USSD Data Coding Scheme 0x%x", dcs);
|
||||||
|
goto error;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* So far only DCS_ASCII works.
|
||||||
|
* DCS_8BIT and DCS_UCS2 is broken, because the modem firmware
|
||||||
|
* (least on a EC20) encodes those in-correctly onto the air interface,
|
||||||
|
* resulting in wrong decoded USSD data.
|
||||||
|
*/
|
||||||
|
qmi_ussd = alloca(sizeof(struct qmi_ussd_data) + utf8_len);
|
||||||
|
qmi_ussd->dcs = QMI_USSD_DCS_ASCII;
|
||||||
|
qmi_ussd->length = len;
|
||||||
|
memcpy(qmi_ussd->data, utf8, utf8_len);
|
||||||
|
|
||||||
|
param = qmi_param_new();
|
||||||
|
if (param == NULL)
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
qmi_param_append(param, QMI_VOICE_PARAM_USS_DATA,
|
||||||
|
sizeof(struct qmi_ussd_data) + utf8_len, qmi_ussd);
|
||||||
|
|
||||||
|
if (qmi_service_send(ud->voice, QMI_VOICE_ASYNC_ORIG_USSD, param,
|
||||||
|
qmi_ussd_request_cb, cbd, g_free) > 0)
|
||||||
|
return;
|
||||||
|
|
||||||
|
qmi_param_free(param);
|
||||||
|
error:
|
||||||
|
g_free(utf8);
|
||||||
|
g_free(cbd);
|
||||||
|
CALLBACK_WITH_FAILURE(cb, data);
|
||||||
|
}
|
||||||
|
|
||||||
static struct ofono_ussd_driver driver = {
|
static struct ofono_ussd_driver driver = {
|
||||||
.name = "qmimodem",
|
.name = "qmimodem",
|
||||||
.probe = qmi_ussd_probe,
|
.probe = qmi_ussd_probe,
|
||||||
.remove = qmi_ussd_remove,
|
.remove = qmi_ussd_remove,
|
||||||
|
.request = qmi_ussd_request,
|
||||||
|
.cancel = qmi_ussd_cancel
|
||||||
};
|
};
|
||||||
|
|
||||||
void qmi_ussd_init(void)
|
void qmi_ussd_init(void)
|
||||||
|
|
Loading…
Reference in New Issue