This provides the list of available technologies in the radio-settings
atom. Note that this list is hard-coded and includes LTE unconditionally
which is probably not correct for all QMI devices.
---
drivers/qmimodem/radio-settings.c | 77 +++++++++++++++++++++++++++++++++++++++
1 file changed, 77 insertions(+)
diff --git a/drivers/qmimodem/radio-settings.c
b/drivers/qmimodem/radio-settings.c
index 3a2b068..5e76bc5 100644
--- a/drivers/qmimodem/radio-settings.c
+++ b/drivers/qmimodem/radio-settings.c
@@ -29,11 +29,13 @@
#include "qmi.h"
#include "nas.h"
+#include "dms.h"
#include "qmimodem.h"
struct settings_data {
struct qmi_service *nas;
+ struct qmi_service *dms;
uint16_t major;
uint16_t minor;
};
@@ -150,6 +152,78 @@ static void qmi_set_rat_mode(struct ofono_radio_settings
*rs,
g_free(cbd);
}
+static void get_caps_cb(struct qmi_result *result, void *user_data)
+{
+ struct cb_data *cbd = user_data;
+ ofono_radio_settings_available_rats_query_cb_t cb = cbd->cb;
+ const struct qmi_dms_device_caps *caps;
+ unsigned int available_rats;
+ uint16_t len;
+ uint8_t i;
+
+ DBG("");
+
+ if (qmi_result_set_error(result, NULL))
+ goto error;
+
+ caps = qmi_result_get(result, QMI_DMS_RESULT_DEVICE_CAPS, &len);
+ if (!caps)
+ goto error;
+
+ available_rats = 0;
+ for (i = 0; i < caps->radio_if_count; i++) {
+ switch (caps->radio_if[i]) {
+ case QMI_DMS_RADIO_IF_GSM:
+ available_rats |= OFONO_RADIO_ACCESS_MODE_GSM;
+ break;
+ case QMI_DMS_RADIO_IF_UMTS:
+ available_rats |= OFONO_RADIO_ACCESS_MODE_UMTS;
+ break;
+ case QMI_DMS_RADIO_IF_LTE:
+ available_rats |= OFONO_RADIO_ACCESS_MODE_LTE;
+ }
+ }
+
+ CALLBACK_WITH_SUCCESS(cb, available_rats, cbd->data);
+
+ return;
+
+error:
+ CALLBACK_WITH_FAILURE(cb, -1, cbd->data);
+}
+
+static void qmi_query_available_rats(struct ofono_radio_settings *rs,
+ ofono_radio_settings_available_rats_query_cb_t cb,
+ void *data)
+{
+ struct settings_data *rsd = ofono_radio_settings_get_data(rs);
+ struct cb_data *cbd = cb_data_new(cb, data);
+
+ if (!rsd->dms)
+ goto error;
+
+ if (qmi_service_send(rsd->dms, QMI_DMS_GET_CAPS, NULL,
+ get_caps_cb, cbd, g_free) > 0)
+ return;
+
+error:
+ g_free(cbd);
+ CALLBACK_WITH_FAILURE(cb, -1, data);
+}
+
+static void create_dms_cb(struct qmi_service *service, void *user_data)
+{
+ struct ofono_radio_settings *rs = user_data;
+ struct settings_data *data = ofono_radio_settings_get_data(rs);
+
+ DBG("");
+
+ if (!service)
+ return;
+
+ data->dms = qmi_service_ref(service);
+}
+
static void create_nas_cb(struct qmi_service *service, void *user_data)
{
struct ofono_radio_settings *rs = user_data;
@@ -186,6 +260,8 @@ static int qmi_radio_settings_probe(struct
ofono_radio_settings *rs,
ofono_radio_settings_set_data(rs, data);
+ qmi_service_create_shared(device, QMI_SERVICE_DMS,
+ create_dms_cb, rs, NULL);
qmi_service_create_shared(device, QMI_SERVICE_NAS,
create_nas_cb, rs, NULL);
@@ -213,6 +289,7 @@ static struct ofono_radio_settings_driver driver = {
.remove = qmi_radio_settings_remove,
.set_rat_mode = qmi_set_rat_mode,
.query_rat_mode = qmi_query_rat_mode,
+ .query_available_rats = qmi_query_available_rats,
};
void qmi_radio_settings_init(void)
--
2.9.3
_______________________________________________
ofono mailing list
[email protected]
https://lists.ofono.org/mailman/listinfo/ofono