ustd: convert to new ustcomm api
[ust.git] / ustd / ustd.c
index 19981191e2d9d17be606d9358570118a6e36cc11..d5884dfe040c8bed7667a03e06784e444023c0e1 100644 (file)
@@ -1,9 +1,27 @@
+/*
+ * Copyright (C) 2009  Pierre-Marc Fournier
+ *
+ * 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 3 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, see <http://www.gnu.org/licenses/>.
+ */
+
 #define _GNU_SOURCE
 
 #include <sys/types.h>
 #include <sys/shm.h>
 #include <fcntl.h>
 #include <unistd.h>
+#include <pthread.h>
 
 #include <stdlib.h>
 #include <stdio.h>
@@ -17,6 +35,7 @@ struct list_head buffers = LIST_HEAD_INIT(buffers);
 struct buffer_info {
        char *name;
        pid_t pid;
+       struct ustcomm_connection conn;
 
        int shmid;
        void *mem;
@@ -32,86 +51,10 @@ struct buffer_info {
        long consumed_old;
 };
 
-int add_buffer(pid_t pid, char *bufname)
-{
-       struct buffer_info *buf;
-       char *send_msg;
-       char *received_msg;
-       int result;
-       char *tmp;
-       int fd;
-
-       buf = (struct buffer_info *) malloc(sizeof(struct buffer_info));
-       if(buf == NULL) {
-               ERR("add_buffer: insufficient memory");
-               return -1;
-       }
-
-       buf->name = bufname;
-       buf->pid = pid;
-
-       /* get shmid */
-       asprintf(&send_msg, "get_shmid %s", buf->name);
-       send_message(pid, send_msg, &received_msg);
-       free(send_msg);
-       DBG("got buffer name %s", buf->name);
-
-       result = sscanf(received_msg, "%d", &buf->shmid);
-       if(result != 1) {
-               ERR("unable to parse response to get_shmid");
-               return -1;
-       }
-       free(received_msg);
-       DBG("got shmid %d", buf->shmid);
-
-       /* get n_subbufs */
-       asprintf(&send_msg, "get_n_subbufs %s", buf->name);
-       send_message(pid, send_msg, &received_msg);
-       free(send_msg);
-
-       result = sscanf(received_msg, "%d", &buf->n_subbufs);
-       if(result != 1) {
-               ERR("unable to parse response to get_n_subbufs");
-               return -1;
-       }
-       free(received_msg);
-       DBG("got n_subbufs %d", buf->n_subbufs);
-
-       /* get subbuf size */
-       asprintf(&send_msg, "get_subbuf_size %s", buf->name);
-       send_message(pid, send_msg, &received_msg);
-       free(send_msg);
-
-       result = sscanf(received_msg, "%d", &buf->subbuf_size);
-       if(result != 1) {
-               ERR("unable to parse response to get_subbuf_size");
-               return -1;
-       }
-       free(received_msg);
-       DBG("got subbuf_size %d", buf->subbuf_size);
-
-       /* attach memory */
-       buf->mem = shmat(buf->shmid, NULL, 0);
-       if(buf->mem == (void *) 0) {
-               perror("shmat");
-               return -1;
-       }
-       DBG("successfully attached memory");
-
-       /* open file for output */
-       asprintf(&tmp, "/tmp/trace/%s_0", buf->name);
-       result = fd = open(tmp, O_WRONLY | O_CREAT | O_TRUNC, 00600);
-       if(result == -1) {
-               PERROR("open");
-               return -1;
-       }
-       buf->file_fd = fd;
-       free(tmp);
-
-       list_add(&buf->list, &buffers);
-
-       return 0;
-}
+/* return value: 0 = subbuffer is finished, it won't produce data anymore
+ *               1 = got subbuffer successfully
+ *               <0 = error
+ */
 
 int get_subbuffer(struct buffer_info *buf)
 {
@@ -122,29 +65,35 @@ int get_subbuffer(struct buffer_info *buf)
        int result;
 
        asprintf(&send_msg, "get_subbuffer %s", buf->name);
-       result = send_message(buf->pid, send_msg, &received_msg);
+       result = ustcomm_send_request(&buf->conn, send_msg, &received_msg);
        if(result < 0) {
-               ERR("get_subbuffer: send_message failed");
+               ERR("get_subbuffer: ustcomm_send_request failed");
                return -1;
        }
        free(send_msg);
 
        result = sscanf(received_msg, "%as %ld", &rep_code, &buf->consumed_old);
-       if(result != 2) {
+       if(result != 2 && result != 1) {
                ERR("unable to parse response to get_subbuffer");
                return -1;
        }
-       free(received_msg);
+
+       DBG("received msg is %s", received_msg);
 
        if(!strcmp(rep_code, "OK")) {
                DBG("got subbuffer %s", buf->name);
                retval = 1;
        }
+       else if(nth_token_is(received_msg, "END", 0) == 1) {
+               return 0;
+       }
        else {
-               DBG("did not get subbuffer %s", buf->name);
-               retval = 0;
+               DBG("error getting subbuffer %s", buf->name);
+               retval = -1;
        }
 
+       /* FIMXE: free correctly the stuff */
+       free(received_msg);
        free(rep_code);
        return retval;
 }
@@ -158,7 +107,7 @@ int put_subbuffer(struct buffer_info *buf)
        int result;
 
        asprintf(&send_msg, "put_subbuffer %s %ld", buf->name, buf->consumed_old);
-       result = send_message(buf->pid, send_msg, &received_msg);
+       result = ustcomm_send_request(&buf->conn, send_msg, &received_msg);
        if(result < 0) {
                ERR("put_subbuffer: send_message failed");
                return -1;
@@ -205,6 +154,132 @@ ssize_t patient_write(int fd, const void *buf, size_t count)
        return bufc-(const char *)buf;
 }
 
+void *consumer_thread(void *arg)
+{
+       struct buffer_info *buf = (struct buffer_info *) arg;
+       int result;
+
+       for(;;) {
+               result = get_subbuffer(buf);
+               if(result == -1) {
+                       ERR("error getting subbuffer");
+                       continue;
+               }
+               if(result == 0) {
+                       /* this is done */
+                       break;
+               }
+
+               /* write data to file */
+               result = patient_write(buf->file_fd, buf->mem + (buf->consumed_old & (buf->n_subbufs * buf->subbuf_size-1)), buf->subbuf_size);
+               if(result == -1) {
+                       PERROR("write");
+                       /* FIXME: maybe drop this trace */
+               }
+
+               result = put_subbuffer(buf);
+               if(result == -1) {
+                       ERR("error putting subbuffer");
+                       break;
+               }
+       }
+
+       DBG("thread for buffer %s is stopping", buf->name);
+
+       return NULL;
+}
+
+int add_buffer(pid_t pid, char *bufname)
+{
+       struct buffer_info *buf;
+       char *send_msg;
+       char *received_msg;
+       int result;
+       char *tmp;
+       int fd;
+       pthread_t thr;
+
+       buf = (struct buffer_info *) malloc(sizeof(struct buffer_info));
+       if(buf == NULL) {
+               ERR("add_buffer: insufficient memory");
+               return -1;
+       }
+
+       buf->name = bufname;
+       buf->pid = pid;
+
+       /* connect to app */
+       result = ustcomm_connect_app(buf->pid, &buf->conn);
+       if(result) {
+               ERR("unable to connect to process");
+               return -1;
+       }
+
+       /* get shmid */
+       asprintf(&send_msg, "get_shmid %s", buf->name);
+       ustcomm_send_request(&buf->conn, send_msg, &received_msg);
+       free(send_msg);
+       DBG("got buffer name %s", buf->name);
+
+       result = sscanf(received_msg, "%d", &buf->shmid);
+       if(result != 1) {
+               ERR("unable to parse response to get_shmid");
+               return -1;
+       }
+       free(received_msg);
+       DBG("got shmid %d", buf->shmid);
+
+       /* get n_subbufs */
+       asprintf(&send_msg, "get_n_subbufs %s", buf->name);
+       ustcomm_send_request(&buf->conn, send_msg, &received_msg);
+       free(send_msg);
+
+       result = sscanf(received_msg, "%d", &buf->n_subbufs);
+       if(result != 1) {
+               ERR("unable to parse response to get_n_subbufs");
+               return -1;
+       }
+       free(received_msg);
+       DBG("got n_subbufs %d", buf->n_subbufs);
+
+       /* get subbuf size */
+       asprintf(&send_msg, "get_subbuf_size %s", buf->name);
+       ustcomm_send_request(&buf->conn, send_msg, &received_msg);
+       free(send_msg);
+
+       result = sscanf(received_msg, "%d", &buf->subbuf_size);
+       if(result != 1) {
+               ERR("unable to parse response to get_subbuf_size");
+               return -1;
+       }
+       free(received_msg);
+       DBG("got subbuf_size %d", buf->subbuf_size);
+
+       /* attach memory */
+       buf->mem = shmat(buf->shmid, NULL, 0);
+       if(buf->mem == (void *) 0) {
+               perror("shmat");
+               return -1;
+       }
+       DBG("successfully attached memory");
+
+       /* open file for output */
+       asprintf(&tmp, "/tmp/trace/%s_0", buf->name);
+       result = fd = open(tmp, O_WRONLY | O_CREAT | O_TRUNC, 00600);
+       if(result == -1) {
+               PERROR("open");
+               return -1;
+       }
+       buf->file_fd = fd;
+       free(tmp);
+
+       //list_add(&buf->list, &buffers);
+
+       pthread_create(&thr, NULL, consumer_thread, buf);
+
+       return 0;
+}
+
 int main(int argc, char **argv)
 {
        struct ustcomm_ustd ustd;
@@ -219,9 +294,8 @@ int main(int argc, char **argv)
        /* app loop */
        for(;;) {
                char *recvbuf;
-               struct buffer_info *buf;
 
-               /* 1. check for requests on our public socket */
+               /* check for requests on our public socket */
                result = ustcomm_ustd_recv_message(&ustd, &recvbuf, NULL, 100);
                if(result == -1) {
                        ERR("error in ustcomm_ustd_recv_message");
@@ -247,30 +321,6 @@ int main(int argc, char **argv)
 
                        free(recvbuf);
                }
-
-               /* 2. try to consume data from tracing apps */
-               list_for_each_entry(buf, &buffers, list) {
-                       result = get_subbuffer(buf);
-                       if(result == -1) {
-                               ERR("error getting subbuffer");
-                               continue;
-                       }
-                       if(result == 0)
-                               continue;
-
-                       /* write data to file */
-                       //result = write(buf->file_fd, buf->, );
-                       result = patient_write(buf->file_fd, buf->mem + (buf->consumed_old & (buf->n_subbufs * buf->subbuf_size-1)), buf->subbuf_size);
-                       if(result == -1) {
-                               PERROR("write");
-                               /* FIXME: maybe drop this trace */
-                       }
-
-                       result = put_subbuffer(buf);
-                       if(result == -1) {
-                               ERR("error putting subbuffer");
-                       }
-               }
        }
 
        return 0;
This page took 0.026396 seconds and 4 git commands to generate.