X-Git-Url: http://git.lttng.org/?p=ust.git;a=blobdiff_plain;f=libustcomm%2Fustcomm.c;h=07f7f8748daec2d29a04798244b63f5293da0677;hp=2bd86eb728442c2713f74cd24a30766706d731c8;hb=HEAD;hpb=6af64c431c0a521fc927fa72b9f4015397ce11d4 diff --git a/libustcomm/ustcomm.c b/libustcomm/ustcomm.c index 2bd86eb..07f7f87 100644 --- a/libustcomm/ustcomm.c +++ b/libustcomm/ustcomm.c @@ -15,637 +15,1014 @@ * 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 #include #include #include +#include #include #include #include #include +#include #include #include #include #include -#include #include "ustcomm.h" #include "usterr.h" +#include "share.h" -#define UNIX_PATH_MAX 108 +static int mkdir_p(const char *path, mode_t mode) +{ + const char *path_p; + char *tmp; -#define MSG_MAX 1000 + int retval = 0; + int result; + mode_t old_umask; -/* 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. - */ + 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) + break; + ++path_p; + } + if (*path_p == '/') { + strncpy(tmp, path, path_p - path); + tmp[path_p-path] = '\0'; + if (tmp[path_p - path - 1] != '/') { + result = mkdir(tmp, mode); + if(result == -1) { + if (!(errno == EEXIST || errno == EACCES || errno == EROFS)) { + /* Then this is a real error */ + retval = -1; + break; + } + } + } + /* pass / */ + path_p++; + } else { + /* last component */ + result = mkdir(path, mode); + if (result == -1) + retval = -1; + break; + } + } -//static void bt(void) -//{ -// void *buffer[100]; -// int result; -// -// result = backtrace(&buffer, 100); -// backtrace_symbols_fd(buffer, result, STDERR_FILENO); -//} + 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; + + alloc_size = (size_t) (((struct sockaddr_un *) 0)->sun_path) + + strlen(name) + 1; - if(s == NULL) + addr = malloc(alloc_size); + if (addr < 0) { + ERR("allocating addr failed"); return NULL; + } - retval = (char *) malloc(strlen(s)+1); + addr->sun_family = AF_UNIX; + strcpy(addr->sun_path, name); - strcpy(retval, s); + *sock_addr_size = alloc_size; - return retval; + return addr; } -static int signal_process(pid_t pid) +struct ustcomm_sock * ustcomm_init_sock(int fd, int epoll_fd, + struct cds_list_head *list) { - return 0; -} + struct epoll_event ev; + struct ustcomm_sock *sock; -int pid_is_online(pid_t pid) { - return 1; -} + 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; - result = send(fd, msg, strlen(msg), MSG_NOSIGNAL); - if(result == -1) { - 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); } - 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 (cannot happen) - * returns -1 to indicate an error - */ + return sock; -static int recv_message_fd(int fd, char **msg, struct ustcomm_source *src) +free_addr: + free(addr); +close_sock: + close(fd); + + return NULL; +} + +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; - *msg = (char *) malloc(MSG_MAX+1); + fd = sock->fd; - result = recv(fd, *msg, MSG_MAX, 0); - if(result == -1) { - PERROR("recv"); - return -1; - } + if(!keep_socket_file) { - (*msg)[result] = '\0'; - - DBG("ustcomm_app_recv_message: result is %d, message is %s", result, (*msg)); + /* Get the socket name */ + alloc_size = sizeof(dummy); + if (getsockname(fd, &dummy, (socklen_t *)&alloc_size) < 0) { + PERROR("getsockname failed"); + goto del_sock; + } - if(src) - src->fd = fd; + sockaddr = zmalloc(alloc_size); + if (!sockaddr) { + ERR("failed to allocate sockaddr"); + goto del_sock; + } - return 1; + if (getsockname(fd, sockaddr, (socklen_t *)&alloc_size) < 0) { + PERROR("getsockname failed"); + goto free_sockaddr; + } + + /* Destroy socket */ + result = stat(sockaddr->sun_path, &st); + if(result < 0) { + PERROR("stat (%s)", sockaddr->sun_path); + goto free_sockaddr; + } + + /* 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; + } + + result = unlink(sockaddr->sun_path); + if(result < 0) { + PERROR("unlink"); + } + } + +free_sockaddr: + free(sockaddr); + +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; 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; + } 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; - 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; - - result = newfd = accept(server->listen_fd, NULL, NULL); - if(result == -1) { - PERROR("accept"); - return -1; - } + iov[1].iov_base = data; + iov[1].iov_len = peek_header.size; - newconn = (struct ustcomm_connection *) malloc(sizeof(struct ustcomm_connection)); - if(newconn == NULL) { - ERR("malloc returned NULL"); - return -1; - } + msg.msg_iovlen++; + } - 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; idxconnections, 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; + return 1; } -int ustcomm_ustd_recv_message(struct ustcomm_ustd *ustd, char **msg, struct ustcomm_source *src, int timeout) +int ustcomm_recv(int sock, + struct ustcomm_header *header, + char *data) { - return ustcomm_recv_message(&ustd->server, msg, src, timeout); + return ustcomm_recv_fd(sock, header, data, NULL); } -int ustcomm_app_recv_message(struct ustcomm_app *app, char **msg, struct ustcomm_source *src, int timeout) + +int ustcomm_send_fd(int sock, + const struct ustcomm_header *header, + const char *data, + int *fd) { - return ustcomm_recv_message(&app->server, msg, src, timeout); -} + struct iovec iov[2]; + struct msghdr msg; + int result; + struct cmsghdr *cmsg; + char buf[CMSG_SPACE(sizeof(int))]; -/* This removes src from the list of active connections of app. - */ + memset(&msg, 0, sizeof(msg)); -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; + iov[0].iov_base = (char *)header; + iov[0].iov_len = sizeof(struct ustcomm_header); + + msg.msg_iov = iov; + msg.msg_iovlen = 1; + + if (header->size && data) { + iov[1].iov_base = (char *)data; + iov[1].iov_len = header->size; + + msg.msg_iovlen++; - 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; + 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; + } + + result = sendmsg(sock, &msg, MSG_NOSIGNAL); + if (result < 0 && errno != EPIPE) { + PERROR("sendmsg failed"); + } + return result; } -static int init_named_socket(const char *name, char **path_out) +int ustcomm_send(int sock, + const struct ustcomm_header *header, + const char *data) +{ + return ustcomm_send_fd(sock, header, data, NULL); +} + +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; - int fd; - struct sockaddr_un addr; - - result = fd = socket(PF_UNIX, SOCK_STREAM, 0); - if(result == -1) { - PERROR("socket"); - return -1; + result = ustcomm_send(sock, req_header, req_data); + if ( result <= 0) { + return result; } - addr.sun_family = AF_UNIX; + return ustcomm_recv(sock, res_header, res_data); +} - strncpy(addr.sun_path, name, UNIX_PATH_MAX); - addr.sun_path[UNIX_PATH_MAX-1] = '\0'; +/* Return value: + * 0: success + * -1: error + */ - 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"); +int ustcomm_connect_path(const char *name, int *connection_fd) +{ + int result, fd; + size_t sock_addr_size; + struct sockaddr_un *addr; + + fd = socket(PF_UNIX, SOCK_STREAM, 0); + if(fd == -1) { + PERROR("socket"); + return -1; } - result = bind(fd, (struct sockaddr *)&addr, sizeof(addr)); - if(result == -1) { - PERROR("bind"); + addr = create_sock_addr(name, &sock_addr_size); + if (addr == NULL) { + ERR("allocating addr failed"); goto close_sock; } - result = listen(fd, 1); + result = connect(fd, (struct sockaddr *)addr, sock_addr_size); if(result == -1) { - PERROR("listen"); - goto close_sock; + PERROR("connect (path=%s)", name); + goto free_sock_addr; } - if(path_out) { - *path_out = strdup(addr.sun_path); - } + *connection_fd = fd; - return fd; + free(addr); - close_sock: + return 0; + +free_sock_addr: + free(addr); +close_sock: close(fd); return -1; } -/* - * 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_request(struct ustcomm_connection *conn, const char *req, char **reply) +/* Returns the current users socket directory, must be freed */ +char *ustcomm_user_sock_dir(void) { int result; + char *sock_dir = NULL; - result = send(conn->fd, req, strlen(req), MSG_NOSIGNAL); - if(result == -1) { - if(errno != EPIPE) - PERROR("send"); - return -1; + result = asprintf(&sock_dir, "%s%s", USER_SOCK_DIR, + cuserid(NULL)); + if (result < 0) { + ERR("string overflow allocating directory name"); + return NULL; } - if(!reply) - return 1; + return sock_dir; +} - *reply = (char *) malloc(MSG_MAX+1); - result = recv(conn->fd, *reply, MSG_MAX, 0); - if(result == -1) { - if(errno != ECONNRESET) - PERROR("recv"); +static int time_and_pid_from_socket_name(char *sock_name, unsigned long *time, + pid_t *pid) +{ + char *saveptr, *pid_m_time_str; + char *sock_basename = strdup(basename(sock_name)); + + if (!sock_basename) { return -1; } - else if(result == 0) { - return 0; + + /* This is the pid */ + pid_m_time_str = strtok_r(sock_basename, ".", &saveptr); + if (!pid_m_time_str) { + goto out_err; } - - (*reply)[result] = '\0'; - return 1; + errno = 0; + *pid = (pid_t)strtoul(pid_m_time_str, NULL, 10); + if (errno) { + goto out_err; + } + + /* This should be the time-stamp */ + pid_m_time_str = strtok_r(NULL, ".", &saveptr); + if (!pid_m_time_str) { + goto out_err; + } + + errno = 0; + *time = strtoul(pid_m_time_str, NULL, 10); + if (errno) { + goto out_err; + } + + return 0; + +out_err: + free(sock_basename); + return -1; } -int ustcomm_connect_path(const char *path, struct ustcomm_connection *conn, pid_t signalpid) +time_t ustcomm_pid_st_mtime(pid_t pid) { - int fd; - int result; - struct sockaddr_un addr; + struct stat proc_stat; + char proc_name[PATH_MAX]; - result = fd = socket(PF_UNIX, SOCK_STREAM, 0); - if(result == -1) { - PERROR("socket"); - return -1; + if (snprintf(proc_name, PATH_MAX - 1, "/proc/%ld", (long) pid) < 0) { + return 0; } - addr.sun_family = AF_UNIX; + if (stat(proc_name, &proc_stat)) { + return 0; + } - result = snprintf(addr.sun_path, UNIX_PATH_MAX, "%s", path); - if(result >= UNIX_PATH_MAX) { - ERR("string overflow allocating socket name"); - return -1; + return proc_stat.st_mtime; +} + +int ustcomm_is_socket_live(char *sock_name, pid_t *read_pid) +{ + time_t time_from_pid; + unsigned long time_from_sock; + pid_t pid; + + if (time_and_pid_from_socket_name(sock_name, &time_from_sock, &pid)) { + return 0; } - if(signalpid >= 0) { - result = signal_process(signalpid); - if(result == -1) { - ERR("could not signal process"); - return -1; - } + if (read_pid) { + *read_pid = pid; } - result = connect(fd, (struct sockaddr *)&addr, sizeof(addr)); - if(result == -1) { - PERROR("connect"); - return -1; + time_from_pid = ustcomm_pid_st_mtime(pid); + if (!time_from_pid) { + return 0; } - conn->fd = fd; + if ((unsigned long) time_from_pid == time_from_sock) { + return 1; + } return 0; } -int ustcomm_disconnect(struct ustcomm_connection *conn) +#define MAX_SOCK_PATH_BASE_LEN 100 + +static int ustcomm_get_sock_name(char *dir_name, pid_t pid, char *sock_name) { - return close(conn->fd); + struct dirent *dirent; + char sock_path_base[MAX_SOCK_PATH_BASE_LEN]; + int len; + DIR *dir = opendir(dir_name); + + snprintf(sock_path_base, MAX_SOCK_PATH_BASE_LEN - 1, + "%ld.", (long) pid); + len = strlen(sock_path_base); + + while ((dirent = readdir(dir))) { + if (!strcmp(dirent->d_name, ".") || + !strcmp(dirent->d_name, "..") || + !strcmp(dirent->d_name, "ust-consumer") || + dirent->d_type == DT_DIR || + strncmp(dirent->d_name, sock_path_base, len)) { + continue; + } + + if (ustcomm_is_socket_live(dirent->d_name, NULL)) { + if (snprintf(sock_name, PATH_MAX - 1, "%s/%s", + dir_name, dirent->d_name) < 0) { + PERROR("path longer than PATH_MAX?"); + goto out_err; + } + closedir(dir); + return 0; + } + } + +out_err: + closedir(dir); + return -1; } -int ustcomm_connect_app(pid_t pid, struct ustcomm_connection *conn) +/* Open a connection to a traceable app. + * + * Return value: + * 0: success + * -1: error + */ + +static int connect_app_non_root(pid_t pid, int *app_fd) { int result; - char path[UNIX_PATH_MAX]; + int retval = 0; + char *dir_name; + char sock_name[PATH_MAX]; + 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; + if (ustcomm_get_sock_name(dir_name, pid, sock_name)) { + retval = -ENOENT; + 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_dir_name; + } + +free_dir_name: + free(dir_name); + + return retval; } -/* 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) + +static int connect_app_root(pid_t pid, int *app_fd) { - int result; - char *name; + DIR *tmp_dir; + struct dirent *dirent; + char dir_name[PATH_MAX], sock_name[PATH_MAX]; + int result = -1; - result = asprintf(&name, "%s/%d", SOCK_DIR, (int)pid); - if(result >= UNIX_PATH_MAX) { - ERR("string overflow allocating socket name"); + tmp_dir = opendir(USER_TMP_DIR); + if (!tmp_dir) { return -1; } - 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; - } - free(name); + while ((dirent = readdir(tmp_dir))) { + if (!strncmp(dirent->d_name, USER_SOCK_DIR_BASE, + strlen(USER_SOCK_DIR_BASE))) { - INIT_LIST_HEAD(&handle->server.connections); + if (snprintf(dir_name, PATH_MAX - 1, "%s/%s", USER_TMP_DIR, + dirent->d_name) < 0) { + continue; + } - return 0; + if (ustcomm_get_sock_name(dir_name, pid, sock_name)) { + continue; + } -free_name: - free(name); - return -1; -} + result = ustcomm_connect_path(sock_name, app_fd); -/* Used by the daemon to initialize its server so applications - * can connect to it. - */ + if (result == 0) { + goto close_tmp_dir; + } + } + } + +close_tmp_dir: + closedir(tmp_dir); + + return result; +} -int ustcomm_init_ustd(struct ustcomm_ustd *handle, const char *sock_path) +int ustcomm_connect_app(pid_t pid, int *app_fd) { - char *name; - int retval = 0; + *app_fd = 0; - if(sock_path) { - asprintf(&name, "%s", sock_path); + if (geteuid()) { + return connect_app_non_root(pid, app_fd); + } else { + return connect_app_root(pid, app_fd); } - else { - asprintf(&name, "%s/%s", SOCK_DIR, "ustd"); + +} + +int ensure_dir_exists(const char *dir, mode_t mode) +{ + struct stat st; + int result; + + if (!strcmp(dir, "")) + return -1; + + result = stat(dir, &st); + if (result < 0 && errno != ENOENT) { + return -1; + } else if (result < 0) { + /* ENOENT */ + int result; + + 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; + } + } } - 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; + return 0; +} + +char * ustcomm_print_data(char *data_field, int field_size, + int *offset, const char *format, ...) +{ + va_list args; + int count, limit; + char *ptr = USTCOMM_POISON_PTR; + + 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; } - INIT_LIST_HEAD(&handle->server.connections); + return ptr; +} -free_name: - free(name); +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; + } - return retval; + return data_field + (long)ptr; } -void ustcomm_fini_app(struct ustcomm_app *handle) +int ustcomm_pack_single_field(struct ustcomm_header *header, + struct ustcomm_single_field *single_field, + const char *string) { - int result; - struct stat st; + int offset = 0; - /* Destroy socket */ - result = stat(handle->server.socketpath, &st); - if(result == -1) { - PERROR("stat (%s)", handle->server.socketpath); - return; - } + single_field->field = ustcomm_print_data(single_field->data, + sizeof(single_field->data), + &offset, + string); - /* 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; + if (single_field->field == USTCOMM_POISON_PTR) { + return -ENOMEM; } - result = unlink(handle->server.socketpath); - if(result == -1) { - PERROR("unlink"); + header->size = COMPUTE_MSG_SIZE(single_field, offset); + + return 0; +} + +int ustcomm_unpack_single_field(struct ustcomm_single_field *single_field) +{ + single_field->field = ustcomm_restore_ptr(single_field->field, + single_field->data, + sizeof(single_field->data)); + if (!single_field->field) { + return -EINVAL; } + + return 0; } -static char *find_tok(char *str) +int ustcomm_pack_channel_info(struct ustcomm_header *header, + struct ustcomm_channel_info *ch_inf, + const char *trace, + const char *channel) { - while(*str == ' ') { - str++; + int offset = 0; - if(*str == 0) - return NULL; + ch_inf->trace = ustcomm_print_data(ch_inf->data, + sizeof(ch_inf->data), + &offset, + trace); + + if (ch_inf->trace == USTCOMM_POISON_PTR) { + return -ENOMEM; + } + + ch_inf->channel = ustcomm_print_data(ch_inf->data, + sizeof(ch_inf->data), + &offset, + channel); + + if (ch_inf->channel == USTCOMM_POISON_PTR) { + return -ENOMEM; } - return str; + header->size = COMPUTE_MSG_SIZE(ch_inf, offset); + + return 0; } -static char *find_sep(char *str) + +int ustcomm_unpack_channel_info(struct ustcomm_channel_info *ch_inf) { - while(*str != ' ') { - str++; + ch_inf->trace = ustcomm_restore_ptr(ch_inf->trace, + ch_inf->data, + sizeof(ch_inf->data)); + if (!ch_inf->trace) { + return -EINVAL; + } - if(*str == 0) - break; + ch_inf->channel = ustcomm_restore_ptr(ch_inf->channel, + ch_inf->data, + sizeof(ch_inf->data)); + if (!ch_inf->channel) { + return -EINVAL; } - return str; + return 0; } -int nth_token_is(char *str, char *token, int tok_no) +int ustcomm_pack_buffer_info(struct ustcomm_header *header, + struct ustcomm_buffer_info *buf_inf, + const char *trace, + const char *channel, + int channel_cpu) { - int i; - char *start; - char *end; + int offset = 0; - for(i=0; i<=tok_no; i++) { - str = find_tok(str); - if(str == NULL) - return -1; + buf_inf->trace = ustcomm_print_data(buf_inf->data, + sizeof(buf_inf->data), + &offset, + trace); - start = str; + if (buf_inf->trace == USTCOMM_POISON_PTR) { + return -ENOMEM; + } - str = find_sep(str); - if(str == NULL) - return -1; + buf_inf->channel = ustcomm_print_data(buf_inf->data, + sizeof(buf_inf->data), + &offset, + channel); - end = str; + if (buf_inf->channel == USTCOMM_POISON_PTR) { + return -ENOMEM; } - if(end-start != strlen(token)) - return 0; + buf_inf->ch_cpu = channel_cpu; - if(strncmp(start, token, end-start)) - return 0; + header->size = COMPUTE_MSG_SIZE(buf_inf, offset); - return 1; + return 0; +} + + +int ustcomm_unpack_buffer_info(struct ustcomm_buffer_info *buf_inf) +{ + buf_inf->trace = ustcomm_restore_ptr(buf_inf->trace, + buf_inf->data, + sizeof(buf_inf->data)); + if (!buf_inf->trace) { + return -EINVAL; + } + + buf_inf->channel = ustcomm_restore_ptr(buf_inf->channel, + buf_inf->data, + sizeof(buf_inf->data)); + if (!buf_inf->channel) { + return -EINVAL; + } + + return 0; } -char *nth_token(char *str, int tok_no) +int ustcomm_pack_ust_marker_info(struct ustcomm_header *header, + struct ustcomm_ust_marker_info *ust_marker_inf, + const char *trace, + const char *channel, + const char *ust_marker) { - static char *retval = NULL; - int i; - char *start; - char *end; + int offset = 0; - for(i=0; i<=tok_no; i++) { - str = find_tok(str); - if(str == NULL) - return NULL; + ust_marker_inf->trace = ustcomm_print_data(ust_marker_inf->data, + sizeof(ust_marker_inf->data), + &offset, + trace); - start = str; + if (ust_marker_inf->trace == USTCOMM_POISON_PTR) { + return -ENOMEM; + } - str = find_sep(str); - if(str == NULL) - return NULL; - end = str; + ust_marker_inf->channel = ustcomm_print_data(ust_marker_inf->data, + sizeof(ust_marker_inf->data), + &offset, + channel); + + if (ust_marker_inf->channel == USTCOMM_POISON_PTR) { + return -ENOMEM; } - if(retval) { - free(retval); - retval = NULL; + + ust_marker_inf->ust_marker = ustcomm_print_data(ust_marker_inf->data, + sizeof(ust_marker_inf->data), + &offset, + ust_marker); + + if (ust_marker_inf->ust_marker == USTCOMM_POISON_PTR) { + return -ENOMEM; } - asprintf(&retval, "%.*s", (int)(end-start), start); + header->size = COMPUTE_MSG_SIZE(ust_marker_inf, offset); - return retval; + return 0; +} + +int ustcomm_unpack_ust_marker_info(struct ustcomm_ust_marker_info *ust_marker_inf) +{ + ust_marker_inf->trace = ustcomm_restore_ptr(ust_marker_inf->trace, + ust_marker_inf->data, + sizeof(ust_marker_inf->data)); + if (!ust_marker_inf->trace) { + return -EINVAL; + } + + ust_marker_inf->channel = ustcomm_restore_ptr(ust_marker_inf->channel, + ust_marker_inf->data, + sizeof(ust_marker_inf->data)); + if (!ust_marker_inf->channel) { + return -EINVAL; + } + + ust_marker_inf->ust_marker = ustcomm_restore_ptr(ust_marker_inf->ust_marker, + ust_marker_inf->data, + sizeof(ust_marker_inf->data)); + if (!ust_marker_inf->ust_marker) { + return -EINVAL; + } + + return 0; }