ust: change communication socket for STREAM
[ust.git] / libustcomm / ustcomm.c
index 0275a736b99a22b7f4b82304f5c289ca2544446d..2773b1a0a4fc7c299a95e3a6897a993c5eefbb60 100644 (file)
@@ -5,6 +5,7 @@
 #include <sys/socket.h>
 #include <sys/un.h>
 #include <unistd.h>
+#include <poll.h>
 
 #include <stdio.h>
 #include <stdlib.h>
 
 #define MSG_MAX 1000
 
-static void bt(void)
-{
-       void *buffer[100];
-       int result;
+/* 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.
+ */
 
-       result = backtrace(&buffer, 100);
-       backtrace_symbols_fd(buffer, result, STDERR_FILENO);
-}
+//static void bt(void)
+//{
+//     void *buffer[100];
+//     int result;
+//
+//     result = backtrace(&buffer, 100);
+//     backtrace_symbols_fd(buffer, result, STDERR_FILENO);
+//}
 
 static void signal_process(pid_t pid)
 {
@@ -48,7 +54,7 @@ int send_message_path(const char *path, const char *msg, char **reply, int signa
        int result;
        struct sockaddr_un addr;
 
-       result = fd = socket(PF_UNIX, SOCK_DGRAM, 0);
+       result = fd = socket(PF_UNIX, SOCK_STREAM, 0);
        if(result == -1) {
                PERROR("socket");
                return -1;
@@ -65,9 +71,15 @@ int send_message_path(const char *path, const char *msg, char **reply, int signa
        if(signalpid >= 0)
                signal_process(signalpid);
 
-       result = sendto(fd, msg, strlen(msg), 0, (struct sockaddr *)&addr, sizeof(addr));
+       result = connect(fd, (struct sockaddr *)&addr, sizeof(addr));
+       if(result == -1) {
+               PERROR("connect");
+               return -1;
+       }
+
+       result = send(fd, msg, strlen(msg), 0);
        if(result == -1) {
-               PERROR("sendto");
+               PERROR("send");
                return -1;
        }
 
@@ -124,19 +136,19 @@ int ustcomm_request_consumer(pid_t pid, const char *channel)
 
        asprintf(&msg, "collect %d %s", pid, channel); 
 
-       send_message_path(path, msg, NULL, pid);
+       send_message_path(path, msg, NULL, -1);
        free(msg);
 
        return 0;
 }
 
-static int recv_message_fd(int fd, char **msg)
+static int recv_message_fd(int fd, char **msg, struct ustcomm_source *src)
 {
        int result;
-       struct sockaddr_un addr;
 
        *msg = (char *) malloc(MSG_MAX+1);
-       result = recvfrom(fd, *msg, MSG_MAX, 0, NULL, NULL);
+
+       result = recv(fd, *msg, MSG_MAX, 0);
        if(result == -1) {
                PERROR("recvfrom");
                return -1;
@@ -146,19 +158,99 @@ static int recv_message_fd(int fd, char **msg)
        
        DBG("ustcomm_app_recv_message: result is %d, message is %s", result, (*msg));
 
-       bt();
-
        return 0;
 }
 
-int ustcomm_ustd_recv_message(struct ustcomm_ustd *ustd, char **msg)
+int ustcomm_ustd_recv_message(struct ustcomm_ustd *ustd, char **msg, struct ustcomm_source *src)
 {
-       return recv_message_fd(ustd->fd, msg);
+       struct pollfd *fds;
+       struct ustcomm_connection *conn;
+       int result;
+       int retval;
+
+       for(;;) {
+               int idx = 0;
+               int n_fds = 1;
+
+               list_for_each_entry(conn, &ustd->connections, list) {
+                       n_fds++;
+               }
+
+               fds = (struct pollfd *) malloc(n_fds * sizeof(struct pollfd));
+               if(fds == NULL) {
+                       ERR("malloc returned NULL");
+                       return -1;
+               }
+
+               /* special idx 0 is for listening socket */
+               fds[idx].fd = ustd->listen_fd;
+               fds[idx].events = POLLIN;
+               idx++;
+
+               list_for_each_entry(conn, &ustd->connections, list) {
+                       fds[idx].fd = conn->fd;
+                       fds[idx].events = POLLIN;
+                       idx++;
+               }
+
+               result = poll(fds, n_fds, -1);
+               if(result == -1) {
+                       PERROR("poll");
+                       return -1;
+               }
+
+               if(fds[0].revents) {
+                       struct ustcomm_connection *newconn;
+                       int newfd;
+
+                       result = newfd = accept(ustd->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;
+                       }
+
+                       newconn->fd = newfd;
+
+                       list_add(&newconn->list, &ustd->connections);
+               }
+
+               for(idx=1; idx<n_fds; idx++) {
+                       if(fds[idx].revents) {
+                               retval = recv_message_fd(fds[idx].fd, msg, src);
+                               if(**msg == 0) {
+                                       /* connection finished */
+                                       close(fds[idx].fd);
+
+                                       list_for_each_entry(conn, &ustd->connections, list) {
+                                               if(conn->fd == fds[idx].fd) {
+                                                       list_del(&conn->list);
+                                                       break;
+                                               }
+                                       }
+                               }
+                               else {
+                                       goto free_fds_return;
+                               }
+                       }
+               }
+
+               free(fds);
+       }
+
+free_fds_return:
+       free(fds);
+       return retval;
 }
 
-int ustcomm_app_recv_message(struct ustcomm_app *app, char **msg)
+int ustcomm_app_recv_message(struct ustcomm_app *app, char **msg, struct ustcomm_source *src)
 {
-       return recv_message_fd(app->fd, msg);
+       return ustcomm_ustd_recv_message((struct ustcomm_ustd *)app, msg, src);
 }
 
 static int init_named_socket(char *name, char **path_out)
@@ -168,7 +260,7 @@ static int init_named_socket(char *name, char **path_out)
 
        struct sockaddr_un addr;
        
-       result = fd = socket(PF_UNIX, SOCK_DGRAM, 0);
+       result = fd = socket(PF_UNIX, SOCK_STREAM, 0);
        if(result == -1) {
                PERROR("socket");
                return -1;
@@ -179,12 +271,29 @@ static int init_named_socket(char *name, char **path_out)
        strncpy(addr.sun_path, name, UNIX_PATH_MAX);
        addr.sun_path[UNIX_PATH_MAX-1] = '\0';
 
+       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");
+       }
+
        result = bind(fd, (struct sockaddr *)&addr, sizeof(addr));
        if(result == -1) {
                PERROR("bind");
                goto close_sock;
        }
 
+       result = listen(fd, 1);
+       if(result == -1) {
+               PERROR("listen");
+               goto close_sock;
+       }
+
        if(path_out) {
                *path_out = "";
                *path_out = strdupa(addr.sun_path);
@@ -209,12 +318,15 @@ int ustcomm_init_app(pid_t pid, struct ustcomm_app *handle)
                return -1;
        }
 
-       handle->fd = init_named_socket(name, &(handle->socketpath));
-       if(handle->fd < 0) {
+       handle->listen_fd = init_named_socket(name, &(handle->socketpath));
+       if(handle->listen_fd < 0) {
+               ERR("error initializing named socket");
                goto free_name;
        }
        free(name);
 
+       INIT_LIST_HEAD(&handle->connections);
+
        return 0;
 
 free_name:
@@ -224,9 +336,112 @@ free_name:
 
 int ustcomm_init_ustd(struct ustcomm_ustd *handle)
 {
-       handle->fd = init_named_socket("ustd", &handle->socketpath);
-       if(handle->fd < 0)
-               return handle->fd;
+       int result;
+       char *name;
+
+       result = asprintf(&name, "%s/%s", SOCK_DIR, "ustd");
+       if(result >= UNIX_PATH_MAX) {
+               ERR("string overflow allocating socket name");
+               return -1;
+       }
+
+       handle->listen_fd = init_named_socket(name, &handle->socketpath);
+       if(handle->listen_fd < 0) {
+               ERR("error initializing named socket");
+               goto free_name;
+       }
+       free(name);
+
+       INIT_LIST_HEAD(&handle->connections);
 
        return 0;
+
+free_name:
+       free(name);
+       return -1;
 }
+
+static char *find_tok(char *str)
+{
+       while(*str == ' ') {
+               str++;
+
+               if(*str == 0)
+                       return NULL;
+       }
+
+       return str;
+}
+
+static char *find_sep(char *str)
+{
+       while(*str != ' ') {
+               str++;
+
+               if(*str == 0)
+                       break;
+       }
+
+       return str;
+}
+
+int nth_token_is(char *str, char *token, int tok_no)
+{
+       int i;
+       char *start;
+       char *end;
+
+       for(i=0; i<=tok_no; i++) {
+               str = find_tok(str);
+               if(str == NULL)
+                       return -1;
+
+               start = str;
+
+               str = find_sep(str);
+               if(str == NULL)
+                       return -1;
+
+               end = str;
+       }
+
+       if(end-start != strlen(token))
+               return 0;
+
+       if(strncmp(start, token, end-start))
+               return 0;
+
+       return 1;
+}
+
+char *nth_token(char *str, int tok_no)
+{
+       static char *retval = NULL;
+       int i;
+       char *start;
+       char *end;
+
+       for(i=0; i<=tok_no; i++) {
+               str = find_tok(str);
+               if(str == NULL)
+                       return NULL;
+
+               start = str;
+
+               str = find_sep(str);
+               if(str == NULL)
+                       return NULL;
+
+               end = str;
+       }
+
+       if(retval) {
+               free(retval);
+               retval = NULL;
+       }
+
+       asprintf(&retval, "%.*s", (int)(end-start), start);
+
+       return retval;
+}
+
This page took 0.037745 seconds and 4 git commands to generate.