summaryrefslogtreecommitdiffstats
path: root/serial/manager.c
diff options
context:
space:
mode:
authorClaudio Takahasi <claudio.takahasi@openbossa.org>2007-05-08 11:30:35 +0000
committerClaudio Takahasi <claudio.takahasi@openbossa.org>2007-05-08 11:30:35 +0000
commit5d9f545ef534d3d2f4861c336de8d4f6321dd011 (patch)
tree971c56b163142b01ba49b2f2c25037d820d3940b /serial/manager.c
parentfa6159b9a4d2e54d94d56e215474ea07155366a1 (diff)
serial: added rfcomm_connect
Diffstat (limited to 'serial/manager.c')
-rw-r--r--serial/manager.c138
1 files changed, 129 insertions, 9 deletions
diff --git a/serial/manager.c b/serial/manager.c
index 0b35f6e6..795b9b36 100644
--- a/serial/manager.c
+++ b/serial/manager.c
@@ -30,6 +30,9 @@
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
+#include <unistd.h>
+#include <sys/ioctl.h>
+
#include <glib.h>
#include <bluetooth/bluetooth.h>
@@ -37,6 +40,7 @@
#include <bluetooth/hci_lib.h>
#include <bluetooth/sdp.h>
#include <bluetooth/sdp_lib.h>
+#include <bluetooth/rfcomm.h>
#include "dbus.h"
#include "logging.h"
@@ -53,9 +57,10 @@
struct pending_connection {
DBusConnection *conn;
DBusMessage *msg;
- bdaddr_t src; /* Source address */
char *addr; /* Destination address */
char *adapter_path; /* Adapter D-Bus path */
+ bdaddr_t src;
+ uint8_t channel;
};
static DBusConnection *connection = NULL;
@@ -105,6 +110,108 @@ static DBusHandlerResult err_not_supported(DBusConnection *conn,
"The service is not supported by the remote device"));
}
+static gboolean rfcomm_connect_cb(GIOChannel *chan,
+ GIOCondition cond, struct pending_connection *pc)
+{
+ DBusMessage *reply;
+ char node_name[16];
+ const char *pname = node_name;
+ struct rfcomm_dev_req req;
+ int sk, ret, err, id;
+ socklen_t len;
+
+ /* FIXME: Check if it was canceled */
+
+ sk = g_io_channel_unix_get_fd(chan);
+
+ len = sizeof(ret);
+ if (getsockopt(sk, SOL_SOCKET, SO_ERROR, &ret, &len) < 0) {
+ err = errno;
+ error("getsockopt(SO_ERROR): %s (%d)", strerror(err), err);
+ goto fail;
+ }
+
+ if (ret != 0) {
+ error("connect(): %s (%d)", strerror(ret), ret);
+ goto fail;
+ }
+
+ debug("rfcomm_connect_cb: connected");
+
+ memset(&req, 0, sizeof(req));
+ req.dev_id = -1;
+ req.flags = (1 << RFCOMM_REUSE_DLC) | (1 << RFCOMM_RELEASE_ONHUP);
+ bacpy(&req.src, &pc->src);
+ str2ba(pc->addr, &req.dst);
+ req.channel = pc->channel;
+
+ id = ioctl(sk, RFCOMMCREATEDEV, &req);
+ if (id < 0) {
+ err = errno;
+ error("ioctl(RFCOMMCREATEDEV): %s (%d)", strerror(err), err);
+ err_connection_failed(pc->conn, pc->msg, strerror(err));
+ goto fail;
+ }
+
+ snprintf(node_name, 16, "/dev/rfcomm%d", id);
+ reply = dbus_message_new_method_return(pc->msg);
+ dbus_message_append_args(reply,
+ DBUS_TYPE_STRING, &pname,
+ DBUS_TYPE_INVALID);
+ send_message_and_unref(pc->conn, reply);
+fail:
+ pending_connection_free(pc);
+ /* FIXME: Remote from the pending connects list */
+ return FALSE;
+}
+
+static int rfcomm_connect(struct pending_connection *pc)
+{
+ struct sockaddr_rc addr;
+ GIOChannel *io;
+ int sk, err = 0;
+
+ sk = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
+ if (sk < 0)
+ return -errno;
+
+ addr.rc_family = AF_BLUETOOTH;
+ bacpy(&addr.rc_bdaddr, &pc->src);
+ addr.rc_channel = 0;
+
+ if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0)
+ return -errno;
+
+ if (set_nonblocking(sk) < 0)
+ return -errno;
+
+ io = g_io_channel_unix_new(sk);
+ g_io_channel_set_close_on_unref(io, TRUE);
+
+ addr.rc_family = AF_BLUETOOTH;
+ str2ba(pc->addr, &addr.rc_bdaddr);
+ addr.rc_channel = pc->channel;
+
+ if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
+ /* BlueZ returns EAGAIN eventhough it should return EINPROGRESS */
+ if (!(errno == EAGAIN || errno == EINPROGRESS)) {
+ err = errno;
+ error("connect() failed: %s (%d)", strerror(err), err);
+ goto fail;
+ }
+
+ debug("Connect in progress");
+ g_io_add_watch(io, G_IO_OUT, (GIOFunc) rfcomm_connect_cb, pc);
+ /* FIXME: Control the pending connects */
+ } else {
+ debug("Connect succeeded with first try");
+ (void) rfcomm_connect_cb(io, G_IO_OUT, pc);
+ }
+fail:
+ g_io_channel_unref(io);
+ return -err;
+}
+
static void record_reply(DBusPendingCall *call, void *data)
{
struct pending_connection *pc = data;
@@ -113,7 +220,7 @@ static void record_reply(DBusPendingCall *call, void *data)
const uint8_t *rec_bin;
sdp_list_t *protos;
DBusError derr;
- int len, scanned, ch;
+ int len, scanned, ch, err;
dbus_error_init(&derr);
if (dbus_set_error_from_message(&derr, reply)) {
@@ -163,10 +270,21 @@ static void record_reply(DBusPendingCall *call, void *data)
error("Channel out of range: %d", ch);
sdp_record_free(rec);
err_not_supported(pc->conn, pc->msg);
+ goto fail;
}
- /* FIXME: Check if there is a pending connection */
+ /* FIXME: Check if there is a pending connection or if it was canceled */
+
+ pc->channel = ch;
+ err = rfcomm_connect(pc);
+ if (err < 0) {
+ error("RFCOMM connection failed");
+ err_connection_failed(pc->conn, pc->msg, strerror(-err));
+ goto fail;
+ }
+ dbus_message_unref(reply);
+ return;
fail:
dbus_message_unref(reply);
dbus_error_free(&derr);
@@ -285,7 +403,7 @@ static DBusHandlerResult connect_service(DBusConnection *conn,
const char *addr, *pattern;
char *endptr;
long val;
- int dev_id;
+ int dev_id, err;
/* FIXME: Check if it already exist or if there is pending connect */
@@ -330,7 +448,6 @@ static DBusHandlerResult connect_service(DBusConnection *conn,
pending_connection_free(pc);
return err_not_supported(conn, msg);
}
-
return DBUS_HANDLER_RESULT_HANDLED;
}
@@ -353,7 +470,6 @@ static DBusHandlerResult connect_service(DBusConnection *conn,
if (get_record(pc, val, record_reply) < 0) {
pending_connection_free(pc);
return err_not_supported(conn, msg);
-
}
return DBUS_HANDLER_RESULT_HANDLED;
}
@@ -365,9 +481,13 @@ static DBusHandlerResult connect_service(DBusConnection *conn,
"invalid RFCOMM channel");
}
- /* FIXME: Connect */
- info("Connecting to channel: %d", val);
-
+ pc->channel = val;
+ err = rfcomm_connect(pc);
+ if (err < 0) {
+ const char *strerr = strerror(-err);
+ error("RFCOMM connect failed: %s(%d)", strerr, -err);
+ err_connection_failed(conn, msg, strerr);
+ }
return DBUS_HANDLER_RESULT_HANDLED;
}