diff options
Diffstat (limited to 'network/connection.c')
-rw-r--r-- | network/connection.c | 622 |
1 files changed, 622 insertions, 0 deletions
diff --git a/network/connection.c b/network/connection.c new file mode 100644 index 0000000..f4dd74e --- /dev/null +++ b/network/connection.c @@ -0,0 +1,622 @@ +/* + * + * BlueZ - Bluetooth protocol stack for Linux + * + * Copyright (C) 2004-2010 Marcel Holtmann <marcel@holtmann.org> + * + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * 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 <unistd.h> +#include <netinet/in.h> + +#include <bluetooth/bluetooth.h> +#include <bluetooth/bnep.h> +#include <bluetooth/sdp.h> + +#include <glib.h> +#include <gdbus.h> + +#include "log.h" +#include "glib-helper.h" +#include "btio.h" +#include "dbus-common.h" +#include "adapter.h" +#include "device.h" + +#include "error.h" +#include "common.h" +#include "connection.h" + +#define NETWORK_PEER_INTERFACE "org.bluez.Network" + +typedef enum { + CONNECTED, + CONNECTING, + DISCONNECTED +} conn_state; + +struct network_peer { + bdaddr_t src; + bdaddr_t dst; + char *path; /* D-Bus path */ + struct btd_device *device; + GSList *connections; +}; + +struct network_conn { + DBusMessage *msg; + char dev[16]; /* Interface name */ + uint16_t id; /* Role: Service Class Identifier */ + conn_state state; + GIOChannel *io; + guint watch; /* Disconnect watch */ + guint dc_id; + struct network_peer *peer; +}; + +struct __service_16 { + uint16_t dst; + uint16_t src; +} __attribute__ ((packed)); + +static DBusConnection *connection = NULL; +static GSList *peers = NULL; + +static struct network_peer *find_peer(GSList *list, const char *path) +{ + GSList *l; + + for (l = list; l; l = l->next) { + struct network_peer *peer = l->data; + + if (!strcmp(peer->path, path)) + return peer; + } + + return NULL; +} + +static struct network_conn *find_connection(GSList *list, uint16_t id) +{ + GSList *l; + + for (l = list; l; l = l->next) { + struct network_conn *nc = l->data; + + if (nc->id == id) + return nc; + } + + return NULL; +} + +static gboolean bnep_watchdog_cb(GIOChannel *chan, GIOCondition cond, + gpointer data) +{ + struct network_conn *nc = data; + + if (connection != NULL) { + gboolean connected = FALSE; + const char *property = ""; + emit_property_changed(connection, nc->peer->path, + NETWORK_PEER_INTERFACE, "Connected", + DBUS_TYPE_BOOLEAN, &connected); + emit_property_changed(connection, nc->peer->path, + NETWORK_PEER_INTERFACE, "Interface", + DBUS_TYPE_STRING, &property); + emit_property_changed(connection, nc->peer->path, + NETWORK_PEER_INTERFACE, "UUID", + DBUS_TYPE_STRING, &property); + device_remove_disconnect_watch(nc->peer->device, nc->dc_id); + nc->dc_id = 0; + if (nc->watch) { + g_dbus_remove_watch(connection, nc->watch); + nc->watch = 0; + } + } + + info("%s disconnected", nc->dev); + + bnep_if_down(nc->dev); + nc->state = DISCONNECTED; + memset(nc->dev, 0, sizeof(nc->dev)); + strcpy(nc->dev, "bnep%d"); + + return FALSE; +} + +static void cancel_connection(struct network_conn *nc, const char *err_msg) +{ + DBusMessage *reply; + + if (nc->watch) { + g_dbus_remove_watch(connection, nc->watch); + nc->watch = 0; + } + + if (nc->msg && err_msg) { + reply = btd_error_failed(nc->msg, err_msg); + g_dbus_send_message(connection, reply); + } + + g_io_channel_shutdown(nc->io, TRUE, NULL); + g_io_channel_unref(nc->io); + nc->io = NULL; + + nc->state = DISCONNECTED; +} + +static void connection_destroy(DBusConnection *conn, void *user_data) +{ + struct network_conn *nc = user_data; + + if (nc->state == CONNECTED) { + bnep_if_down(nc->dev); + bnep_kill_connection(&nc->peer->dst); + } else if (nc->io) + cancel_connection(nc, NULL); +} + +static void disconnect_cb(struct btd_device *device, gboolean removal, + void *user_data) +{ + struct network_conn *nc = user_data; + + info("Network: disconnect %s", nc->peer->path); + + connection_destroy(NULL, user_data); +} + +static gboolean bnep_setup_cb(GIOChannel *chan, GIOCondition cond, + gpointer data) +{ + struct network_conn *nc = data; + struct bnep_control_rsp *rsp; + struct timeval timeo; + char pkt[BNEP_MTU]; + ssize_t r; + int sk; + const char *pdev, *uuid; + gboolean connected; + + if (cond & G_IO_NVAL) + return FALSE; + + if (cond & (G_IO_HUP | G_IO_ERR)) { + error("Hangup or error on l2cap server socket"); + goto failed; + } + + sk = g_io_channel_unix_get_fd(chan); + + memset(pkt, 0, BNEP_MTU); + r = read(sk, pkt, sizeof(pkt) -1); + if (r < 0) { + error("IO Channel read error"); + goto failed; + } + + if (r == 0) { + error("No packet received on l2cap socket"); + goto failed; + } + + errno = EPROTO; + + if ((size_t) r < sizeof(*rsp)) { + error("Packet received is not bnep type"); + goto failed; + } + + rsp = (void *) pkt; + if (rsp->type != BNEP_CONTROL) { + error("Packet received is not bnep type"); + goto failed; + } + + if (rsp->ctrl != BNEP_SETUP_CONN_RSP) + return TRUE; + + r = ntohs(rsp->resp); + + if (r != BNEP_SUCCESS) { + error("bnep failed"); + goto failed; + } + + memset(&timeo, 0, sizeof(timeo)); + timeo.tv_sec = 0; + + setsockopt(sk, SOL_SOCKET, SO_RCVTIMEO, &timeo, sizeof(timeo)); + + if (bnep_connadd(sk, BNEP_SVC_PANU, nc->dev)) { + error("%s could not be added", nc->dev); + goto failed; + } + + bnep_if_up(nc->dev); + pdev = nc->dev; + uuid = bnep_uuid(nc->id); + + g_dbus_send_reply(connection, nc->msg, + DBUS_TYPE_STRING, &pdev, + DBUS_TYPE_INVALID); + + connected = TRUE; + emit_property_changed(connection, nc->peer->path, + NETWORK_PEER_INTERFACE, "Connected", + DBUS_TYPE_BOOLEAN, &connected); + emit_property_changed(connection, nc->peer->path, + NETWORK_PEER_INTERFACE, "Interface", + DBUS_TYPE_STRING, &pdev); + emit_property_changed(connection, nc->peer->path, + NETWORK_PEER_INTERFACE, "UUID", + DBUS_TYPE_STRING, &uuid); + + nc->state = CONNECTED; + nc->dc_id = device_add_disconnect_watch(nc->peer->device, disconnect_cb, + nc, NULL); + + info("%s connected", nc->dev); + /* Start watchdog */ + g_io_add_watch(chan, G_IO_ERR | G_IO_HUP | G_IO_NVAL, + (GIOFunc) bnep_watchdog_cb, nc); + g_io_channel_unref(nc->io); + nc->io = NULL; + + return FALSE; + +failed: + cancel_connection(nc, "bnep setup failed"); + + return FALSE; +} + +static int bnep_connect(struct network_conn *nc) +{ + struct bnep_setup_conn_req *req; + struct __service_16 *s; + struct timeval timeo; + unsigned char pkt[BNEP_MTU]; + int fd; + + /* Send request */ + req = (void *) pkt; + req->type = BNEP_CONTROL; + req->ctrl = BNEP_SETUP_CONN_REQ; + req->uuid_size = 2; /* 16bit UUID */ + s = (void *) req->service; + s->dst = htons(nc->id); + s->src = htons(BNEP_SVC_PANU); + + memset(&timeo, 0, sizeof(timeo)); + timeo.tv_sec = 30; + + fd = g_io_channel_unix_get_fd(nc->io); + setsockopt(fd, SOL_SOCKET, SO_RCVTIMEO, &timeo, sizeof(timeo)); + + if (send(fd, pkt, sizeof(*req) + sizeof(*s), 0) < 0) + return -errno; + + g_io_add_watch(nc->io, G_IO_IN | G_IO_ERR | G_IO_HUP | G_IO_NVAL, + (GIOFunc) bnep_setup_cb, nc); + + return 0; +} + +static void connect_cb(GIOChannel *chan, GError *err, gpointer data) +{ + struct network_conn *nc = data; + const char *err_msg; + int perr; + + if (err) { + error("%s", err->message); + err_msg = err->message; + goto failed; + } + + perr = bnep_connect(nc); + if (perr < 0) { + err_msg = strerror(-perr); + error("bnep connect(): %s (%d)", err_msg, -perr); + goto failed; + } + + return; + +failed: + cancel_connection(nc, err_msg); +} + +/* Connect and initiate BNEP session */ +static DBusMessage *connection_connect(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + struct network_peer *peer = data; + struct network_conn *nc; + const char *svc; + uint16_t id; + GError *err = NULL; + + if (dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &svc, + DBUS_TYPE_INVALID) == FALSE) + return NULL; + + id = bnep_service_id(svc); + nc = find_connection(peer->connections, id); + if (!nc) + return btd_error_not_supported(msg); + + if (nc->state != DISCONNECTED) + return btd_error_already_connected(msg); + + nc->io = bt_io_connect(BT_IO_L2CAP, connect_cb, nc, + NULL, &err, + BT_IO_OPT_SOURCE_BDADDR, &peer->src, + BT_IO_OPT_DEST_BDADDR, &peer->dst, + BT_IO_OPT_PSM, BNEP_PSM, + BT_IO_OPT_OMTU, BNEP_MTU, + BT_IO_OPT_IMTU, BNEP_MTU, + BT_IO_OPT_INVALID); + if (!nc->io) { + DBusMessage *reply; + error("%s", err->message); + reply = btd_error_failed(msg, err->message); + g_error_free(err); + return reply; + } + + nc->state = CONNECTING; + nc->msg = dbus_message_ref(msg); + nc->watch = g_dbus_add_disconnect_watch(conn, + dbus_message_get_sender(msg), + connection_destroy, + nc, NULL); + + return NULL; +} + +static DBusMessage *connection_cancel(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + struct network_conn *nc = data; + const char *owner = dbus_message_get_sender(nc->msg); + const char *caller = dbus_message_get_sender(msg); + + if (!g_str_equal(owner, caller)) + return btd_error_not_authorized(msg); + + connection_destroy(conn, nc); + + return g_dbus_create_reply(msg, DBUS_TYPE_INVALID); +} + +static DBusMessage *connection_disconnect(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + struct network_peer *peer = data; + GSList *l; + + for (l = peer->connections; l; l = l->next) { + struct network_conn *nc = l->data; + + if (nc->state == DISCONNECTED) + continue; + + return connection_cancel(conn, msg, nc); + } + + return btd_error_not_connected(msg); +} + +static DBusMessage *connection_get_properties(DBusConnection *conn, + DBusMessage *msg, void *data) +{ + struct network_peer *peer = data; + struct network_conn *nc = NULL; + DBusMessage *reply; + DBusMessageIter iter; + DBusMessageIter dict; + dbus_bool_t connected; + const char *property; + GSList *l; + + reply = dbus_message_new_method_return(msg); + if (!reply) + return NULL; + + dbus_message_iter_init_append(reply, &iter); + + dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY, + DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING + DBUS_TYPE_STRING_AS_STRING DBUS_TYPE_VARIANT_AS_STRING + DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict); + + /* Connected */ + for (l = peer->connections; l; l = l->next) { + struct network_conn *tmp = l->data; + + if (tmp->state != CONNECTED) + continue; + + nc = tmp; + break; + } + + connected = nc ? TRUE : FALSE; + dict_append_entry(&dict, "Connected", DBUS_TYPE_BOOLEAN, &connected); + + /* Interface */ + property = nc ? nc->dev : ""; + dict_append_entry(&dict, "Interface", DBUS_TYPE_STRING, &property); + + /* UUID */ + property = nc ? bnep_uuid(nc->id) : ""; + dict_append_entry(&dict, "UUID", DBUS_TYPE_STRING, &property); + + dbus_message_iter_close_container(&iter, &dict); + + return reply; +} + +static void connection_free(struct network_conn *nc) +{ + if (nc->dc_id) + device_remove_disconnect_watch(nc->peer->device, nc->dc_id); + + connection_destroy(connection, nc); + + g_free(nc); + nc = NULL; +} + +static void peer_free(struct network_peer *peer) +{ + g_slist_foreach(peer->connections, (GFunc) connection_free, NULL); + g_slist_free(peer->connections); + btd_device_unref(peer->device); + g_free(peer->path); + g_free(peer); +} + +static void path_unregister(void *data) +{ + struct network_peer *peer = data; + + DBG("Unregistered interface %s on path %s", + NETWORK_PEER_INTERFACE, peer->path); + + peers = g_slist_remove(peers, peer); + peer_free(peer); +} + +static GDBusMethodTable connection_methods[] = { + { "Connect", "s", "s", connection_connect, + G_DBUS_METHOD_FLAG_ASYNC }, + { "Disconnect", "", "", connection_disconnect }, + { "GetProperties", "", "a{sv}",connection_get_properties }, + { } +}; + +static GDBusSignalTable connection_signals[] = { + { "PropertyChanged", "sv" }, + { } +}; + +void connection_unregister(const char *path, uint16_t id) +{ + struct network_peer *peer; + struct network_conn *nc; + + peer = find_peer(peers, path); + if (!peer) + return; + + nc = find_connection(peer->connections, id); + if (!nc) + return; + + peer->connections = g_slist_remove(peer->connections, nc); + connection_free(nc); + if (peer->connections) + return; + + g_dbus_unregister_interface(connection, path, NETWORK_PEER_INTERFACE); +} + +static struct network_peer *create_peer(struct btd_device *device, + const char *path, bdaddr_t *src, + bdaddr_t *dst) +{ + struct network_peer *peer; + + peer = g_new0(struct network_peer, 1); + peer->device = btd_device_ref(device); + peer->path = g_strdup(path); + bacpy(&peer->src, src); + bacpy(&peer->dst, dst); + + if (g_dbus_register_interface(connection, path, + NETWORK_PEER_INTERFACE, + connection_methods, + connection_signals, NULL, + peer, path_unregister) == FALSE) { + error("D-Bus failed to register %s interface", + NETWORK_PEER_INTERFACE); + peer_free(peer); + return NULL; + } + + DBG("Registered interface %s on path %s", + NETWORK_PEER_INTERFACE, path); + + return peer; +} + +int connection_register(struct btd_device *device, const char *path, + bdaddr_t *src, bdaddr_t *dst, uint16_t id) +{ + struct network_peer *peer; + struct network_conn *nc; + + if (!path) + return -EINVAL; + + peer = find_peer(peers, path); + if (!peer) { + peer = create_peer(device, path, src, dst); + if (!peer) + return -1; + peers = g_slist_append(peers, peer); + } + + nc = find_connection(peer->connections, id); + if (nc) + return 0; + + nc = g_new0(struct network_conn, 1); + nc->id = id; + memset(nc->dev, 0, sizeof(nc->dev)); + strcpy(nc->dev, "bnep%d"); + nc->state = DISCONNECTED; + nc->peer = peer; + + peer->connections = g_slist_append(peer->connections, nc); + + return 0; +} + +int connection_init(DBusConnection *conn) +{ + connection = dbus_connection_ref(conn); + + return 0; +} + +void connection_exit(void) +{ + dbus_connection_unref(connection); + connection = NULL; +} |