mirror of git://git.sysmocom.de/ofono
qmimodem: Add support for device information handling
This commit is contained in:
Marcel Holtmann
parent
0e6fc7aee4
commit
ad20ea12c5
|
|
@ -153,13 +153,15 @@ endif
|
|||
|
||||
if QMIMODEM
|
||||
qmi_sources = drivers/qmimodem/qmi.h drivers/qmimodem/qmi.c \
|
||||
drivers/qmimodem/ctl.h
|
||||
drivers/qmimodem/ctl.h \
|
||||
drivers/qmimodem/dms.h
|
||||
|
||||
builtin_modules += qmimodem
|
||||
builtin_sources += $(qmi_sources) \
|
||||
drivers/qmimodem/util.h \
|
||||
drivers/qmimodem/qmimodem.h \
|
||||
drivers/qmimodem/qmimodem.c
|
||||
drivers/qmimodem/qmimodem.c \
|
||||
drivers/qmimodem/devinfo.c
|
||||
|
||||
builtin_modules += gobi
|
||||
builtin_sources += plugins/gobi.c
|
||||
|
|
|
|||
|
|
@ -0,0 +1,225 @@
|
|||
/*
|
||||
*
|
||||
* oFono - Open Source Telephony
|
||||
*
|
||||
* Copyright (C) 2011-2012 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* 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 <config.h>
|
||||
#endif
|
||||
|
||||
#include <ofono/log.h>
|
||||
#include <ofono/modem.h>
|
||||
#include <ofono/devinfo.h>
|
||||
|
||||
#include "qmi.h"
|
||||
#include "dms.h"
|
||||
|
||||
#include "qmimodem.h"
|
||||
|
||||
struct devinfo_data {
|
||||
struct qmi_service *dms;
|
||||
};
|
||||
|
||||
static void string_cb(struct qmi_result *result, void *user_data)
|
||||
{
|
||||
struct cb_data *cbd = user_data;
|
||||
ofono_devinfo_query_cb_t cb = cbd->cb;
|
||||
char *str;
|
||||
|
||||
DBG("");
|
||||
|
||||
if (qmi_result_set_error(result, NULL)) {
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
return;
|
||||
}
|
||||
|
||||
str = qmi_result_get_string(result, 0x01);
|
||||
if (!str) {
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
return;
|
||||
}
|
||||
|
||||
CALLBACK_WITH_SUCCESS(cb, str, cbd->data);
|
||||
|
||||
qmi_free(str);
|
||||
}
|
||||
|
||||
static void qmi_query_manufacturer(struct ofono_devinfo *devinfo,
|
||||
ofono_devinfo_query_cb_t cb, void *user_data)
|
||||
{
|
||||
struct devinfo_data *data = ofono_devinfo_get_data(devinfo);
|
||||
struct cb_data *cbd = cb_data_new(cb, user_data);
|
||||
|
||||
DBG("");
|
||||
|
||||
if (qmi_service_send(data->dms, QMI_DMS_GET_MANUFACTURER, NULL,
|
||||
string_cb, cbd, g_free) > 0)
|
||||
return;
|
||||
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
|
||||
g_free(cbd);
|
||||
}
|
||||
|
||||
static void qmi_query_model(struct ofono_devinfo *devinfo,
|
||||
ofono_devinfo_query_cb_t cb, void *user_data)
|
||||
{
|
||||
struct devinfo_data *data = ofono_devinfo_get_data(devinfo);
|
||||
struct cb_data *cbd = cb_data_new(cb, user_data);
|
||||
|
||||
DBG("");
|
||||
|
||||
if (qmi_service_send(data->dms, QMI_DMS_GET_MODEL_ID, NULL,
|
||||
string_cb, cbd, g_free) > 0)
|
||||
return;
|
||||
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
|
||||
g_free(cbd);
|
||||
}
|
||||
|
||||
static void qmi_query_revision(struct ofono_devinfo *devinfo,
|
||||
ofono_devinfo_query_cb_t cb, void *user_data)
|
||||
{
|
||||
struct devinfo_data *data = ofono_devinfo_get_data(devinfo);
|
||||
struct cb_data *cbd = cb_data_new(cb, user_data);
|
||||
|
||||
DBG("");
|
||||
|
||||
if (qmi_service_send(data->dms, QMI_DMS_GET_REV_ID, NULL,
|
||||
string_cb, cbd, g_free) > 0)
|
||||
return;
|
||||
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
|
||||
g_free(cbd);
|
||||
}
|
||||
|
||||
static void get_ids_cb(struct qmi_result *result, void *user_data)
|
||||
{
|
||||
struct cb_data *cbd = user_data;
|
||||
ofono_devinfo_query_cb_t cb = cbd->cb;
|
||||
char *str;
|
||||
|
||||
DBG("");
|
||||
|
||||
if (qmi_result_set_error(result, NULL)) {
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
return;
|
||||
}
|
||||
|
||||
str = qmi_result_get_string(result, QMI_DMS_RESULT_ESN);
|
||||
if (!str) {
|
||||
str = qmi_result_get_string(result, QMI_DMS_RESULT_IMEI);
|
||||
if (!str) {
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
CALLBACK_WITH_SUCCESS(cb, str, cbd->data);
|
||||
|
||||
qmi_free(str);
|
||||
}
|
||||
|
||||
static void qmi_query_serial(struct ofono_devinfo *devinfo,
|
||||
ofono_devinfo_query_cb_t cb, void *user_data)
|
||||
{
|
||||
struct devinfo_data *data = ofono_devinfo_get_data(devinfo);
|
||||
struct cb_data *cbd = cb_data_new(cb, user_data);
|
||||
|
||||
DBG("");
|
||||
|
||||
if (qmi_service_send(data->dms, QMI_DMS_GET_IDS, NULL,
|
||||
get_ids_cb, cbd, g_free) > 0)
|
||||
return;
|
||||
|
||||
CALLBACK_WITH_FAILURE(cb, NULL, cbd->data);
|
||||
|
||||
g_free(cbd);
|
||||
}
|
||||
|
||||
static void create_dms_cb(struct qmi_service *service, void *user_data)
|
||||
{
|
||||
struct ofono_devinfo *devinfo = user_data;
|
||||
struct devinfo_data *data = ofono_devinfo_get_data(devinfo);
|
||||
|
||||
DBG("");
|
||||
|
||||
if (!service) {
|
||||
ofono_error("Failed to request DMS service");
|
||||
ofono_devinfo_remove(devinfo);
|
||||
return;
|
||||
}
|
||||
|
||||
data->dms = qmi_service_ref(service);
|
||||
|
||||
ofono_devinfo_register(devinfo);
|
||||
}
|
||||
|
||||
static int qmi_devinfo_probe(struct ofono_devinfo *devinfo,
|
||||
unsigned int vendor, void *user_data)
|
||||
{
|
||||
struct qmi_device *device = user_data;
|
||||
struct devinfo_data *data;
|
||||
|
||||
DBG("");
|
||||
|
||||
data = g_new0(struct devinfo_data, 1);
|
||||
|
||||
ofono_devinfo_set_data(devinfo, data);
|
||||
|
||||
qmi_service_create(device, QMI_SERVICE_DMS,
|
||||
create_dms_cb, devinfo, NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void qmi_devinfo_remove(struct ofono_devinfo *devinfo)
|
||||
{
|
||||
struct devinfo_data *data = ofono_devinfo_get_data(devinfo);
|
||||
|
||||
DBG("");
|
||||
|
||||
ofono_devinfo_set_data(devinfo, NULL);
|
||||
|
||||
qmi_service_unref(data->dms);
|
||||
|
||||
g_free(data);
|
||||
}
|
||||
|
||||
static struct ofono_devinfo_driver driver = {
|
||||
.name = "qmimodem",
|
||||
.probe = qmi_devinfo_probe,
|
||||
.remove = qmi_devinfo_remove,
|
||||
.query_manufacturer = qmi_query_manufacturer,
|
||||
.query_model = qmi_query_model,
|
||||
.query_revision = qmi_query_revision,
|
||||
.query_serial = qmi_query_serial,
|
||||
};
|
||||
|
||||
void qmi_devinfo_init(void)
|
||||
{
|
||||
ofono_devinfo_driver_register(&driver);
|
||||
}
|
||||
|
||||
void qmi_devinfo_exit(void)
|
||||
{
|
||||
ofono_devinfo_driver_unregister(&driver);
|
||||
}
|
||||
|
|
@ -0,0 +1,144 @@
|
|||
/*
|
||||
*
|
||||
* oFono - Open Source Telephony
|
||||
*
|
||||
* Copyright (C) 2011-2012 Intel Corporation. All rights reserved.
|
||||
*
|
||||
* 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
|
||||
*
|
||||
*/
|
||||
|
||||
#define QMI_DMS_RESET 0 /* Reset DMS service */
|
||||
#define QMI_DMS_EVENT 1 /* Event report indication */
|
||||
#define QMI_DMS_SET_EVENT 1 /* Set report conditions */
|
||||
#define QMI_DMS_GET_CAPS 32 /* Get device capabilities */
|
||||
#define QMI_DMS_GET_MANUFACTURER 33 /* Get device manfacturer */
|
||||
#define QMI_DMS_GET_MODEL_ID 34 /* Get device model ID */
|
||||
#define QMI_DMS_GET_REV_ID 35 /* Get device revision ID */
|
||||
#define QMI_DMS_GET_NUMBER 36 /* Get assigned voice number */
|
||||
#define QMI_DMS_GET_IDS 37 /* Get ESN/IMEI/MEID */
|
||||
#define QMI_DMS_GET_POWER_STATE 38 /* Get power state */
|
||||
#define QMI_DMS_SET_PIN_PROTECT 39 /* Set PIN protection */
|
||||
#define QMI_DMS_PIN_VERIFY 40 /* Verify PIN */
|
||||
#define QMI_DMS_PIN_UNBLOCK 41 /* Unblock PIN */
|
||||
#define QMI_DMS_PIN_CHANGE 42 /* Change PIN */
|
||||
#define QMI_DMS_GET_PIN_STATUS 43 /* Get PIN status */
|
||||
#define QMI_DMS_GET_MSM_ID 44 /* Get MSM ID */
|
||||
#define QMI_DMS_GET_OPER_MODE 45 /* Get operating mode */
|
||||
#define QMI_DMS_SET_OPER_MODE 46 /* Set operating mode */
|
||||
#define QMI_DMS_GET_TIME 47 /* Get timestamp from the device */
|
||||
#define QMI_DMS_GET_PRL_VERSION 48 /* Get PRL version */
|
||||
|
||||
#define QMI_DMS_GET_ICCID 60 /* Get UIM ICCID */
|
||||
|
||||
#define QMI_DMS_GET_IMSI 67 /* Get IMSI */
|
||||
#define QMI_DMS_GET_UIM_STATE 68 /* Get UIM state */
|
||||
#define QMI_DMS_GET_BAND_CAPS 69 /* Get device band capabilities */
|
||||
#define QMI_DMS_GET_FACTORY_ID 70 /* Get device factory ID */
|
||||
#define QMI_DMS_GET_SW_VERSION 81 /* Get software version */
|
||||
|
||||
|
||||
/* Report indication */
|
||||
#define QMI_DMS_NOTIFY_PIN1_STATE 0x11
|
||||
#define QMI_DMS_NOTIFY_PIN2_STATE 0x12
|
||||
#define QMI_DMS_NOTIFY_OPER_MODE 0x14 /* uint8 */
|
||||
#define QMI_DMS_NOTIFY_UIM_STATE 0x15 /* uint8 */
|
||||
|
||||
#define QMI_DMS_UIM_STATE_INIT_COMPLETE 0x00
|
||||
#define QMI_DMS_UIM_STATE_INIT_FAILED 0x01
|
||||
#define QMI_DMS_UIM_STATE_NOT_PRESENT 0x02
|
||||
#define QMI_DMS_UIM_STATE_INVALID 0xff
|
||||
|
||||
#define QMI_DMS_OPER_MODE_ONLINE 0x00
|
||||
#define QMI_DMS_OPER_MODE_LOW_POWER 0x01
|
||||
#define QMI_DMS_OPER_MODE_FACTORY_TEST 0x02
|
||||
#define QMI_DMS_OPER_MODE_OFFLINE 0x03
|
||||
#define QMI_DMS_OPER_MODE_RESET 0x04
|
||||
#define QMI_DMS_OPER_MODE_SHUTDOWN 0x05
|
||||
#define QMI_DMS_OPER_MODE_PERSIST_LOW_POWER 0x06
|
||||
#define QMI_DMS_OPER_MODE_ONLY_LOW_POWER 0x07
|
||||
|
||||
/* Set report conditions */
|
||||
#define QMI_DMS_PARAM_REPORT_PIN_STATUS 0x12 /* bool */
|
||||
#define QMI_DMS_PARAM_REPORT_OPER_MODE 0x14 /* bool */
|
||||
#define QMI_DMS_PARAM_REPORT_UIM_STATE 0x15 /* bool */
|
||||
|
||||
/* Get device capabilities */
|
||||
#define QMI_DMS_RESULT_DEVICE_CAPS 0x01
|
||||
struct qmi_dms_device_caps {
|
||||
uint32_t max_tx_rate;
|
||||
uint32_t max_rx_rate;
|
||||
uint8_t data_capa;
|
||||
int8_t sim_supported;
|
||||
uint8_t radio_if_count;
|
||||
uint8_t radio_if[0];
|
||||
} __attribute__ ((packed));
|
||||
|
||||
#define QMI_DMS_DATA_CAPA_NOT_SUPPORTED 0x00
|
||||
#define QMI_DMS_DATA_CAPA_CS_ONLY 0x01
|
||||
#define QMI_DMS_DATA_CAPA_PS_ONLY 0x02
|
||||
#define QMI_DMS_DATA_CAPA_SIMUL_CS_PS 0x03
|
||||
#define QMI_DMS_DATA_CAPA_NONSIMUL_CS_PS 0x04
|
||||
|
||||
#define QMI_DMS_RADIO_IF_CDMA2000_1X 0x01
|
||||
#define QMI_DMS_RADIO_IF_CDMA2000_HRPD 0x02
|
||||
#define QMI_DMS_RADIO_IF_GSM 0x04
|
||||
#define QMI_DMS_RADIO_IF_UMTS 0x05
|
||||
#define QMI_DMS_RADIO_IF_LTE 0x08
|
||||
|
||||
/* Get device manfacturer */
|
||||
#define QMI_DMS_RESULT_MANUFACTURER 0x01
|
||||
|
||||
/* Get device model ID */
|
||||
#define QMI_DMS_RESULT_MODEL_ID 0x01
|
||||
|
||||
/* Get device revision ID */
|
||||
#define QMI_DMS_RESULT_REV_ID 0x01
|
||||
|
||||
/* Get assigned voice number */
|
||||
#define QMI_DMS_RESULT_VOICE_NUMBER 0x01
|
||||
#define QMI_DMS_RESULT_MOBILE_ID 0x10
|
||||
#define QMI_DMS_RESULT_IMSI_NUMBER 0x11
|
||||
|
||||
/* Get ESN/IMEI/MEID */
|
||||
#define QMI_DMS_RESULT_ESN 0x10 /* optional */
|
||||
#define QMI_DMS_RESULT_IMEI 0x11 /* optional */
|
||||
#define QMI_DMS_RESULT_MEID 0x12 /* optional */
|
||||
|
||||
/* Get PIN status */
|
||||
#define QMI_DMS_RESULT_PIN1_STATUS 0x11
|
||||
#define QMI_DMS_RESULT_PIN2_STATUS 0x12
|
||||
struct qmi_dms_pin_status {
|
||||
uint8_t status;
|
||||
uint8_t verify_retries;
|
||||
uint8_t unblock_retries;
|
||||
} __attribute__ ((packed));
|
||||
|
||||
#define QMI_DMS_PIN_UNINITIALIZED 0x00
|
||||
#define QMI_DMS_PIN_ENABLED_UNVERIFIED 0x01
|
||||
#define QMI_DMS_PIN_ENABLED_VERIFIED 0x02
|
||||
#define QMI_DMS_PIN_DISABLED 0x03
|
||||
#define QMI_DMS_PIN_BLOCKED 0x04
|
||||
#define QMI_DMS_PIN_BLOCKED_PERMANENTLY 0x05
|
||||
#define QMI_DMS_PIN_UNBLOCKED 0x06
|
||||
#define QMI_DMS_PIN_CHANGED 0x07
|
||||
|
||||
/* Get operating mode */
|
||||
#define QMI_DMS_RESULT_OPER_MODE 0x01 /* uint8 */
|
||||
|
||||
/* Set operating mode */
|
||||
#define QMI_DMS_PARAM_OPER_MODE 0x01 /* uint8 */
|
||||
|
||||
/* Get UIM state */
|
||||
#define QMI_DMS_RESULT_UIM_STATE 0x01 /* uint8 */
|
||||
|
|
@ -30,11 +30,14 @@
|
|||
|
||||
static int qmimodem_init(void)
|
||||
{
|
||||
qmi_devinfo_init();
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void qmimodem_exit(void)
|
||||
{
|
||||
qmi_devinfo_exit();
|
||||
}
|
||||
|
||||
OFONO_PLUGIN_DEFINE(qmimodem, "Qualcomm QMI modem driver", VERSION,
|
||||
|
|
|
|||
|
|
@ -20,3 +20,6 @@
|
|||
*/
|
||||
|
||||
#include "util.h"
|
||||
|
||||
extern void qmi_devinfo_init(void);
|
||||
extern void qmi_devinfo_exit(void);
|
||||
|
|
|
|||
Loading…
Reference in New Issue