Hi Frédéric,

On 08/27/2013 11:59 AM, Frédéric Dalleau wrote:
> This code can register an handsfree audio agent and receive NewConnection and
> Release calls.
> ---
>   tools/handsfree-audio.c |  388 +++++++++++++++++++++++++++++++++++++++++++++++
>   1 file changed, 388 insertions(+)
>   create mode 100644 tools/handsfree-audio.c
>
> diff --git a/tools/handsfree-audio.c b/tools/handsfree-audio.c
> new file mode 100644
> index 0000000..8ff2876
> --- /dev/null
> +++ b/tools/handsfree-audio.c
> @@ -0,0 +1,388 @@
> +/*
> + *
> + *  oFono - Open Source Telephony
> + *
> + *  Copyright (C) 2013  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 <stdio.h>
> +#include <errno.h>
> +#include <fcntl.h>
> +#include <unistd.h>
> +#include <stdlib.h>
> +#include <string.h>
> +#include <signal.h>
> +#include <pthread.h>
> +#include <sys/socket.h>
> +#include <poll.h>
> +
> +#include <gdbus.h>
> +#include <glib.h>
> +
> +#define OFONO_SERVICE			"org.ofono"
> +#define HFP_AUDIO_MANAGER_PATH		"/"
> +#define HFP_AUDIO_MANAGER_INTERFACE	OFONO_SERVICE ".HandsfreeAudioManager"
> +#define HFP_AUDIO_AGENT_PATH		"/hfpaudioagent"
> +#define HFP_AUDIO_AGENT_INTERFACE	OFONO_SERVICE ".HandsfreeAudioAgent"
> +
> +#define HFP_AUDIO_CVSD			1
> +#define HFP_AUDIO_MSBC			2
> +
> +#define DBG(fmt, arg...) do {\
> +		g_print("%s: " fmt "\n", __FUNCTION__, ## arg);\
> +	} while (0)
> +
> +/* DBus related */
> +static GMainLoop *main_loop = NULL;
> +static DBusConnection *conn;
> +static GSList *threads = NULL;
> +
> +static gboolean option_nocvsd = FALSE;

Why do we need this option? CVSD must always be supported.

> +static gboolean option_nomsbc = FALSE;
> +
> +struct hfp_thread {
> +	int fd;
> +	int running;

You might want to make this atomic, if this variable is needed at all

> +	pthread_t thread;
> +};
> +
> +static void hfp_audio_thread_free(struct hfp_thread *thread)
> +{
> +	DBG("Freeing audio connection %p", thread);
> +
> +	if (!thread)
> +		return;
> +
> +	thread->running = 0;
> +	if (thread->thread)
> +		pthread_join(thread->thread, NULL);
> +
> +	if (shutdown(thread->fd, SHUT_RDWR) < 0)
> +			DBG("Failed to shutdown socket");

When sending the NewConnection method call on the Agent, oFono closes 
the accepted / connected SCO socket.  So it has no ownership of it at 
this point.  Do we really need this shutdown system call here?

> +
> +	if (close(thread->fd) < 0)
> +		DBG("Failed to close socket");
> +
> +	threads = g_slist_remove(threads, thread);
> +	g_free(thread);
> +	DBG("freed %p", thread);
> +}
> +
> +static gboolean thread_cleanup(gpointer user_data)
> +{
> +	hfp_audio_thread_free(user_data);
> +	return FALSE;
> +}
> +
> +static void *thread_func(void *userdata)
> +{
> +	struct hfp_thread *thread = userdata;
> +	struct pollfd fds[8];
> +
> +	/* Force defered setup */
> +	if (recv(thread->fd, NULL, 0, 0) < 0)
> +		DBG("Defered setup failed: %d (%s)", errno, strerror(errno));
> +
> +	while (thread->running) {
> +		int err;
> +		char c[128];
> +
> +		memset(fds, 0, sizeof(fds));
> +		fds[0].fd = thread->fd;
> +		fds[0].events = POLLIN | POLLERR | POLLHUP | POLLNVAL;
> +		if (poll(fds, 1, 200) == 0)
> +			continue;
> +
> +		if (fds[0].revents & (POLLERR | POLLHUP | POLLNVAL)) {
> +			DBG("POLLERR | POLLHUP | POLLNVAL triggered (%d)",
> +					fds[0].revents);
> +			break;
> +		}
> +
> +		if (!fds[0].revents & POLLIN)
> +			continue;
> +
> +		err = recv(thread->fd, &c, sizeof(c), 0);
> +
> +		if (err < 0) {
> +			DBG("POLLIN triggered, but read error");
> +			break;
> +		}
> +
> +		DBG("%d bytes received", err);
> +	}
> +
> +	/* Ask main loop to join */
> +	g_idle_add(thread_cleanup, userdata);

This part makes no sense to me.  We have two broad cases being covered:
1. Cleaning up the threads on exit, in which case this g_idle_add is 
pointless since there is no more main loop to run
2. Cleaning up the thread when an exceptional condition occurs, e.g. 
socket is closed.

You might want to separate the logic for each appropriately.

A more broad question is, why are you using threads in the first place? 
  Can't we interact with ALSA via regular FD polling?

> +	return NULL;
> +}
> +
> +static int new_connection(int fd, int codec)
> +{
> +	struct hfp_thread *thread;
> +
> +	DBG("New connection: fd=%d codec=%d", fd, codec);
> +	thread = g_try_malloc0(sizeof(struct hfp_thread));
> +	if (thread == NULL)
> +		return -ENOMEM;
> +
> +	thread->fd = fd;
> +	thread->running = 1;
> +
> +	if (pthread_create(&thread->thread, NULL, thread_func, thread) < 0) {
> +		hfp_audio_thread_free(thread);
> +		return -EINVAL;
> +	}
> +
> +	threads = g_slist_prepend(threads, thread);
> +	return 0;
> +}
> +
> +static DBusMessage *agent_newconnection(DBusConnection *conn, DBusMessage *msg,
> +								void *data)
> +{
> +	const char *card;
> +	int fd;
> +	unsigned char codec;
> +	DBusMessage *reply;
> +
> +	DBG("New connection");
> +
> +	if (dbus_message_get_args(msg, NULL, DBUS_TYPE_OBJECT_PATH, &card,
> +			DBUS_TYPE_UNIX_FD, &fd, DBUS_TYPE_BYTE, &codec,
> +			DBUS_TYPE_INVALID) == FALSE)
> +		return g_dbus_create_error(msg,
> +				HFP_AUDIO_AGENT_INTERFACE ".InvalidArguments",
> +				"Invalid arguments");
> +
> +	reply = dbus_message_new_method_return(msg);
> +	if (!reply)
> +		goto fail;
> +
> +	if (new_connection(fd, codec) >= 0)
> +		return reply;
> +
> +	dbus_message_unref(reply);
> +
> +fail:
> +	close(fd);
> +
> +	return g_dbus_create_error(msg,
> +			HFP_AUDIO_AGENT_INTERFACE ".Failed", "Failed to start");
> +}
> +
> +static DBusMessage *agent_release(DBusConnection *conn, DBusMessage *msg,
> +		void *data)
> +{
> +	DBG("HFP audio agent released");
> +	/* agent will be registered on next oFono startup */
> +	return dbus_message_new_method_return(msg);
> +}
> +
> +static const GDBusMethodTable agent_methods[] = {
> +	{ GDBUS_METHOD("NewConnection",
> +		GDBUS_ARGS({ "path", "o" }, { "fd", "h" }, { "codec", "y" }),
> +		NULL, agent_newconnection) },
> +	{ GDBUS_METHOD("Release", NULL, NULL, agent_release) },
> +	{ },
> +};
> +
> +static void hfp_audio_agent_register_reply(DBusPendingCall *call, void *data)
> +{
> +	DBusMessage *reply = dbus_pending_call_steal_reply(call);
> +	DBusError err;
> +
> +	dbus_error_init(&err);
> +
> +	if (dbus_set_error_from_message(&err, reply) == TRUE) {
> +		DBG("Failed to register audio agent (%s: %s)",
> +				err.name, err.message);
> +		dbus_error_free(&err);
> +	} else
> +		DBG("HFP audio agent registered");
> +
> +	dbus_message_unref(reply);
> +}
> +
> +static void hfp_audio_agent_register(DBusConnection *conn)
> +{
> +	DBusMessage *msg;
> +	DBusPendingCall *call;
> +	const char *path = HFP_AUDIO_AGENT_PATH;
> +	unsigned char codecs[2];
> +	const unsigned char *pcodecs = codecs;
> +	int ncodecs = 0;
> +
> +	DBG("Registering audio agent in oFono");
> +
> +	msg = dbus_message_new_method_call(OFONO_SERVICE,
> +			HFP_AUDIO_MANAGER_PATH, HFP_AUDIO_MANAGER_INTERFACE,
> +			"Register");
> +	if (msg == NULL) {
> +		DBG("Not enough memory");
> +		return;
> +	}
> +
> +	if (option_nocvsd == FALSE)
> +		codecs[ncodecs++] = HFP_AUDIO_CVSD;
> +
> +	if (option_nomsbc == FALSE)
> +		codecs[ncodecs++] = HFP_AUDIO_MSBC;
> +
> +	dbus_message_append_args(msg, DBUS_TYPE_OBJECT_PATH, &path,
> +			DBUS_TYPE_ARRAY, DBUS_TYPE_BYTE, &pcodecs, ncodecs,
> +			DBUS_TYPE_INVALID);
> +
> +	if (!dbus_connection_send_with_reply(conn, msg, &call, -1)) {
> +		dbus_message_unref(msg);
> +		DBG("Unable to register agent");
> +		return;
> +	}
> +
> +	dbus_message_unref(msg);
> +
> +	dbus_pending_call_set_notify(call, hfp_audio_agent_register_reply, NULL,
> +			NULL);
> +
> +	dbus_pending_call_unref(call);
> +}
> +
> +static void hfp_audio_agent_create(DBusConnection *conn)
> +{
> +	DBG("Registering audio agent on DBUS");
> +
> +	if (!g_dbus_register_interface(conn, HFP_AUDIO_AGENT_PATH,
> +			HFP_AUDIO_AGENT_INTERFACE, agent_methods, NULL, NULL,
> +			NULL, NULL)) {
> +		DBG("Unable to create local agent");
> +		g_main_loop_quit(main_loop);

When this function is called the main loop isn't running yet...

> +	}
> +}
> +
> +static void hfp_audio_agent_destroy(DBusConnection *conn)
> +{
> +	DBG("Unregistering audio agent on DBUS");
> +
> +	g_dbus_unregister_interface(conn, HFP_AUDIO_AGENT_PATH,
> +			HFP_AUDIO_AGENT_INTERFACE);
> +}
> +
> +static void ofono_connect(DBusConnection *conn, void *user_data)
> +{
> +	DBG("oFono appeared");
> +
> +	hfp_audio_agent_register(conn);
> +}
> +
> +static void ofono_disconnect(DBusConnection *conn, void *user_data)
> +{
> +	DBG("oFono disappeared");
> +}
> +
> +static void disconnect_callback(DBusConnection *conn, void *user_data)
> +{
> +	DBG("Disconnected from BUS");
> +
> +	g_main_loop_quit(main_loop);
> +}
> +
> +static void sig_term(int sig)
> +{
> +	DBG("Terminating");
> +
> +	g_main_loop_quit(main_loop);
> +}
> +
> +static GOptionEntry options[] = {
> +	{ "nocvsd", 'c', 0, G_OPTION_ARG_NONE, &option_nocvsd,
> +				"Disable CVSD support" },
> +	{ "nomsbc", 'm', 0, G_OPTION_ARG_NONE, &option_nomsbc,
> +				"Disable MSBC support" },
> +	{ NULL },
> +};
> +
> +int main(int argc, char **argv)
> +{
> +	GOptionContext *context;
> +	GError *error = NULL;
> +	DBusError err;
> +	guint watch;
> +	struct sigaction sa;
> +
> +	context = g_option_context_new(NULL);
> +	g_option_context_add_main_entries(context, options, NULL);
> +
> +	if (g_option_context_parse(context, &argc, &argv, &error) == FALSE) {
> +		if (error != NULL) {
> +			DBG("%s", error->message);
> +			g_error_free(error);
> +		} else
> +			DBG("An unknown error occurred");
> +		exit(1);
> +	}
> +
> +	g_option_context_free(context);
> +
> +	if (option_nocvsd == TRUE && option_nomsbc == TRUE) {
> +		DBG("At least one codec must be supported");
> +		exit(2);
> +	}
> +
> +	main_loop = g_main_loop_new(NULL, FALSE);
> +
> +	dbus_error_init(&err);
> +
> +	memset(&sa, 0, sizeof(sa));
> +	sa.sa_handler = sig_term;
> +	sigaction(SIGINT, &sa, NULL);
> +	sigaction(SIGTERM, &sa, NULL);

It might be better to use signalfd here instead of sigaction.

> +
> +	conn = g_dbus_setup_bus(DBUS_BUS_SYSTEM, NULL, &err);
> +	if (conn == NULL) {
> +		if (dbus_error_is_set(&err) == TRUE) {
> +			DBG("%s", err.message);
> +			dbus_error_free(&err);
> +		} else
> +			DBG("Can't register with system bus");
> +		exit(1);
> +	}
> +
> +	g_dbus_set_disconnect_function(conn, disconnect_callback, NULL, NULL);
> +
> +	hfp_audio_agent_create(conn);
> +
> +	watch = g_dbus_add_service_watch(conn, OFONO_SERVICE,
> +				ofono_connect, ofono_disconnect, NULL, NULL);
> +
> +	g_main_loop_run(main_loop);
> +
> +	while (threads != NULL)
> +		hfp_audio_thread_free(threads->data);
> +
> +	g_dbus_remove_watch(conn, watch);
> +	hfp_audio_agent_destroy(conn);
> +
> +	dbus_connection_unref(conn);
> +
> +	g_main_loop_unref(main_loop);
> +
> +	return 0;
> +}
>

Regards,
-Denis