qmimodem: Add support for GPRS data connection handling

1 files changed, 233 insertions, 0 deletions

diff --git a/drivers/qmimodem/gprs.c b/drivers/qmimodem/gprs.c
new file mode 100644
index 00000000..5e27b0e1
--- /dev/null
+++ b/drivers/qmimodem/gprs.c
@@ -0,0 +1,233 @@
+/*
+ *
+ *  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/gprs.h>
+
+#include "qmi.h"
+#include "nas.h"
+
+#include "qmimodem.h"
+
+struct gprs_data {
+	struct qmi_service *nas;
+};
+
+static bool extract_ss_info(struct qmi_result *result, int *status)
+{
+	const struct qmi_nas_serving_system *ss;
+	uint16_t len;
+
+	DBG("");
+
+	ss = qmi_result_get(result, QMI_NAS_RESULT_SERVING_SYSTEM, &len);
+	if (!ss)
+		return false;
+
+	if (ss->ps_state == QMI_NAS_ATTACH_STATUS_ATTACHED)
+		*status = 0x01;
+	else
+		*status = 0x00;
+
+	return true;
+}
+
+static void ss_info_notify(struct qmi_result *result, void *user_data)
+{
+	struct ofono_gprs *gprs = user_data;
+	int status;
+
+	DBG("");
+
+	if (!extract_ss_info(result, &status))
+		return;
+
+	ofono_gprs_status_notify(gprs, status);
+}
+
+static void attach_detach_cb(struct qmi_result *result, void *user_data)
+{
+	struct cb_data *cbd = user_data;
+	ofono_gprs_cb_t cb = cbd->cb;
+	uint16_t error;
+
+	DBG("");
+
+	if (qmi_result_set_error(result, &error)) {
+		if (error == 26) {
+			/* no effect */
+			goto done;
+		}
+
+		CALLBACK_WITH_FAILURE(cb, cbd->data);
+		return;
+	}
+
+done:
+	CALLBACK_WITH_SUCCESS(cb, cbd->data);
+}
+
+static void qmi_set_attached(struct ofono_gprs *gprs, int attached,
+					ofono_gprs_cb_t cb, void *user_data)
+{
+	struct gprs_data *data = ofono_gprs_get_data(gprs);
+	struct cb_data *cbd = cb_data_new(cb, user_data);
+	struct qmi_param *param;
+	uint8_t action;
+
+	DBG("attached %d", attached);
+
+	if (attached)
+		action = QMI_NAS_ATTACH_ACTION_ATTACH;
+	else
+		action = QMI_NAS_ATTACH_ACTION_DETACH;
+
+	param = qmi_param_new_uint8(QMI_NAS_PARAM_ATTACH_ACTION, action);
+	if (!param)
+		goto error;
+
+	if (qmi_service_send(data->nas, QMI_NAS_ATTACH_DETACH, param,
+					attach_detach_cb, cbd, g_free) > 0)
+		return;
+
+	qmi_param_free(param);
+
+error:
+	CALLBACK_WITH_FAILURE(cb, cbd->data);
+
+	g_free(cbd);
+}
+
+static void get_ss_info_cb(struct qmi_result *result, void *user_data)
+{
+	struct cb_data *cbd = user_data;
+	ofono_gprs_status_cb_t cb = cbd->cb;
+	int status;
+
+	DBG("");
+
+	if (qmi_result_set_error(result, NULL)) {
+		CALLBACK_WITH_FAILURE(cb, -1, cbd->data);
+		return;
+	}
+
+	if (!extract_ss_info(result, &status)) {
+		CALLBACK_WITH_FAILURE(cb, -1, cbd->data);
+		return;
+	}
+
+	CALLBACK_WITH_SUCCESS(cb, status, cbd->data);
+}
+
+static void qmi_attached_status(struct ofono_gprs *gprs,
+				ofono_gprs_status_cb_t cb, void *user_data)
+{
+	struct gprs_data *data = ofono_gprs_get_data(gprs);
+	struct cb_data *cbd = cb_data_new(cb, user_data);
+
+	DBG("");
+
+	if (qmi_service_send(data->nas, QMI_NAS_GET_SS_INFO, NULL,
+					get_ss_info_cb, cbd, g_free) > 0)
+		return;
+
+	CALLBACK_WITH_FAILURE(cb, -1, cbd->data);
+
+	g_free(cbd);
+}
+
+static void create_nas_cb(struct qmi_service *service, void *user_data)
+{
+	struct ofono_gprs *gprs = user_data;
+	struct gprs_data *data = ofono_gprs_get_data(gprs);
+
+	DBG("");
+
+	if (!service) {
+		ofono_error("Failed to request NAS service");
+		ofono_gprs_remove(gprs);
+		return;
+	}
+
+	data->nas = qmi_service_ref(service);
+
+	qmi_service_register(data->nas, QMI_NAS_SS_INFO_IND,
+					ss_info_notify, gprs, NULL);
+
+	ofono_gprs_set_cid_range(gprs, 1, 1);
+
+	ofono_gprs_register(gprs);
+}
+
+static int qmi_gprs_probe(struct ofono_gprs *gprs,
+				unsigned int vendor, void *user_data)
+{
+	struct qmi_device *device = user_data;
+	struct gprs_data *data;
+
+	DBG("");
+
+	data = g_new0(struct gprs_data, 1);
+
+	ofono_gprs_set_data(gprs, data);
+
+	qmi_service_create(device, QMI_SERVICE_NAS, create_nas_cb, gprs, NULL);
+
+	return 0;
+}
+
+static void qmi_gprs_remove(struct ofono_gprs *gprs)
+{
+	struct gprs_data *data = ofono_gprs_get_data(gprs);
+
+	DBG("");
+
+	ofono_gprs_set_data(gprs, NULL);
+
+	qmi_service_unregister_all(data->nas);
+
+	qmi_service_unref(data->nas);
+
+	g_free(data);
+}
+
+static struct ofono_gprs_driver driver = {
+	.name			= "qmimodem",
+	.probe			= qmi_gprs_probe,
+	.remove			= qmi_gprs_remove,
+	.set_attached		= qmi_set_attached,
+	.attached_status	= qmi_attached_status,
+};
+
+void qmi_gprs_init(void)
+{
+	ofono_gprs_driver_register(&driver);
+}
+
+void qmi_gprs_exit(void)
+{
+	ofono_gprs_driver_unregister(&driver);
+}