handsfree: Add skeleton implementation

Makefile.am

@@ -424,7 +424,8 @@ src_ofonod_SOURCES = $(gdbus_sources) $(builtin_sources) src/ofono.ver \
 			src/cdma-connman.c src/gnss.c \
 			src/gnssagent.c src/gnssagent.h \
 			src/cdma-smsutil.h src/cdma-smsutil.c \
-			src/cdma-sms.c src/private-network.c src/cdma-netreg.c
+			src/cdma-sms.c src/private-network.c src/cdma-netreg.c \
+			src/handsfree.c
 
 src_ofonod_LDADD = $(builtin_libadd) @GLIB_LIBS@ @DBUS_LIBS@ @CAPNG_LIBS@ -ldl
 

src/handsfree.c

@@ -0,0 +1,223 @@
+/*
+ *
+ *  oFono - Open Source Telephony
+ *
+ *  Copyright (C) 2008-2010  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 <string.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <errno.h>
+#include <unistd.h>
+
+#include <glib.h>
+
+#include <ofono/log.h>
+#include <ofono/modem.h>
+#include <ofono/handsfree.h>
+
+#include <gdbus.h>
+#include "ofono.h"
+#include "common.h"
+
+static GSList *g_drivers = NULL;
+
+struct ofono_handsfree {
+	const struct ofono_handsfree_driver *driver;
+	void *driver_data;
+	struct ofono_atom *atom;
+};
+
+static DBusMessage *handsfree_get_properties(DBusConnection *conn,
+						DBusMessage *msg, void *data)
+{
+	DBusMessage *reply;
+	DBusMessageIter iter;
+	DBusMessageIter dict;
+
+	reply = dbus_message_new_method_return(msg);
+	if (reply == NULL)
+		return NULL;
+
+	dbus_message_iter_init_append(reply, &iter);
+
+	dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY,
+					OFONO_PROPERTIES_ARRAY_SIGNATURE,
+					&dict);
+	dbus_message_iter_close_container(&iter, &dict);
+
+	return reply;
+}
+
+static DBusMessage *handsfree_set_property(DBusConnection *conn,
+						DBusMessage *msg, void *data)
+{
+	DBusMessageIter iter, var;
+	const char *name;
+
+	if (dbus_message_iter_init(msg, &iter) == FALSE)
+		return __ofono_error_invalid_args(msg);
+
+	if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_STRING)
+		return __ofono_error_invalid_args(msg);
+
+	dbus_message_iter_get_basic(&iter, &name);
+	dbus_message_iter_next(&iter);
+
+	if (dbus_message_iter_get_arg_type(&iter) != DBUS_TYPE_VARIANT)
+		return __ofono_error_invalid_args(msg);
+
+	dbus_message_iter_recurse(&iter, &var);
+
+	return __ofono_error_invalid_args(msg);
+}
+
+static GDBusMethodTable handsfree_methods[] = {
+	{ "GetProperties",    "",    "a{sv}", handsfree_get_properties,
+		G_DBUS_METHOD_FLAG_ASYNC },
+	{ "SetProperty",      "sv",  "", handsfree_set_property,
+		G_DBUS_METHOD_FLAG_ASYNC },
+	{ NULL, NULL, NULL, NULL }
+};
+
+static GDBusSignalTable handsfree_signals[] = {
+	{ "PropertyChanged",	"sv" },
+	{ }
+};
+
+static void handsfree_remove(struct ofono_atom *atom)
+{
+	struct ofono_handsfree *hf = __ofono_atom_get_data(atom);
+
+	DBG("atom: %p", atom);
+
+	if (hf == NULL)
+		return;
+
+	if (hf->driver != NULL && hf->driver->remove != NULL)
+		hf->driver->remove(hf);
+
+	g_free(hf);
+}
+
+struct ofono_handsfree *ofono_handsfree_create(struct ofono_modem *modem,
+					unsigned int vendor,
+					const char *driver,
+					void *data)
+{
+	struct ofono_handsfree *hf;
+	GSList *l;
+
+	if (driver == NULL)
+		return NULL;
+
+	hf = g_try_new0(struct ofono_handsfree, 1);
+	if (hf == NULL)
+		return NULL;
+
+	hf->atom = __ofono_modem_add_atom(modem,
+					OFONO_ATOM_TYPE_HANDSFREE,
+					handsfree_remove, hf);
+
+	for (l = g_drivers; l; l = l->next) {
+		const struct ofono_handsfree_driver *drv = l->data;
+
+		if (g_strcmp0(drv->name, driver))
+			continue;
+
+		if (drv->probe(hf, vendor, data) < 0)
+			continue;
+
+		hf->driver = drv;
+		break;
+	}
+
+	return hf;
+}
+
+static void handsfree_unregister(struct ofono_atom *atom)
+{
+	DBusConnection *conn = ofono_dbus_get_connection();
+	struct ofono_modem *modem = __ofono_atom_get_modem(atom);
+	const char *path = __ofono_atom_get_path(atom);
+
+	ofono_modem_remove_interface(modem, OFONO_HANDSFREE_INTERFACE);
+	g_dbus_unregister_interface(conn, path,
+					OFONO_HANDSFREE_INTERFACE);
+}
+
+void ofono_handsfree_register(struct ofono_handsfree *hf)
+{
+	DBusConnection *conn = ofono_dbus_get_connection();
+	struct ofono_modem *modem = __ofono_atom_get_modem(hf->atom);
+	const char *path = __ofono_atom_get_path(hf->atom);
+
+	if (!g_dbus_register_interface(conn, path,
+					OFONO_HANDSFREE_INTERFACE,
+					handsfree_methods, handsfree_signals,
+					NULL, hf, NULL)) {
+		ofono_error("Could not create %s interface",
+					OFONO_HANDSFREE_INTERFACE);
+
+		return;
+	}
+
+	ofono_modem_add_interface(modem, OFONO_HANDSFREE_INTERFACE);
+
+	__ofono_atom_register(hf->atom, handsfree_unregister);
+}
+
+int ofono_handsfree_driver_register(const struct ofono_handsfree_driver *d)
+{
+	DBG("driver: %p, name: %s", d, d->name);
+
+	if (d->probe == NULL)
+		return -EINVAL;
+
+	g_drivers = g_slist_prepend(g_drivers, (void *) d);
+
+	return 0;
+}
+
+void ofono_handsfree_driver_unregister(
+				const struct ofono_handsfree_driver *d)
+{
+	DBG("driver: %p, name: %s", d, d->name);
+
+	g_drivers = g_slist_remove(g_drivers, (void *) d);
+}
+
+void ofono_handsfree_remove(struct ofono_handsfree *hf)
+{
+	__ofono_atom_free(hf->atom);
+}
+
+void ofono_handsfree_set_data(struct ofono_handsfree *hf, void *data)
+{
+	hf->driver_data = data;
+}
+
+void *ofono_handsfree_get_data(struct ofono_handsfree *hf)
+{
+	return hf->driver_data;
+}

src/ofono.h

@@ -138,6 +138,7 @@ enum ofono_atom_type {
 	OFONO_ATOM_TYPE_GNSS,
 	OFONO_ATOM_TYPE_CDMA_SMS,
 	OFONO_ATOM_TYPE_CDMA_NETREG,
+	OFONO_ATOM_TYPE_HANDSFREE,
 };
 
 enum ofono_atom_watch_condition {