qmimodem: Add support for GPS location reporting

4 files changed, 348 insertions, 0 deletions

diff --git a/drivers/qmimodem/location-reporting.c b/drivers/qmimodem/location-reporting.c
new file mode 100644
index 00000000..e4ce2331
--- /dev/null
+++ b/drivers/qmimodem/location-reporting.c
@@ -0,0 +1,298 @@
+/*
+ *
+ *  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
+
+#define _GNU_SOURCE
+#include <fcntl.h>
+#include <unistd.h>
+
+#include <ofono/log.h>
+#include <ofono/modem.h>
+#include <ofono/location-reporting.h>
+
+#include "qmi.h"
+#include "pds.h"
+
+#include "qmimodem.h"
+
+struct location_data {
+	struct qmi_service *pds;
+	int fd;
+};
+
+static void event_notify(struct qmi_result *result, void *user_data)
+{
+	struct ofono_location_reporting *lr = user_data;
+	struct location_data *data = ofono_location_reporting_get_data(lr);
+	const void *ptr;
+	uint16_t len;
+	ssize_t written;
+
+	DBG("");
+
+	if (data->fd < 0)
+		return;
+
+	ptr = qmi_result_get(result, QMI_PDS_NOTIFY_NMEA, &len);
+	if (ptr) {
+		written = write(data->fd, ptr, len);
+		if (written < 0)
+			ofono_warn("Failed to write NMEA data");
+	}
+
+	ptr = qmi_result_get(result, QMI_PDS_NOTIFY_NMEA_DEBUG, &len);
+	if (ptr) {
+		written = write(data->fd, ptr, len);
+		if (written < 0)
+			ofono_warn("Failed to write NMEA debug");
+	}
+}
+
+static void state_notify(struct qmi_result *result, void *user_data)
+{
+	DBG("");
+}
+
+static int enable_data_stream(struct ofono_location_reporting *lr)
+{
+	struct location_data *data = ofono_location_reporting_get_data(lr);
+	int pipefd[2];
+
+	DBG("");
+
+	if (pipe2(pipefd, O_NONBLOCK | O_CLOEXEC) < 0)
+		return -1;
+
+	data->fd = pipefd[1];
+
+	return pipefd[0];
+}
+
+static void disable_data_stream(struct ofono_location_reporting *lr)
+{
+	struct location_data *data = ofono_location_reporting_get_data(lr);
+
+	DBG("");
+
+	close(data->fd);
+	data->fd = -1;
+}
+
+static void autotrack_enable_cb(struct qmi_result *result, void *user_data)
+{
+	struct cb_data *cbd = user_data;
+	ofono_location_reporting_enable_cb_t cb = cbd->cb;
+	struct ofono_location_reporting *lr = cbd->user;
+	int fd;
+
+	DBG("");
+
+	if (qmi_result_set_error(result, NULL)) {
+		CALLBACK_WITH_FAILURE(cb, -1, cbd->data);
+		return;
+	}
+
+	fd = enable_data_stream(lr);
+	if (fd < 0) {
+		CALLBACK_WITH_FAILURE(cb, -1, cbd->data);
+		return;
+	}
+
+	CALLBACK_WITH_SUCCESS(cb, fd, cbd->data);
+
+	close(fd);
+}
+
+static void qmi_location_reporting_enable(struct ofono_location_reporting *lr,
+		ofono_location_reporting_enable_cb_t cb, void *user_data)
+{
+	struct location_data *data = ofono_location_reporting_get_data(lr);
+	struct cb_data *cbd = cb_data_new(cb, user_data);
+	struct qmi_param *param;
+
+	DBG("");
+
+	cbd->user = lr;
+
+	param = qmi_param_new_uint8(QMI_PDS_PARAM_AUTO_TRACKING, 0x01);
+	if (!param)
+		goto error;
+
+	if (qmi_service_send(data->pds, QMI_PDS_SET_AUTOTRACK, param,
+					autotrack_enable_cb, cbd, g_free) > 0)
+		return;
+
+	qmi_param_free(param);
+
+error:
+	CALLBACK_WITH_FAILURE(cb, -1, cbd->data);
+
+	g_free(cbd);
+}
+
+static void autotrack_disable_cb(struct qmi_result *result, void *user_data)
+{
+	struct cb_data *cbd = user_data;
+	ofono_location_reporting_disable_cb_t cb = cbd->cb;
+	struct ofono_location_reporting *lr = cbd->user;
+
+	DBG("");
+
+	if (qmi_result_set_error(result, NULL)) {
+		CALLBACK_WITH_FAILURE(cb, cbd->data);
+		return;
+	}
+
+	disable_data_stream(lr);
+
+	CALLBACK_WITH_SUCCESS(cb, cbd->data);
+}
+
+static void qmi_location_reporting_disable(struct ofono_location_reporting *lr,
+		ofono_location_reporting_disable_cb_t cb, void *user_data)
+{
+	struct location_data *data = ofono_location_reporting_get_data(lr);
+	struct cb_data *cbd = cb_data_new(cb, user_data);
+	struct qmi_param *param;
+
+	DBG("");
+
+	cbd->user = lr;
+
+	param = qmi_param_new_uint8(QMI_PDS_PARAM_AUTO_TRACKING, 0x00);
+	if (!param)
+		goto error;
+
+	if (qmi_service_send(data->pds, QMI_PDS_SET_AUTOTRACK, param,
+					autotrack_disable_cb, cbd, g_free) > 0)
+		return;
+
+	qmi_param_free(param);
+
+error:
+	CALLBACK_WITH_FAILURE(cb, cbd->data);
+
+	g_free(cbd);
+}
+
+static void set_event_cb(struct qmi_result *result, void *user_data)
+{
+	struct ofono_location_reporting *lr = user_data;
+
+	DBG("");
+
+	ofono_location_reporting_register(lr);
+}
+
+static void create_pds_cb(struct qmi_service *service, void *user_data)
+{
+	struct ofono_location_reporting *lr = user_data;
+	struct location_data *data = ofono_location_reporting_get_data(lr);
+	struct qmi_param *param;
+
+	DBG("");
+
+	if (!service) {
+		ofono_error("Failed to request PDS service");
+		ofono_location_reporting_remove(lr);
+		return;
+	}
+
+	data->pds = qmi_service_ref(service);
+
+	qmi_service_register(data->pds, QMI_PDS_EVENT,
+					event_notify, lr, NULL);
+
+	qmi_service_register(data->pds, QMI_PDS_STATE_IND,
+					state_notify, lr, NULL);
+
+	param = qmi_param_new();
+	if (!param)
+		goto done;
+
+	qmi_param_append_uint8(param, QMI_PDS_PARAM_REPORT_NMEA, 0x01);
+	qmi_param_append_uint8(param, QMI_PDS_PARAM_REPORT_NMEA_DEBUG, 0x00);
+
+	if (qmi_service_send(data->pds, QMI_PDS_SET_EVENT, param,
+					set_event_cb, lr, NULL) > 0)
+		return;
+
+	qmi_param_free(param);
+
+done:
+	ofono_location_reporting_register(lr);
+}
+
+static int qmi_location_reporting_probe(struct ofono_location_reporting *lr,
+					unsigned int vendor, void *user_data)
+{
+	struct qmi_device *device = user_data;
+	struct location_data *data;
+
+	DBG("");
+
+	data = g_new0(struct location_data, 1);
+
+	data->fd = -1;
+
+	ofono_location_reporting_set_data(lr, data);
+
+	qmi_service_create(device, QMI_SERVICE_PDS, create_pds_cb, lr, NULL);
+
+	return 0;
+}
+
+static void qmi_location_reporting_remove(struct ofono_location_reporting *lr)
+{
+	struct location_data *data = ofono_location_reporting_get_data(lr);
+
+	DBG("");
+
+	ofono_location_reporting_set_data(lr, NULL);
+
+	qmi_service_unregister_all(data->pds);
+
+	qmi_service_unref(data->pds);
+
+	g_free(data);
+}
+
+static struct ofono_location_reporting_driver driver = {
+	.name		= "qmimodem",
+	.type		= OFONO_LOCATION_REPORTING_TYPE_NMEA,
+	.probe		= qmi_location_reporting_probe,
+	.remove		= qmi_location_reporting_remove,
+	.enable		= qmi_location_reporting_enable,
+	.disable	= qmi_location_reporting_disable,
+};
+
+void qmi_location_reporting_init()
+{
+	ofono_location_reporting_driver_register(&driver);
+}
+
+void qmi_location_reporting_exit()
+{
+	ofono_location_reporting_driver_unregister(&driver);
+}
diff --git a/drivers/qmimodem/pds.h b/drivers/qmimodem/pds.h
new file mode 100644
index 00000000..bba6deed
--- /dev/null
+++ b/drivers/qmimodem/pds.h
@@ -0,0 +1,45 @@
+/*
+ *
+ *  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_PDS_RESET		0	/* Reset PDS service state variables */
+#define QMI_PDS_EVENT		1	/* PDS report indication */
+#define QMI_PDS_SET_EVENT	1	/* Set PDS report conditions */
+
+#define QMI_PDS_GET_STATE	32	/* Return PDS service state */
+#define QMI_PDS_STATE_IND	32	/* PDS service state indication */
+
+#define QMI_PDS_GET_AUTOTRACK	48	/* Get the service auto-tracking state */
+#define QMI_PDS_SET_AUTOTRACK	49	/* Set the service auto-tracking state */
+
+
+/* PDS report indication */
+#define QMI_PDS_NOTIFY_NMEA			0x10	/* string */
+#define QMI_PDS_NOTIFY_NMEA_DEBUG		0x25	/* string */
+
+/* Set PDS report conditions */
+#define QMI_PDS_PARAM_REPORT_NMEA		0x10	/* bool */
+#define QMI_PDS_PARAM_REPORT_NMEA_DEBUG		0x22	/* bool */
+
+/* Get the service auto-tracking state */
+#define QMI_PDS_RESULT_AUTO_TRACKING		0x01	/* bool */
+
+/* Set the service auto-tracking state */
+#define QMI_PDS_PARAM_AUTO_TRACKING		0x01	/* bool */
diff --git a/drivers/qmimodem/qmimodem.c b/drivers/qmimodem/qmimodem.c
index ad9742bc..77f98e17 100644
--- a/drivers/qmimodem/qmimodem.c
+++ b/drivers/qmimodem/qmimodem.c
@@ -35,12 +35,14 @@ static int qmimodem_init(void)
 	qmi_sim_legacy_init();
 	qmi_gprs_init();
 	qmi_gprs_context_init();
+	qmi_location_reporting_init();
 
 	return 0;
 }
 
 static void qmimodem_exit(void)
 {
+	qmi_location_reporting_exit();
 	qmi_gprs_context_exit();
 	qmi_gprs_exit();
 	qmi_sim_legacy_exit();
diff --git a/drivers/qmimodem/qmimodem.h b/drivers/qmimodem/qmimodem.h
index c1584ca1..5a54c6cc 100644
--- a/drivers/qmimodem/qmimodem.h
+++ b/drivers/qmimodem/qmimodem.h
@@ -35,3 +35,6 @@ extern void qmi_gprs_exit(void);
 
 extern void qmi_gprs_context_init(void);
 extern void qmi_gprs_context_exit(void);
+
+extern void qmi_location_reporting_init(void);
+extern void qmi_location_reporting_exit(void);