mirror of
https://gitlab.freedesktop.org/pulseaudio/pulseaudio.git
synced 2025-11-01 22:58:47 -04:00
Adding module-bt-discover
This commit is contained in:
João Paulo Rechi Vita
Lennart Poettering
parent
2ab4bb76b2
commit
8b511f5598
1 changed files with 461 additions and 0 deletions
461
src/modules/module-bt-discover.c
Normal file
461
src/modules/module-bt-discover.c
Normal file
|
|
@ -0,0 +1,461 @@
|
|||
/* TODO LIST
|
||||
* listen to signals AdapterAdded, AdapterRemoved, DeviceCreated and DeviceRemoved
|
||||
* listen to org.freedesktop.DBus.NameOwnerChanged, to properly handle hcid activity
|
||||
*/
|
||||
|
||||
/***
|
||||
This file is part of PulseAudio.
|
||||
|
||||
Copyright 2008 Joao Paulo Rechi Vita
|
||||
|
||||
PulseAudio is free software; you can redistribute it and/or modify
|
||||
it under the terms of the GNU Lesser General Public License as published
|
||||
by the Free Software Foundation; either version 2 of the License,
|
||||
or (at your option) any later version.
|
||||
|
||||
PulseAudio 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 Lesser General Public License
|
||||
along with PulseAudio; if not, write to the Free Software
|
||||
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
|
||||
USA.
|
||||
***/
|
||||
|
||||
#include <config.h>
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
#include <pulse/xmalloc.h>
|
||||
#include <pulsecore/module.h>
|
||||
#include <pulsecore/modargs.h>
|
||||
|
||||
#include "dbus-util.h"
|
||||
/* TODO: Create symdef file for static linking
|
||||
* #include "module-bt-proximity-symdef.h" */
|
||||
|
||||
PA_MODULE_AUTHOR("Joao Paulo Rechi Vita");
|
||||
PA_MODULE_DESCRIPTION("Detect available bluetooth audio devices and load bluetooth audio drivers");
|
||||
PA_MODULE_VERSION(PACKAGE_VERSION);
|
||||
PA_MODULE_USAGE("");
|
||||
|
||||
#define AUDIO_DEVICE_INTERFACE "org.bluez.audio.Device"
|
||||
#define GENERIC_AUDIO_UUID "00001203-0000-1000-8000-00805F9B34FB"
|
||||
#define HSP_HS_UUID "00001108-0000-1000-8000-00805F9B34FB"
|
||||
#define HSP_AG_UUID "00001112-0000-1000-8000-00805F9B34FB"
|
||||
#define HFP_HS_UUID "0000111E-0000-1000-8000-00805F9B34FB"
|
||||
#define HFP_AG_UUID "0000111F-0000-1000-8000-00805F9B34FB"
|
||||
#define ADVANCED_AUDIO_UUID "0000110D-0000-1000-8000-00805F9B34FB"
|
||||
#define A2DP_SOURCE_UUID "0000110A-0000-1000-8000-00805F9B34FB"
|
||||
#define A2DP_SINK_UUID "0000110B-0000-1000-8000-00805F9B34FB"
|
||||
#define AVRCP_REMOTE_UUID "0000110E-0000-1000-8000-00805F9B34FB"
|
||||
#define AVRCP_TARGET_UUID "0000110C-0000-1000-8000-00805F9B34FB"
|
||||
|
||||
#define VERBOSE 1
|
||||
|
||||
typedef struct adapter adapter_t;
|
||||
typedef struct device device_t;
|
||||
typedef struct uuid uuid_t;
|
||||
|
||||
struct uuid {
|
||||
char *uuid;
|
||||
uuid_t *next;
|
||||
};
|
||||
|
||||
struct device {
|
||||
char *name;
|
||||
char *object_path;
|
||||
int paired;
|
||||
adapter_t *adapter;
|
||||
char *alias;
|
||||
int connected;
|
||||
uuid_t *uuid_list;
|
||||
char *address;
|
||||
int class;
|
||||
int trusted;
|
||||
device_t *next;
|
||||
};
|
||||
|
||||
struct adapter {
|
||||
char *object_path;
|
||||
char *mode;
|
||||
char *address;
|
||||
device_t *device_list;
|
||||
adapter_t *next;
|
||||
};
|
||||
|
||||
struct userdata {
|
||||
pa_module *module;
|
||||
pa_dbus_connection *conn;
|
||||
adapter_t *adapter_list;
|
||||
};
|
||||
|
||||
uuid_t *uuid_new(const char *uuid) {
|
||||
uuid_t *node = pa_xnew0(uuid_t, 1);
|
||||
node->uuid = pa_xstrdup(uuid);
|
||||
node->next = NULL;
|
||||
return node;
|
||||
}
|
||||
|
||||
void uuid_list_append(uuid_t *node, const char *uuid) {
|
||||
while (node->next != NULL) node = node->next;
|
||||
node->next = uuid_new(uuid);
|
||||
}
|
||||
|
||||
device_t *device_new(const char *device, adapter_t *adapter) {
|
||||
device_t *node = pa_xnew0(device_t, 1);
|
||||
node->name = NULL;
|
||||
node->object_path = pa_xstrdup(device);
|
||||
node->paired = -1;
|
||||
node->adapter = adapter;
|
||||
node->alias = NULL;
|
||||
node->connected = -1;
|
||||
node->uuid_list = uuid_new("UUID_HEAD");
|
||||
node->address = NULL;
|
||||
node->class = -1;
|
||||
node->trusted = -1;
|
||||
node->next = NULL;
|
||||
return node;
|
||||
}
|
||||
|
||||
void device_list_append(device_t *node, const char *device, adapter_t *adapter) {
|
||||
while (node->next != NULL) node = node->next;
|
||||
node->next = device_new(device, adapter);
|
||||
}
|
||||
|
||||
adapter_t *adapter_new(const char *adapter) {
|
||||
adapter_t *node = pa_xnew0(adapter_t, 1);
|
||||
node->object_path = pa_xstrdup(adapter);
|
||||
node->mode = NULL;
|
||||
node->address = NULL;
|
||||
node->device_list = device_new("/DEVICE_HEAD", NULL);
|
||||
node->next = NULL;
|
||||
return node;
|
||||
}
|
||||
|
||||
void adapter_list_append(adapter_t *node, const char *adapter) {
|
||||
while (node->next != NULL) node = node->next;
|
||||
node->next = adapter_new(adapter);
|
||||
}
|
||||
|
||||
void print_devices(device_t *device_list) {
|
||||
device_t *device_list_i = device_list;
|
||||
while (device_list_i != NULL) {
|
||||
uuid_t *uuid_list_i = device_list_i->uuid_list;
|
||||
if (strcmp(device_list_i->object_path, "/DEVICE_HEAD") != 0) {
|
||||
pa_log(" [ %s ]", device_list_i->object_path);
|
||||
pa_log(" Name = %s", device_list_i->name);
|
||||
pa_log(" Paired = %d", device_list_i->paired);
|
||||
pa_log(" Adapter = %s", device_list_i->adapter->object_path);
|
||||
pa_log(" Alias = %s", device_list_i->alias);
|
||||
pa_log(" Connected = %d", device_list_i->connected);
|
||||
pa_log(" UUIDs = ");
|
||||
while (uuid_list_i != NULL) {
|
||||
if (strcmp(uuid_list_i->uuid, "UUID_HEAD") != 0) {
|
||||
pa_log(" %s", uuid_list_i->uuid);
|
||||
}
|
||||
uuid_list_i = uuid_list_i->next;
|
||||
}
|
||||
pa_log(" Address = %s", device_list_i->address);
|
||||
pa_log(" Class = 0x%x", device_list_i->class);
|
||||
pa_log(" Trusted = %d", device_list_i->trusted);
|
||||
}
|
||||
device_list_i = device_list_i->next;
|
||||
}
|
||||
}
|
||||
|
||||
void print_adapters(adapter_t *adapter_list) {
|
||||
adapter_t *adapter_list_i = adapter_list;
|
||||
while (adapter_list_i != NULL) {
|
||||
if (strcmp(adapter_list_i->object_path, "/ADAPTER_HEAD") != 0) {
|
||||
pa_log("[ %s ]", adapter_list_i->object_path);
|
||||
pa_log(" Mode = %s", adapter_list_i->mode);
|
||||
pa_log(" Address = %s", adapter_list_i->address);
|
||||
print_devices(adapter_list_i->device_list);
|
||||
}
|
||||
adapter_list_i = adapter_list_i->next;
|
||||
}
|
||||
}
|
||||
|
||||
DBusMessageIter call_dbus_method(pa_dbus_connection *conn, const char *destination, const char *path, const char *interface,
|
||||
const char *method) {
|
||||
DBusMessage *msg;
|
||||
DBusPendingCall *pending;
|
||||
DBusMessageIter args;
|
||||
|
||||
/* construct the DBusMessage */
|
||||
msg = dbus_message_new_method_call(destination, path, interface, method);
|
||||
|
||||
/* send the message and get a handle for a reply */
|
||||
if (!dbus_connection_send_with_reply(pa_dbus_connection_get(conn), msg, &pending, -1)) {
|
||||
pa_log("Out Of Memory!");
|
||||
}
|
||||
if (pending == NULL) {
|
||||
pa_log("Pending Call Null");
|
||||
}
|
||||
dbus_connection_flush(pa_dbus_connection_get(conn));
|
||||
|
||||
/* free msg */
|
||||
dbus_message_unref(msg);
|
||||
|
||||
/* wait for reply */
|
||||
dbus_pending_call_block(pending);
|
||||
|
||||
/* get the reply */
|
||||
msg = dbus_pending_call_steal_reply(pending);
|
||||
if (msg == NULL) {
|
||||
pa_log("Reply Null");
|
||||
}
|
||||
|
||||
/* free pending */
|
||||
dbus_pending_call_unref(pending);
|
||||
|
||||
/* read the reply */
|
||||
if (!dbus_message_iter_init(msg, &args))
|
||||
pa_log("Reply has no arguments");
|
||||
|
||||
dbus_message_unref(msg);
|
||||
|
||||
return args;
|
||||
|
||||
}
|
||||
|
||||
void detect_adapters(adapter_t *adapter_list, pa_dbus_connection *conn) {
|
||||
DBusMessageIter arg_i, element_i, dict_i, variant_i;
|
||||
adapter_t *adapter_list_i;
|
||||
const char *key, *value;
|
||||
|
||||
/* get adapters */
|
||||
arg_i = call_dbus_method(conn, "org.bluez", "/", "org.bluez.Manager", "ListAdapters");
|
||||
dbus_message_iter_recurse(&arg_i, &element_i);
|
||||
while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
|
||||
if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_OBJECT_PATH) {
|
||||
dbus_message_iter_get_basic(&element_i, &value);
|
||||
adapter_list_append(adapter_list, value);
|
||||
}
|
||||
dbus_message_iter_next(&element_i);
|
||||
}
|
||||
|
||||
/* get adapter properties */
|
||||
adapter_list_i = adapter_list->next;
|
||||
while (adapter_list_i != NULL) {
|
||||
arg_i = call_dbus_method(conn, "org.bluez", adapter_list_i->object_path, "org.bluez.Adapter", "GetProperties");
|
||||
dbus_message_iter_recurse(&arg_i, &element_i);
|
||||
while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
|
||||
if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
|
||||
dbus_message_iter_recurse(&element_i, &dict_i);
|
||||
dbus_message_iter_get_basic(&dict_i, &key);
|
||||
dbus_message_iter_next(&dict_i);
|
||||
dbus_message_iter_recurse(&dict_i, &variant_i);
|
||||
dbus_message_iter_get_basic(&variant_i, &value);
|
||||
if (strcmp(key, "Mode") == 0) {
|
||||
adapter_list_i->mode = pa_xstrdup(value);
|
||||
}
|
||||
else if (strcmp(key, "Address") == 0) {
|
||||
adapter_list_i->address = pa_xstrdup(value);
|
||||
}
|
||||
}
|
||||
dbus_message_iter_next(&element_i);
|
||||
}
|
||||
adapter_list_i = adapter_list_i->next;
|
||||
}
|
||||
}
|
||||
|
||||
void detect_devices(adapter_t *adapter_list, pa_dbus_connection *conn) {
|
||||
DBusMessageIter arg_i, element_i, dict_i, variant_i;
|
||||
adapter_t *adapter_list_i;
|
||||
device_t *device_list_i, *device_list_prev_i;
|
||||
const char *key, *value;
|
||||
unsigned int uvalue;
|
||||
|
||||
/* get devices of each adapter */
|
||||
adapter_list_i = adapter_list->next;
|
||||
while (adapter_list_i != NULL) {
|
||||
arg_i = call_dbus_method(conn, "org.bluez", adapter_list_i->object_path , "org.bluez.Adapter", "ListDevices");
|
||||
dbus_message_iter_recurse(&arg_i, &element_i);
|
||||
while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
|
||||
if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_OBJECT_PATH) {
|
||||
dbus_message_iter_get_basic(&element_i, &value);
|
||||
device_list_append(adapter_list_i->device_list, value, adapter_list_i);
|
||||
}
|
||||
dbus_message_iter_next(&element_i);
|
||||
}
|
||||
adapter_list_i = adapter_list_i->next;
|
||||
}
|
||||
|
||||
/* get device properties */
|
||||
adapter_list_i = adapter_list->next;
|
||||
while (adapter_list_i != NULL) {
|
||||
device_list_prev_i = adapter_list_i->device_list;
|
||||
device_list_i = adapter_list_i->device_list->next;
|
||||
while (device_list_i != NULL) {
|
||||
arg_i = call_dbus_method(conn, "org.bluez", device_list_i->object_path, "org.bluez.Device", "GetProperties");
|
||||
dbus_message_iter_recurse(&arg_i, &element_i);
|
||||
while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
|
||||
if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_DICT_ENTRY) {
|
||||
dbus_message_iter_recurse(&element_i, &dict_i);
|
||||
dbus_message_iter_get_basic(&dict_i, &key);
|
||||
dbus_message_iter_next(&dict_i);
|
||||
dbus_message_iter_recurse(&dict_i, &variant_i);
|
||||
if (strcmp(key, "Name") == 0) {
|
||||
dbus_message_iter_get_basic(&variant_i, &value);
|
||||
device_list_i->name = pa_xstrdup(value);
|
||||
}
|
||||
else if (strcmp(key, "Paired") == 0) {
|
||||
dbus_message_iter_get_basic(&variant_i, &uvalue);
|
||||
device_list_i->paired = uvalue;
|
||||
}
|
||||
else if (strcmp(key, "Alias") == 0) {
|
||||
dbus_message_iter_get_basic(&variant_i, &value);
|
||||
device_list_i->alias = pa_xstrdup(value);
|
||||
}
|
||||
else if (strcmp(key, "Connected") == 0) {
|
||||
dbus_message_iter_get_basic(&variant_i, &uvalue);
|
||||
device_list_i->connected = uvalue;
|
||||
}
|
||||
else if (strcmp(key, "UUIDs") == 0) {
|
||||
DBusMessageIter uuid_i;
|
||||
int is_audio_device = 0;
|
||||
dbus_message_iter_recurse(&variant_i, &uuid_i);
|
||||
while (dbus_message_iter_get_arg_type(&uuid_i) != DBUS_TYPE_INVALID) {
|
||||
dbus_message_iter_get_basic(&uuid_i, &value);
|
||||
if ( (strcmp(value, HSP_HS_UUID) == 0) || (strcmp(value, HFP_HS_UUID) == 0) ||
|
||||
(strcmp(value, A2DP_SOURCE_UUID) == 0) || (strcmp(value, A2DP_SINK_UUID) == 0) )
|
||||
is_audio_device = 1;
|
||||
uuid_list_append(device_list_i->uuid_list, value);
|
||||
dbus_message_iter_next(&uuid_i);
|
||||
}
|
||||
if (!is_audio_device) {
|
||||
/* remove current device */
|
||||
device_list_prev_i->next = device_list_i->next;
|
||||
pa_xfree(device_list_i);
|
||||
break;
|
||||
}
|
||||
}
|
||||
else if (strcmp(key, "Address") == 0) {
|
||||
dbus_message_iter_get_basic(&variant_i, &value);
|
||||
device_list_i->address = pa_xstrdup(value);
|
||||
}
|
||||
else if (strcmp(key, "Class") == 0) {
|
||||
dbus_message_iter_get_basic(&variant_i, &uvalue);
|
||||
device_list_i->class = uvalue;
|
||||
}
|
||||
else if (strcmp(key, "Trusted") == 0) {
|
||||
dbus_message_iter_get_basic(&variant_i, &uvalue);
|
||||
device_list_i->trusted = uvalue;
|
||||
}
|
||||
}
|
||||
dbus_message_iter_next(&element_i);
|
||||
}
|
||||
device_list_prev_i = device_list_prev_i->next;
|
||||
if (device_list_prev_i == NULL)
|
||||
device_list_i = NULL;
|
||||
else
|
||||
device_list_i = device_list_prev_i->next;
|
||||
}
|
||||
adapter_list_i = adapter_list_i->next;
|
||||
}
|
||||
}
|
||||
|
||||
void pa__done(pa_module* m) {
|
||||
struct userdata *u;
|
||||
adapter_t *adapter_list_i, *adapter_list_next_i;
|
||||
device_t *device_list_i, *device_list_next_i;
|
||||
|
||||
pa_assert(m);
|
||||
|
||||
if (!(u = m->userdata))
|
||||
return;
|
||||
|
||||
if ((adapter_list_i = u->adapter_list) != NULL) {
|
||||
while ((adapter_list_next_i = adapter_list_i->next) != NULL) {
|
||||
if ((device_list_i = adapter_list_i->device_list) != NULL) {
|
||||
while ((device_list_next_i = device_list_i->next) != NULL) {
|
||||
pa_xfree(device_list_i);
|
||||
device_list_i = device_list_next_i;
|
||||
}
|
||||
pa_xfree(device_list_i);
|
||||
}
|
||||
pa_xfree(adapter_list_i);
|
||||
adapter_list_i = adapter_list_next_i;
|
||||
}
|
||||
pa_xfree(adapter_list_i);
|
||||
}
|
||||
|
||||
pa_dbus_connection_unref(u->conn);
|
||||
pa_xfree(u);
|
||||
pa_log("Unloading module-bt-discover");
|
||||
return;
|
||||
}
|
||||
|
||||
int pa__init(pa_module* m) {
|
||||
pa_modargs *ma = NULL;
|
||||
DBusError err;
|
||||
DBusMessageIter arg_i, element_i;
|
||||
adapter_t *adapter_list_i;
|
||||
device_t *device_list_i;
|
||||
const char *value;
|
||||
unsigned int hcid_running = 0;
|
||||
struct userdata *u;
|
||||
|
||||
pa_assert(m);
|
||||
dbus_error_init(&err);
|
||||
pa_log("Loading module-bt-discover");
|
||||
m->userdata = u = pa_xnew0(struct userdata, 1);
|
||||
u->module = m;
|
||||
|
||||
/* connect to the bus */
|
||||
u->conn = pa_dbus_bus_get(m->core, DBUS_BUS_SYSTEM, &err);
|
||||
if ( dbus_error_is_set(&err) || (u->conn == NULL) ) {
|
||||
pa_log("Failed to get D-Bus connection: %s", err.message);
|
||||
goto fail;
|
||||
}
|
||||
|
||||
/* check if hcid is running */
|
||||
arg_i = call_dbus_method(u->conn, "org.freedesktop.DBus", "/org/freedesktop/DBus" , "org.freedesktop.DBus", "ListNames");
|
||||
dbus_message_iter_recurse(&arg_i, &element_i);
|
||||
while (dbus_message_iter_get_arg_type(&element_i) != DBUS_TYPE_INVALID) {
|
||||
if (dbus_message_iter_get_arg_type(&element_i) == DBUS_TYPE_STRING) {
|
||||
dbus_message_iter_get_basic(&element_i, &value);
|
||||
if (strcmp(value, "org.bluez") == 0)
|
||||
hcid_running = 1;
|
||||
}
|
||||
dbus_message_iter_next(&element_i);
|
||||
}
|
||||
if (!hcid_running) {
|
||||
pa_log("hcid not running");
|
||||
goto fail;
|
||||
}
|
||||
|
||||
/* static detection of bluetooth devices */
|
||||
u->adapter_list = adapter_new("/ADAPTER_HEAD");
|
||||
detect_adapters(u->adapter_list, u->conn);
|
||||
detect_devices(u->adapter_list, u->conn);
|
||||
|
||||
if (VERBOSE) print_adapters(u->adapter_list);
|
||||
|
||||
/* load device modules */
|
||||
adapter_list_i = u->adapter_list->next;
|
||||
while (adapter_list_i != NULL) {
|
||||
device_list_i = adapter_list_i->device_list->next;
|
||||
while (device_list_i != NULL) {
|
||||
pa_log("Loading module-bt-device for %s", device_list_i->name); /* CHECK: Should it be name or alias? */
|
||||
/* call module */
|
||||
device_list_i = device_list_i->next;
|
||||
}
|
||||
adapter_list_i = adapter_list_i->next;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
fail:
|
||||
if (ma)
|
||||
pa_modargs_free(ma);
|
||||
dbus_error_free(&err);
|
||||
pa__done(m);
|
||||
return -1;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue