libust/tracectl.c

   1 /* Copyright (C) 2009  Pierre-Marc Fournier
   2  *
   3  * This library is free software; you can redistribute it and/or
   4  * modify it under the terms of the GNU Lesser General Public
   5  * License as published by the Free Software Foundation; either
   6  * version 2.1 of the License, or (at your option) any later version.
   7  *
   8  * This library is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11  * Lesser General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU Lesser General Public
  14  * License along with this library; if not, write to the Free Software
  15  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA
  16  */
  17
  18 #define _GNU_SOURCE
  19 #include <stdio.h>
  20 #include <stdint.h>
  21 #include <signal.h>
  22 #include <sys/types.h>
  23 #include <sys/socket.h>
  24 #include <sys/un.h>
  25 #include <sched.h>
  26 #include <fcntl.h>
  27 #include <poll.h>
  28 #include <regex.h>
  29
  30 #include <urcu-bp.h>
  31
  32 #include <ust/marker.h>
  33 #include <ust/tracectl.h>
  34 #include "tracer.h"
  35 #include "usterr.h"
  36 #include "ustcomm.h"
  37 #include "buffers.h"
  38 #include "marker-control.h"
  39
  40 //#define USE_CLONE
  41
  42 #define USTSIGNAL SIGIO
  43
  44 #define MAX_MSG_SIZE (100)
  45 #define MSG_NOTIF 1
  46 #define MSG_REGISTER_NOTIF 2
  47
  48 char consumer_stack[10000];
  49
  50 /* This should only be accessed by the constructor, before the creation
  51  * of the listener, and then only by the listener.
  52  */
  53 s64 pidunique = -1LL;
  54
  55 struct list_head blocked_consumers = LIST_HEAD_INIT(blocked_consumers);
  56
  57 static struct ustcomm_app ustcomm_app;
  58
  59 struct tracecmd { /* no padding */
  60         uint32_t size;
  61         uint16_t command;
  62 };
  63
  64 /* volatile because shared between the listener and the main thread */
  65 volatile sig_atomic_t buffers_to_export = 0;
  66
  67 struct trctl_msg {
  68         /* size: the size of all the fields except size itself */
  69         uint32_t size;
  70         uint16_t type;
  71         /* Only the necessary part of the payload is transferred. It
  72          * may even be none of it.
  73          */
  74         char payload[94];
  75 };
  76
  77 struct consumer_channel {
  78         int fd;
  79         struct ltt_channel_struct *chan;
  80 };
  81
  82 struct blocked_consumer {
  83         int fd_consumer;
  84         int fd_producer;
  85         int tmp_poll_idx;
  86
  87         /* args to ustcomm_send_reply */
  88         struct ustcomm_server server;
  89         struct ustcomm_source src;
  90
  91         /* args to ust_buffers_get_subbuf */
  92         struct ust_buffer *buf;
  93
  94         struct list_head list;
  95 };
  96
  97 static long long make_pidunique(void)
  98 {
  99         s64 retval;
 100         struct timeval tv;
 101
 102         gettimeofday(&tv, NULL);
 103
 104         retval = tv.tv_sec;
 105         retval <<= 32;
 106         retval |= tv.tv_usec;
 107
 108         return retval;
 109 }
 110
 111 static void print_markers(FILE *fp)
 112 {
 113         struct marker_iter iter;
 114
 115         lock_markers();
 116         marker_iter_reset(&iter);
 117         marker_iter_start(&iter);
 118
 119         while(iter.marker) {
 120                 fprintf(fp, "marker: %s/%s %d \"%s\" %p\n", iter.marker->channel, iter.marker->name, (int)imv_read(iter.marker->state), iter.marker->format, iter.marker->location);
 121                 marker_iter_next(&iter);
 122         }
 123         unlock_markers();
 124 }
 125
 126 static int init_socket(void);
 127
 128 /* This needs to be called whenever a new thread is created. It notifies
 129  * liburcu of the new thread.
 130  */
 131
 132 void ust_register_thread(void)
 133 {
 134         rcu_register_thread();
 135 }
 136
 137 int fd_notif = -1;
 138 void notif_cb(void)
 139 {
 140         int result;
 141         struct trctl_msg msg;
 142
 143         /* FIXME: fd_notif should probably be protected by a spinlock */
 144
 145         if(fd_notif == -1)
 146                 return;
 147
 148         msg.type = MSG_NOTIF;
 149         msg.size = sizeof(msg.type);
 150
 151         /* FIXME: don't block here */
 152         result = write(fd_notif, &msg, msg.size+sizeof(msg.size));
 153         if(result == -1) {
 154                 PERROR("write");
 155                 return;
 156         }
 157 }
 158
 159 /* Ask the daemon to collect a trace called trace_name and being
 160  * produced by this pid.
 161  *
 162  * The trace must be at least allocated. (It can also be started.)
 163  * This is because _ltt_trace_find is used.
 164  */
 165
 166 static void inform_consumer_daemon(const char *trace_name)
 167 {
 168         int i,j;
 169         struct ust_trace *trace;
 170         pid_t pid = getpid();
 171         int result;
 172
 173         ltt_lock_traces();
 174
 175         trace = _ltt_trace_find(trace_name);
 176         if(trace == NULL) {
 177                 WARN("inform_consumer_daemon: could not find trace \"%s\"; it is probably already destroyed", trace_name);
 178                 goto finish;
 179         }
 180
 181         for(i=0; i < trace->nr_channels; i++) {
 182                 /* iterate on all cpus */
 183                 for(j=0; j<trace->channels[i].n_cpus; j++) {
 184                         char *buf;
 185                         asprintf(&buf, "%s_%d", trace->channels[i].channel_name, j);
 186                         result = ustcomm_request_consumer(pid, buf);
 187                         if(result == -1) {
 188                                 WARN("Failed to request collection for channel %s. Is the daemon available?", trace->channels[i].channel_name);
 189                                 /* continue even if fail */
 190                         }
 191                         free(buf);
 192                         buffers_to_export++;
 193                 }
 194         }
 195
 196         finish:
 197         ltt_unlock_traces();
 198 }
 199
 200 void process_blocked_consumers(void)
 201 {
 202         int n_fds = 0;
 203         struct pollfd *fds;
 204         struct blocked_consumer *bc;
 205         int idx = 0;
 206         char inbuf;
 207         int result;
 208
 209         list_for_each_entry(bc, &blocked_consumers, list) {
 210                 n_fds++;
 211         }
 212
 213         fds = (struct pollfd *) malloc(n_fds * sizeof(struct pollfd));
 214         if(fds == NULL) {
 215                 ERR("malloc returned NULL");
 216                 return;
 217         }
 218
 219         list_for_each_entry(bc, &blocked_consumers, list) {
 220                 fds[idx].fd = bc->fd_producer;
 221                 fds[idx].events = POLLIN;
 222                 bc->tmp_poll_idx = idx;
 223                 idx++;
 224         }
 225
 226         while((result = poll(fds, n_fds, 0)) == -1 && errno == EINTR)
 227                 /* nothing */;
 228         if(result == -1) {
 229                 PERROR("poll");
 230                 return;
 231         }
 232
 233         list_for_each_entry(bc, &blocked_consumers, list) {
 234                 if(fds[bc->tmp_poll_idx].revents) {
 235                         long consumed_old = 0;
 236                         char *reply;
 237
 238                         result = read(bc->fd_producer, &inbuf, 1);
 239                         if(result == -1) {
 240                                 PERROR("read");
 241                                 continue;
 242                         }
 243                         if(result == 0) {
 244                                 DBG("PRODUCER END");
 245
 246                                 close(bc->fd_producer);
 247
 248                                 list_del(&bc->list);
 249
 250                                 result = ustcomm_send_reply(&bc->server, "END", &bc->src);
 251                                 if(result < 0) {
 252                                         ERR("ustcomm_send_reply failed");
 253                                         continue;
 254                                 }
 255
 256                                 continue;
 257                         }
 258
 259                         result = ust_buffers_get_subbuf(bc->buf, &consumed_old);
 260                         if(result == -EAGAIN) {
 261                                 WARN("missed buffer?");
 262                                 continue;
 263                         }
 264                         else if(result < 0) {
 265                                 DBG("ust_buffers_get_subbuf: error: %s", strerror(-result));
 266                         }
 267                         asprintf(&reply, "%s %ld", "OK", consumed_old);
 268                         result = ustcomm_send_reply(&bc->server, reply, &bc->src);
 269                         if(result < 0) {
 270                                 ERR("ustcomm_send_reply failed");
 271                                 free(reply);
 272                                 continue;
 273                         }
 274                         free(reply);
 275
 276                         list_del(&bc->list);
 277                 }
 278         }
 279
 280 }
 281
 282 void seperate_channel_cpu(const char *channel_and_cpu, char **channel, int *cpu)
 283 {
 284         const char *sep;
 285
 286         sep = rindex(channel_and_cpu, '_');
 287         if(sep == NULL) {
 288                 *cpu = -1;
 289                 sep = channel_and_cpu + strlen(channel_and_cpu);
 290         }
 291         else {
 292                 *cpu = atoi(sep+1);
 293         }
 294
 295         asprintf(channel, "%.*s", (int)(sep-channel_and_cpu), channel_and_cpu);
 296 }
 297
 298 static int do_cmd_get_shmid(const char *recvbuf, struct ustcomm_source *src)
 299 {
 300         int retval = 0;
 301         struct ust_trace *trace;
 302         char trace_name[] = "auto";
 303         int i;
 304         char *channel_and_cpu;
 305         int found = 0;
 306         int result;
 307         char *ch_name;
 308         int ch_cpu;
 309
 310         DBG("get_shmid");
 311
 312         channel_and_cpu = nth_token(recvbuf, 1);
 313         if(channel_and_cpu == NULL) {
 314                 ERR("get_shmid: cannot parse channel");
 315                 goto end;
 316         }
 317
 318         seperate_channel_cpu(channel_and_cpu, &ch_name, &ch_cpu);
 319         if(ch_cpu == -1) {
 320                 ERR("Problem parsing channel name");
 321                 goto free_short_chan_name;
 322         }
 323
 324         ltt_lock_traces();
 325         trace = _ltt_trace_find(trace_name);
 326         ltt_unlock_traces();
 327
 328         if(trace == NULL) {
 329                 ERR("cannot find trace!");
 330                 retval = -1;
 331                 goto free_short_chan_name;
 332         }
 333
 334         for(i=0; i<trace->nr_channels; i++) {
 335                 struct ust_channel *channel = &trace->channels[i];
 336                 struct ust_buffer *buf = channel->buf[ch_cpu];
 337
 338                 if(!strcmp(trace->channels[i].channel_name, ch_name)) {
 339                         char *reply;
 340
 341 //                      DBG("the shmid for the requested channel is %d", buf->shmid);
 342 //                      DBG("the shmid for its buffer structure is %d", channel->buf_struct_shmids);
 343                         asprintf(&reply, "%d %d", buf->shmid, channel->buf_struct_shmids[ch_cpu]);
 344
 345                         result = ustcomm_send_reply(&ustcomm_app.server, reply, src);
 346                         if(result) {
 347                                 ERR("listener: get_shmid: ustcomm_send_reply failed");
 348                                 free(reply);
 349                                 retval = -1;
 350                                 goto free_short_chan_name;
 351                         }
 352
 353                         free(reply);
 354
 355                         found = 1;
 356                         break;
 357                 }
 358         }
 359
 360         if(found) {
 361                 buffers_to_export--;
 362         }
 363         else {
 364                 ERR("get_shmid: channel not found (%s)", channel_and_cpu);
 365         }
 366
 367         free_short_chan_name:
 368         free(ch_name);
 369
 370         end:
 371         return retval;
 372 }
 373
 374 static int do_cmd_get_n_subbufs(const char *recvbuf, struct ustcomm_source *src)
 375 {
 376         int retval = 0;
 377         struct ust_trace *trace;
 378         char trace_name[] = "auto";
 379         int i;
 380         char *channel_and_cpu;
 381         int found = 0;
 382         int result;
 383         char *ch_name;
 384         int ch_cpu;
 385
 386         DBG("get_n_subbufs");
 387
 388         channel_and_cpu = nth_token(recvbuf, 1);
 389         if(channel_and_cpu == NULL) {
 390                 ERR("get_n_subbufs: cannot parse channel");
 391                 goto end;
 392         }
 393
 394         seperate_channel_cpu(channel_and_cpu, &ch_name, &ch_cpu);
 395         if(ch_cpu == -1) {
 396                 ERR("Problem parsing channel name");
 397                 goto free_short_chan_name;
 398         }
 399
 400         ltt_lock_traces();
 401         trace = _ltt_trace_find(trace_name);
 402         ltt_unlock_traces();
 403
 404         if(trace == NULL) {
 405                 ERR("cannot find trace!");
 406                 retval = -1;
 407                 goto free_short_chan_name;
 408         }
 409
 410         for(i=0; i<trace->nr_channels; i++) {
 411                 struct ust_channel *channel = &trace->channels[i];
 412
 413                 if(!strcmp(trace->channels[i].channel_name, ch_name)) {
 414                         char *reply;
 415
 416                         DBG("the n_subbufs for the requested channel is %d", channel->subbuf_cnt);
 417                         asprintf(&reply, "%d", channel->subbuf_cnt);
 418
 419                         result = ustcomm_send_reply(&ustcomm_app.server, reply, src);
 420                         if(result) {
 421                                 ERR("listener: get_n_subbufs: ustcomm_send_reply failed");
 422                                 free(reply);
 423                                 retval = -1;
 424                                 goto free_short_chan_name;
 425                         }
 426
 427                         free(reply);
 428                         found = 1;
 429                         break;
 430                 }
 431         }
 432         if(found == 0) {
 433                 ERR("get_n_subbufs: unable to find channel");
 434         }
 435
 436         free_short_chan_name:
 437         free(ch_name);
 438
 439         end:
 440         return retval;
 441 }
 442
 443 static int do_cmd_get_subbuf_size(const char *recvbuf, struct ustcomm_source *src)
 444 {
 445         int retval = 0;
 446         struct ust_trace *trace;
 447         char trace_name[] = "auto";
 448         int i;
 449         char *channel_and_cpu;
 450         int found = 0;
 451         int result;
 452         char *ch_name;
 453         int ch_cpu;
 454
 455         DBG("get_subbuf_size");
 456
 457         channel_and_cpu = nth_token(recvbuf, 1);
 458         if(channel_and_cpu == NULL) {
 459                 ERR("get_subbuf_size: cannot parse channel");
 460                 goto end;
 461         }
 462
 463         seperate_channel_cpu(channel_and_cpu, &ch_name, &ch_cpu);
 464         if(ch_cpu == -1) {
 465                 ERR("Problem parsing channel name");
 466                 goto free_short_chan_name;
 467         }
 468
 469         ltt_lock_traces();
 470         trace = _ltt_trace_find(trace_name);
 471         ltt_unlock_traces();
 472
 473         if(trace == NULL) {
 474                 ERR("cannot find trace!");
 475                 retval = -1;
 476                 goto free_short_chan_name;
 477         }
 478
 479         for(i=0; i<trace->nr_channels; i++) {
 480                 struct ust_channel *channel = &trace->channels[i];
 481
 482                 if(!strcmp(trace->channels[i].channel_name, ch_name)) {
 483                         char *reply;
 484
 485                         DBG("the subbuf_size for the requested channel is %zd", channel->subbuf_size);
 486                         asprintf(&reply, "%zd", channel->subbuf_size);
 487
 488                         result = ustcomm_send_reply(&ustcomm_app.server, reply, src);
 489                         if(result) {
 490                                 ERR("listener: get_subbuf_size: ustcomm_send_reply failed");
 491                                 free(reply);
 492                                 retval = -1;
 493                                 goto free_short_chan_name;
 494                         }
 495
 496                         free(reply);
 497                         found = 1;
 498                         break;
 499                 }
 500         }
 501         if(found == 0) {
 502                 ERR("get_subbuf_size: unable to find channel");
 503         }
 504
 505         free_short_chan_name:
 506         free(ch_name);
 507
 508         end:
 509         return retval;
 510 }
 511
 512 static int do_cmd_get_subbuffer(const char *recvbuf, struct ustcomm_source *src)
 513 {
 514         int retval = 0;
 515         struct ust_trace *trace;
 516         char trace_name[] = "auto";
 517         int i;
 518         char *channel_and_cpu;
 519         int found = 0;
 520         char *ch_name;
 521         int ch_cpu;
 522
 523         DBG("get_subbuf");
 524
 525         channel_and_cpu = nth_token(recvbuf, 1);
 526         if(channel_and_cpu == NULL) {
 527                 ERR("get_subbuf: cannot parse channel");
 528                 goto end;
 529         }
 530
 531         seperate_channel_cpu(channel_and_cpu, &ch_name, &ch_cpu);
 532         if(ch_cpu == -1) {
 533                 ERR("Problem parsing channel name");
 534                 goto free_short_chan_name;
 535         }
 536
 537         ltt_lock_traces();
 538         trace = _ltt_trace_find(trace_name);
 539         ltt_unlock_traces();
 540
 541         if(trace == NULL) {
 542                 ERR("cannot find trace!");
 543                 retval = -1;
 544                 goto free_short_chan_name;
 545         }
 546
 547         for(i=0; i<trace->nr_channels; i++) {
 548                 struct ust_channel *channel = &trace->channels[i];
 549
 550                 if(!strcmp(trace->channels[i].channel_name, ch_name)) {
 551                         struct ust_buffer *buf = channel->buf[ch_cpu];
 552                         struct blocked_consumer *bc;
 553
 554                         found = 1;
 555
 556                         bc = (struct blocked_consumer *) malloc(sizeof(struct blocked_consumer));
 557                         if(bc == NULL) {
 558                                 ERR("malloc returned NULL");
 559                                 goto free_short_chan_name;
 560                         }
 561                         bc->fd_consumer = src->fd;
 562                         bc->fd_producer = buf->data_ready_fd_read;
 563                         bc->buf = buf;
 564                         bc->src = *src;
 565                         bc->server = ustcomm_app.server;
 566
 567                         list_add(&bc->list, &blocked_consumers);
 568
 569                         break;
 570                 }
 571         }
 572         if(found == 0) {
 573                 ERR("get_subbuf: unable to find channel");
 574         }
 575
 576         free_short_chan_name:
 577         free(ch_name);
 578
 579         end:
 580         return retval;
 581 }
 582
 583 static int do_cmd_put_subbuffer(const char *recvbuf, struct ustcomm_source *src)
 584 {
 585         int retval = 0;
 586         struct ust_trace *trace;
 587         char trace_name[] = "auto";
 588         int i;
 589         char *channel_and_cpu;
 590         int found = 0;
 591         int result;
 592         char *ch_name;
 593         int ch_cpu;
 594         long consumed_old;
 595         char *consumed_old_str;
 596         char *endptr;
 597
 598         DBG("put_subbuf");
 599
 600         channel_and_cpu = strdup_malloc(nth_token(recvbuf, 1));
 601         if(channel_and_cpu == NULL) {
 602                 ERR("put_subbuf_size: cannot parse channel");
 603                 retval = -1;
 604                 goto end;
 605         }
 606
 607         consumed_old_str = strdup_malloc(nth_token(recvbuf, 2));
 608         if(consumed_old_str == NULL) {
 609                 ERR("put_subbuf: cannot parse consumed_old");
 610                 retval = -1;
 611                 goto free_channel_and_cpu;
 612         }
 613         consumed_old = strtol(consumed_old_str, &endptr, 10);
 614         if(*endptr != '\0') {
 615                 ERR("put_subbuf: invalid value for consumed_old");
 616                 retval = -1;
 617                 goto free_consumed_old_str;
 618         }
 619
 620         seperate_channel_cpu(channel_and_cpu, &ch_name, &ch_cpu);
 621         if(ch_cpu == -1) {
 622                 ERR("Problem parsing channel name");
 623                 retval = -1;
 624                 goto free_short_chan_name;
 625         }
 626
 627         ltt_lock_traces();
 628         trace = _ltt_trace_find(trace_name);
 629         ltt_unlock_traces();
 630
 631         if(trace == NULL) {
 632                 ERR("cannot find trace!");
 633                 retval = -1;
 634                 goto free_short_chan_name;
 635         }
 636
 637         for(i=0; i<trace->nr_channels; i++) {
 638                 struct ust_channel *channel = &trace->channels[i];
 639
 640                 if(!strcmp(trace->channels[i].channel_name, ch_name)) {
 641                         struct ust_buffer *buf = channel->buf[ch_cpu];
 642                         char *reply;
 643
 644                         found = 1;
 645
 646                         result = ust_buffers_put_subbuf(buf, consumed_old);
 647                         if(result < 0) {
 648                                 WARN("ust_buffers_put_subbuf: error (subbuf=%s)", channel_and_cpu);
 649                                 asprintf(&reply, "%s", "ERROR");
 650                         }
 651                         else {
 652                                 DBG("ust_buffers_put_subbuf: success (subbuf=%s)", channel_and_cpu);
 653                                 asprintf(&reply, "%s", "OK");
 654                         }
 655
 656                         result = ustcomm_send_reply(&ustcomm_app.server, reply, src);
 657                         if(result) {
 658                                 ERR("listener: put_subbuf: ustcomm_send_reply failed");
 659                                 free(reply);
 660                                 retval = -1;
 661                                 goto free_channel_and_cpu;
 662                         }
 663
 664                         free(reply);
 665                         break;
 666                 }
 667         }
 668         if(found == 0) {
 669                 ERR("get_subbuf_size: unable to find channel");
 670         }
 671
 672         free_channel_and_cpu:
 673         free(channel_and_cpu);
 674         free_consumed_old_str:
 675         free(consumed_old_str);
 676         free_short_chan_name:
 677         free(ch_name);
 678
 679         end:
 680         return retval;
 681 }
 682
 683 void *listener_main(void *p)
 684 {
 685         int result;
 686
 687         ust_register_thread();
 688
 689         DBG("LISTENER");
 690
 691         for(;;) {
 692                 char trace_name[] = "auto";
 693                 char trace_type[] = "ustrelay";
 694                 char *recvbuf;
 695                 int len;
 696                 struct ustcomm_source src;
 697
 698                 process_blocked_consumers();
 699
 700                 result = ustcomm_app_recv_message(&ustcomm_app, &recvbuf, &src, 5);
 701                 if(result < 0) {
 702                         WARN("error in ustcomm_app_recv_message");
 703                         continue;
 704                 }
 705                 else if(result == 0) {
 706                         /* no message */
 707                         continue;
 708                 }
 709
 710                 DBG("received a message! it's: %s", recvbuf);
 711                 len = strlen(recvbuf);
 712
 713                 if(!strcmp(recvbuf, "print_markers")) {
 714                         print_markers(stderr);
 715                 }
 716                 else if(!strcmp(recvbuf, "list_markers")) {
 717                         char *ptr;
 718                         size_t size;
 719                         FILE *fp;
 720
 721                         fp = open_memstream(&ptr, &size);
 722                         print_markers(fp);
 723                         fclose(fp);
 724
 725                         result = ustcomm_send_reply(&ustcomm_app.server, ptr, &src);
 726
 727                         free(ptr);
 728                 }
 729                 else if(!strcmp(recvbuf, "start")) {
 730                         /* start is an operation that setups the trace, allocates it and starts it */
 731                         result = ltt_trace_setup(trace_name);
 732                         if(result < 0) {
 733                                 ERR("ltt_trace_setup failed");
 734                                 return (void *)1;
 735                         }
 736
 737                         result = ltt_trace_set_type(trace_name, trace_type);
 738                         if(result < 0) {
 739                                 ERR("ltt_trace_set_type failed");
 740                                 return (void *)1;
 741                         }
 742
 743                         result = ltt_trace_alloc(trace_name);
 744                         if(result < 0) {
 745                                 ERR("ltt_trace_alloc failed");
 746                                 return (void *)1;
 747                         }
 748
 749                         inform_consumer_daemon(trace_name);
 750
 751                         result = ltt_trace_start(trace_name);
 752                         if(result < 0) {
 753                                 ERR("ltt_trace_start failed");
 754                                 continue;
 755                         }
 756                 }
 757                 else if(!strcmp(recvbuf, "trace_setup")) {
 758                         DBG("trace setup");
 759
 760                         result = ltt_trace_setup(trace_name);
 761                         if(result < 0) {
 762                                 ERR("ltt_trace_setup failed");
 763                                 return (void *)1;
 764                         }
 765
 766                         result = ltt_trace_set_type(trace_name, trace_type);
 767                         if(result < 0) {
 768                                 ERR("ltt_trace_set_type failed");
 769                                 return (void *)1;
 770                         }
 771                 }
 772                 else if(!strcmp(recvbuf, "trace_alloc")) {
 773                         DBG("trace alloc");
 774
 775                         result = ltt_trace_alloc(trace_name);
 776                         if(result < 0) {
 777                                 ERR("ltt_trace_alloc failed");
 778                                 return (void *)1;
 779                         }
 780                 }
 781                 else if(!strcmp(recvbuf, "trace_create")) {
 782                         DBG("trace create");
 783
 784                         result = ltt_trace_setup(trace_name);
 785                         if(result < 0) {
 786                                 ERR("ltt_trace_setup failed");
 787                                 return (void *)1;
 788                         }
 789
 790                         result = ltt_trace_set_type(trace_name, trace_type);
 791                         if(result < 0) {
 792                                 ERR("ltt_trace_set_type failed");
 793                                 return (void *)1;
 794                         }
 795
 796                         result = ltt_trace_alloc(trace_name);
 797                         if(result < 0) {
 798                                 ERR("ltt_trace_alloc failed");
 799                                 return (void *)1;
 800                         }
 801
 802                         inform_consumer_daemon(trace_name);
 803                 }
 804                 else if(!strcmp(recvbuf, "trace_start")) {
 805                         DBG("trace start");
 806
 807                         result = ltt_trace_start(trace_name);
 808                         if(result < 0) {
 809                                 ERR("ltt_trace_start failed");
 810                                 continue;
 811                         }
 812                 }
 813                 else if(!strcmp(recvbuf, "trace_stop")) {
 814                         DBG("trace stop");
 815
 816                         result = ltt_trace_stop(trace_name);
 817                         if(result < 0) {
 818                                 ERR("ltt_trace_stop failed");
 819                                 return (void *)1;
 820                         }
 821                 }
 822                 else if(!strcmp(recvbuf, "trace_destroy")) {
 823
 824                         DBG("trace destroy");
 825
 826                         result = ltt_trace_destroy(trace_name);
 827                         if(result < 0) {
 828                                 ERR("ltt_trace_destroy failed");
 829                                 return (void *)1;
 830                         }
 831                 }
 832                 else if(nth_token_is(recvbuf, "get_shmid", 0) == 1) {
 833                         do_cmd_get_shmid(recvbuf, &src);
 834                 }
 835                 else if(nth_token_is(recvbuf, "get_n_subbufs", 0) == 1) {
 836                         do_cmd_get_n_subbufs(recvbuf, &src);
 837                 }
 838                 else if(nth_token_is(recvbuf, "get_subbuf_size", 0) == 1) {
 839                         do_cmd_get_subbuf_size(recvbuf, &src);
 840                 }
 841                 else if(nth_token_is(recvbuf, "load_probe_lib", 0) == 1) {
 842                         char *libfile;
 843
 844                         libfile = nth_token(recvbuf, 1);
 845
 846                         DBG("load_probe_lib loading %s", libfile);
 847
 848                         free(libfile);
 849                 }
 850                 else if(nth_token_is(recvbuf, "get_subbuffer", 0) == 1) {
 851                         do_cmd_get_subbuffer(recvbuf, &src);
 852                 }
 853                 else if(nth_token_is(recvbuf, "put_subbuffer", 0) == 1) {
 854                         do_cmd_put_subbuffer(recvbuf, &src);
 855                 }
 856                 else if(nth_token_is(recvbuf, "enable_marker", 0) == 1) {
 857                         char *channel_slash_name = nth_token(recvbuf, 1);
 858                         char channel_name[256]="";
 859                         char marker_name[256]="";
 860
 861                         result = sscanf(channel_slash_name, "%255[^/]/%255s", channel_name, marker_name);
 862
 863                         if(channel_name == NULL || marker_name == NULL) {
 864                                 WARN("invalid marker name");
 865                                 goto next_cmd;
 866                         }
 867
 868                         result = ltt_marker_connect(channel_name, marker_name, "default");
 869                         if(result < 0) {
 870                                 WARN("could not enable marker; channel=%s, name=%s", channel_name, marker_name);
 871                         }
 872                 }
 873                 else if(nth_token_is(recvbuf, "disable_marker", 0) == 1) {
 874                         char *channel_slash_name = nth_token(recvbuf, 1);
 875                         char *marker_name;
 876                         char *channel_name;
 877
 878                         result = sscanf(channel_slash_name, "%a[^/]/%as", &channel_name, &marker_name);
 879
 880                         if(marker_name == NULL) {
 881                         }
 882
 883                         result = ltt_marker_disconnect(channel_name, marker_name, "default");
 884                         if(result < 0) {
 885                                 WARN("could not disable marker; channel=%s, name=%s", channel_name, marker_name);
 886                         }
 887                 }
 888                 else if(nth_token_is(recvbuf, "get_pidunique", 0) == 1) {
 889                         char *reply;
 890
 891                         asprintf(&reply, "%lld", pidunique);
 892
 893                         result = ustcomm_send_reply(&ustcomm_app.server, reply, &src);
 894                         if(result) {
 895                                 ERR("listener: get_pidunique: ustcomm_send_reply failed");
 896                                 goto next_cmd;
 897                         }
 898
 899                         free(reply);
 900                 }
 901 //              else if(nth_token_is(recvbuf, "get_notifications", 0) == 1) {
 902 //                      struct ust_trace *trace;
 903 //                      char trace_name[] = "auto";
 904 //                      int i;
 905 //                      char *channel_name;
 906 //
 907 //                      DBG("get_notifications");
 908 //
 909 //                      channel_name = strdup_malloc(nth_token(recvbuf, 1));
 910 //                      if(channel_name == NULL) {
 911 //                              ERR("put_subbuf_size: cannot parse channel");
 912 //                              goto next_cmd;
 913 //                      }
 914 //
 915 //                      ltt_lock_traces();
 916 //                      trace = _ltt_trace_find(trace_name);
 917 //                      ltt_unlock_traces();
 918 //
 919 //                      if(trace == NULL) {
 920 //                              ERR("cannot find trace!");
 921 //                              return (void *)1;
 922 //                      }
 923 //
 924 //                      for(i=0; i<trace->nr_channels; i++) {
 925 //                              struct rchan *rchan = trace->channels[i].trans_channel_data;
 926 //                              int fd;
 927 //
 928 //                              if(!strcmp(trace->channels[i].channel_name, channel_name)) {
 929 //                                      struct rchan_buf *rbuf = rchan->buf;
 930 //                                      struct ltt_channel_buf_struct *lttbuf = trace->channels[i].buf;
 931 //
 932 //                                      result = fd = ustcomm_app_detach_client(&ustcomm_app, &src);
 933 //                                      if(result == -1) {
 934 //                                              ERR("ustcomm_app_detach_client failed");
 935 //                                              goto next_cmd;
 936 //                                      }
 937 //
 938 //                                      lttbuf->wake_consumer_arg = (void *) fd;
 939 //
 940 //                                      smp_wmb();
 941 //
 942 //                                      lttbuf->call_wake_consumer = 1;
 943 //
 944 //                                      break;
 945 //                              }
 946 //                      }
 947 //
 948 //                      free(channel_name);
 949 //              }
 950                 else {
 951                         ERR("unable to parse message: %s", recvbuf);
 952                 }
 953
 954         next_cmd:
 955                 free(recvbuf);
 956         }
 957 }
 958
 959 volatile sig_atomic_t have_listener = 0;
 960
 961 void create_listener(void)
 962 {
 963 #ifdef USE_CLONE
 964         static char listener_stack[16384];
 965         int result;
 966 #else
 967         pthread_t thread;
 968 #endif
 969
 970         if(have_listener) {
 971                 WARN("not creating listener because we already had one");
 972                 return;
 973         }
 974
 975 #ifdef USE_CLONE
 976         result = clone((int (*)(void *)) listener_main, listener_stack+sizeof(listener_stack)-1, CLONE_FS | CLONE_FILES | CLONE_VM | CLONE_SIGHAND | CLONE_THREAD, NULL);
 977         if(result == -1) {
 978                 perror("clone");
 979                 return;
 980         }
 981 #else
 982
 983         pthread_create(&thread, NULL, listener_main, NULL);
 984 #endif
 985
 986         have_listener = 1;
 987 }
 988
 989 static int init_socket(void)
 990 {
 991         return ustcomm_init_app(getpid(), &ustcomm_app);
 992 }
 993
 994 #define AUTOPROBE_DISABLED      0
 995 #define AUTOPROBE_ENABLE_ALL    1
 996 #define AUTOPROBE_ENABLE_REGEX  2
 997 static int autoprobe_method = AUTOPROBE_DISABLED;
 998 static regex_t autoprobe_regex;
 999
1000 static void auto_probe_connect(struct marker *m)
1001 {
1002         int result;
1003
1004         char* concat_name = NULL;
1005         const char *probe_name = "default";
1006
1007         if(autoprobe_method == AUTOPROBE_DISABLED) {
1008                 return;
1009         }
1010         else if(autoprobe_method == AUTOPROBE_ENABLE_REGEX) {
1011                 result = asprintf(&concat_name, "%s/%s", m->channel, m->name);
1012                 if(result == -1) {
1013                         ERR("auto_probe_connect: asprintf failed (marker %s/%s)",
1014                                 m->channel, m->name);
1015                         return;
1016                 }
1017                 if (regexec(&autoprobe_regex, concat_name, 0, NULL, 0)) {
1018                         free(concat_name);
1019                         return;
1020                 }
1021                 free(concat_name);
1022         }
1023
1024         result = ltt_marker_connect(m->channel, m->name, probe_name);
1025         if(result && result != -EEXIST)
1026                 ERR("ltt_marker_connect (marker = %s/%s, errno = %d)", m->channel, m->name, -result);
1027
1028         DBG("auto connected marker %s (addr: %p) %s to probe default", m->channel, m, m->name);
1029
1030 }
1031
1032 static void __attribute__((constructor)) init()
1033 {
1034         int result;
1035         char* autoprobe_val = NULL;
1036
1037         /* Assign the pidunique, to be able to differentiate the processes with same
1038          * pid, (before and after an exec).
1039          */
1040         pidunique = make_pidunique();
1041
1042         /* Initialize RCU in case the constructor order is not good. */
1043         rcu_init();
1044
1045         /* It is important to do this before events start to be generated. */
1046         ust_register_thread();
1047
1048         DBG("Tracectl constructor");
1049
1050         /* Must create socket before signal handler to prevent races.
1051          */
1052         result = init_socket();
1053         if(result == -1) {
1054                 ERR("init_socket error");
1055                 return;
1056         }
1057
1058         create_listener();
1059
1060         autoprobe_val = getenv("UST_AUTOPROBE");
1061         if(autoprobe_val) {
1062                 struct marker_iter iter;
1063
1064                 DBG("Autoprobe enabled.");
1065
1066                 /* Ensure markers are initialized */
1067                 //init_markers();
1068
1069                 /* Ensure marker control is initialized, for the probe */
1070                 init_marker_control();
1071
1072                 /* first, set the callback that will connect the
1073                  * probe on new markers
1074                  */
1075                 if(autoprobe_val[0] == '/') {
1076                         result = regcomp(&autoprobe_regex, autoprobe_val+1, 0);
1077                         if (result) {
1078                                 char regexerr[150];
1079
1080                                 regerror(result, &autoprobe_regex, regexerr, sizeof(regexerr));
1081                                 ERR("cannot parse regex %s (%s), will ignore UST_AUTOPROBE", autoprobe_val, regexerr);
1082                                 /* don't crash the application just for this */
1083                         }
1084                         else {
1085                                 autoprobe_method = AUTOPROBE_ENABLE_REGEX;
1086                         }
1087                 }
1088                 else {
1089                         /* just enable all instrumentation */
1090                         autoprobe_method = AUTOPROBE_ENABLE_ALL;
1091                 }
1092
1093                 marker_set_new_marker_cb(auto_probe_connect);
1094
1095                 /* Now, connect the probes that were already registered. */
1096                 marker_iter_reset(&iter);
1097                 marker_iter_start(&iter);
1098
1099                 DBG("now iterating on markers already registered");
1100                 while(iter.marker) {
1101                         DBG("now iterating on marker %s", iter.marker->name);
1102                         auto_probe_connect(iter.marker);
1103                         marker_iter_next(&iter);
1104                 }
1105         }
1106
1107         if(getenv("UST_TRACE")) {
1108                 char trace_name[] = "auto";
1109                 char trace_type[] = "ustrelay";
1110
1111                 DBG("starting early tracing");
1112
1113                 /* Ensure marker control is initialized */
1114                 init_marker_control();
1115
1116                 /* Ensure markers are initialized */
1117                 init_markers();
1118
1119                 /* Ensure buffers are initialized, for the transport to be available.
1120                  * We are about to set a trace type and it will fail without this.
1121                  */
1122                 init_ustrelay_transport();
1123
1124                 /* FIXME: When starting early tracing (here), depending on the
1125                  * order of constructors, it is very well possible some marker
1126                  * sections are not yet registered. Because of this, some
1127                  * channels may not be registered. Yet, we are about to ask the
1128                  * daemon to collect the channels. Channels which are not yet
1129                  * registered will not be collected.
1130                  *
1131                  * Currently, in LTTng, there is no way to add a channel after
1132                  * trace start. The reason for this is that it induces complex
1133                  * concurrency issues on the trace structures, which can only
1134                  * be resolved using RCU. This has not been done yet. As a
1135                  * workaround, we are forcing the registration of the "ust"
1136                  * channel here. This is the only channel (apart from metadata)
1137                  * that can be reliably used in early tracing.
1138                  *
1139                  * Non-early tracing does not have this problem and can use
1140                  * arbitrary channel names.
1141                  */
1142                 ltt_channels_register("ust");
1143
1144                 result = ltt_trace_setup(trace_name);
1145                 if(result < 0) {
1146                         ERR("ltt_trace_setup failed");
1147                         return;
1148                 }
1149
1150                 result = ltt_trace_set_type(trace_name, trace_type);
1151                 if(result < 0) {
1152                         ERR("ltt_trace_set_type failed");
1153                         return;
1154                 }
1155
1156                 result = ltt_trace_alloc(trace_name);
1157                 if(result < 0) {
1158                         ERR("ltt_trace_alloc failed");
1159                         return;
1160                 }
1161
1162                 result = ltt_trace_start(trace_name);
1163                 if(result < 0) {
1164                         ERR("ltt_trace_start failed");
1165                         return;
1166                 }
1167
1168                 /* Do this after the trace is started in order to avoid creating confusion
1169                  * if the trace fails to start. */
1170                 inform_consumer_daemon(trace_name);
1171         }
1172
1173
1174         return;
1175
1176         /* should decrementally destroy stuff if error */
1177
1178 }
1179
1180 /* This is only called if we terminate normally, not with an unhandled signal,
1181  * so we cannot rely on it. However, for now, LTTV requires that the header of
1182  * the last sub-buffer contain a valid end time for the trace. This is done
1183  * automatically only when the trace is properly stopped.
1184  *
1185  * If the traced program crashed, it is always possible to manually add the
1186  * right value in the header, or to open the trace in text mode.
1187  *
1188  * FIXME: Fix LTTV so it doesn't need this.
1189  */
1190
1191 static void destroy_traces(void)
1192 {
1193         int result;
1194
1195         /* if trace running, finish it */
1196
1197         DBG("destructor stopping traces");
1198
1199         result = ltt_trace_stop("auto");
1200         if(result == -1) {
1201                 ERR("ltt_trace_stop error");
1202         }
1203
1204         result = ltt_trace_destroy("auto");
1205         if(result == -1) {
1206                 ERR("ltt_trace_destroy error");
1207         }
1208 }
1209
1210 static int trace_recording(void)
1211 {
1212         int retval = 0;
1213         struct ust_trace *trace;
1214
1215         ltt_lock_traces();
1216
1217         list_for_each_entry(trace, &ltt_traces.head, list) {
1218                 if(trace->active) {
1219                         retval = 1;
1220                         break;
1221                 }
1222         }
1223
1224         ltt_unlock_traces();
1225
1226         return retval;
1227 }
1228
1229 #if 0
1230 static int have_consumer(void)
1231 {
1232         return !list_empty(&blocked_consumers);
1233 }
1234 #endif
1235
1236 int restarting_usleep(useconds_t usecs)
1237 {
1238         struct timespec tv;
1239         int result;
1240
1241         tv.tv_sec = 0;
1242         tv.tv_nsec = usecs * 1000;
1243
1244         do {
1245                 result = nanosleep(&tv, &tv);
1246         } while(result == -1 && errno == EINTR);
1247
1248         return result;
1249 }
1250
1251 /* This destructor keeps the process alive for a few seconds in order
1252  * to leave time to ustd to connect to its buffers. This is necessary
1253  * for programs whose execution is very short. It is also useful in all
1254  * programs when tracing is started close to the end of the program
1255  * execution.
1256  *
1257  * FIXME: For now, this only works for the first trace created in a
1258  * process.
1259  */
1260
1261 static void __attribute__((destructor)) keepalive()
1262 {
1263         if(trace_recording() && buffers_to_export) {
1264                 int total = 0;
1265                 DBG("Keeping process alive for consumer daemon...");
1266                 while(buffers_to_export) {
1267                         const int interv = 200000;
1268                         restarting_usleep(interv);
1269                         total += interv;
1270
1271                         if(total >= 3000000) {
1272                                 WARN("non-consumed buffers remaining after wait limit; not waiting anymore");
1273                                 break;
1274                         }
1275                 }
1276                 DBG("Finally dying...");
1277         }
1278
1279         destroy_traces();
1280
1281         ustcomm_fini_app(&ustcomm_app);
1282 }
1283
1284 void ust_potential_exec(void)
1285 {
1286         trace_mark(ust, potential_exec, MARK_NOARGS);
1287
1288         DBG("test");
1289
1290         keepalive();
1291 }
1292
1293 /* Notify ust that there was a fork. This needs to be called inside
1294  * the new process, anytime a process whose memory is not shared with
1295  * the parent is created. If this function is not called, the events
1296  * of the new process will not be collected.
1297  *
1298  * Signals should be disabled before the fork and reenabled only after
1299  * this call in order to guarantee tracing is not started before ust_fork()
1300  * sanitizes the new process.
1301  */
1302
1303 static void ust_fork(void)
1304 {
1305         struct blocked_consumer *bc;
1306         struct blocked_consumer *deletable_bc = NULL;
1307         int result;
1308
1309         DBG("ust: forking");
1310         ltt_trace_stop("auto");
1311         ltt_trace_destroy("auto");
1312         /* Delete all active connections */
1313         ustcomm_close_all_connections(&ustcomm_app.server);
1314
1315         /* Delete all blocked consumers */
1316         list_for_each_entry(bc, &blocked_consumers, list) {
1317                 close(bc->fd_producer);
1318                 close(bc->fd_consumer);
1319                 free(deletable_bc);
1320                 deletable_bc = bc;
1321                 list_del(&bc->list);
1322         }
1323
1324         have_listener = 0;
1325         create_listener();
1326         init_socket();
1327         ltt_trace_setup("auto");
1328         result = ltt_trace_set_type("auto", "ustrelay");
1329         if(result < 0) {
1330                 ERR("ltt_trace_set_type failed");
1331                 return;
1332         }
1333
1334         ltt_trace_alloc("auto");
1335         ltt_trace_start("auto");
1336         inform_consumer_daemon("auto");
1337 }
1338
1339 void ust_before_fork(ust_fork_info_t *fork_info)
1340 {
1341         /* Disable signals. This is to avoid that the child
1342          * intervenes before it is properly setup for tracing. It is
1343          * safer to disable all signals, because then we know we are not
1344          * breaking anything by restoring the original mask.
1345          */
1346         sigset_t all_sigs;
1347         int result;
1348
1349         /* FIXME:
1350                 - only do this if tracing is active
1351         */
1352
1353         /* Disable signals */
1354         sigfillset(&all_sigs);
1355         result = sigprocmask(SIG_BLOCK, &all_sigs, &fork_info->orig_sigs);
1356         if(result == -1) {
1357                 PERROR("sigprocmask");
1358                 return;
1359         }
1360 }
1361
1362 /* Don't call this function directly in a traced program */
1363 static void ust_after_fork_common(ust_fork_info_t *fork_info)
1364 {
1365         int result;
1366
1367         /* Restore signals */
1368         result = sigprocmask(SIG_SETMASK, &fork_info->orig_sigs, NULL);
1369         if(result == -1) {
1370                 PERROR("sigprocmask");
1371                 return;
1372         }
1373 }
1374
1375 void ust_after_fork_parent(ust_fork_info_t *fork_info)
1376 {
1377         /* Reenable signals */
1378         ust_after_fork_common(fork_info);
1379 }
1380
1381 void ust_after_fork_child(ust_fork_info_t *fork_info)
1382 {
1383         /* First sanitize the child */
1384         ust_fork();
1385
1386         /* Then reenable interrupts */
1387         ust_after_fork_common(fork_info);
1388 }
1389