summaryrefslogtreecommitdiffstats
path: root/serial
diff options
context:
space:
mode:
authorLuiz Augusto von Dentz <luiz.dentz@indt.org.br>2008-08-12 18:59:10 -0300
committerLuiz Augusto von Dentz <luiz.dentz@indt.org.br>2008-08-12 18:59:10 -0300
commitcfb4d2ae65f9dc2c2f792dfeb1afc164ee598efc (patch)
tree7cb8e23681ee21054f877c4cd0806a18b779aae9 /serial
parent00e08e05f39aad7194b3959a8583071b1551ecbe (diff)
Make serial plugin to register adapter drivers.
Diffstat (limited to 'serial')
-rw-r--r--serial/Makefile.am2
-rw-r--r--serial/manager.c1064
-rw-r--r--serial/manager.h9
-rw-r--r--serial/proxy.c1151
-rw-r--r--serial/proxy.h25
5 files changed, 1205 insertions, 1046 deletions
diff --git a/serial/Makefile.am b/serial/Makefile.am
index ef215e4c..01551889 100644
--- a/serial/Makefile.am
+++ b/serial/Makefile.am
@@ -6,7 +6,7 @@ plugin_LTLIBRARIES = serial.la
serial_la_SOURCES = main.c \
manager.h manager.c port.h port.c \
- storage.h storage.c
+ storage.h storage.c proxy.h proxy.c
LDADD = $(top_builddir)/common/libhelper.a \
@GDBUS_LIBS@ @GLIB_LIBS@ @DBUS_LIBS@ @BLUEZ_LIBS@
diff --git a/serial/manager.c b/serial/manager.c
index 9df3caaa..ee1bfd16 100644
--- a/serial/manager.c
+++ b/serial/manager.c
@@ -61,6 +61,7 @@
#include "error.h"
#include "port.h"
+#include "proxy.h"
#include "storage.h"
#include "manager.h"
#include "sdpd.h"
@@ -72,1026 +73,7 @@
#define DIALUP_NET_NAME "dun"
#define DIALUP_NET_UUID "00001103-0000-1000-8000-00805F9B34FB"
-#define SERIAL_PROXY_INTERFACE "org.bluez.serial.Proxy"
-#define BUF_SIZE 1024
-
-typedef enum {
- TTY_PROXY,
- UNIX_SOCKET_PROXY,
- TCP_SOCKET_PROXY,
- UNKNOWN_PROXY_TYPE = 0xFF
-} proxy_type_t;
-
-struct proxy {
- bdaddr_t src;
- bdaddr_t dst;
- char *uuid128; /* UUID 128 */
- char *address; /* TTY or Unix socket name */
- char *path; /* D-Bus path */
- short int port; /* TCP port */
- proxy_type_t type; /* TTY or Unix socket */
- struct termios sys_ti; /* Default TTY setting */
- struct termios proxy_ti; /* Proxy TTY settings */
- uint8_t channel; /* RFCOMM channel */
- uint32_t record_id; /* Service record id */
- GIOChannel *io; /* Server listen */
- guint rfcomm_watch; /* RFCOMM watch: Remote */
- guint local_watch; /* Local watch: TTY or Unix socket */
-};
-
static DBusConnection *connection = NULL;
-static GSList *proxies = NULL;
-static int sk_counter = 0;
-
-static void disable_proxy(struct proxy *prx)
-{
- if (prx->rfcomm_watch) {
- g_source_remove(prx->rfcomm_watch);
- prx->rfcomm_watch = 0;
- }
-
- if (prx->local_watch) {
- g_source_remove(prx->local_watch);
- prx->local_watch = 0;
- }
-
- remove_record_from_server(prx->record_id);
- prx->record_id = 0;
-
- g_io_channel_unref(prx->io);
- prx->io = NULL;
-}
-
-static void proxy_free(struct proxy *prx)
-{
- g_free(prx->address);
- g_free(prx->uuid128);
- g_free(prx);
-}
-
-static inline DBusMessage *does_not_exist(DBusMessage *msg,
- const char *description)
-{
- return g_dbus_create_error(msg, ERROR_INTERFACE ".DoesNotExist",
- description);
-}
-
-static inline DBusMessage *invalid_arguments(DBusMessage *msg,
- const char *description)
-{
- return g_dbus_create_error(msg, ERROR_INTERFACE ".InvalidArguments",
- description);
-}
-
-static inline DBusMessage *failed(DBusMessage *msg, const char *description)
-{
- return g_dbus_create_error(msg, ERROR_INTERFACE ".Failed",
- description);
-}
-
-static void add_lang_attr(sdp_record_t *r)
-{
- sdp_lang_attr_t base_lang;
- sdp_list_t *langs = 0;
-
- /* UTF-8 MIBenum (http://www.iana.org/assignments/character-sets) */
- base_lang.code_ISO639 = (0x65 << 8) | 0x6e;
- base_lang.encoding = 106;
- base_lang.base_offset = SDP_PRIMARY_LANG_BASE;
- langs = sdp_list_append(0, &base_lang);
- sdp_set_lang_attr(r, langs);
- sdp_list_free(langs, 0);
-}
-
-static sdp_record_t *proxy_record_new(const char *uuid128, uint8_t channel)
-{
- sdp_list_t *apseq, *aproto, *profiles, *proto[2], *root, *svclass_id;
- uuid_t uuid, root_uuid, l2cap, rfcomm;
- sdp_profile_desc_t profile;
- sdp_record_t *record;
- sdp_data_t *ch;
-
- record = sdp_record_alloc();
- if (!record)
- return NULL;
-
- sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
- root = sdp_list_append(NULL, &root_uuid);
- sdp_set_browse_groups(record, root);
- sdp_list_free(root, NULL);
-
- bt_string2uuid(&uuid, uuid128);
- svclass_id = sdp_list_append(NULL, &uuid);
- sdp_set_service_classes(record, svclass_id);
- sdp_list_free(svclass_id, NULL);
-
- sdp_uuid16_create(&profile.uuid, SERIAL_PORT_PROFILE_ID);
- profile.version = 0x0100;
- profiles = sdp_list_append(NULL, &profile);
- sdp_set_profile_descs(record, profiles);
- sdp_list_free(profiles, NULL);
-
- sdp_uuid16_create(&l2cap, L2CAP_UUID);
- proto[0] = sdp_list_append(NULL, &l2cap);
- apseq = sdp_list_append(NULL, proto[0]);
-
- sdp_uuid16_create(&rfcomm, RFCOMM_UUID);
- proto[1] = sdp_list_append(NULL, &rfcomm);
- ch = sdp_data_alloc(SDP_UINT8, &channel);
- proto[1] = sdp_list_append(proto[1], ch);
- apseq = sdp_list_append(apseq, proto[1]);
-
- aproto = sdp_list_append(NULL, apseq);
- sdp_set_access_protos(record, aproto);
-
- add_lang_attr(record);
-
- sdp_set_info_attr(record, "Port Proxy Entity",
- NULL, "Port Proxy Entity");
-
- sdp_data_free(ch);
- sdp_list_free(proto[0], NULL);
- sdp_list_free(proto[1], NULL);
- sdp_list_free(apseq, NULL);
- sdp_list_free(aproto, NULL);
-
- return record;
-}
-
-static GIOError channel_write(GIOChannel *chan, char *buf, size_t size)
-{
- GIOError err = G_IO_ERROR_NONE;
- gsize wbytes, written;
-
- wbytes = written = 0;
- while (wbytes < size) {
- err = g_io_channel_write(chan,
- buf + wbytes,
- size - wbytes,
- &written);
-
- if (err != G_IO_ERROR_NONE)
- return err;
-
- wbytes += written;
- }
-
- return err;
-}
-
-static gboolean forward_data(GIOChannel *chan, GIOCondition cond, gpointer data)
-{
- char buf[BUF_SIZE];
- GIOChannel *dest = data;
- GIOError err;
- size_t rbytes;
-
- if (cond & G_IO_NVAL)
- return FALSE;
-
- if (cond & (G_IO_HUP | G_IO_ERR)) {
- /* Try forward remaining data */
- do {
- rbytes = 0;
- err = g_io_channel_read(chan, buf, sizeof(buf), &rbytes);
- if (err != G_IO_ERROR_NONE || rbytes == 0)
- break;
-
- err = channel_write(dest, buf, rbytes);
- } while (err == G_IO_ERROR_NONE);
-
- g_io_channel_close(dest);
- return FALSE;
- }
-
- rbytes = 0;
- err = g_io_channel_read(chan, buf, sizeof(buf), &rbytes);
- if (err != G_IO_ERROR_NONE)
- return FALSE;
-
- err = channel_write(dest, buf, rbytes);
- if (err != G_IO_ERROR_NONE)
- return FALSE;
-
- return TRUE;
-}
-
-static inline int unix_socket_connect(const char *address)
-{
- struct sockaddr_un addr;
- int err, sk;
-
- memset(&addr, 0, sizeof(addr));
- addr.sun_family = PF_UNIX;
-
- if (strncmp("x00", address, 3) == 0) {
- /*
- * Abstract namespace: first byte NULL, x00
- * must be removed from the original address.
- */
- strcpy(addr.sun_path + 1, address + 3);
- } else {
- /* Filesystem address */
- strcpy(addr.sun_path, address);
- }
-
- /* Unix socket */
- sk = socket(AF_UNIX, SOCK_STREAM, 0);
- if (sk < 0) {
- err = errno;
- error("Unix socket(%s) create failed: %s(%d)",
- address, strerror(err), err);
- return -err;
- }
-
- if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
- err = errno;
- error("Unix socket(%s) connect failed: %s(%d)",
- address, strerror(err), err);
- close(sk);
- errno = err;
- return -err;
- }
-
- return sk;
-}
-
-static int tcp_socket_connect(const char *address)
-{
- struct sockaddr_in addr;
- int err, sk;
- unsigned short int port;
-
- memset(&addr, 0, sizeof(addr));
-
- if (strncmp(address, "localhost", 9) != 0) {
- error("Address should have the form localhost:port.");
- return -1;
- }
- port = atoi(strchr(address, ':') + 1);
- if (port <= 0) {
- error("Invalid port '%d'.", port);
- return -1;
- }
- addr.sin_family = AF_INET;
- addr.sin_addr.s_addr = inet_addr("127.0.0.1");
- addr.sin_port = htons(port);
-
- sk = socket(PF_INET, SOCK_STREAM, 0);
- if (sk < 0) {
- err = errno;
- error("TCP socket(%s) create failed %s(%d)", address,
- strerror(err), err);
- return -err;
- }
- if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
- err = errno;
- error("TCP socket(%s) connect failed: %s(%d)",
- address, strerror(err), err);
- close(sk);
- errno = err;
- return -err;
- }
- return sk;
-}
-
-static inline int tty_open(const char *tty, struct termios *ti)
-{
- int err, sk;
-
- sk = open(tty, O_RDWR | O_NOCTTY);
- if (sk < 0) {
- err = errno;
- error("Can't open TTY %s: %s(%d)", tty, strerror(err), err);
- return -err;
- }
-
- if (ti && tcsetattr(sk, TCSANOW, ti) < 0) {
- err = errno;
- error("Can't change serial settings: %s(%d)",
- strerror(err), err);
- close(sk);
- errno = err;
- return -err;
- }
-
- return sk;
-}
-
-static void connect_event_cb(GIOChannel *chan, int err, const bdaddr_t *src,
- const bdaddr_t *dst, gpointer data)
-{
- struct proxy *prx = data;
- GIOChannel *io;
- int sk;
-
- if (err < 0) {
- error("accept: %s (%d)", strerror(-err), -err);
- return;
- }
-
- bacpy(&prx->dst, dst);
-
- switch (prx->type) {
- case UNIX_SOCKET_PROXY:
- sk = unix_socket_connect(prx->address);
- break;
- case TTY_PROXY:
- sk = tty_open(prx->address, &prx->proxy_ti);
- break;
- case TCP_SOCKET_PROXY:
- sk = tcp_socket_connect(prx->address);
- break;
- default:
- sk = -1;
- }
-
- if (sk < 0) {
- g_io_channel_unref(chan);
- return;
- }
-
- g_io_channel_set_close_on_unref(chan, TRUE);
- io = g_io_channel_unix_new(sk);
- g_io_channel_set_close_on_unref(io, TRUE);
-
- prx->rfcomm_watch = g_io_add_watch(chan,
- G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
- forward_data, io);
-
- prx->local_watch = g_io_add_watch(io,
- G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
- forward_data, chan);
-
- g_io_channel_unref(chan);
- g_io_channel_unref(io);
-
- return;
-}
-
-static DBusMessage *proxy_enable(DBusConnection *conn,
- DBusMessage *msg, void *data)
-{
- struct proxy *prx = data;
- sdp_record_t *record;
-
- if (prx->io)
- return failed(msg, "Already enabled");
-
- /* Listen */
- prx->io = bt_rfcomm_listen_allocate(&prx->src, &prx->channel, 0,
- connect_event_cb, prx);
- if (!prx->io) {
- const char *strerr = strerror(errno);
- error("RFCOMM listen socket failed: %s(%d)", strerr, errno);
- return failed(msg, strerr);
- }
-
- g_io_channel_set_close_on_unref(prx->io, TRUE);
-
- record = proxy_record_new(prx->uuid128, prx->channel);
- if (!record) {
- g_io_channel_unref(prx->io);
- return failed(msg, "Unable to allocate new service record");
- }
-
- if (add_record_to_server(&prx->src, record) < 0) {
- sdp_record_free(record);
- g_io_channel_unref(prx->io);
- return failed(msg, "Service registration failed");
- }
-
- prx->record_id = record->handle;
-
- return dbus_message_new_method_return(msg);
-}
-
-static DBusMessage *proxy_disable(DBusConnection *conn,
- DBusMessage *msg, void *data)
-{
- struct proxy *prx = data;
-
- if (!prx->io)
- return failed(msg, "Not enabled");
-
- /* Remove the watches and unregister the record */
- disable_proxy(prx);
-
- return dbus_message_new_method_return(msg);
-}
-
-static DBusMessage *proxy_get_info(DBusConnection *conn,
- DBusMessage *msg, void *data)
-{
- struct proxy *prx = data;
- DBusMessage *reply;
- DBusMessageIter iter, dict;
- dbus_bool_t boolean;
-
- 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);
-
- dbus_message_iter_append_dict_entry(&dict, "uuid",
- DBUS_TYPE_STRING, &prx->uuid128);
-
- dbus_message_iter_append_dict_entry(&dict, "address",
- DBUS_TYPE_STRING, &prx->address);
-
- if (prx->channel)
- dbus_message_iter_append_dict_entry(&dict, "channel",
- DBUS_TYPE_BYTE, &prx->channel);
-
- boolean = (prx->io ? TRUE : FALSE);
- dbus_message_iter_append_dict_entry(&dict, "enabled",
- DBUS_TYPE_BOOLEAN, &boolean);
-
- boolean = (prx->rfcomm_watch ? TRUE : FALSE);
- dbus_message_iter_append_dict_entry(&dict, "connected",
- DBUS_TYPE_BOOLEAN, &boolean);
-
- /* If connected: append the remote address */
- if (boolean) {
- char bda[18];
- const char *pstr = bda;
-
- ba2str(&prx->dst, bda);
- dbus_message_iter_append_dict_entry(&dict, "address",
- DBUS_TYPE_STRING, &pstr);
- }
-
- dbus_message_iter_close_container(&iter, &dict);
-
- return reply;
-}
-
-static struct {
- const char *str;
- speed_t speed;
-} supported_speed[] = {
- {"50", B50 },
- {"300", B300 },
- {"600", B600 },
- {"1200", B1200 },
- {"1800", B1800 },
- {"2400", B2400 },
- {"4800", B4800 },
- {"9600", B9600 },
- {"19200", B19200 },
- {"38400", B38400 },
- {"57600", B57600 },
- {"115200", B115200 },
- { NULL, B0 }
-};
-
-static speed_t str2speed(const char *str, speed_t *speed)
-{
- int i;
-
- for (i = 0; supported_speed[i].str; i++) {
- if (strcmp(supported_speed[i].str, str) != 0)
- continue;
-
- if (speed)
- *speed = supported_speed[i].speed;
-
- return supported_speed[i].speed;
- }
-
- return B0;
-}
-
-static int set_parity(const char *str, tcflag_t *ctrl)
-{
- if (strcasecmp("even", str) == 0) {
- *ctrl |= PARENB;
- *ctrl &= ~PARODD;
- } else if (strcasecmp("odd", str) == 0) {
- *ctrl |= PARENB;
- *ctrl |= PARODD;
- } else if (strcasecmp("mark", str) == 0)
- *ctrl |= PARENB;
- else if ((strcasecmp("none", str) == 0) ||
- (strcasecmp("space", str) == 0))
- *ctrl &= ~PARENB;
- else
- return -1;
-
- return 0;
-}
-
-static int set_databits(uint8_t databits, tcflag_t *ctrl)
-{
- if (databits < 5 || databits > 8)
- return -EINVAL;
-
- *ctrl &= ~CSIZE;
- switch (databits) {
- case 5:
- *ctrl |= CS5;
- break;
- case 6:
- *ctrl |= CS6;
- break;
- case 7:
- *ctrl |= CS7;
- break;
- case 8:
- *ctrl |= CS8;
- break;
- }
-
- return 0;
-}
-
-static int set_stopbits(uint8_t stopbits, tcflag_t *ctrl)
-{
- /* 1.5 will not be allowed */
- switch (stopbits) {
- case 1:
- *ctrl &= ~CSTOPB;
- return 0;
- case 2:
- *ctrl |= CSTOPB;
- return 0;
- }
-
- return -EINVAL;
-}
-
-static DBusMessage *proxy_set_serial_params(DBusConnection *conn,
- DBusMessage *msg, void *data)
-{
- struct proxy *prx = data;
- const char *ratestr, *paritystr;
- uint8_t databits, stopbits;
- tcflag_t ctrl; /* Control mode flags */
- speed_t speed = B0; /* In/Out speed */
-
- /* Don't allow change TTY settings if it is open */
- if (prx->local_watch)
- return failed(msg, "Not allowed");
-
- if (!dbus_message_get_args(msg, NULL,
- DBUS_TYPE_STRING, &ratestr,
- DBUS_TYPE_BYTE, &databits,
- DBUS_TYPE_BYTE, &stopbits,
- DBUS_TYPE_STRING, &paritystr,
- DBUS_TYPE_INVALID))
- return NULL;
-
- if (str2speed(ratestr, &speed) == B0)
- return invalid_arguments(msg, "Invalid baud rate");
-
- ctrl = prx->proxy_ti.c_cflag;
- if (set_databits(databits, &ctrl) < 0)
- return invalid_arguments(msg, "Invalid data bits");
-
- if (set_stopbits(stopbits, &ctrl) < 0)
- return invalid_arguments(msg, "Invalid stop bits");
-
- if (set_parity(paritystr, &ctrl) < 0)
- return invalid_arguments(msg, "Invalid parity");
-
- prx->proxy_ti.c_cflag = ctrl;
- prx->proxy_ti.c_cflag |= (CLOCAL | CREAD);
- cfsetispeed(&prx->proxy_ti, speed);
- cfsetospeed(&prx->proxy_ti, speed);
-
- proxy_store(&prx->src, prx->uuid128, prx->address, NULL,
- prx->channel, 0, &prx->proxy_ti);
-
- return dbus_message_new_method_return(msg);
-}
-
-static GDBusMethodTable proxy_methods[] = {
- { "Enable", "", "", proxy_enable },
- { "Disable", "", "", proxy_disable },
- { "GetInfo", "", "a{sv}",proxy_get_info },
- { "SetSerialParameters", "syys", "", proxy_set_serial_params },
- { },
-};
-
-static void proxy_unregister(gpointer data)
-{
- struct proxy *prx = data;
- int sk;
-
- info("Unregistered proxy: %s", prx->address);
-
- if (prx->type != TTY_PROXY)
- goto done;
-
- /* Restore the initial TTY configuration */
- sk = open(prx->address, O_RDWR | O_NOCTTY);
- if (sk) {
- tcsetattr(sk, TCSAFLUSH, &prx->sys_ti);
- close(sk);
- }
-done:
-
- proxy_free(prx);
-}
-
-static int register_proxy_object(struct proxy *prx, char *outpath, size_t size)
-{
- char path[MAX_PATH_LENGTH + 1];
-
- snprintf(path, MAX_PATH_LENGTH, "/org/bluez/serial/proxy%d",
- sk_counter++);
-
- if (!g_dbus_register_interface(connection, path,
- SERIAL_PROXY_INTERFACE,
- proxy_methods, NULL, NULL,
- prx, proxy_unregister)) {
- error("D-Bus failed to register %s path", path);
- return -1;
- }
-
- prx->path = g_strdup(path);
- proxies = g_slist_append(proxies, prx);
-
- if (outpath)
- strncpy(outpath, path, size);
-
- info("Registered proxy:%s", path);
-
- return 0;
-}
-
-static int proxy_tty_register(bdaddr_t *src, const char *uuid128,
- const char *address, struct termios *ti,
- char *outpath, size_t size, gboolean save)
-{
- struct termios sys_ti;
- struct proxy *prx;
- int sk, ret;
-
- sk = open(address, O_RDONLY | O_NOCTTY);
- if (sk < 0) {
- error("Cant open TTY: %s(%d)", strerror(errno), errno);
- return -EINVAL;
- }
-
- prx = g_new0(struct proxy, 1);
- prx->address = g_strdup(address);
- prx->uuid128 = g_strdup(uuid128);
- prx->type = TTY_PROXY;
- bacpy(&prx->src, src);
-
- /* Current TTY settings */
- memset(&sys_ti, 0, sizeof(sys_ti));
- tcgetattr(sk, &sys_ti);
- memcpy(&prx->sys_ti, &sys_ti, sizeof(sys_ti));
- close(sk);
-
- if (!ti) {
- /* Use current settings */
- memcpy(&prx->proxy_ti, &sys_ti, sizeof(sys_ti));
- } else {
- /* New TTY settings: user provided */
- memcpy(&prx->proxy_ti, ti, sizeof(*ti));
- }
-
- ret = register_proxy_object(prx, outpath, size);
- if (ret < 0)
- proxy_free(prx);
-
- if (save)
- proxy_store(src, uuid128, address, NULL,
- prx->channel, 0, &prx->proxy_ti);
-
- return ret;
-}
-
-static int proxy_socket_register(bdaddr_t *src, const char *uuid128,
- const char *address, char *outpath,
- size_t size, gboolean save)
-{
- struct proxy *prx;
- int ret;
-
- prx = g_new0(struct proxy, 1);
- prx->address = g_strdup(address);
- prx->uuid128 = g_strdup(uuid128);
- prx->type = UNIX_SOCKET_PROXY;
- bacpy(&prx->src, src);
-
- ret = register_proxy_object(prx, outpath, size);
- if (ret < 0)
- proxy_free(prx);
-
- if (save)
- proxy_store(src, uuid128, address, NULL,
- prx->channel, 0, NULL);
-
- return ret;
-}
-
-static int proxy_tcp_register(bdaddr_t *src, const char *uuid128,
- const char *address, char *outpath,
- size_t size, gboolean save)
-{
- struct proxy *prx;
- int ret;
-
- prx = g_new0(struct proxy, 1);
- prx->address = g_strdup(address);
- prx->uuid128 = g_strdup(uuid128);
- prx->type = TCP_SOCKET_PROXY;
- bacpy(&prx->src, src);
-
- ret = register_proxy_object(prx, outpath, size);
- if (ret < 0)
- proxy_free(prx);
-
- if (save)
- proxy_store(src, uuid128, address, NULL,
- prx->channel, 0, NULL);
-
- return ret;
-}
-
-static proxy_type_t addr2type(const char *address)
-{
- struct stat st;
-
- if (stat(address, &st) < 0) {
- /*
- * Unix socket: if the sun_path starts with null byte
- * it refers to abstract namespace. 'x00' will be used
- * to represent the null byte.
- */
- if (strncmp("localhost:", address, 10) == 0)
- return TCP_SOCKET_PROXY;
- if (strncmp("x00", address, 3) != 0)
- return UNKNOWN_PROXY_TYPE;
- else
- return UNIX_SOCKET_PROXY;
- } else {
- /* Filesystem: char device or unix socket */
- if (S_ISCHR(st.st_mode) && strncmp("/dev/", address, 4) == 0)
- return TTY_PROXY;
- else if (S_ISSOCK(st.st_mode))
- return UNIX_SOCKET_PROXY;
- else
- return UNKNOWN_PROXY_TYPE;
- }
-}
-
-static int proxy_addrcmp(gconstpointer proxy, gconstpointer addr)
-{
- const struct proxy *prx = proxy;
- const char *address = addr;
-
- return strcmp(prx->address, address);
-}
-
-static int proxy_pathcmp(gconstpointer proxy, gconstpointer p)
-{
- const struct proxy *prx = proxy;
- const char *path = p;
-
- return strcmp(prx->path, path);
-}
-
-static DBusMessage *create_proxy(DBusConnection *conn,
- DBusMessage *msg, void *data)
-{
- char path[MAX_PATH_LENGTH + 1];
- const char *uuid128, *address, *ppath = path;
- DBusMessage *reply;
- proxy_type_t type;
- bdaddr_t src;
- uuid_t uuid;
- int dev_id, ret;
-
- if (!dbus_message_get_args(msg, NULL,
- DBUS_TYPE_STRING, &uuid128,
- DBUS_TYPE_STRING, &address,
- DBUS_TYPE_INVALID))
- return NULL;
-
- if (bt_string2uuid(&uuid, uuid128) < 0)
- return invalid_arguments(msg, "Invalid UUID");
-
- type = addr2type(address);
- if (type == UNKNOWN_PROXY_TYPE)
- return invalid_arguments(msg, "Invalid address");
-
- /* Only one proxy per address(TTY or unix socket) is allowed */
- if (g_slist_find_custom(proxies, address, proxy_addrcmp))
- return g_dbus_create_error(msg, ERROR_INTERFACE ".AlreadyExist",
- "Proxy already exists");
-
- dev_id = hci_get_route(NULL);
- if ((dev_id < 0) || (hci_devba(dev_id, &src) < 0)) {
- error("Adapter not available");
- return failed(msg, "Adapter no available");
- }
-
- reply = dbus_message_new_method_return(msg);
- if (!reply)
- return NULL;
-
- switch (type) {
- case UNIX_SOCKET_PROXY:
- ret = proxy_socket_register(&src, uuid128, address,
- path, sizeof(path), TRUE);
- break;
- case TTY_PROXY:
- ret = proxy_tty_register(&src, uuid128, address,
- NULL, path, sizeof(path), TRUE);
- break;
- case TCP_SOCKET_PROXY:
- ret = proxy_tcp_register(&src, uuid128, address,
- path, sizeof(path), TRUE);
- break;
- default:
- ret = -1;
- }
- if (ret < 0) {
- dbus_message_unref(reply);
- return failed(msg, "Create object path failed");
- }
-
- g_dbus_emit_signal(connection, SERIAL_MANAGER_PATH,
- SERIAL_MANAGER_INTERFACE, "ProxyCreated",
- DBUS_TYPE_STRING, &ppath,
- DBUS_TYPE_INVALID);
-
- dbus_message_append_args(reply,
- DBUS_TYPE_STRING, &ppath,
- DBUS_TYPE_INVALID);
-
- return reply;
-}
-
-static DBusMessage *list_proxies(DBusConnection *conn,
- DBusMessage *msg, void *data)
-{
- struct proxy *prx;
- const GSList *l;
- DBusMessage *reply;
- DBusMessageIter iter, iter_array;
-
- 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_TYPE_STRING_AS_STRING, &iter_array);
-
- for (l = proxies; l; l = l->next) {
- prx = l->data;
- dbus_message_iter_append_basic(&iter_array,
- DBUS_TYPE_STRING, &prx->path);
- }
-
- dbus_message_iter_close_container(&iter, &iter_array);
-
- return reply;
-}
-
-static DBusMessage *remove_proxy(DBusConnection *conn,
- DBusMessage *msg, void *data)
-{
- struct proxy *prx;
- const char *path;
- GSList *l;
-
- if (!dbus_message_get_args(msg, NULL,
- DBUS_TYPE_STRING, &path,
- DBUS_TYPE_INVALID))
- return NULL;
-
- l = g_slist_find_custom(proxies, path, proxy_pathcmp);
- if (!l)
- return does_not_exist(msg, "Invalid proxy path");
-
- g_dbus_emit_signal(conn, SERIAL_MANAGER_PATH,
- SERIAL_MANAGER_INTERFACE, "ProxyRemoved",
- DBUS_TYPE_STRING, &path,
- DBUS_TYPE_INVALID);
-
- prx = l->data;
- proxy_delete(&prx->src, prx->address);
- proxies = g_slist_remove(proxies, prx);
-
- g_dbus_unregister_interface(conn, path, SERIAL_PROXY_INTERFACE);
-
- return dbus_message_new_method_return(msg);
-}
-
-static void manager_unregister(void *data)
-{
- if (proxies) {
- g_slist_foreach(proxies,
- (GFunc) proxy_unregister, NULL);
- g_slist_free(proxies);
- proxies = NULL;
- }
-}
-
-static GDBusMethodTable manager_methods[] = {
- { "CreateProxy", "ss", "s", create_proxy },
- { "ListProxies", "", "as", list_proxies },
- { "RemoveProxy", "s", "", remove_proxy },
- { },
-};
-
-static GDBusSignalTable manager_signals[] = {
- { "ProxyCreated", "s" },
- { "ProxyRemoved", "s" },
- { }
-};
-
-static void parse_proxy(char *key, char *value, void *data)
-{
- char uuid128[MAX_LEN_UUID_STR], tmp[3];
- char *pvalue, *src_addr = data;
- proxy_type_t type;
- int ch, opts, pos;
- bdaddr_t src;
- struct termios ti;
- uint8_t *pti;
-
- memset(uuid128, 0, sizeof(uuid128));
- ch = opts = pos = 0;
- if (sscanf(value,"%s %d 0x%04X %n", uuid128, &ch, &opts, &pos) != 3)
- return;
-
- /* Extracting name */
- value += pos;
- pvalue = strchr(value, ':');
- if (!pvalue)
- return;
-
- /* FIXME: currently name is not used */
- *pvalue = '\0';
-
- str2ba(src_addr, &src);
- type = addr2type(key);
- switch (type) {
- case TTY_PROXY:
- /* Extracting termios */
- pvalue++;
- if (!pvalue || strlen(pvalue) != (2 * sizeof(ti)))
- return;
-
- memset(&ti, 0, sizeof(ti));
- memset(tmp, 0, sizeof(tmp));
-
- /* Converting to termios struct */
- pti = (uint8_t *) &ti;
- for (pos = 0; pos < sizeof(ti); pos++, pvalue += 2, pti++) {
- memcpy(tmp, pvalue, 2);
- *pti = (uint8_t) strtol(tmp, NULL, 16);
- }
-
- proxy_tty_register(&src, uuid128, key, &ti, NULL, 0, FALSE);
- break;
- case UNIX_SOCKET_PROXY:
- proxy_socket_register(&src, uuid128, key, NULL, 0, FALSE);
- break;
- case TCP_SOCKET_PROXY:
- proxy_tcp_register(&src, uuid128, key, NULL, 0, FALSE);
- break;
- default:
- return;
- }
-}
-
-static void register_stored(void)
-{
- char filename[PATH_MAX + 1];
- struct dirent *de;
- DIR *dir;
-
- snprintf(filename, PATH_MAX, "%s", STORAGEDIR);
-
- dir = opendir(filename);
- if (!dir)
- return;
-
- while ((de = readdir(dir)) != NULL) {
- if (!isdigit(de->d_name[0]))
- continue;
-
- snprintf(filename, PATH_MAX, "%s/%s/proxy", STORAGEDIR, de->d_name);
- textfile_foreach(filename, parse_proxy, de->d_name);
- }
-
- closedir(dir);
-}
static int serial_probe(struct btd_device_driver *driver,
struct btd_device *device, sdp_record_t *rec,
@@ -1162,23 +144,38 @@ static struct btd_device_driver serial_dialup_driver = {
.remove = serial_remove,
};
-int serial_manager_init(DBusConnection *conn)
+static int proxy_probe(struct adapter *adapter)
{
- if (!g_dbus_register_interface(conn, SERIAL_MANAGER_PATH,
- SERIAL_MANAGER_INTERFACE,
- manager_methods, manager_signals, NULL,
- NULL, manager_unregister)) {
- error("Failed to register %s interface to %s",
- SERIAL_MANAGER_INTERFACE, SERIAL_MANAGER_PATH);
- return -1;
- }
+ const char *path = adapter_get_path(adapter);
+ const char *address = adapter_get_address(adapter);
+ bdaddr_t src;
- connection = dbus_connection_ref(conn);
+ DBG("path %s", path);
+ str2ba(address, &src);
+
+ return proxy_register(connection, path, &src);
+}
+
+static void proxy_remove(struct adapter *adapter)
+{
+ const char *path = adapter_get_path(adapter);
- info("Registered manager path:%s", SERIAL_MANAGER_PATH);
+ DBG("path %s", path);
+
+ proxy_unregister(path);
+}
+
+static struct btd_adapter_driver serial_proxy_driver = {
+ .name = "serial-proxy",
+ .probe = proxy_probe,
+ .remove = proxy_remove,
+};
- register_stored();
+int serial_manager_init(DBusConnection *conn)
+{
+ connection = dbus_connection_ref(conn);
+ btd_register_adapter_driver(&serial_proxy_driver);
btd_register_device_driver(&serial_port_driver);
btd_register_device_driver(&serial_dialup_driver);
@@ -1190,11 +187,6 @@ void serial_manager_exit(void)
btd_unregister_device_driver(&serial_port_driver);
btd_unregister_device_driver(&serial_dialup_driver);
- g_dbus_unregister_interface(connection, SERIAL_MANAGER_PATH,
- SERIAL_MANAGER_INTERFACE);
-
dbus_connection_unref(connection);
connection = NULL;
-
- port_release_all();
}
diff --git a/serial/manager.h b/serial/manager.h
index fdcc8ab9..6ddb787a 100644
--- a/serial/manager.h
+++ b/serial/manager.h
@@ -21,14 +21,5 @@
*
*/
-#define SERIAL_MANAGER_PATH "/org/bluez/serial"
-#define SERIAL_MANAGER_INTERFACE "org.bluez.serial.Manager"
-
int serial_manager_init(DBusConnection *conn);
void serial_manager_exit(void);
-int rfcomm_release(int16_t id);
-
-DBusMessage *service_connect(DBusConnection *conn, DBusMessage *msg,
- const char *adapter,
- const char *address,
- const char *pattern);
diff --git a/serial/proxy.c b/serial/proxy.c
new file mode 100644
index 00000000..88c517a0
--- /dev/null
+++ b/serial/proxy.c
@@ -0,0 +1,1151 @@
+/*
+ *
+ * BlueZ - Bluetooth protocol stack for Linux
+ *
+ * Copyright (C) 2004-2008 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 <ctype.h>
+#include <dirent.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <termios.h>
+#include <unistd.h>
+#include <arpa/inet.h>
+#include <sys/param.h>
+#include <sys/ioctl.h>
+#include <sys/stat.h>
+#include <sys/types.h>
+#include <sys/un.h>
+
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/hci.h>
+#include <bluetooth/hci_lib.h>
+#include <bluetooth/sdp.h>
+#include <bluetooth/sdp_lib.h>
+#include <bluetooth/rfcomm.h>
+
+#include <glib.h>
+#include <gdbus.h>
+
+#include "../src/dbus-common.h"
+
+#include "logging.h"
+#include "textfile.h"
+
+#include "error.h"
+#include "storage.h"
+#include "sdpd.h"
+#include "glib-helper.h"
+
+#define SERIAL_PORT_NAME "spp"
+#define SERIAL_PORT_UUID "00001101-0000-1000-8000-00805F9B34FB"
+
+#define DIALUP_NET_NAME "dun"
+#define DIALUP_NET_UUID "00001103-0000-1000-8000-00805F9B34FB"
+
+#define SERIAL_PROXY_INTERFACE "org.bluez.serial.Proxy"
+#define SERIAL_MANAGER_INTERFACE "org.bluez.serial.ProxyManager"
+#define BUF_SIZE 1024
+
+typedef enum {
+ TTY_PROXY,
+ UNIX_SOCKET_PROXY,
+ TCP_SOCKET_PROXY,
+ UNKNOWN_PROXY_TYPE = 0xFF
+} proxy_type_t;
+
+struct serial_adapter {
+ bdaddr_t src; /* Adapter address */
+ char *path; /* D-Bus path */
+ DBusConnection *conn; /* Adapter connection */
+ GSList *proxies; /* Proxies list */
+};
+
+struct serial_proxy {
+ bdaddr_t dst; /* Remote address */
+ char *path; /* Proxy path */
+ char *uuid128; /* UUID 128 */
+ char *address; /* TTY or Unix socket name */
+ short int port; /* TCP port */
+ proxy_type_t type; /* TTY or Unix socket */
+ struct termios sys_ti; /* Default TTY setting */
+ struct termios proxy_ti; /* Proxy TTY settings */
+ uint8_t channel; /* RFCOMM channel */
+ uint32_t record_id; /* Service record id */
+ GIOChannel *io; /* Server listen */
+ guint rfcomm_watch; /* RFCOMM watch: Remote */
+ guint local_watch; /* Local watch: TTY or Unix socket */
+ struct serial_adapter *adapter; /* Adapter pointer */
+};
+
+static GSList *adapters = NULL;
+static int sk_counter = 0;
+
+static void disable_proxy(struct serial_proxy *prx)
+{
+ if (prx->rfcomm_watch) {
+ g_source_remove(prx->rfcomm_watch);
+ prx->rfcomm_watch = 0;
+ }
+
+ if (prx->local_watch) {
+ g_source_remove(prx->local_watch);
+ prx->local_watch = 0;
+ }
+
+ remove_record_from_server(prx->record_id);
+ prx->record_id = 0;
+
+ g_io_channel_unref(prx->io);
+ prx->io = NULL;
+}
+
+static void proxy_free(struct serial_proxy *prx)
+{
+ g_free(prx->path);
+ g_free(prx->address);
+ g_free(prx->uuid128);
+ g_free(prx);
+}
+
+static inline DBusMessage *does_not_exist(DBusMessage *msg,
+ const char *description)
+{
+ return g_dbus_create_error(msg, ERROR_INTERFACE ".DoesNotExist",
+ description);
+}
+
+static inline DBusMessage *invalid_arguments(DBusMessage *msg,
+ const char *description)
+{
+ return g_dbus_create_error(msg, ERROR_INTERFACE ".InvalidArguments",
+ description);
+}
+
+static inline DBusMessage *failed(DBusMessage *msg, const char *description)
+{
+ return g_dbus_create_error(msg, ERROR_INTERFACE ".Failed",
+ description);
+}
+
+static void add_lang_attr(sdp_record_t *r)
+{
+ sdp_lang_attr_t base_lang;
+ sdp_list_t *langs = 0;
+
+ /* UTF-8 MIBenum (http://www.iana.org/assignments/character-sets) */
+ base_lang.code_ISO639 = (0x65 << 8) | 0x6e;
+ base_lang.encoding = 106;
+ base_lang.base_offset = SDP_PRIMARY_LANG_BASE;
+ langs = sdp_list_append(0, &base_lang);
+ sdp_set_lang_attr(r, langs);
+ sdp_list_free(langs, 0);
+}
+
+static sdp_record_t *proxy_record_new(const char *uuid128, uint8_t channel)
+{
+ sdp_list_t *apseq, *aproto, *profiles, *proto[2], *root, *svclass_id;
+ uuid_t uuid, root_uuid, l2cap, rfcomm;
+ sdp_profile_desc_t profile;
+ sdp_record_t *record;
+ sdp_data_t *ch;
+
+ record = sdp_record_alloc();
+ if (!record)
+ return NULL;
+
+ sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
+ root = sdp_list_append(NULL, &root_uuid);
+ sdp_set_browse_groups(record, root);
+ sdp_list_free(root, NULL);
+
+ bt_string2uuid(&uuid, uuid128);
+ svclass_id = sdp_list_append(NULL, &uuid);
+ sdp_set_service_classes(record, svclass_id);
+ sdp_list_free(svclass_id, NULL);
+
+ sdp_uuid16_create(&profile.uuid, SERIAL_PORT_PROFILE_ID);
+ profile.version = 0x0100;
+ profiles = sdp_list_append(NULL, &profile);
+ sdp_set_profile_descs(record, profiles);
+ sdp_list_free(profiles, NULL);
+
+ sdp_uuid16_create(&l2cap, L2CAP_UUID);
+ proto[0] = sdp_list_append(NULL, &l2cap);
+ apseq = sdp_list_append(NULL, proto[0]);
+
+ sdp_uuid16_create(&rfcomm, RFCOMM_UUID);
+ proto[1] = sdp_list_append(NULL, &rfcomm);
+ ch = sdp_data_alloc(SDP_UINT8, &channel);
+ proto[1] = sdp_list_append(proto[1], ch);
+ apseq = sdp_list_append(apseq, proto[1]);
+
+ aproto = sdp_list_append(NULL, apseq);
+ sdp_set_access_protos(record, aproto);
+
+ add_lang_attr(record);
+
+ sdp_set_info_attr(record, "Port Proxy Entity",
+ NULL, "Port Proxy Entity");
+
+ sdp_data_free(ch);
+ sdp_list_free(proto[0], NULL);
+ sdp_list_free(proto[1], NULL);
+ sdp_list_free(apseq, NULL);
+ sdp_list_free(aproto, NULL);
+
+ return record;
+}
+
+static GIOError channel_write(GIOChannel *chan, char *buf, size_t size)
+{
+ GIOError err = G_IO_ERROR_NONE;
+ gsize wbytes, written;
+
+ wbytes = written = 0;
+ while (wbytes < size) {
+ err = g_io_channel_write(chan,
+ buf + wbytes,
+ size - wbytes,
+ &written);
+
+ if (err != G_IO_ERROR_NONE)
+ return err;
+
+ wbytes += written;
+ }
+
+ return err;
+}
+
+static gboolean forward_data(GIOChannel *chan, GIOCondition cond, gpointer data)
+{
+ char buf[BUF_SIZE];
+ GIOChannel *dest = data;
+ GIOError err;
+ size_t rbytes;
+
+ if (cond & G_IO_NVAL)
+ return FALSE;
+
+ if (cond & (G_IO_HUP | G_IO_ERR)) {
+ /* Try forward remaining data */
+ do {
+ rbytes = 0;
+ err = g_io_channel_read(chan, buf, sizeof(buf), &rbytes);
+ if (err != G_IO_ERROR_NONE || rbytes == 0)
+ break;
+
+ err = channel_write(dest, buf, rbytes);
+ } while (err == G_IO_ERROR_NONE);
+
+ g_io_channel_close(dest);
+ return FALSE;
+ }
+
+ rbytes = 0;
+ err = g_io_channel_read(chan, buf, sizeof(buf), &rbytes);
+ if (err != G_IO_ERROR_NONE)
+ return FALSE;
+
+ err = channel_write(dest, buf, rbytes);
+ if (err != G_IO_ERROR_NONE)
+ return FALSE;
+
+ return TRUE;
+}
+
+static inline int unix_socket_connect(const char *address)
+{
+ struct sockaddr_un addr;
+ int err, sk;
+
+ memset(&addr, 0, sizeof(addr));
+ addr.sun_family = PF_UNIX;
+
+ if (strncmp("x00", address, 3) == 0) {
+ /*
+ * Abstract namespace: first byte NULL, x00
+ * must be removed from the original address.
+ */
+ strcpy(addr.sun_path + 1, address + 3);
+ } else {
+ /* Filesystem address */
+ strcpy(addr.sun_path, address);
+ }
+
+ /* Unix socket */
+ sk = socket(AF_UNIX, SOCK_STREAM, 0);
+ if (sk < 0) {
+ err = errno;
+ error("Unix socket(%s) create failed: %s(%d)",
+ address, strerror(err), err);
+ return -err;
+ }
+
+ if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
+ err = errno;
+ error("Unix socket(%s) connect failed: %s(%d)",
+ address, strerror(err), err);
+ close(sk);
+ errno = err;
+ return -err;
+ }
+
+ return sk;
+}
+
+static int tcp_socket_connect(const char *address)
+{
+ struct sockaddr_in addr;
+ int err, sk;
+ unsigned short int port;
+
+ memset(&addr, 0, sizeof(addr));
+
+ if (strncmp(address, "localhost", 9) != 0) {
+ error("Address should have the form localhost:port.");
+ return -1;
+ }
+ port = atoi(strchr(address, ':') + 1);
+ if (port <= 0) {
+ error("Invalid port '%d'.", port);
+ return -1;
+ }
+ addr.sin_family = AF_INET;
+ addr.sin_addr.s_addr = inet_addr("127.0.0.1");
+ addr.sin_port = htons(port);
+
+ sk = socket(PF_INET, SOCK_STREAM, 0);
+ if (sk < 0) {
+ err = errno;
+ error("TCP socket(%s) create failed %s(%d)", address,
+ strerror(err), err);
+ return -err;
+ }
+ if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
+ err = errno;
+ error("TCP socket(%s) connect failed: %s(%d)",
+ address, strerror(err), err);
+ close(sk);
+ errno = err;
+ return -err;
+ }
+ return sk;
+}
+
+static inline int tty_open(const char *tty, struct termios *ti)
+{
+ int err, sk;
+
+ sk = open(tty, O_RDWR | O_NOCTTY);
+ if (sk < 0) {
+ err = errno;
+ error("Can't open TTY %s: %s(%d)", tty, strerror(err), err);
+ return -err;
+ }
+
+ if (ti && tcsetattr(sk, TCSANOW, ti) < 0) {
+ err = errno;
+ error("Can't change serial settings: %s(%d)",
+ strerror(err), err);
+ close(sk);
+ errno = err;
+ return -err;
+ }
+
+ return sk;
+}
+
+static void connect_event_cb(GIOChannel *chan, int err, const bdaddr_t *src,
+ const bdaddr_t *dst, gpointer data)
+{
+ struct serial_proxy *prx = data;
+ GIOChannel *io;
+ int sk;
+
+ if (err < 0) {
+ error("accept: %s (%d)", strerror(-err), -err);
+ return;
+ }
+
+ bacpy(&prx->dst, dst);
+
+ switch (prx->type) {
+ case UNIX_SOCKET_PROXY:
+ sk = unix_socket_connect(prx->address);
+ break;
+ case TTY_PROXY:
+ sk = tty_open(prx->address, &prx->proxy_ti);
+ break;
+ case TCP_SOCKET_PROXY:
+ sk = tcp_socket_connect(prx->address);
+ break;
+ default:
+ sk = -1;
+ }
+
+ if (sk < 0) {
+ g_io_channel_unref(chan);
+ return;
+ }
+
+ g_io_channel_set_close_on_unref(chan, TRUE);
+ io = g_io_channel_unix_new(sk);
+ g_io_channel_set_close_on_unref(io, TRUE);
+
+ prx->rfcomm_watch = g_io_add_watch(chan,
+ G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
+ forward_data, io);
+
+ prx->local_watch = g_io_add_watch(io,
+ G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
+ forward_data, chan);
+
+ g_io_channel_unref(chan);
+ g_io_channel_unref(io);
+
+ return;
+}
+
+static DBusMessage *proxy_enable(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ struct serial_proxy *prx = data;
+ struct serial_adapter *adapter = prx->adapter;
+ sdp_record_t *record;
+
+ if (prx->io)
+ return failed(msg, "Already enabled");
+
+ /* Listen */
+ prx->io = bt_rfcomm_listen_allocate(&adapter->src, &prx->channel, 0,
+ connect_event_cb, prx);
+ if (!prx->io) {
+ const char *strerr = strerror(errno);
+ error("RFCOMM listen socket failed: %s(%d)", strerr, errno);
+ return failed(msg, strerr);
+ }
+
+ g_io_channel_set_close_on_unref(prx->io, TRUE);
+
+ record = proxy_record_new(prx->uuid128, prx->channel);
+ if (!record) {
+ g_io_channel_unref(prx->io);
+ return failed(msg, "Unable to allocate new service record");
+ }
+
+ if (add_record_to_server(&adapter->src, record) < 0) {
+ sdp_record_free(record);
+ g_io_channel_unref(prx->io);
+ return failed(msg, "Service registration failed");
+ }
+
+ prx->record_id = record->handle;
+
+ return dbus_message_new_method_return(msg);
+}
+
+static DBusMessage *proxy_disable(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ struct serial_proxy *prx = data;
+
+ if (!prx->io)
+ return failed(msg, "Not enabled");
+
+ /* Remove the watches and unregister the record */
+ disable_proxy(prx);
+
+ return dbus_message_new_method_return(msg);
+}
+
+static DBusMessage *proxy_get_info(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ struct serial_proxy *prx = data;
+ DBusMessage *reply;
+ DBusMessageIter iter, dict;
+ dbus_bool_t boolean;
+
+ 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);
+
+ dbus_message_iter_append_dict_entry(&dict, "uuid",
+ DBUS_TYPE_STRING, &prx->uuid128);
+
+ dbus_message_iter_append_dict_entry(&dict, "address",
+ DBUS_TYPE_STRING, &prx->address);
+
+ if (prx->channel)
+ dbus_message_iter_append_dict_entry(&dict, "channel",
+ DBUS_TYPE_BYTE, &prx->channel);
+
+ boolean = (prx->io ? TRUE : FALSE);
+ dbus_message_iter_append_dict_entry(&dict, "enabled",
+ DBUS_TYPE_BOOLEAN, &boolean);
+
+ boolean = (prx->rfcomm_watch ? TRUE : FALSE);
+ dbus_message_iter_append_dict_entry(&dict, "connected",
+ DBUS_TYPE_BOOLEAN, &boolean);
+
+ /* If connected: append the remote address */
+ if (boolean) {
+ char bda[18];
+ const char *pstr = bda;
+
+ ba2str(&prx->dst, bda);
+ dbus_message_iter_append_dict_entry(&dict, "address",
+ DBUS_TYPE_STRING, &pstr);
+ }
+
+ dbus_message_iter_close_container(&iter, &dict);
+
+ return reply;
+}
+
+static struct {
+ const char *str;
+ speed_t speed;
+} supported_speed[] = {
+ {"50", B50 },
+ {"300", B300 },
+ {"600", B600 },
+ {"1200", B1200 },
+ {"1800", B1800 },
+ {"2400", B2400 },
+ {"4800", B4800 },
+ {"9600", B9600 },
+ {"19200", B19200 },
+ {"38400", B38400 },
+ {"57600", B57600 },
+ {"115200", B115200 },
+ { NULL, B0 }
+};
+
+static speed_t str2speed(const char *str, speed_t *speed)
+{
+ int i;
+
+ for (i = 0; supported_speed[i].str; i++) {
+ if (strcmp(supported_speed[i].str, str) != 0)
+ continue;
+
+ if (speed)
+ *speed = supported_speed[i].speed;
+
+ return supported_speed[i].speed;
+ }
+
+ return B0;
+}
+
+static int set_parity(const char *str, tcflag_t *ctrl)
+{
+ if (strcasecmp("even", str) == 0) {
+ *ctrl |= PARENB;
+ *ctrl &= ~PARODD;
+ } else if (strcasecmp("odd", str) == 0) {
+ *ctrl |= PARENB;
+ *ctrl |= PARODD;
+ } else if (strcasecmp("mark", str) == 0)
+ *ctrl |= PARENB;
+ else if ((strcasecmp("none", str) == 0) ||
+ (strcasecmp("space", str) == 0))
+ *ctrl &= ~PARENB;
+ else
+ return -1;
+
+ return 0;
+}
+
+static int set_databits(uint8_t databits, tcflag_t *ctrl)
+{
+ if (databits < 5 || databits > 8)
+ return -EINVAL;
+
+ *ctrl &= ~CSIZE;
+ switch (databits) {
+ case 5:
+ *ctrl |= CS5;
+ break;
+ case 6:
+ *ctrl |= CS6;
+ break;
+ case 7:
+ *ctrl |= CS7;
+ break;
+ case 8:
+ *ctrl |= CS8;
+ break;
+ }
+
+ return 0;
+}
+
+static int set_stopbits(uint8_t stopbits, tcflag_t *ctrl)
+{
+ /* 1.5 will not be allowed */
+ switch (stopbits) {
+ case 1:
+ *ctrl &= ~CSTOPB;
+ return 0;
+ case 2:
+ *ctrl |= CSTOPB;
+ return 0;
+ }
+
+ return -EINVAL;
+}
+
+static DBusMessage *proxy_set_serial_params(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ struct serial_proxy *prx = data;
+ struct serial_adapter *adapter = prx->adapter;
+ const char *ratestr, *paritystr;
+ uint8_t databits, stopbits;
+ tcflag_t ctrl; /* Control mode flags */
+ speed_t speed = B0; /* In/Out speed */
+
+ /* Don't allow change TTY settings if it is open */
+ if (prx->local_watch)
+ return failed(msg, "Not allowed");
+
+ if (!dbus_message_get_args(msg, NULL,
+ DBUS_TYPE_STRING, &ratestr,
+ DBUS_TYPE_BYTE, &databits,
+ DBUS_TYPE_BYTE, &stopbits,
+ DBUS_TYPE_STRING, &paritystr,
+ DBUS_TYPE_INVALID))
+ return NULL;
+
+ if (str2speed(ratestr, &speed) == B0)
+ return invalid_arguments(msg, "Invalid baud rate");
+
+ ctrl = prx->proxy_ti.c_cflag;
+ if (set_databits(databits, &ctrl) < 0)
+ return invalid_arguments(msg, "Invalid data bits");
+
+ if (set_stopbits(stopbits, &ctrl) < 0)
+ return invalid_arguments(msg, "Invalid stop bits");
+
+ if (set_parity(paritystr, &ctrl) < 0)
+ return invalid_arguments(msg, "Invalid parity");
+
+ prx->proxy_ti.c_cflag = ctrl;
+ prx->proxy_ti.c_cflag |= (CLOCAL | CREAD);
+ cfsetispeed(&prx->proxy_ti, speed);
+ cfsetospeed(&prx->proxy_ti, speed);
+
+ proxy_store(&adapter->src, prx->uuid128, prx->address, NULL,
+ prx->channel, 0, &prx->proxy_ti);
+
+ return dbus_message_new_method_return(msg);
+}
+
+static GDBusMethodTable proxy_methods[] = {
+ { "Enable", "", "", proxy_enable },
+ { "Disable", "", "", proxy_disable },
+ { "GetInfo", "", "a{sv}",proxy_get_info },
+ { "SetSerialParameters", "syys", "", proxy_set_serial_params },
+ { },
+};
+
+static void proxy_path_unregister(gpointer data)
+{
+ struct serial_proxy *prx = data;
+ int sk;
+
+ info("Unregistered proxy: %s", prx->address);
+
+ if (prx->type != TTY_PROXY)
+ goto done;
+
+ /* Restore the initial TTY configuration */
+ sk = open(prx->address, O_RDWR | O_NOCTTY);
+ if (sk) {
+ tcsetattr(sk, TCSAFLUSH, &prx->sys_ti);
+ close(sk);
+ }
+done:
+
+ proxy_free(prx);
+}
+
+static int register_proxy_object(struct serial_proxy *prx, char *outpath, size_t size)
+{
+ struct serial_adapter *adapter = prx->adapter;
+ char path[MAX_PATH_LENGTH + 1];
+
+ snprintf(path, MAX_PATH_LENGTH, "%s/proxy%d",
+ adapter->path, sk_counter++);
+
+ if (!g_dbus_register_interface(adapter->conn, path,
+ SERIAL_PROXY_INTERFACE,
+ proxy_methods, NULL, NULL,
+ prx, proxy_path_unregister)) {
+ error("D-Bus failed to register %s path", path);
+ return -1;
+ }
+
+ prx->path = g_strdup(path);
+ adapter->proxies = g_slist_append(adapter->proxies, prx);
+
+ if (outpath)
+ strncpy(outpath, path, size);
+
+ info("Registered proxy: %s", path);
+
+ return 0;
+}
+
+static int proxy_tty_register(struct serial_adapter *adapter,
+ const char *uuid128, const char *address,
+ struct termios *ti, char *outpath, size_t size,
+ gboolean save)
+{
+ struct termios sys_ti;
+ struct serial_proxy *prx;
+ int sk, ret;
+
+ sk = open(address, O_RDONLY | O_NOCTTY);
+ if (sk < 0) {
+ error("Cant open TTY: %s(%d)", strerror(errno), errno);
+ return -EINVAL;
+ }
+
+ prx = g_new0(struct serial_proxy, 1);
+ prx->address = g_strdup(address);
+ prx->uuid128 = g_strdup(uuid128);
+ prx->type = TTY_PROXY;
+ prx->adapter = adapter;
+
+ /* Current TTY settings */
+ memset(&sys_ti, 0, sizeof(sys_ti));
+ tcgetattr(sk, &sys_ti);
+ memcpy(&prx->sys_ti, &sys_ti, sizeof(sys_ti));
+ close(sk);
+
+ if (!ti) {
+ /* Use current settings */
+ memcpy(&prx->proxy_ti, &sys_ti, sizeof(sys_ti));
+ } else {
+ /* New TTY settings: user provided */
+ memcpy(&prx->proxy_ti, ti, sizeof(*ti));
+ }
+
+ ret = register_proxy_object(prx, outpath, size);
+ if (ret < 0)
+ proxy_free(prx);
+
+ if (save)
+ proxy_store(&adapter->src, uuid128, address, NULL,
+ prx->channel, 0, &prx->proxy_ti);
+
+ return ret;
+}
+
+static int proxy_socket_register(struct serial_adapter *adapter,
+ const char *uuid128, const char *address,
+ char *outpath, size_t size, gboolean save)
+{
+ struct serial_proxy *prx;
+ int ret;
+
+ prx = g_new0(struct serial_proxy, 1);
+ prx->address = g_strdup(address);
+ prx->uuid128 = g_strdup(uuid128);
+ prx->type = UNIX_SOCKET_PROXY;
+ prx->adapter = adapter;
+
+ ret = register_proxy_object(prx, outpath, size);
+ if (ret < 0)
+ proxy_free(prx);
+
+ if (save)
+ proxy_store(&adapter->src, uuid128, address, NULL,
+ prx->channel, 0, NULL);
+
+ return ret;
+}
+
+static int proxy_tcp_register(struct serial_adapter *adapter,
+ const char *uuid128, const char *address,
+ char *outpath, size_t size, gboolean save)
+{
+ struct serial_proxy *prx;
+ int ret;
+
+ prx = g_new0(struct serial_proxy, 1);
+ prx->address = g_strdup(address);
+ prx->uuid128 = g_strdup(uuid128);
+ prx->type = TCP_SOCKET_PROXY;
+ prx->adapter = adapter;
+
+ ret = register_proxy_object(prx, outpath, size);
+ if (ret < 0)
+ proxy_free(prx);
+
+ if (save)
+ proxy_store(&adapter->src, uuid128, address, NULL,
+ prx->channel, 0, NULL);
+
+ return ret;
+}
+
+static proxy_type_t addr2type(const char *address)
+{
+ struct stat st;
+
+ if (stat(address, &st) < 0) {
+ /*
+ * Unix socket: if the sun_path starts with null byte
+ * it refers to abstract namespace. 'x00' will be used
+ * to represent the null byte.
+ */
+ if (strncmp("localhost:", address, 10) == 0)
+ return TCP_SOCKET_PROXY;
+ if (strncmp("x00", address, 3) != 0)
+ return UNKNOWN_PROXY_TYPE;
+ else
+ return UNIX_SOCKET_PROXY;
+ } else {
+ /* Filesystem: char device or unix socket */
+ if (S_ISCHR(st.st_mode) && strncmp("/dev/", address, 4) == 0)
+ return TTY_PROXY;
+ else if (S_ISSOCK(st.st_mode))
+ return UNIX_SOCKET_PROXY;
+ else
+ return UNKNOWN_PROXY_TYPE;
+ }
+}
+
+static int proxy_addrcmp(gconstpointer proxy, gconstpointer addr)
+{
+ const struct serial_proxy *prx = proxy;
+ const char *address = addr;
+
+ return strcmp(prx->address, address);
+}
+
+static int proxy_pathcmp(gconstpointer proxy, gconstpointer p)
+{
+ const struct serial_proxy *prx = proxy;
+ const char *path = p;
+
+ return strcmp(prx->path, path);
+}
+
+static DBusMessage *create_proxy(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ struct serial_adapter *adapter = data;
+ char path[MAX_PATH_LENGTH + 1];
+ const char *uuid128, *address, *ppath = path;
+ DBusMessage *reply;
+ proxy_type_t type;
+ uuid_t uuid;
+ int ret;
+
+ if (!dbus_message_get_args(msg, NULL,
+ DBUS_TYPE_STRING, &uuid128,
+ DBUS_TYPE_STRING, &address,
+ DBUS_TYPE_INVALID))
+ return NULL;
+
+ if (bt_string2uuid(&uuid, uuid128) < 0)
+ return invalid_arguments(msg, "Invalid UUID");
+
+ type = addr2type(address);
+ if (type == UNKNOWN_PROXY_TYPE)
+ return invalid_arguments(msg, "Invalid address");
+
+ /* Only one proxy per address(TTY or unix socket) is allowed */
+ if (g_slist_find_custom(adapter->proxies, address, proxy_addrcmp))
+ return g_dbus_create_error(msg, ERROR_INTERFACE ".AlreadyExist",
+ "Proxy already exists");
+
+ reply = dbus_message_new_method_return(msg);
+ if (!reply)
+ return NULL;
+
+ switch (type) {
+ case UNIX_SOCKET_PROXY:
+ ret = proxy_socket_register(adapter, uuid128, address,
+ path, sizeof(path), TRUE);
+ break;
+ case TTY_PROXY:
+ ret = proxy_tty_register(adapter, uuid128, address,
+ NULL, path, sizeof(path), TRUE);
+ break;
+ case TCP_SOCKET_PROXY:
+ ret = proxy_tcp_register(adapter, uuid128, address,
+ path, sizeof(path), TRUE);
+ break;
+ default:
+ ret = -1;
+ }
+ if (ret < 0) {
+ dbus_message_unref(reply);
+ return failed(msg, "Create object path failed");
+ }
+
+ g_dbus_emit_signal(adapter->conn, adapter->path,
+ SERIAL_MANAGER_INTERFACE, "ProxyCreated",
+ DBUS_TYPE_STRING, &ppath,
+ DBUS_TYPE_INVALID);
+
+ dbus_message_append_args(reply,
+ DBUS_TYPE_STRING, &ppath,
+ DBUS_TYPE_INVALID);
+
+ return reply;
+}
+
+static DBusMessage *list_proxies(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ struct serial_adapter *adapter = data;
+ const GSList *l;
+ DBusMessage *reply;
+ DBusMessageIter iter, iter_array;
+
+ 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_TYPE_STRING_AS_STRING, &iter_array);
+
+ for (l = adapter->proxies; l; l = l->next) {
+ struct serial_proxy *prx = l->data;
+
+ dbus_message_iter_append_basic(&iter_array,
+ DBUS_TYPE_STRING, &prx->path);
+ }
+
+ dbus_message_iter_close_container(&iter, &iter_array);
+
+ return reply;
+}
+
+static DBusMessage *remove_proxy(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ struct serial_adapter *adapter = data;
+ struct serial_proxy *prx;
+ const char *path;
+ GSList *l;
+
+ if (!dbus_message_get_args(msg, NULL,
+ DBUS_TYPE_STRING, &path,
+ DBUS_TYPE_INVALID))
+ return NULL;
+
+ l = g_slist_find_custom(adapter->proxies, path, proxy_pathcmp);
+ if (!l)
+ return does_not_exist(msg, "Invalid proxy path");
+
+ g_dbus_emit_signal(conn, adapter->path,
+ SERIAL_MANAGER_INTERFACE, "ProxyRemoved",
+ DBUS_TYPE_STRING, &path,
+ DBUS_TYPE_INVALID);
+
+ prx = l->data;
+ proxy_delete(&adapter->src, prx->address);
+ adapter->proxies = g_slist_remove(adapter->proxies, prx);
+
+ g_dbus_unregister_interface(conn, path, SERIAL_PROXY_INTERFACE);
+
+ return dbus_message_new_method_return(msg);
+}
+
+static void manager_path_unregister(void *data)
+{
+ struct serial_adapter *adapter = data;
+ GSList *l;
+
+ /* Remove proxy objects */
+ for (l = adapter->proxies; l; l = l->next) {
+ struct serial_proxy *prx = l->data;
+
+ g_dbus_unregister_interface(adapter->conn, prx->path,
+ SERIAL_PROXY_INTERFACE);
+ }
+
+ if (adapter->conn)
+ dbus_connection_unref(adapter->conn);
+ g_slist_free(adapter->proxies);
+ g_free(adapter->path);
+ g_free(adapter);
+}
+
+static GDBusMethodTable manager_methods[] = {
+ { "CreateProxy", "ss", "s", create_proxy },
+ { "ListProxies", "", "as", list_proxies },
+ { "RemoveProxy", "s", "", remove_proxy },
+ { },
+};
+
+static GDBusSignalTable manager_signals[] = {
+ { "ProxyCreated", "s" },
+ { "ProxyRemoved", "s" },
+ { }
+};
+
+static void parse_proxy(char *key, char *value, void *data)
+{
+ struct serial_adapter *adapter = data;
+ char uuid128[MAX_LEN_UUID_STR], tmp[3];
+ char *pvalue;
+ proxy_type_t type;
+ int ch, opts, pos;
+ struct termios ti;
+ uint8_t *pti;
+
+ memset(uuid128, 0, sizeof(uuid128));
+ ch = opts = pos = 0;
+ if (sscanf(value,"%s %d 0x%04X %n", uuid128, &ch, &opts, &pos) != 3)
+ return;
+
+ /* Extracting name */
+ value += pos;
+ pvalue = strchr(value, ':');
+ if (!pvalue)
+ return;
+
+ /* FIXME: currently name is not used */
+ *pvalue = '\0';
+
+ type = addr2type(key);
+ switch (type) {
+ case TTY_PROXY:
+ /* Extracting termios */
+ pvalue++;
+ if (!pvalue || strlen(pvalue) != (2 * sizeof(ti)))
+ return;
+
+ memset(&ti, 0, sizeof(ti));
+ memset(tmp, 0, sizeof(tmp));
+
+ /* Converting to termios struct */
+ pti = (uint8_t *) &ti;
+ for (pos = 0; pos < sizeof(ti); pos++, pvalue += 2, pti++) {
+ memcpy(tmp, pvalue, 2);
+ *pti = (uint8_t) strtol(tmp, NULL, 16);
+ }
+
+ proxy_tty_register(adapter, uuid128, key, &ti, NULL, 0, FALSE);
+ break;
+ case UNIX_SOCKET_PROXY:
+ proxy_socket_register(adapter, uuid128, key, NULL, 0, FALSE);
+ break;
+ case TCP_SOCKET_PROXY:
+ proxy_tcp_register(adapter, uuid128, key, NULL, 0, FALSE);
+ break;
+ default:
+ return;
+ }
+}
+
+static void register_stored(struct serial_adapter *adapter)
+{
+ char filename[PATH_MAX + 1];
+ char address[18];
+
+ ba2str(&adapter->src, address);
+ snprintf(filename, PATH_MAX, "%s/%s/proxy", STORAGEDIR, address);
+ textfile_foreach(filename, parse_proxy, adapter);
+}
+
+static struct serial_adapter *find_adapter(GSList *list, const char *path)
+{
+ GSList *l;
+
+ for (l = list; l; l = l->next) {
+ struct serial_adapter *adapter = l->data;
+
+ if (g_str_equal(adapter->path, path))
+ return adapter;
+ }
+
+ return NULL;
+}
+
+int proxy_register(DBusConnection *conn, const char *path, bdaddr_t *src)
+{
+ struct serial_adapter *adapter;
+
+ adapter = find_adapter(adapters, path);
+ if (adapter)
+ return -EINVAL;
+
+ adapter = g_new0(struct serial_adapter, 1);
+ adapter->conn = dbus_connection_ref(conn);
+ bacpy(&adapter->src, src);
+ adapter->path = g_strdup(path);
+
+ if (!g_dbus_register_interface(conn, path,
+ SERIAL_MANAGER_INTERFACE,
+ manager_methods, manager_signals, NULL,
+ adapter, manager_path_unregister)) {
+ error("Failed to register %s interface to %s",
+ SERIAL_MANAGER_INTERFACE, path);
+ return -1;
+ }
+
+ register_stored(adapter);
+
+ adapters = g_slist_append(adapters, adapter);
+
+ info("Registered interface %s on path %s",
+ SERIAL_MANAGER_INTERFACE, path);
+
+ return 0;
+}
+
+void proxy_unregister(const char *path)
+{
+ struct serial_adapter *adapter;
+
+ adapter = find_adapter(adapters, path);
+ if (!adapter)
+ return;
+
+ g_dbus_unregister_interface(adapter->conn, path,
+ SERIAL_MANAGER_INTERFACE);
+}
diff --git a/serial/proxy.h b/serial/proxy.h
new file mode 100644
index 00000000..bd628050
--- /dev/null
+++ b/serial/proxy.h
@@ -0,0 +1,25 @@
+/*
+ *
+ * BlueZ - Bluetooth protocol stack for Linux
+ *
+ * Copyright (C) 2004-2008 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
+ *
+ */
+
+int proxy_register(DBusConnection *conn, const char *path, bdaddr_t *src);
+void proxy_unregister(const char *path);