#include <string.h>
#include <unistd.h>
#include <inttypes.h>
+#include <sys/socket.h>
#include <glib.h>
#include <gdbus.h>
#include "service.h"
#include "log.h"
#include "btio.h"
-#include "glib-helper.h"
#define BT_RX_MTU 32767
#define BT_TX_MTU 32767
if (any->path == NULL)
continue;
- xml = g_markup_printf_escaped(driver->record, driver->channel,
- driver->name);
+ if (driver->port != 0)
+ xml = g_markup_printf_escaped(driver->record,
+ driver->channel,
+ driver->name,
+ driver->port);
+ else
+ xml = g_markup_printf_escaped(driver->record,
+ driver->channel,
+ driver->name);
+
add_record(any->path, xml, service);
g_free(xml);
}
for (l = any->services; l; l = l->next) {
struct bluetooth_service *service = l->data;
+ struct obex_service_driver *driver = service->driver;
char *xml;
- xml = g_markup_printf_escaped(service->driver->record,
- service->driver->channel,
- service->driver->name);
+ if (driver->port != 0)
+ xml = g_markup_printf_escaped(driver->record,
+ driver->channel,
+ driver->name,
+ driver->port);
+ else
+ xml = g_markup_printf_escaped(driver->record,
+ driver->channel,
+ driver->name);
+
add_record(any->path, xml, service);
g_free(xml);
}
static void connect_event(GIOChannel *io, GError *err, void *user_data)
{
+ int sk = g_io_channel_unix_get_fd(io);
struct bluetooth_service *service = user_data;
struct obex_server *server = service->server;
+ int type;
+ int omtu = BT_TX_MTU;
+ int imtu = BT_RX_MTU;
+ gboolean stream = TRUE;
+ socklen_t len = sizeof(int);
if (err)
goto drop;
- if (obex_server_new_connection(server, io, BT_TX_MTU, BT_RX_MTU) < 0)
+ if (getsockopt(sk, SOL_SOCKET, SO_TYPE, &type, &len) < 0)
+ goto done;
+
+ if (type != SOCK_SEQPACKET)
+ goto done;
+
+ stream = FALSE;
+
+ /* Read MTU if io is an L2CAP socket */
+ bt_io_get(io, BT_IO_L2CAP, NULL, BT_IO_OPT_OMTU, &omtu,
+ BT_IO_OPT_IMTU, &imtu,
+ BT_IO_OPT_INVALID);
+
+done:
+ if (obex_server_new_connection(server, io, omtu, imtu, stream) < 0)
g_io_channel_shutdown(io, TRUE, NULL);
return;
}
static int request_service_authorization(struct bluetooth_service *service,
- GIOChannel *io, const char *address)
+ GIOChannel *io,
+ const char *source,
+ const char *address)
{
struct pending_request *pending;
- char source[18];
- GError *err = NULL;
if (connection == NULL || any->path == NULL)
return -1;
- bt_io_get(io, BT_IO_RFCOMM, &err,
- BT_IO_OPT_SOURCE, source,
- BT_IO_OPT_INVALID);
- if (err) {
- error("%s", err->message);
- g_error_free(err);
- return -EINVAL;
- }
-
pending = g_new0(struct pending_request, 1);
pending->call = find_adapter(source, find_adapter_reply, pending);
if (!pending->call) {
return 0;
}
-static void confirm_event(GIOChannel *io, void *user_data)
+static void confirm_connection(GIOChannel *io, const char *source,
+ const char *address, void *user_data)
{
+
+ struct obex_service_driver *driver = user_data;
struct bluetooth_service *service;
GError *err = NULL;
- char address[18];
- uint8_t channel;
- struct obex_service_driver *driver = user_data;
-
- bt_io_get(io, BT_IO_RFCOMM, &err,
- BT_IO_OPT_DEST, address,
- BT_IO_OPT_CHANNEL, &channel,
- BT_IO_OPT_INVALID);
- if (err) {
- error("%s", err->message);
- g_error_free(err);
- goto drop;
- }
-
- info("bluetooth: New connection from: %s, channel %u", address,
- channel);
service = find_service(driver);
if (service == NULL) {
}
if (driver->secure) {
- if (request_service_authorization(service, io, address) < 0)
+ if (request_service_authorization(service, io, source,
+ address) < 0)
goto drop;
return;
g_io_channel_shutdown(io, TRUE, NULL);
}
-static GIOChannel *start(struct obex_server *server,
+static void confirm_rfcomm(GIOChannel *io, void *user_data)
+{
+ GError *err = NULL;
+ char source[18];
+ char address[18];
+ uint8_t channel;
+
+ bt_io_get(io, BT_IO_RFCOMM, &err,
+ BT_IO_OPT_SOURCE, source,
+ BT_IO_OPT_DEST, address,
+ BT_IO_OPT_CHANNEL, &channel,
+ BT_IO_OPT_INVALID);
+ if (err) {
+ error("%s", err->message);
+ g_error_free(err);
+ g_io_channel_shutdown(io, TRUE, NULL);
+ return;
+ }
+
+ info("bluetooth: New connection from: %s, channel %u", address,
+ channel);
+
+ confirm_connection(io, source, address, user_data);
+}
+
+static void confirm_l2cap(GIOChannel *io, void *user_data)
+{
+ GError *err = NULL;
+ char source[18];
+ char address[18];
+ uint16_t psm;
+
+ bt_io_get(io, BT_IO_L2CAP, &err,
+ BT_IO_OPT_SOURCE, source,
+ BT_IO_OPT_DEST, address,
+ BT_IO_OPT_PSM, &psm,
+ BT_IO_OPT_INVALID);
+ if (err) {
+ error("%s", err->message);
+ g_error_free(err);
+ g_io_channel_shutdown(io, TRUE, NULL);
+ return;
+ }
+
+ info("bluetooth: New connection from: %s, psm %u", address, psm);
+
+ confirm_connection(io, source, address, user_data);
+}
+
+static GSList *start(struct obex_server *server,
struct obex_service_driver *service)
{
BtIOSecLevel sec_level;
+ GSList *l = NULL;
GIOChannel *io;
GError *err = NULL;
+ uint16_t psm;
if (service->secure == TRUE)
sec_level = BT_IO_SEC_MEDIUM;
else
sec_level = BT_IO_SEC_LOW;
-
- io = bt_io_listen(BT_IO_RFCOMM, NULL, confirm_event,
+ io = bt_io_listen(BT_IO_RFCOMM, NULL, confirm_rfcomm,
service, NULL, &err,
BT_IO_OPT_CHANNEL, service->channel,
BT_IO_OPT_SEC_LEVEL, sec_level,
error("bluetooth: unable to listen in channel %d: %s",
service->channel, err->message);
g_error_free(err);
- } else
+ } else {
+ l = g_slist_prepend(l, io);
DBG("listening on channel %d", service->channel);
+ }
+
+ if (service->port == 0)
+ return l;
+
+ psm = service->port == OBEX_PORT_RANDOM ? 0 : service->port;
+
+ io = bt_io_listen(BT_IO_L2CAP, NULL, confirm_l2cap,
+ service, NULL, &err,
+ BT_IO_OPT_PSM, psm,
+ BT_IO_OPT_MODE, BT_IO_MODE_ERTM,
+ BT_IO_OPT_OMTU, BT_TX_MTU,
+ BT_IO_OPT_IMTU, BT_RX_MTU,
+ BT_IO_OPT_SEC_LEVEL, sec_level,
+ BT_IO_OPT_INVALID);
+ if (io == NULL) {
+ error("bluetooth: unable to listen in psm %d: %s",
+ service->port, err->message);
+ g_error_free(err);
+ service->port = 0;
+ } else {
+ l = g_slist_prepend(l, io);
+ bt_io_get(io, BT_IO_L2CAP, &err, BT_IO_OPT_PSM, &service->port,
+ BT_IO_OPT_INVALID);
+ DBG("listening on psm %d", service->port);
+ }
- return io;
+ return l;
}
static void *bluetooth_start(struct obex_server *server, int *err)
for (l = server->drivers; l; l = l->next) {
struct obex_service_driver *service = l->data;
- GIOChannel *io;
+ GSList *l;
- io = start(server, service);
- if (io == NULL)
+ l = start(server, service);
+ if (l == NULL)
continue;
- ios = g_slist_prepend(ios, io);
+ ios = g_slist_concat(ios, l);
}
register_record(server);
static int bluetooth_getpeername(GIOChannel *io, char **name)
{
+ int sk = g_io_channel_unix_get_fd(io);
GError *gerr = NULL;
char address[18];
+ int type;
+ socklen_t len = sizeof(int);
- bt_io_get(io, BT_IO_RFCOMM, &gerr,
- BT_IO_OPT_DEST, address,
- BT_IO_OPT_INVALID);
- if (gerr)
+ if (getsockopt(sk, SOL_SOCKET, SO_TYPE, &type, &len) < 0)
+ return -errno;
+
+ if (type == SOCK_STREAM)
+ bt_io_get(io, BT_IO_RFCOMM, &gerr,
+ BT_IO_OPT_DEST, address,
+ BT_IO_OPT_INVALID);
+ else
+ bt_io_get(io, BT_IO_L2CAP, &gerr,
+ BT_IO_OPT_DEST, address,
+ BT_IO_OPT_INVALID);
+
+ if (gerr) {
+ error("%s", gerr->message);
+ g_error_free(gerr);
return -EINVAL;
+ }
*name = g_strdup(address);