X-Git-Url: http://git.lttng.org/?a=blobdiff_plain;f=libustcomm%2Fustcomm.c;h=e401c4256e6666292a3ea6b9f5dddd948d811b64;hb=304f67a5f2d2eaaa7407c09b2ac7d6e049bccf1f;hp=7dd12510612eac2b1502445f6d9cfd64e89c9102;hpb=5932431b3ef6217b50e6e9503826b94ee191edd7;p=ust.git

diff --git a/libustcomm/ustcomm.c b/libustcomm/ustcomm.c
index 7dd1251..e401c42 100644
--- a/libustcomm/ustcomm.c
+++ b/libustcomm/ustcomm.c
@@ -15,6 +15,8 @@
  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA
  */
 
+/* API used by UST components to communicate with each other via sockets. */
+
 #define _GNU_SOURCE
 #include <sys/types.h>
 #include <signal.h>
@@ -23,6 +25,7 @@
 #include <sys/un.h>
 #include <unistd.h>
 #include <poll.h>
+#include <sys/epoll.h>
 #include <sys/stat.h>
 
 #include <stdio.h>
@@ -34,24 +37,6 @@
 #include "usterr.h"
 #include "share.h"
 
-#define UNIX_PATH_MAX 108
-
-#define MSG_MAX 10000
-
-/* FIXME: ustcomm blocks on message sending, which might be problematic in
- * some cases. Fix the poll() usage so sends are buffered until they don't
- * block.
- */
-
-//static void bt(void)
-//{
-//	void *buffer[100];
-//	int result;
-//
-//	result = backtrace(&buffer, 100);
-//	backtrace_symbols_fd(buffer, result, STDERR_FILENO);
-//}
-
 static int mkdir_p(const char *path, mode_t mode)
 {
 	const char *path_p;
@@ -59,14 +44,16 @@ static int mkdir_p(const char *path, mode_t mode)
 
 	int retval = 0;
 	int result;
+	mode_t old_umask;
 
-	tmp = malloc(strlen(path) + 1);
+	tmp = zmalloc(strlen(path) + 1);
 	if (tmp == NULL)
 		return -1;
 
 	/* skip first / */
 	path_p = path+1;
 
+	old_umask = umask(0);
 	for(;;) {
 		while (*path_p != '/') {
 			if(*path_p == 0)
@@ -98,732 +85,772 @@ static int mkdir_p(const char *path, mode_t mode)
 	}
 
 	free(tmp);
+	umask(old_umask);
 	return retval;
 }
 
-char *strdup_malloc(const char *s)
+static struct sockaddr_un * create_sock_addr(const char *name,
+					     size_t *sock_addr_size)
 {
-	char *retval;
+	struct sockaddr_un * addr;
+	size_t alloc_size;
 
-	if(s == NULL)
-		return NULL;
+	alloc_size = (size_t) (((struct sockaddr_un *) 0)->sun_path) +
+		strlen(name) + 1;
 
-	retval = (char *) malloc(strlen(s)+1);
+	addr = malloc(alloc_size);
+	if (addr < 0) {
+		ERR("allocating addr failed");
+		return NULL;
+	}
 
-	strcpy(retval, s);
+	addr->sun_family = AF_UNIX;
+	strcpy(addr->sun_path, name);
 
-	return retval;
-}
+	*sock_addr_size = alloc_size;
 
-static int signal_process(pid_t pid)
-{
-	return 0;
+	return addr;
 }
 
-void ustcomm_init_connection(struct ustcomm_connection *conn)
+struct ustcomm_sock * ustcomm_init_sock(int fd, int epoll_fd,
+					struct cds_list_head *list)
 {
-	conn->recv_buf = NULL;
-	conn->recv_buf_size = 0;
-	conn->recv_buf_alloc = 0;
-}
-
-int pid_is_online(pid_t pid) {
-	return 1;
-}
+	struct epoll_event ev;
+	struct ustcomm_sock *sock;
 
-/* Send a message
- *
- * @fd: file descriptor to send to
- * @msg: a null-terminated string containing the message to send
- *
- * Return value:
- * -1: error
- * 0: connection closed
- * 1: success
- */
+	sock = malloc(sizeof(struct ustcomm_sock));
+	if (!sock) {
+		perror("malloc: couldn't allocate ustcomm_sock");
+		return NULL;
+	}
 
-static int send_message_fd(int fd, const char *msg)
-{
-	int result;
+	ev.events = EPOLLIN;
+	ev.data.ptr = sock;
+	sock->fd = fd;
 
-	/* Send including the final \0 */
-	result = patient_send(fd, msg, strlen(msg)+1, MSG_NOSIGNAL);
-	if(result == -1) {
-		if(errno != EPIPE)
-			PERROR("send");
-		return -1;
+	if (epoll_ctl(epoll_fd, EPOLL_CTL_ADD, sock->fd, &ev) == -1) {
+		perror("epoll_ctl: failed to add socket\n");
+		free(sock);
+		return NULL;
 	}
-	else if(result == 0) {
-		return 0;
+
+	sock->epoll_fd = epoll_fd;
+	if (list) {
+		cds_list_add(&sock->list, list);
+	} else {
+		CDS_INIT_LIST_HEAD(&sock->list);
 	}
 
-	DBG("sent message \"%s\"", msg);
-	return 1;
+	return sock;
 }
 
-/* Called by an app to ask the consumer daemon to connect to it. */
+void ustcomm_del_sock(struct ustcomm_sock *sock, int keep_in_epoll)
+{
+	cds_list_del(&sock->list);
+	if (!keep_in_epoll) {
+		if (epoll_ctl(sock->epoll_fd, EPOLL_CTL_DEL, sock->fd, NULL) == -1) {
+			PERROR("epoll_ctl: failed to delete socket");
+		}
+	}
+	close(sock->fd);
+	free(sock);
+}
 
-int ustcomm_request_consumer(pid_t pid, const char *channel)
+struct ustcomm_sock * ustcomm_init_named_socket(const char *name,
+						int epoll_fd)
 {
-	char path[UNIX_PATH_MAX];
 	int result;
-	char *msg=NULL;
-	int retval = 0;
-	struct ustcomm_connection conn;
-	char *explicit_daemon_socket_path;
+	int fd;
+	size_t sock_addr_size;
+	struct sockaddr_un * addr;
+	struct ustcomm_sock *sock;
 
-	explicit_daemon_socket_path = getenv("UST_DAEMON_SOCKET");
-	if(explicit_daemon_socket_path) {
-		/* user specified explicitly a socket path */
-		result = snprintf(path, UNIX_PATH_MAX, "%s", explicit_daemon_socket_path);
-	}
-	else {
-		/* just use the default path */
-		result = snprintf(path, UNIX_PATH_MAX, "%s/ustd", SOCK_DIR);
+	fd = socket(PF_UNIX, SOCK_STREAM, 0);
+	if(fd == -1) {
+		PERROR("socket");
+		return NULL;
 	}
 
-	if(result >= UNIX_PATH_MAX) {
-		ERR("string overflow allocating socket name");
-		return -1;
+	addr = create_sock_addr(name, &sock_addr_size);
+	if (addr == NULL) {
+		ERR("allocating addr, UST thread bailing");
+		goto close_sock;
 	}
 
-	asprintf(&msg, "collect %d %s", pid, channel); 
+	result = access(name, F_OK);
+	if(result == 0) {
+		/* file exists */
+		result = unlink(name);
+		if(result == -1) {
+			PERROR("unlink of socket file");
+			goto free_addr;
+		}
+		DBG("socket already exists; overwriting");
+	}
 
-	/* don't signal it because it's the daemon */
-	result = ustcomm_connect_path(path, &conn, -1);
+	result = bind(fd, (struct sockaddr *)addr, sock_addr_size);
 	if(result == -1) {
-		WARN("ustcomm_connect_path failed");
-		retval = -1;
-		goto del_string;
+		PERROR("bind");
+		goto free_addr;
 	}
 
-	result = ustcomm_send_request(&conn, msg, NULL);
+	result = listen(fd, 1);
 	if(result == -1) {
-		WARN("ustcomm_send_request failed");
-		retval = -1;
-		goto disconnect;
+		PERROR("listen");
+		goto free_addr;
 	}
 
-	disconnect:
-	ustcomm_disconnect(&conn);
-	del_string:
-	free(msg);
+	sock = ustcomm_init_sock(fd, epoll_fd,
+				 NULL);
+	if (!sock) {
+		ERR("failed to create ustcomm_sock");
+		goto free_addr;
+	}
 
-	return retval;
-}
+	free(addr);
 
-/* returns 1 to indicate a message was received
- * returns 0 to indicate no message was received (end of stream)
- * returns -1 to indicate an error
- */
+	return sock;
 
-#define RECV_INCREMENT 1000
-#define RECV_INITIAL_BUF_SIZE 10
+free_addr:
+	free(addr);
+close_sock:
+	close(fd);
+
+	return NULL;
+}
 
-static int recv_message_fd(int fd, char **recv_buf, int *recv_buf_size, int *recv_buf_alloc, char **msg)
+void ustcomm_del_named_sock(struct ustcomm_sock *sock,
+			    int keep_socket_file)
 {
-	int result;
+	int result, fd;
+	struct stat st;
+	struct sockaddr dummy;
+	struct sockaddr_un *sockaddr = NULL;
+	int alloc_size;
 
-	/* 1. Check if there is a message in the buf */
-	/* 2. If not, do:
-           2.1 receive chunk and put it in buffer
-	   2.2 process full message if there is one
-	   -- while no message arrived
-	*/
+	fd = sock->fd;
 
-	for(;;) {
-		int i;
-		int nulfound = 0;
+	if(!keep_socket_file) {
 
-		/* Search for full message in buffer */
-		for(i=0; i<*recv_buf_size; i++) {
-			if((*recv_buf)[i] == '\0') {
-				nulfound = 1;
-				break;
-			}
+		/* Get the socket name */
+		alloc_size = sizeof(dummy);
+		if (getsockname(fd, &dummy, (socklen_t *)&alloc_size) < 0) {
+			PERROR("getsockname failed");
+			goto del_sock;
 		}
 
-		/* Process found message */
-		if(nulfound == 1) {
-			char *newbuf;
-
-			if(i == 0) {
-				/* problem */
-			}
-			*msg = strndup(*recv_buf, i);
-
-			/* Remove processed message from buffer */
-			newbuf = (char *) malloc(*recv_buf_size - (i+1));
-			memcpy(newbuf, *recv_buf + (i+1), *recv_buf_size - (i+1));
-			free(*recv_buf);
-			*recv_buf = newbuf;
-			*recv_buf_size -= (i+1);
-			*recv_buf_alloc -= (i+1);
-
-			return 1;
+		sockaddr = zmalloc(alloc_size);
+		if (!sockaddr) {
+			ERR("failed to allocate sockaddr");
+			goto del_sock;
 		}
 
-		/* Receive a chunk from the fd */
-		if(*recv_buf_alloc - *recv_buf_size < RECV_INCREMENT) {
-			*recv_buf_alloc += RECV_INCREMENT - (*recv_buf_alloc - *recv_buf_size);
-			*recv_buf = (char *) realloc(*recv_buf, *recv_buf_alloc);
+		if (getsockname(fd, sockaddr, (socklen_t *)&alloc_size) < 0) {
+			PERROR("getsockname failed");
+			goto free_sockaddr;
 		}
 
-		result = recv(fd, *recv_buf+*recv_buf_size, RECV_INCREMENT, 0);
-		if(result == -1) {
-			if(errno == ECONNRESET) {
-				*recv_buf_size = 0;
-				return 0;
-			}
-			/* real error */
-			PERROR("recv");
-			return -1;
+		/* Destroy socket */
+		result = stat(sockaddr->sun_path, &st);
+		if(result < 0) {
+			PERROR("stat (%s)", sockaddr->sun_path);
+			goto free_sockaddr;
 		}
-		if(result == 0) {
-			return 0;
+
+		/* Paranoid check before deleting. */
+		result = S_ISSOCK(st.st_mode);
+		if(!result) {
+			ERR("The socket we are about to delete is not a socket.");
+			goto free_sockaddr;
 		}
-		*recv_buf_size += result;
 
-		/* Go back to the beginning to check if there is a full message in the buffer */
+		result = unlink(sockaddr->sun_path);
+		if(result < 0) {
+			PERROR("unlink");
+		}
 	}
 
-	DBG("received message \"%s\"", *recv_buf);
+free_sockaddr:
+	free(sockaddr);
 
-	return 1;
-
-}
-
-static int recv_message_conn(struct ustcomm_connection *conn, char **msg)
-{
-	return recv_message_fd(conn->fd, &conn->recv_buf, &conn->recv_buf_size, &conn->recv_buf_alloc, msg);
+del_sock:
+	ustcomm_del_sock(sock, keep_socket_file);
 }
 
-int ustcomm_send_reply(struct ustcomm_server *server, char *msg, struct ustcomm_source *src)
-{
+int ustcomm_recv_alloc(int sock,
+		       struct ustcomm_header *header,
+		       char **data) {
 	int result;
+	struct ustcomm_header peek_header;
+	struct iovec iov[2];
+	struct msghdr msg;
 
-	result = send_message_fd(src->fd, msg);
-	if(result < 0) {
-		ERR("error in send_message_fd");
-		return -1;
+	/* Just to make the caller fail hard */
+	*data = NULL;
+
+	result = recv(sock, &peek_header, sizeof(peek_header),
+		      MSG_PEEK | MSG_WAITALL);
+	if (result <= 0) {
+		if(errno == ECONNRESET) {
+			return 0;
+		} else if (errno == EINTR) {
+			return -1;
+		} else if (result < 0) {
+			PERROR("recv");
+			return -1;
+		}
+		return 0;
 	}
 
-	return 0;
-} 
+	memset(&msg, 0, sizeof(msg));
 
-/* Called after a fork. */
+	iov[0].iov_base = (char *)header;
+	iov[0].iov_len = sizeof(struct ustcomm_header);
 
-int ustcomm_close_all_connections(struct ustcomm_server *server)
-{
-	struct ustcomm_connection *conn;
-	struct ustcomm_connection *deletable_conn = NULL;
+	msg.msg_iov = iov;
+	msg.msg_iovlen = 1;
+
+	if (peek_header.size) {
+		*data = zmalloc(peek_header.size);
+		if (!*data) {
+			return -ENOMEM;
+		}
 
-	list_for_each_entry(conn, &server->connections, list) {
-		free(deletable_conn);
-		deletable_conn = conn;
-		close(conn->fd);
-		list_del(&conn->list);
+		iov[1].iov_base = *data;
+		iov[1].iov_len = peek_header.size;
+
+		msg.msg_iovlen++;
 	}
 
-	return 0;
+	result = recvmsg(sock, &msg, MSG_WAITALL);
+	if (result < 0) {
+		free(*data);
+		PERROR("recvmsg failed");
+	}
+
+	return result;
 }
 
-/* @timeout: max blocking time in milliseconds, -1 means infinity
- *
- * returns 1 to indicate a message was received
- * returns 0 to indicate no message was received
+/* returns 1 to indicate a message was received
+ * returns 0 to indicate no message was received (end of stream)
  * returns -1 to indicate an error
  */
-
-int ustcomm_recv_message(struct ustcomm_server *server, char **msg, struct ustcomm_source *src, int timeout)
+int ustcomm_recv_fd(int sock,
+		    struct ustcomm_header *header,
+		    char *data, int *fd)
 {
-	struct pollfd *fds;
-	struct ustcomm_connection **conn_table;
-	struct ustcomm_connection *conn;
 	int result;
-	int retval;
-
-	for(;;) {
-		int idx = 0;
-		int n_fds = 1;
-
-		list_for_each_entry(conn, &server->connections, list) {
-			n_fds++;
-		}
-
-		fds = (struct pollfd *) malloc(n_fds * sizeof(struct pollfd));
-		if(fds == NULL) {
-			ERR("malloc returned NULL");
+	struct ustcomm_header peek_header;
+	struct iovec iov[2];
+	struct msghdr msg;
+	struct cmsghdr *cmsg;
+	char buf[CMSG_SPACE(sizeof(int))];
+
+	result = recv(sock, &peek_header, sizeof(peek_header),
+		      MSG_PEEK | MSG_WAITALL);
+	if (result <= 0) {
+		if(errno == ECONNRESET) {
+			return 0;
+		} else if (errno == EINTR) {
 			return -1;
-		}
-
-		conn_table = (struct ustcomm_connection **) malloc(n_fds * sizeof(struct ustcomm_connection *));
-		if(conn_table == NULL) {
-			ERR("malloc returned NULL");
+		} else if (result < 0) {
+			PERROR("recv");
 			return -1;
 		}
+		return 0;
+	}
 
-		/* special idx 0 is for listening socket */
-		fds[idx].fd = server->listen_fd;
-		fds[idx].events = POLLIN;
-		idx++;
+	memset(&msg, 0, sizeof(msg));
 
-		list_for_each_entry(conn, &server->connections, list) {
-			fds[idx].fd = conn->fd;
-			fds[idx].events = POLLIN;
-			conn_table[idx] = conn;
-			idx++;
-		}
+	iov[0].iov_base = (char *)header;
+	iov[0].iov_len = sizeof(struct ustcomm_header);
 
-		while((result = poll(fds, n_fds, timeout)) == -1 && errno == EINTR)
-			/* nothing */;
-		if(result == -1) {
-			PERROR("poll");
-			return -1;
-		}
+	msg.msg_iov = iov;
+	msg.msg_iovlen = 1;
 
-		if(result == 0)
+	if (peek_header.size && data) {
+		if (peek_header.size < 0 ||
+		    peek_header.size > USTCOMM_DATA_SIZE) {
+			ERR("big peek header! %ld", peek_header.size);
 			return 0;
+		}
 
-		if(fds[0].revents) {
-			struct ustcomm_connection *newconn;
-			int newfd;
+		iov[1].iov_base = data;
+		iov[1].iov_len = peek_header.size;
 
-			result = newfd = accept(server->listen_fd, NULL, NULL);
-			if(result == -1) {
-				PERROR("accept");
-				return -1;
-			}
-
-			newconn = (struct ustcomm_connection *) malloc(sizeof(struct ustcomm_connection));
-			if(newconn == NULL) {
-				ERR("malloc returned NULL");
-				return -1;
-			}
+		msg.msg_iovlen++;
+	}
 
-			ustcomm_init_connection(newconn);
-			newconn->fd = newfd;
+	if (fd && peek_header.fd_included) {
+		msg.msg_control = buf;
+		msg.msg_controllen = sizeof(buf);
+	}
 
-			list_add(&newconn->list, &server->connections);
+	result = recvmsg(sock, &msg, MSG_WAITALL);
+	if (result <= 0) {
+		if (result < 0) {
+			PERROR("recvmsg failed");
 		}
+		return result;
+	}
 
-		for(idx=1; idx<n_fds; idx++) {
-			if(fds[idx].revents) {
-				retval = recv_message_conn(conn_table[idx], msg);
-				if(src)
-					src->fd = fds[idx].fd;
-
-				if(retval == 0) {
-					/* connection finished */
-					close(fds[idx].fd);
-
-					list_for_each_entry(conn, &server->connections, list) {
-						if(conn->fd == fds[idx].fd) {
-							list_del(&conn->list);
-							break;
-						}
-					}
-				}
-				else {
-					goto free_fds_return;
-				}
+	if (fd && peek_header.fd_included) {
+		cmsg = CMSG_FIRSTHDR(&msg);
+		result = 0;
+		while (cmsg != NULL) {
+			if (cmsg->cmsg_level == SOL_SOCKET
+			    && cmsg->cmsg_type  == SCM_RIGHTS) {
+				*fd = *(int *) CMSG_DATA(cmsg);
+				result = 1;
+				break;
 			}
+			cmsg = CMSG_NXTHDR(&msg, cmsg);
+		}
+		if (!result) {
+			ERR("Failed to receive file descriptor\n");
 		}
-
-		free(fds);
 	}
 
-free_fds_return:
-	free(fds);
-	return retval;
-}
-
-int ustcomm_ustd_recv_message(struct ustcomm_ustd *ustd, char **msg, struct ustcomm_source *src, int timeout)
-{
-	return ustcomm_recv_message(&ustd->server, msg, src, timeout);
+	return 1;
 }
 
-int ustcomm_app_recv_message(struct ustcomm_app *app, char **msg, struct ustcomm_source *src, int timeout)
+int ustcomm_recv(int sock,
+		 struct ustcomm_header *header,
+		 char *data)
 {
-	return ustcomm_recv_message(&app->server, msg, src, timeout);
+	return ustcomm_recv_fd(sock, header, data, NULL);
 }
 
-/* This removes src from the list of active connections of app.
- */
 
-int ustcomm_app_detach_client(struct ustcomm_app *app, struct ustcomm_source *src)
-{
-	struct ustcomm_server *server = (struct ustcomm_server *)app;
-	struct ustcomm_connection *conn;
-
-	list_for_each_entry(conn, &server->connections, list) {
-		if(conn->fd == src->fd) {
-			list_del(&conn->list);
-			goto found;
-		}
-	}
-
-	return -1;
-found:
-	return src->fd;
-}
-
-static int init_named_socket(const char *name, char **path_out)
+int ustcomm_send_fd(int sock,
+		    const struct ustcomm_header *header,
+		    const char *data,
+		    int *fd)
 {
+	struct iovec iov[2];
+	struct msghdr msg;
 	int result;
-	int fd;
+	struct cmsghdr *cmsg;
+	char buf[CMSG_SPACE(sizeof(int))];
 
-	struct sockaddr_un addr;
-	
-	result = fd = socket(PF_UNIX, SOCK_STREAM, 0);
-	if(result == -1) {
-		PERROR("socket");
-		return -1;
-	}
+	memset(&msg, 0, sizeof(msg));
 
-	addr.sun_family = AF_UNIX;
+	iov[0].iov_base = (char *)header;
+	iov[0].iov_len = sizeof(struct ustcomm_header);
 
-	strncpy(addr.sun_path, name, UNIX_PATH_MAX);
-	addr.sun_path[UNIX_PATH_MAX-1] = '\0';
+	msg.msg_iov = iov;
+	msg.msg_iovlen = 1;
 
-	result = access(name, F_OK);
-	if(result == 0) {
-		/* file exists */
-		result = unlink(name);
-		if(result == -1) {
-			PERROR("unlink of socket file");
-			goto close_sock;
-		}
-		WARN("socket already exists; overwriting");
-	}
+	if (header->size && data) {
+		iov[1].iov_base = (char *)data;
+		iov[1].iov_len = header->size;
 
-	result = bind(fd, (struct sockaddr *)&addr, sizeof(addr));
-	if(result == -1) {
-		PERROR("bind");
-		goto close_sock;
-	}
+		msg.msg_iovlen++;
 
-	result = listen(fd, 1);
-	if(result == -1) {
-		PERROR("listen");
-		goto close_sock;
 	}
 
-	if(path_out) {
-		*path_out = strdup(addr.sun_path);
+	if (fd && header->fd_included) {
+		msg.msg_control = buf;
+		msg.msg_controllen = sizeof(buf);
+		cmsg = CMSG_FIRSTHDR(&msg);
+		cmsg->cmsg_level = SOL_SOCKET;
+		cmsg->cmsg_type = SCM_RIGHTS;
+		cmsg->cmsg_len = CMSG_LEN(sizeof(int));
+		*(int *) CMSG_DATA(cmsg) = *fd;
+		msg.msg_controllen = cmsg->cmsg_len;
 	}
 
-	return fd;
-
-	close_sock:
-	close(fd);
-
-	return -1;
+	result = sendmsg(sock, &msg, MSG_NOSIGNAL);
+	if (result < 0 && errno != EPIPE) {
+		PERROR("sendmsg failed");
+	}
+	return result;
 }
 
-/*
- * Return value:
- *   0: Success, but no reply because recv() returned 0
- *   1: Success
- *   -1: Error
- *
- * On error, the error message is printed, except on
- * ECONNRESET, which is normal when the application dies.
- */
+int ustcomm_send(int sock,
+		 const struct ustcomm_header *header,
+		 const char *data)
+{
+	return ustcomm_send_fd(sock, header, data, NULL);
+}
 
-int ustcomm_send_request(struct ustcomm_connection *conn, const char *req, char **reply)
+int ustcomm_req(int sock,
+		const struct ustcomm_header *req_header,
+		const char *req_data,
+		struct ustcomm_header *res_header,
+		char *res_data)
 {
 	int result;
 
-	/* Send including the final \0 */
-	result = send_message_fd(conn->fd, req);
-	if(result != 1)
+	result = ustcomm_send(sock, req_header, req_data);
+	if ( result <= 0) {
 		return result;
-
-	if(!reply)
-		return 1;
-
-	result = recv_message_conn(conn, reply);
-	if(result == -1) {
-		return -1;
 	}
-	else if(result == 0) {
-		return 0;
-	}
-	
-	return 1;
+
+	return ustcomm_recv(sock, res_header, res_data);
 }
 
-int ustcomm_connect_path(const char *path, struct ustcomm_connection *conn, pid_t signalpid)
-{
-	int fd;
-	int result;
-	struct sockaddr_un addr;
+/* Return value:
+ *  0: success
+ * -1: error
+ */
 
-	ustcomm_init_connection(conn);
+int ustcomm_connect_path(const char *name, int *connection_fd)
+{
+	int result, fd;
+	size_t sock_addr_size;
+	struct sockaddr_un *addr;
 
-	result = fd = socket(PF_UNIX, SOCK_STREAM, 0);
-	if(result == -1) {
+	fd = socket(PF_UNIX, SOCK_STREAM, 0);
+	if(fd == -1) {
 		PERROR("socket");
 		return -1;
 	}
 
-	addr.sun_family = AF_UNIX;
-
-	result = snprintf(addr.sun_path, UNIX_PATH_MAX, "%s", path);
-	if(result >= UNIX_PATH_MAX) {
-		ERR("string overflow allocating socket name");
-		return -1;
-	}
-
-	if(signalpid >= 0) {
-		result = signal_process(signalpid);
-		if(result == -1) {
-			ERR("could not signal process");
-			return -1;
-		}
+	addr = create_sock_addr(name, &sock_addr_size);
+	if (addr == NULL) {
+		ERR("allocating addr failed");
+		goto close_sock;
 	}
 
-	result = connect(fd, (struct sockaddr *)&addr, sizeof(addr));
+	result = connect(fd, (struct sockaddr *)addr, sock_addr_size);
 	if(result == -1) {
-		PERROR("connect (path=%s)", path);
-		return -1;
+		PERROR("connect (path=%s)", name);
+		goto free_sock_addr;
 	}
 
-	conn->fd = fd;
+	*connection_fd = fd;
+
+	free(addr);
 
 	return 0;
+
+free_sock_addr:
+	free(addr);
+close_sock:
+	close(fd);
+
+	return -1;
 }
 
-int ustcomm_disconnect(struct ustcomm_connection *conn)
+/* Returns the current users socket directory, must be freed */
+char *ustcomm_user_sock_dir(void)
 {
-	return close(conn->fd);
+	int result;
+	char *sock_dir = NULL;
+
+	result = asprintf(&sock_dir, "%s%s", USER_SOCK_DIR,
+			  cuserid(NULL));
+	if (result < 0) {
+		ERR("string overflow allocating directory name");
+		return NULL;
+	}
+
+	return sock_dir;
 }
 
-int ustcomm_connect_app(pid_t pid, struct ustcomm_connection *conn)
+/* Open a connection to a traceable app.
+ *
+ * Return value:
+ *  0: success
+ * -1: error
+ */
+
+int ustcomm_connect_app(pid_t pid, int *app_fd)
 {
 	int result;
-	char path[UNIX_PATH_MAX];
+	int retval = 0;
+	char *dir_name, *sock_name;
 
+	dir_name = ustcomm_user_sock_dir();
+	if (!dir_name)
+		return -ENOMEM;
 
-	result = snprintf(path, UNIX_PATH_MAX, "%s/%d", SOCK_DIR, pid);
-	if(result >= UNIX_PATH_MAX) {
-		ERR("string overflow allocating socket name");
-		return -1;
+	result = asprintf(&sock_name, "%s/%d", dir_name, pid);
+	if (result < 0) {
+		ERR("failed to allocate socket name");
+		retval = -1;
+		goto free_dir_name;
 	}
 
-	return ustcomm_connect_path(path, conn, pid);
+	result = ustcomm_connect_path(sock_name, app_fd);
+	if (result < 0) {
+		ERR("failed to connect to app");
+		retval = -1;
+		goto free_sock_name;
+	}
+
+free_sock_name:
+	free(sock_name);
+free_dir_name:
+	free(dir_name);
+
+	return retval;
 }
 
-static int ensure_dir_exists(const char *dir)
+int ensure_dir_exists(const char *dir, mode_t mode)
 {
 	struct stat st;
 	int result;
 
-	if(!strcmp(dir, ""))
+	if (!strcmp(dir, ""))
 		return -1;
 
 	result = stat(dir, &st);
-	if(result == -1 && errno != ENOENT) {
+	if (result < 0 && errno != ENOENT) {
 		return -1;
-	}
-	else if(result == -1) {
+	} else if (result < 0) {
 		/* ENOENT */
 		int result;
 
-		result = mkdir_p(dir, 0777);
+		result = mkdir_p(dir, mode);
 		if(result != 0) {
 			ERR("executing in recursive creation of directory %s", dir);
 			return -1;
 		}
+	} else {
+		if (st.st_mode != mode) {
+			result = chmod(dir, mode);
+			if (result < 0) {
+				ERR("couldn't set directory mode on %s", dir);
+				return -1;
+			}
+		}
 	}
 
 	return 0;
 }
 
-/* Called by an application to initialize its server so daemons can
- * connect to it.
- */
-
-int ustcomm_init_app(pid_t pid, struct ustcomm_app *handle)
+char * ustcomm_print_data(char *data_field, int field_size,
+			  int *offset, const char *format, ...)
 {
-	int result;
-	char *name;
+	va_list args;
+	int count, limit;
+	char *ptr = USTCOMM_POISON_PTR;
 
-	result = asprintf(&name, "%s/%d", SOCK_DIR, (int)pid);
-	if(result >= UNIX_PATH_MAX) {
-		ERR("string overflow allocating socket name");
-		return -1;
+	limit = field_size - *offset;
+	va_start(args, format);
+	count = vsnprintf(&data_field[*offset], limit, format, args);
+	va_end(args);
+
+	if (count < limit && count > -1) {
+		ptr = NULL + *offset;
+		*offset = *offset + count + 1;
 	}
 
-	result = ensure_dir_exists(SOCK_DIR);
-	if(result == -1) {
-		ERR("Unable to create socket directory %s", SOCK_DIR);
-		return -1;
+	return ptr;
+}
+
+char * ustcomm_restore_ptr(char *ptr, char *data_field, int data_field_size)
+{
+	if ((unsigned long)ptr > data_field_size ||
+	    ptr == USTCOMM_POISON_PTR) {
+		return NULL;
 	}
 
-	handle->server.listen_fd = init_named_socket(name, &(handle->server.socketpath));
-	if(handle->server.listen_fd < 0) {
-		ERR("Error initializing named socket (%s). Check that directory exists and that it is writable.", name);
-		goto free_name;
+	return data_field + (long)ptr;
+}
+
+int ustcomm_pack_single_field(struct ustcomm_header *header,
+			      struct ustcomm_single_field *single_field,
+			      const char *string)
+{
+	int offset = 0;
+
+	single_field->field = ustcomm_print_data(single_field->data,
+						 sizeof(single_field->data),
+						 &offset,
+						 string);
+
+	if (single_field->field == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
 	}
-	free(name);
 
-	INIT_LIST_HEAD(&handle->server.connections);
+	header->size = COMPUTE_MSG_SIZE(single_field, offset);
 
 	return 0;
-
-free_name:
-	free(name);
-	return -1;
 }
 
-/* Used by the daemon to initialize its server so applications
- * can connect to it.
- */
-
-int ustcomm_init_ustd(struct ustcomm_ustd *handle, const char *sock_path)
+int ustcomm_unpack_single_field(struct ustcomm_single_field *single_field)
 {
-	char *name;
-	int retval = 0;
-
-	if(sock_path) {
-		asprintf(&name, "%s", sock_path);
+	single_field->field = ustcomm_restore_ptr(single_field->field,
+						  single_field->data,
+						  sizeof(single_field->data));
+	if (!single_field->field) {
+		return -EINVAL;
 	}
-	else {
-		int result;
 
-		/* Only check if socket dir exists if we are using the default directory */
-		result = ensure_dir_exists(SOCK_DIR);
-		if(result == -1) {
-			ERR("Unable to create socket directory %s", SOCK_DIR);
-			return -1;
-		}
+	return 0;
+}
 
-		asprintf(&name, "%s/%s", SOCK_DIR, "ustd");
-	}
+int ustcomm_pack_channel_info(struct ustcomm_header *header,
+			      struct ustcomm_channel_info *ch_inf,
+			      const char *trace,
+			      const char *channel)
+{
+	int offset = 0;
 
-	handle->server.listen_fd = init_named_socket(name, &handle->server.socketpath);
-	if(handle->server.listen_fd < 0) {
-		ERR("error initializing named socket at %s", name);
-		retval = -1;
-		goto free_name;
+	ch_inf->trace = ustcomm_print_data(ch_inf->data,
+					   sizeof(ch_inf->data),
+					   &offset,
+					   trace);
+
+	if (ch_inf->trace == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
 	}
 
-	INIT_LIST_HEAD(&handle->server.connections);
+	ch_inf->channel = ustcomm_print_data(ch_inf->data,
+					     sizeof(ch_inf->data),
+					     &offset,
+					     channel);
+
+	if (ch_inf->channel == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
+	}
 
-free_name:
-	free(name);
+	header->size = COMPUTE_MSG_SIZE(ch_inf, offset);
 
-	return retval;
+	return 0;
 }
 
-void ustcomm_fini_app(struct ustcomm_app *handle)
-{
-	int result;
-	struct stat st;
 
-	/* Destroy socket */
-	result = stat(handle->server.socketpath, &st);
-	if(result == -1) {
-		PERROR("stat (%s)", handle->server.socketpath);
-		return;
+int ustcomm_unpack_channel_info(struct ustcomm_channel_info *ch_inf)
+{
+	ch_inf->trace = ustcomm_restore_ptr(ch_inf->trace,
+					    ch_inf->data,
+					    sizeof(ch_inf->data));
+	if (!ch_inf->trace) {
+		return -EINVAL;
 	}
 
-	/* Paranoid check before deleting. */
-	result = S_ISSOCK(st.st_mode);
-	if(!result) {
-		ERR("The socket we are about to delete is not a socket.");
-		return;
+	ch_inf->channel = ustcomm_restore_ptr(ch_inf->channel,
+					      ch_inf->data,
+					      sizeof(ch_inf->data));
+	if (!ch_inf->channel) {
+		return -EINVAL;
 	}
 
-	result = unlink(handle->server.socketpath);
-	if(result == -1) {
-		PERROR("unlink");
-	}
+	return 0;
 }
 
-static const char *find_tok(const char *str)
+int ustcomm_pack_buffer_info(struct ustcomm_header *header,
+			     struct ustcomm_buffer_info *buf_inf,
+			     const char *trace,
+			     const char *channel,
+			     int channel_cpu)
 {
-	while(*str == ' ') {
-		str++;
+	int offset = 0;
+
+	buf_inf->trace = ustcomm_print_data(buf_inf->data,
+					    sizeof(buf_inf->data),
+					    &offset,
+					    trace);
 
-		if(*str == 0)
-			return NULL;
+	if (buf_inf->trace == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
 	}
 
-	return str;
+	buf_inf->channel = ustcomm_print_data(buf_inf->data,
+					      sizeof(buf_inf->data),
+					      &offset,
+					      channel);
+
+	if (buf_inf->channel == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
+	}
+
+	buf_inf->ch_cpu = channel_cpu;
+
+	header->size = COMPUTE_MSG_SIZE(buf_inf, offset);
+
+	return 0;
 }
 
-static const char *find_sep(const char *str)
+
+int ustcomm_unpack_buffer_info(struct ustcomm_buffer_info *buf_inf)
 {
-	while(*str != ' ') {
-		str++;
+	buf_inf->trace = ustcomm_restore_ptr(buf_inf->trace,
+					     buf_inf->data,
+					     sizeof(buf_inf->data));
+	if (!buf_inf->trace) {
+		return -EINVAL;
+	}
 
-		if(*str == 0)
-			break;
+	buf_inf->channel = ustcomm_restore_ptr(buf_inf->channel,
+					       buf_inf->data,
+					       sizeof(buf_inf->data));
+	if (!buf_inf->channel) {
+		return -EINVAL;
 	}
 
-	return str;
+	return 0;
 }
 
-int nth_token_is(const char *str, const char *token, int tok_no)
+int ustcomm_pack_marker_info(struct ustcomm_header *header,
+			     struct ustcomm_marker_info *marker_inf,
+			     const char *trace,
+			     const char *channel,
+			     const char *marker)
 {
-	int i;
-	const char *start;
-	const char *end;
-
-	for(i=0; i<=tok_no; i++) {
-		str = find_tok(str);
-		if(str == NULL)
-			return -1;
+	int offset = 0;
 
-		start = str;
-
-		str = find_sep(str);
-		if(str == NULL)
-			return -1;
+	marker_inf->trace = ustcomm_print_data(marker_inf->data,
+					       sizeof(marker_inf->data),
+					       &offset,
+					       trace);
 
-		end = str;
+	if (marker_inf->trace == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
 	}
 
-	if(end-start != strlen(token))
-		return 0;
 
-	if(strncmp(start, token, end-start))
-		return 0;
+	marker_inf->channel = ustcomm_print_data(marker_inf->data,
+						 sizeof(marker_inf->data),
+						 &offset,
+						 channel);
 
-	return 1;
-}
+	if (marker_inf->channel == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
+	}
 
-char *nth_token(const char *str, int tok_no)
-{
-	static char *retval = NULL;
-	int i;
-	const char *start;
-	const char *end;
 
-	for(i=0; i<=tok_no; i++) {
-		str = find_tok(str);
-		if(str == NULL)
-			return NULL;
+	marker_inf->marker = ustcomm_print_data(marker_inf->data,
+						 sizeof(marker_inf->data),
+						 &offset,
+						 marker);
+
+	if (marker_inf->marker == USTCOMM_POISON_PTR) {
+		return -ENOMEM;
+	}
 
-		start = str;
+	header->size = COMPUTE_MSG_SIZE(marker_inf, offset);
 
-		str = find_sep(str);
-		if(str == NULL)
-			return NULL;
+	return 0;
+}
 
-		end = str;
+int ustcomm_unpack_marker_info(struct ustcomm_marker_info *marker_inf)
+{
+	marker_inf->trace = ustcomm_restore_ptr(marker_inf->trace,
+						marker_inf->data,
+						sizeof(marker_inf->data));
+	if (!marker_inf->trace) {
+		return -EINVAL;
 	}
 
-	if(retval) {
-		free(retval);
-		retval = NULL;
+	marker_inf->channel = ustcomm_restore_ptr(marker_inf->channel,
+						  marker_inf->data,
+						  sizeof(marker_inf->data));
+	if (!marker_inf->channel) {
+		return -EINVAL;
 	}
 
-	asprintf(&retval, "%.*s", (int)(end-start), start);
+	marker_inf->marker = ustcomm_restore_ptr(marker_inf->marker,
+						 marker_inf->data,
+						 sizeof(marker_inf->data));
+	if (!marker_inf->marker) {
+		return -EINVAL;
+	}
 
-	return retval;
+	return 0;
 }