---
audio/telephony.c | 252 ++++++++++++++++++++++++++++++++++++++++++++++++++++-
1 file changed, 249 insertions(+), 3 deletions(-)
diff --git a/audio/telephony.c b/audio/telephony.c
index 65eca41..1bcad6d 100644
--- a/audio/telephony.c
+++ b/audio/telephony.c
@@ -49,12 +49,14 @@
#include "telephony.h"
#include "dbus-common.h"
#include "../src/adapter.h"
+#include "../src/manager.h"
#include "../src/device.h"
#include "sdpd.h"
#define AUDIO_TELEPHONY_INTERFACE "org.bluez.Telephony"
#define AUDIO_TELEPHONY_AGENT_INTERFACE "org.bluez.TelephonyAgent"
+#define DEFAULT_DUN_GW_CHANNEL 1
#define DEFAULT_HS_HS_CHANNEL 6
#define DEFAULT_HS_AG_CHANNEL 12
#define DEFAULT_HF_HS_CHANNEL 7
@@ -97,6 +99,13 @@ struct tel_agent {
uint32_t record_id;
};
+struct dun_client {
+ struct btd_device *btd_dev;
+ bdaddr_t src, dst;
+ GIOChannel *rfcomm;
+ int preauth_id;
+};
+
static DBusConnection *connection = NULL;
static GSList *agents = NULL; /* server list */
@@ -259,6 +268,168 @@ static gboolean agent_sendfd(struct tel_device *dev, int fd,
return TRUE;
}
+static gboolean dun_dev_disconnect_cb(GIOChannel *chan, GIOCondition cond,
+ struct tel_device *dev)
+{
+ if (cond & G_IO_NVAL)
+ return FALSE;
+
+ telephony_device_disconnect(dev);
+
+ return FALSE;
+}
+
+static void dun_newconnection_reply(DBusPendingCall *call, void *user_data)
+{
+ struct tel_device *dev = user_data;
+ DBusMessage *reply = dbus_pending_call_steal_reply(call);
+ DBusError derr;
+
+ if (!dev->rfcomm) {
+ DBG("RFCOMM disconnected from server before agent reply");
+ goto done;
+ }
+
+ dbus_error_init(&derr);
+ if (!dbus_set_error_from_message(&derr, reply)) {
+ DBG("Agent reply: file descriptor passed successfully");
+ g_io_add_watch(dev->rfcomm, G_IO_ERR | G_IO_HUP | G_IO_NVAL,
+ (GIOFunc) dun_dev_disconnect_cb, dev);
+ goto done;
+ }
+
+ DBG("Agent reply: %s", derr.message);
+
+ dbus_error_free(&derr);
+
+done:
+ dbus_message_unref(reply);
+}
+
+static void dun_connect_cb(GIOChannel *chan, GError *err, gpointer user_data)
+{
+ struct dun_client *dun = user_data;
+ char hs_address[18];
+ void *agent;
+
+ if (err) {
+ error("%s", err->message);
+ goto done;
+ }
+
+ ba2str(&dun->dst, hs_address);
+
+ agent = telephony_agent_by_uuid(device_get_adapter(dun->btd_dev),
+ DUN_GW_UUID);
+ telephony_device_connecting(chan, dun->btd_dev, dun, agent);
+
+ DBG("%s: Connected to %s", device_get_path(dun->btd_dev), hs_address);
+
+done:
+ g_free(dun);
+
+ return;
+}
+
+static void dun_auth_cb(DBusError *derr, void *user_data)
+{
+ struct dun_client *dun = user_data;
+ GError *err = NULL;
+
+ if (dun->preauth_id) {
+ g_source_remove(dun->preauth_id);
+ dun->preauth_id = 0;
+ }
+
+ if (derr && dbus_error_is_set(derr)) {
+ error("Access denied: %s", derr->message);
+ g_free(dun);
+ return;
+ }
+
+ if (!bt_io_accept(dun->rfcomm, dun_connect_cb, dun, NULL, &err)) {
+ error("bt_io_accept: %s", err->message);
+ g_error_free(err);
+ g_free(dun);
+ return;
+ }
+}
+
+static gboolean dun_preauth_cb(GIOChannel *chan, GIOCondition cond,
+ gpointer user_data)
+{
+ struct dun_client *dun = user_data;
+
+ DBG("DUN Gateway disconnected during authorization");
+
+ btd_cancel_authorization(&dun->src, &dun->dst);
+
+ g_free(dun);
+
+ return FALSE;
+}
+
+static void dun_confirm(GIOChannel *chan, gpointer data)
+{
+ struct tel_agent *agent = data;
+ struct dun_client *dun;
+ struct btd_adapter *adapter;
+ struct btd_device *device;
+ char addr[18];
+ int perr;
+ GError *err = NULL;
+ uint8_t ch;
+
+ dun = g_new0(struct dun_client, 1);
+
+ bt_io_get(chan, BT_IO_RFCOMM, &err,
+ BT_IO_OPT_SOURCE_BDADDR, &dun->src,
+ BT_IO_OPT_DEST_BDADDR, &dun->dst,
+ BT_IO_OPT_CHANNEL, &ch,
+ BT_IO_OPT_INVALID);
+ if (err) {
+ error("%s", err->message);
+ g_error_free(err);
+ goto drop;
+ }
+
+ ba2str(&dun->src, addr);
+
+ adapter = manager_find_adapter(&dun->src);
+ if (!adapter) {
+ error("Unable to get a btd_adapter object for %s", addr);
+ goto drop;
+ }
+
+ ba2str(&dun->dst, addr);
+
+ device = adapter_get_device(connection, adapter, addr);
+ if (!device) {
+ error("Unable to get btd_device object for %s", addr);
+ goto drop;
+ }
+
+ dun->btd_dev = device;
+ dun->rfcomm = g_io_channel_ref(chan);
+
+ perr = btd_request_authorization(&dun->src, &dun->dst,
+ agent->properties->uuid,
+ dun_auth_cb, dun);
+ if (perr < 0) {
+ DBG("Authorization denied: %s", strerror(-perr));
+ return;
+ }
+
+ dun->preauth_id = g_io_add_watch(chan,
+ G_IO_NVAL | G_IO_HUP | G_IO_ERR,
+ dun_preauth_cb, dun);
+
+ return;
+
+drop:
+ g_io_channel_shutdown(chan, TRUE, NULL);
+}
+
static gboolean hs_dev_disconnect_cb(GIOChannel *chan, GIOCondition cond,
struct tel_device *dev)
{
@@ -401,7 +572,8 @@ void *telephony_device_connecting(GIOChannel *io, struct btd_device *btd_dev,
struct tel_device *dev;
struct tel_agent *ag = agent;
uuid_t uuid;
- int err;
+ int sk;
+ int err = 0;
dev = g_new0(struct tel_device, 1);
dev->btd_dev = btd_dev;
@@ -412,10 +584,22 @@ void *telephony_device_connecting(GIOChannel *io, struct btd_device *btd_dev,
dev->rfcomm = io;
dev->features = 0xFFFF;
- sdp_uuid16_create(&uuid, dev->properties->r_class);
+ if (dev->properties->r_class == 0) {
+ sk = g_io_channel_unix_get_fd(dev->rfcomm);
- err = bt_search_service(&device->src, &device->dst, &uuid,
+ if (agent_sendfd(dev, sk, dev->properties->connection_reply)
+ == FALSE) {
+ error("Failed to send RFComm socket to agent %s,"
+ " path %s", dev->name, dev->path);
+ err = -1;
+ }
+ } else {
+ sdp_uuid16_create(&uuid, dev->properties->r_class);
+
+ err = bt_search_service(&device->src, &device->dst, &uuid,
get_record_cb, dev, NULL);
+ }
+
if (err < 0) {
g_free(dev->name);
g_free(dev->path);
@@ -461,6 +645,60 @@ const char *telephony_get_agent_name(void *slc)
return dev->name;
}
+static sdp_record_t *dun_gw_record(struct tel_agent * agent)
+{
+ sdp_list_t *svclass_id, *pfseq, *apseq, *root;
+ uuid_t root_uuid, svclass_uuid;
+ uuid_t l2cap_uuid, rfcomm_uuid;
+ sdp_profile_desc_t profile;
+ sdp_list_t *aproto, *proto[2];
+ sdp_record_t *record;
+ sdp_data_t *channel;
+
+ record = sdp_record_alloc();
+ if (!record)
+ return NULL;
+
+ sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
+ root = sdp_list_append(0, &root_uuid);
+ sdp_set_browse_groups(record, root);
+
+ sdp_uuid16_create(&svclass_uuid, DIALUP_NET_SVCLASS_ID);
+ svclass_id = sdp_list_append(0, &svclass_uuid);
+ sdp_set_service_classes(record, svclass_id);
+
+ sdp_uuid16_create(&profile.uuid, DIALUP_NET_PROFILE_ID);
+ profile.version = agent->version;
+ pfseq = sdp_list_append(0, &profile);
+ sdp_set_profile_descs(record, pfseq);
+
+ sdp_uuid16_create(&l2cap_uuid, L2CAP_UUID);
+ proto[0] = sdp_list_append(0, &l2cap_uuid);
+ apseq = sdp_list_append(0, proto[0]);
+
+ sdp_uuid16_create(&rfcomm_uuid, RFCOMM_UUID);
+ proto[1] = sdp_list_append(0, &rfcomm_uuid);
+ channel = sdp_data_alloc(SDP_UINT8, &agent->properties->channel);
+ proto[1] = sdp_list_append(proto[1], channel);
+ apseq = sdp_list_append(apseq, proto[1]);
+
+ aproto = sdp_list_append(0, apseq);
+ sdp_set_access_protos(record, aproto);
+
+ sdp_set_info_attr(record, "Dial-up Networking", 0, 0);
+
+ sdp_data_free(channel);
+ sdp_list_free(proto[0], 0);
+ sdp_list_free(proto[1], 0);
+ sdp_list_free(apseq, 0);
+ sdp_list_free(pfseq, 0);
+ sdp_list_free(aproto, 0);
+ sdp_list_free(root, 0);
+ sdp_list_free(svclass_id, 0);
+
+ return record;
+}
+
#if 0
static sdp_record_t *hsp_hs_record(struct tel_agent * agent)
{
@@ -940,6 +1178,14 @@ drop:
}
static struct default_agent default_properties[] = {
+ { DUN_GW_UUID,
+ DEFAULT_DUN_GW_CHANNEL,
+ NULL,
+ 0,
+ 0,
+ dun_gw_record,
+ dun_confirm,
+ dun_newconnection_reply },
{ HSP_AG_UUID,
DEFAULT_HS_AG_CHANNEL,
HSP_HS_UUID,
--
1.7.9.5
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
