diff options
author | Luiz Augusto von Dentz <luiz.dentz@indt.org.br> | 2008-08-12 18:59:10 -0300 |
---|---|---|
committer | Luiz Augusto von Dentz <luiz.dentz@indt.org.br> | 2008-08-12 18:59:10 -0300 |
commit | cfb4d2ae65f9dc2c2f792dfeb1afc164ee598efc (patch) | |
tree | 7cb8e23681ee21054f877c4cd0806a18b779aae9 | |
parent | 00e08e05f39aad7194b3959a8583071b1551ecbe (diff) |
Make serial plugin to register adapter drivers.
-rw-r--r-- | serial/Makefile.am | 2 | ||||
-rw-r--r-- | serial/manager.c | 1064 | ||||
-rw-r--r-- | serial/manager.h | 9 | ||||
-rw-r--r-- | serial/proxy.c | 1151 | ||||
-rw-r--r-- | serial/proxy.h | 25 |
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); |