Add mode setting to socket directory creation
[ust.git] / libustconsumer / libustconsumer.c
CommitLineData
d159ac37
AH
1/* Copyright (C) 2009 Pierre-Marc Fournier
2 * 2010 Alexis Halle
3 *
4 * This library is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU Lesser General Public
6 * License as published by the Free Software Foundation; either
7 * version 2.1 of the License, or (at your option) any later version.
8 *
9 * This library is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * Lesser General Public License for more details.
13 *
14 * You should have received a copy of the GNU Lesser General Public
15 * License along with this library; if not, write to the Free Software
16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
17 */
18
19#define _GNU_SOURCE
20
4723ca09 21#include <sys/epoll.h>
d159ac37 22#include <sys/shm.h>
4723ca09
NC
23#include <sys/types.h>
24#include <sys/stat.h>
d159ac37
AH
25#include <unistd.h>
26#include <pthread.h>
27#include <signal.h>
28
29#include <stdlib.h>
30#include <stdio.h>
31#include <string.h>
32#include <errno.h>
33#include <assert.h>
34
9dc7b7ff 35#include <ust/ustconsumer.h>
d6c9f207 36#include "lowlevel.h"
d159ac37
AH
37#include "usterr.h"
38#include "ustcomm.h"
39
d159ac37
AH
40#define GET_SUBBUF_OK 1
41#define GET_SUBBUF_DONE 0
42#define GET_SUBBUF_DIED 2
43
44#define PUT_SUBBUF_OK 1
45#define PUT_SUBBUF_DIED 0
46#define PUT_SUBBUF_PUSHED 2
47#define PUT_SUBBUF_DONE 3
48
49#define UNIX_PATH_MAX 108
50
72098143 51static int get_subbuffer(struct buffer_info *buf)
d159ac37 52{
72098143
NC
53 struct ustcomm_header _send_hdr, *send_hdr;
54 struct ustcomm_header _recv_hdr, *recv_hdr;
55 struct ustcomm_buffer_info _send_msg, _recv_msg;
56 struct ustcomm_buffer_info *send_msg, *recv_msg;
d159ac37
AH
57 int result;
58
72098143
NC
59 send_hdr = &_send_hdr;
60 recv_hdr = &_recv_hdr;
61 send_msg = &_send_msg;
62 recv_msg = &_recv_msg;
4723ca09 63
d89b8191 64 result = ustcomm_pack_buffer_info(send_hdr, send_msg, buf->trace,
72098143
NC
65 buf->channel, buf->channel_cpu);
66 if (result < 0) {
67 return result;
d159ac37
AH
68 }
69
72098143
NC
70 send_hdr->command = GET_SUBBUFFER;
71
72 result = ustcomm_req(buf->app_sock, send_hdr, (char *)send_msg,
73 recv_hdr, (char *)recv_msg);
74 if ((result < 0 && (errno == ECONNRESET || errno == EPIPE)) ||
75 result == 0) {
76 DBG("app died while being traced");
77 return GET_SUBBUF_DIED;
78 } else if (result < 0) {
79 ERR("get_subbuffer: ustcomm_req failed");
80 return result;
d159ac37
AH
81 }
82
72098143 83 if (!recv_hdr->result) {
d159ac37 84 DBG("got subbuffer %s", buf->name);
72098143
NC
85 buf->consumed_old = recv_msg->consumed_old;
86 return GET_SUBBUF_OK;
87 } else if (recv_hdr->result == -ENODATA) {
88 DBG("For buffer %s, the trace was not found. This likely means"
89 " it was destroyed by the user.", buf->name);
90 return GET_SUBBUF_DIED;
d159ac37
AH
91 }
92
72098143
NC
93 DBG("error getting subbuffer %s", buf->name);
94 return recv_hdr->result;
d159ac37
AH
95}
96
72098143 97static int put_subbuffer(struct buffer_info *buf)
d159ac37 98{
72098143
NC
99 struct ustcomm_header _send_hdr, *send_hdr;
100 struct ustcomm_header _recv_hdr, *recv_hdr;
101 struct ustcomm_buffer_info _send_msg, *send_msg;
d159ac37
AH
102 int result;
103
72098143
NC
104 send_hdr = &_send_hdr;
105 recv_hdr = &_recv_hdr;
106 send_msg = &_send_msg;
d159ac37 107
d89b8191 108 result = ustcomm_pack_buffer_info(send_hdr, send_msg, buf->trace,
72098143
NC
109 buf->channel, buf->channel_cpu);
110 if (result < 0) {
111 return result;
d159ac37
AH
112 }
113
72098143
NC
114 send_hdr->command = PUT_SUBBUFFER;
115 send_msg->consumed_old = buf->consumed_old;
d159ac37 116
72098143
NC
117 result = ustcomm_req(buf->app_sock, send_hdr, (char *)send_msg,
118 recv_hdr, NULL);
119 if ((result < 0 && (errno == ECONNRESET || errno == EPIPE)) ||
120 result == 0) {
121 DBG("app died while being traced");
122 return PUT_SUBBUF_DIED;
123 } else if (result < 0) {
124 ERR("put_subbuffer: ustcomm_req failed");
125 return result;
126 }
d159ac37 127
72098143
NC
128 if (!recv_hdr->result) {
129 DBG("put subbuffer %s", buf->name);
130 return PUT_SUBBUF_OK;
131 } else if (recv_hdr->result == -ENODATA) {
132 DBG("For buffer %s, the trace was not found. This likely means"
133 " it was destroyed by the user.", buf->name);
134 return PUT_SUBBUF_DIED;
135 }
d159ac37 136
72098143
NC
137 DBG("error getting subbuffer %s", buf->name);
138 return recv_hdr->result;
d159ac37
AH
139}
140
141void decrement_active_buffers(void *arg)
142{
9dc7b7ff 143 struct ustconsumer_instance *instance = arg;
d159ac37
AH
144 pthread_mutex_lock(&instance->mutex);
145 instance->active_buffers--;
146 pthread_mutex_unlock(&instance->mutex);
147}
148
72098143 149static int get_pidunique(int sock, s64 *pidunique)
d159ac37 150{
72098143
NC
151 struct ustcomm_header _send_hdr, *send_hdr;
152 struct ustcomm_header _recv_hdr, *recv_hdr;
153 struct ustcomm_pidunique _recv_msg, *recv_msg;
d159ac37 154 int result;
d159ac37 155
72098143
NC
156 send_hdr = &_send_hdr;
157 recv_hdr = &_recv_hdr;
158 recv_msg = &_recv_msg;
159
160 memset(send_hdr, 0, sizeof(*send_hdr));
161
162 send_hdr->command = GET_PIDUNIQUE;
163 result = ustcomm_req(sock, send_hdr, NULL, recv_hdr, (char *)recv_msg);
164 if (result < 1) {
165 return -ENOTCONN;
166 }
167 if (recv_hdr->result < 0) {
168 ERR("App responded with error: %s", strerror(recv_hdr->result));
169 return recv_hdr->result;
d159ac37
AH
170 }
171
72098143 172 *pidunique = recv_msg->pidunique;
d159ac37 173
72098143
NC
174 return 0;
175}
176
177static int get_buf_shmid_pipe_fd(int sock, struct buffer_info *buf,
178 int *buf_shmid, int *buf_struct_shmid,
179 int *buf_pipe_fd)
180{
181 struct ustcomm_header _send_hdr, *send_hdr;
182 struct ustcomm_header _recv_hdr, *recv_hdr;
183 struct ustcomm_buffer_info _send_msg, *send_msg;
184 struct ustcomm_buffer_info _recv_msg, *recv_msg;
185 int result, recv_pipe_fd;
186
187 send_hdr = &_send_hdr;
188 recv_hdr = &_recv_hdr;
189 send_msg = &_send_msg;
190 recv_msg = &_recv_msg;
191
d89b8191 192 result = ustcomm_pack_buffer_info(send_hdr, send_msg, buf->trace,
72098143
NC
193 buf->channel, buf->channel_cpu);
194 if (result < 0) {
195 ERR("Failed to pack buffer info");
196 return result;
d159ac37
AH
197 }
198
72098143
NC
199 send_hdr->command = GET_BUF_SHMID_PIPE_FD;
200
201 result = ustcomm_send(sock, send_hdr, (char *)send_msg);
202 if (result < 1) {
203 ERR("Failed to send request");
204 return -ENOTCONN;
08b8805e 205 }
72098143
NC
206 result = ustcomm_recv_fd(sock, recv_hdr, (char *)recv_msg, &recv_pipe_fd);
207 if (result < 1) {
208 ERR("Failed to receive message and fd");
209 return -ENOTCONN;
d159ac37 210 }
72098143
NC
211 if (recv_hdr->result < 0) {
212 ERR("App responded with error %s", strerror(recv_hdr->result));
213 return recv_hdr->result;
d159ac37
AH
214 }
215
72098143
NC
216 *buf_shmid = recv_msg->buf_shmid;
217 *buf_struct_shmid = recv_msg->buf_struct_shmid;
218 *buf_pipe_fd = recv_pipe_fd;
d159ac37 219
72098143
NC
220 return 0;
221}
222
223static int get_subbuf_num_size(int sock, struct buffer_info *buf,
224 int *subbuf_num, int *subbuf_size)
225{
226 struct ustcomm_header _send_hdr, *send_hdr;
227 struct ustcomm_header _recv_hdr, *recv_hdr;
228 struct ustcomm_channel_info _send_msg, *send_msg;
229 struct ustcomm_channel_info _recv_msg, *recv_msg;
230 int result;
231
232 send_hdr = &_send_hdr;
233 recv_hdr = &_recv_hdr;
234 send_msg = &_send_msg;
235 recv_msg = &_recv_msg;
236
d89b8191 237 result = ustcomm_pack_channel_info(send_hdr, send_msg, buf->trace,
72098143
NC
238 buf->channel);
239 if (result < 0) {
240 return result;
d159ac37 241 }
72098143
NC
242
243 send_hdr->command = GET_SUBBUF_NUM_SIZE;
244
245 result = ustcomm_req(sock, send_hdr, (char *)send_msg,
246 recv_hdr, (char *)recv_msg);
247 if (result < 1) {
248 return -ENOTCONN;
d159ac37
AH
249 }
250
72098143
NC
251 *subbuf_num = recv_msg->subbuf_num;
252 *subbuf_size = recv_msg->subbuf_size;
253
254 return recv_hdr->result;
255}
256
257
258static int notify_buffer_mapped(int sock, struct buffer_info *buf)
259{
260 struct ustcomm_header _send_hdr, *send_hdr;
261 struct ustcomm_header _recv_hdr, *recv_hdr;
262 struct ustcomm_buffer_info _send_msg, *send_msg;
263 int result;
264
265 send_hdr = &_send_hdr;
266 recv_hdr = &_recv_hdr;
267 send_msg = &_send_msg;
268
d89b8191 269 result = ustcomm_pack_buffer_info(send_hdr, send_msg, buf->trace,
72098143
NC
270 buf->channel, buf->channel_cpu);
271 if (result < 0) {
272 return result;
d159ac37 273 }
d159ac37 274
72098143
NC
275 send_hdr->command = NOTIFY_BUF_MAPPED;
276
277 result = ustcomm_req(sock, send_hdr, (char *)send_msg,
278 recv_hdr, NULL);
279 if (result < 1) {
280 return -ENOTCONN;
08b8805e 281 }
72098143
NC
282
283 return recv_hdr->result;
284}
285
286
9dc7b7ff 287struct buffer_info *connect_buffer(struct ustconsumer_instance *instance, pid_t pid,
d89b8191
NC
288 const char *trace, const char *channel,
289 int channel_cpu)
72098143
NC
290{
291 struct buffer_info *buf;
292 int result;
293 struct shmid_ds shmds;
294
295 buf = (struct buffer_info *) zmalloc(sizeof(struct buffer_info));
296 if(buf == NULL) {
297 ERR("add_buffer: insufficient memory");
d159ac37
AH
298 return NULL;
299 }
d159ac37 300
d89b8191
NC
301 buf->trace = strdup(trace);
302 if (!buf->trace) {
303 goto free_buf;
304 }
305
72098143
NC
306 buf->channel = strdup(channel);
307 if (!buf->channel) {
d89b8191 308 goto free_buf_trace;
d159ac37 309 }
d159ac37 310
72098143
NC
311 result = asprintf(&buf->name, "%s_%d", channel, channel_cpu);
312 if (result < 0 || buf->name == NULL) {
313 goto free_buf_channel;
08b8805e 314 }
72098143
NC
315
316 buf->channel_cpu = channel_cpu;
317 buf->pid = pid;
318
319 result = ustcomm_connect_app(buf->pid, &buf->app_sock);
320 if(result) {
321 WARN("unable to connect to process, it probably died before we were able to connect");
322 goto free_buf_name;
d159ac37 323 }
72098143
NC
324
325 /* get pidunique */
326 result = get_pidunique(buf->app_sock, &buf->pidunique);
327 if (result < 0) {
328 ERR("Failed to get pidunique");
329 goto close_app_sock;
330 }
331
332 /* get shmid and pipe fd */
333 result = get_buf_shmid_pipe_fd(buf->app_sock, buf, &buf->shmid,
334 &buf->bufstruct_shmid, &buf->pipe_fd);
335 if (result < 0) {
336 ERR("Failed to get buf_shmid and pipe_fd");
337 goto close_app_sock;
338 } else {
339 struct stat temp;
340 fstat(buf->pipe_fd, &temp);
341 if (!S_ISFIFO(temp.st_mode)) {
342 ERR("Didn't receive a fifo from the app");
343 goto close_app_sock;
344 }
d159ac37
AH
345 }
346
72098143
NC
347
348 /* get number of subbufs and subbuf size */
349 result = get_subbuf_num_size(buf->app_sock, buf, &buf->n_subbufs,
350 &buf->subbuf_size);
351 if (result < 0) {
352 ERR("Failed to get subbuf number and size");
353 goto close_fifo;
d159ac37 354 }
d159ac37 355
cd6b7243
DG
356 /* Set subbuffer's information */
357 buf->subbuf_size_order = get_count_order(buf->subbuf_size);
358 buf->alloc_size = buf->subbuf_size * buf->n_subbufs;
359
d159ac37
AH
360 /* attach memory */
361 buf->mem = shmat(buf->shmid, NULL, 0);
362 if(buf->mem == (void *) 0) {
363 PERROR("shmat");
72098143 364 goto close_fifo;
d159ac37
AH
365 }
366 DBG("successfully attached buffer memory");
367
368 buf->bufstruct_mem = shmat(buf->bufstruct_shmid, NULL, 0);
369 if(buf->bufstruct_mem == (void *) 0) {
370 PERROR("shmat");
72098143 371 goto shmdt_mem;
d159ac37
AH
372 }
373 DBG("successfully attached buffer bufstruct memory");
374
375 /* obtain info on the memory segment */
376 result = shmctl(buf->shmid, IPC_STAT, &shmds);
377 if(result == -1) {
378 PERROR("shmctl");
72098143 379 goto shmdt_bufstruct_mem;
d159ac37
AH
380 }
381 buf->memlen = shmds.shm_segsz;
382
72098143
NC
383 /* Notify the application that we have mapped the buffer */
384 result = notify_buffer_mapped(buf->app_sock, buf);
385 if (result < 0) {
386 goto shmdt_bufstruct_mem;
4723ca09 387 }
72098143 388
d159ac37
AH
389 if(instance->callbacks->on_open_buffer)
390 instance->callbacks->on_open_buffer(instance->callbacks, buf);
391
392 pthread_mutex_lock(&instance->mutex);
393 instance->active_buffers++;
394 pthread_mutex_unlock(&instance->mutex);
395
396 return buf;
397
72098143
NC
398shmdt_bufstruct_mem:
399 shmdt(buf->bufstruct_mem);
400
401shmdt_mem:
402 shmdt(buf->mem);
403
404close_fifo:
405 close(buf->pipe_fd);
406
407close_app_sock:
408 close(buf->app_sock);
409
410free_buf_name:
411 free(buf->name);
412
413free_buf_channel:
414 free(buf->channel);
415
d89b8191
NC
416free_buf_trace:
417 free(buf->trace);
418
72098143 419free_buf:
d159ac37
AH
420 free(buf);
421 return NULL;
422}
423
9dc7b7ff 424static void destroy_buffer(struct ustconsumer_callbacks *callbacks,
d159ac37
AH
425 struct buffer_info *buf)
426{
427 int result;
428
7ecca90d
NC
429 result = close(buf->pipe_fd);
430 if(result == -1) {
431 WARN("problem closing the pipe fd");
432 }
433
4723ca09 434 result = close(buf->app_sock);
d159ac37
AH
435 if(result == -1) {
436 WARN("problem calling ustcomm_close_app");
437 }
438
439 result = shmdt(buf->mem);
440 if(result == -1) {
441 PERROR("shmdt");
442 }
443
444 result = shmdt(buf->bufstruct_mem);
445 if(result == -1) {
446 PERROR("shmdt");
447 }
448
449 if(callbacks->on_close_buffer)
450 callbacks->on_close_buffer(callbacks, buf);
451
452 free(buf);
453}
454
9dc7b7ff 455int consumer_loop(struct ustconsumer_instance *instance, struct buffer_info *buf)
d159ac37 456{
e2b46575
DG
457 int result = 0;
458 int read_result;
4723ca09 459 char read_buf;
d159ac37
AH
460
461 pthread_cleanup_push(decrement_active_buffers, instance);
462
463 for(;;) {
4723ca09 464 read_result = read(buf->pipe_fd, &read_buf, 1);
d159ac37 465 /* get the subbuffer */
4723ca09
NC
466 if (read_result == 1) {
467 result = get_subbuffer(buf);
72098143 468 if (result < 0) {
4723ca09
NC
469 ERR("error getting subbuffer");
470 continue;
471 } else if (result == GET_SUBBUF_DIED) {
472 finish_consuming_dead_subbuffer(instance->callbacks, buf);
473 break;
474 }
475 } else if ((read_result == -1 && (errno == ECONNRESET || errno == EPIPE)) ||
476 result == 0) {
477 DBG("App died while being traced");
d159ac37
AH
478 finish_consuming_dead_subbuffer(instance->callbacks, buf);
479 break;
480 }
481
482 if(instance->callbacks->on_read_subbuffer)
483 instance->callbacks->on_read_subbuffer(instance->callbacks, buf);
484
485 /* put the subbuffer */
486 result = put_subbuffer(buf);
487 if(result == -1) {
488 ERR("unknown error putting subbuffer (channel=%s)", buf->name);
489 break;
490 }
491 else if(result == PUT_SUBBUF_PUSHED) {
492 ERR("Buffer overflow (channel=%s), reader pushed. This channel will not be usable passed this point.", buf->name);
493 break;
494 }
495 else if(result == PUT_SUBBUF_DIED) {
496 DBG("application died while putting subbuffer");
497 /* Skip the first subbuffer. We are not sure it is trustable
498 * because the put_subbuffer() did not complete.
499 */
fbae86d6 500 /* TODO: check on_put_error return value */
d159ac37
AH
501 if(instance->callbacks->on_put_error)
502 instance->callbacks->on_put_error(instance->callbacks, buf);
503
504 finish_consuming_dead_subbuffer(instance->callbacks, buf);
505 break;
506 }
507 else if(result == PUT_SUBBUF_DONE) {
508 /* Done with this subbuffer */
509 /* FIXME: add a case where this branch is used? Upon
510 * normal trace termination, at put_subbuf time, a
511 * special last-subbuffer code could be returned by
512 * the listener.
513 */
514 break;
515 }
516 else if(result == PUT_SUBBUF_OK) {
517 }
518 }
519
520 DBG("thread for buffer %s is stopping", buf->name);
521
522 /* FIXME: destroy, unalloc... */
523
524 pthread_cleanup_pop(1);
525
526 return 0;
527}
528
529struct consumer_thread_args {
530 pid_t pid;
d89b8191 531 const char *trace;
72098143
NC
532 const char *channel;
533 int channel_cpu;
9dc7b7ff 534 struct ustconsumer_instance *instance;
d159ac37
AH
535};
536
537void *consumer_thread(void *arg)
538{
539 struct buffer_info *buf;
540 struct consumer_thread_args *args = (struct consumer_thread_args *) arg;
541 int result;
542 sigset_t sigset;
543
d159ac37
AH
544 if(args->instance->callbacks->on_new_thread)
545 args->instance->callbacks->on_new_thread(args->instance->callbacks);
546
547 /* Block signals that should be handled by the main thread. */
548 result = sigemptyset(&sigset);
549 if(result == -1) {
550 PERROR("sigemptyset");
551 goto end;
552 }
553 result = sigaddset(&sigset, SIGTERM);
554 if(result == -1) {
555 PERROR("sigaddset");
556 goto end;
557 }
558 result = sigaddset(&sigset, SIGINT);
559 if(result == -1) {
560 PERROR("sigaddset");
561 goto end;
562 }
563 result = sigprocmask(SIG_BLOCK, &sigset, NULL);
564 if(result == -1) {
565 PERROR("sigprocmask");
566 goto end;
567 }
568
d89b8191 569 buf = connect_buffer(args->instance, args->pid, args->trace,
72098143 570 args->channel, args->channel_cpu);
d159ac37
AH
571 if(buf == NULL) {
572 ERR("failed to connect to buffer");
573 goto end;
574 }
575
576 consumer_loop(args->instance, buf);
577
578 destroy_buffer(args->instance->callbacks, buf);
579
580 end:
581
582 if(args->instance->callbacks->on_close_thread)
583 args->instance->callbacks->on_close_thread(args->instance->callbacks);
584
72098143 585 free((void *)args->channel);
d159ac37
AH
586 free(args);
587 return NULL;
588}
589
9dc7b7ff 590int start_consuming_buffer(struct ustconsumer_instance *instance, pid_t pid,
d89b8191
NC
591 const char *trace, const char *channel,
592 int channel_cpu)
d159ac37
AH
593{
594 pthread_t thr;
595 struct consumer_thread_args *args;
596 int result;
597
72098143
NC
598 DBG("beginning of start_consuming_buffer: args: pid %d bufname %s_%d", pid, channel,
599 channel_cpu);
d159ac37 600
7032c7d3 601 args = (struct consumer_thread_args *) zmalloc(sizeof(struct consumer_thread_args));
72098143
NC
602 if (!args) {
603 return -ENOMEM;
604 }
d159ac37
AH
605
606 args->pid = pid;
d89b8191 607 args->trace = strdup(trace);
72098143
NC
608 args->channel = strdup(channel);
609 args->channel_cpu = channel_cpu;
d159ac37 610 args->instance = instance;
d89b8191 611 DBG("beginning2 of start_consuming_buffer: args: pid %d trace %s"
fbae86d6 612 " bufname %s_%d", args->pid, args->trace, args->channel, args->channel_cpu);
d159ac37
AH
613
614 result = pthread_create(&thr, NULL, consumer_thread, args);
615 if(result == -1) {
616 ERR("pthread_create failed");
617 return -1;
618 }
619 result = pthread_detach(thr);
620 if(result == -1) {
621 ERR("pthread_detach failed");
622 return -1;
623 }
d89b8191 624 DBG("end of start_consuming_buffer: args: pid %d trace %s "
fbae86d6 625 "bufname %s_%d", args->pid, args->channel, args->trace, args->channel_cpu);
d159ac37
AH
626
627 return 0;
628}
72098143 629static void process_client_cmd(int sock, struct ustcomm_header *req_header,
9dc7b7ff 630 char *recvbuf, struct ustconsumer_instance *instance)
4723ca09 631{
72098143 632 int result;
eb52c24a 633 struct ustcomm_header _res_header = {0};
72098143
NC
634 struct ustcomm_header *res_header = &_res_header;
635 struct ustcomm_buffer_info *buf_inf;
636
637 DBG("Processing client command");
638
639 switch (req_header->command) {
640 case CONSUME_BUFFER:
641
642 buf_inf = (struct ustcomm_buffer_info *)recvbuf;
643 result = ustcomm_unpack_buffer_info(buf_inf);
644 if (result < 0) {
645 ERR("Couldn't unpack buffer info");
646 return;
4723ca09
NC
647 }
648
d89b8191
NC
649 DBG("Going to consume trace %s buffer %s_%d in process %d",
650 buf_inf->trace, buf_inf->channel, buf_inf->ch_cpu,
651 buf_inf->pid);
72098143 652 result = start_consuming_buffer(instance, buf_inf->pid,
d89b8191 653 buf_inf->trace,
72098143
NC
654 buf_inf->channel,
655 buf_inf->ch_cpu);
4723ca09
NC
656 if (result < 0) {
657 ERR("error in add_buffer");
72098143 658 return;
4723ca09
NC
659 }
660
72098143
NC
661 res_header->result = 0;
662 break;
663 case EXIT:
664 res_header->result = 0;
4723ca09 665 /* Only there to force poll to return */
72098143
NC
666 break;
667 default:
668 res_header->result = -EINVAL;
669 WARN("unknown command: %d", req_header->command);
670 }
671
672 if (ustcomm_send(sock, res_header, NULL) <= 0) {
673 ERR("couldn't send command response");
4723ca09
NC
674 }
675}
676
677#define MAX_EVENTS 10
d159ac37 678
9dc7b7ff 679int ustconsumer_start_instance(struct ustconsumer_instance *instance)
d159ac37 680{
72098143
NC
681 struct ustcomm_header recv_hdr;
682 char recv_buf[USTCOMM_BUFFER_SIZE];
4723ca09
NC
683 struct ustcomm_sock *epoll_sock;
684 struct epoll_event events[MAX_EVENTS];
685 struct sockaddr addr;
686 int result, epoll_fd, accept_fd, nfds, i, addr_size, timeout;
d159ac37
AH
687
688 if(!instance->is_init) {
9dc7b7ff 689 ERR("libustconsumer instance not initialized");
d159ac37
AH
690 return 1;
691 }
4723ca09
NC
692 epoll_fd = instance->epoll_fd;
693
694 timeout = -1;
d159ac37
AH
695
696 /* app loop */
697 for(;;) {
4723ca09
NC
698 nfds = epoll_wait(epoll_fd, events, MAX_EVENTS, timeout);
699 if (nfds == -1 && errno == EINTR) {
d159ac37 700 /* Caught signal */
4723ca09 701 } else if (nfds == -1) {
9dc7b7ff 702 PERROR("ustconsumer_start_instance: epoll_wait failed");
4723ca09 703 continue;
d159ac37 704 }
d159ac37 705
4723ca09
NC
706 for (i = 0; i < nfds; ++i) {
707 epoll_sock = (struct ustcomm_sock *)events[i].data.ptr;
708 if (epoll_sock == instance->listen_sock) {
709 addr_size = sizeof(struct sockaddr);
710 accept_fd = accept(epoll_sock->fd,
711 &addr,
712 (socklen_t *)&addr_size);
713 if (accept_fd == -1) {
9dc7b7ff 714 PERROR("ustconsumer_start_instance: "
4723ca09
NC
715 "accept failed");
716 continue;
717 }
718 ustcomm_init_sock(accept_fd, epoll_fd,
719 &instance->connections);
720 } else {
72098143
NC
721 result = ustcomm_recv(epoll_sock->fd, &recv_hdr,
722 recv_buf);
723 if (result < 1) {
4723ca09 724 ustcomm_del_sock(epoll_sock, 0);
72098143
NC
725 } else {
726 process_client_cmd(epoll_sock->fd,
727 &recv_hdr, recv_buf,
728 instance);
d159ac37
AH
729 }
730
d159ac37 731 }
d159ac37
AH
732 }
733
4723ca09 734 if (instance->quit_program) {
d159ac37
AH
735 pthread_mutex_lock(&instance->mutex);
736 if(instance->active_buffers == 0) {
737 pthread_mutex_unlock(&instance->mutex);
738 break;
739 }
740 pthread_mutex_unlock(&instance->mutex);
741 timeout = 100;
742 }
743 }
744
745 if(instance->callbacks->on_trace_end)
746 instance->callbacks->on_trace_end(instance);
747
9dc7b7ff 748 ustconsumer_delete_instance(instance);
d159ac37
AH
749
750 return 0;
751}
752
4723ca09 753/* FIXME: threads and connections !? */
9dc7b7ff 754void ustconsumer_delete_instance(struct ustconsumer_instance *instance)
d159ac37 755{
4723ca09
NC
756 if (instance->is_init) {
757 ustcomm_del_named_sock(instance->listen_sock, 0);
758 close(instance->epoll_fd);
759 }
d159ac37
AH
760
761 pthread_mutex_destroy(&instance->mutex);
762 free(instance->sock_path);
763 free(instance);
764}
765
72098143
NC
766/* FIXME: Do something about the fixed path length, maybe get rid
767 * of the whole concept and use a pipe?
768 */
9dc7b7ff 769int ustconsumer_stop_instance(struct ustconsumer_instance *instance, int send_msg)
d159ac37
AH
770{
771 int result;
772 int fd;
773 int bytes = 0;
774
775 char msg[] = "exit";
776
777 instance->quit_program = 1;
778
779 if(!send_msg)
780 return 0;
781
782 /* Send a message through the socket to force poll to return */
783
784 struct sockaddr_un addr;
785
786 result = fd = socket(PF_UNIX, SOCK_STREAM, 0);
787 if(result == -1) {
788 PERROR("socket");
789 return 1;
790 }
791
792 addr.sun_family = AF_UNIX;
793
794 strncpy(addr.sun_path, instance->sock_path, UNIX_PATH_MAX);
795 addr.sun_path[UNIX_PATH_MAX-1] = '\0';
796
797 result = connect(fd, (struct sockaddr *)&addr, sizeof(addr));
798 if(result == -1) {
799 PERROR("connect");
800 }
801
802 while(bytes != sizeof(msg))
803 bytes += send(fd, msg, sizeof(msg), 0);
804
805 close(fd);
806
807 return 0;
808}
809
9dc7b7ff
NC
810struct ustconsumer_instance
811*ustconsumer_new_instance(struct ustconsumer_callbacks *callbacks,
4723ca09 812 char *sock_path)
d159ac37 813{
9dc7b7ff
NC
814 struct ustconsumer_instance *instance =
815 zmalloc(sizeof(struct ustconsumer_instance));
4723ca09 816 if(!instance) {
f3f8cc91
AH
817 return NULL;
818 }
819
d159ac37
AH
820 instance->callbacks = callbacks;
821 instance->quit_program = 0;
822 instance->is_init = 0;
823 instance->active_buffers = 0;
824 pthread_mutex_init(&instance->mutex, NULL);
825
4723ca09 826 if (sock_path) {
d159ac37 827 instance->sock_path = strdup(sock_path);
4723ca09 828 } else {
d159ac37 829 instance->sock_path = NULL;
4723ca09 830 }
d159ac37
AH
831
832 return instance;
833}
834
9dc7b7ff 835static int init_ustconsumer_socket(struct ustconsumer_instance *instance)
4723ca09
NC
836{
837 char *name;
838
839 if (instance->sock_path) {
840 if (asprintf(&name, "%s", instance->sock_path) < 0) {
9dc7b7ff 841 ERR("ustcomm_init_ustconsumer : asprintf failed (sock_path %s)",
4723ca09
NC
842 instance->sock_path);
843 return -1;
844 }
845 } else {
846 int result;
847
848 /* Only check if socket dir exists if we are using the default directory */
304f67a5 849 result = ensure_dir_exists(SOCK_DIR, S_IRWXU | S_IRWXG | S_IRWXO);
4723ca09
NC
850 if (result == -1) {
851 ERR("Unable to create socket directory %s", SOCK_DIR);
852 return -1;
853 }
854
9dc7b7ff
NC
855 if (asprintf(&name, "%s/%s", SOCK_DIR, "ustconsumer") < 0) {
856 ERR("ustcomm_init_ustconsumer : asprintf failed (%s/ustconsumer)",
4723ca09
NC
857 SOCK_DIR);
858 return -1;
859 }
860 }
861
862 /* Set up epoll */
863 instance->epoll_fd = epoll_create(MAX_EVENTS);
864 if (instance->epoll_fd == -1) {
865 ERR("epoll_create failed, start instance bailing");
866 goto free_name;
867 }
868
869 /* Create the named socket */
870 instance->listen_sock = ustcomm_init_named_socket(name,
871 instance->epoll_fd);
872 if(!instance->listen_sock) {
873 ERR("error initializing named socket at %s", name);
874 goto close_epoll;
875 }
876
0222e121 877 CDS_INIT_LIST_HEAD(&instance->connections);
4723ca09
NC
878
879 free(name);
880
881 return 0;
882
883close_epoll:
884 close(instance->epoll_fd);
885free_name:
886 free(name);
887
888 return -1;
889}
890
9dc7b7ff 891int ustconsumer_init_instance(struct ustconsumer_instance *instance)
d159ac37
AH
892{
893 int result;
9dc7b7ff 894 result = init_ustconsumer_socket(instance);
d159ac37
AH
895 if(result == -1) {
896 ERR("failed to initialize socket");
897 return 1;
898 }
899 instance->is_init = 1;
900 return 0;
901}
902
This page took 0.067294 seconds and 4 git commands to generate.