libustctl/libustctl.c

   1 /* Copyright (C) 2009  Pierre-Marc Fournier, Philippe Proulx-Barrette
   2  * Copyright (C) 2011  Ericsson AB
   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 #include <stdio.h>
  21 #include <unistd.h>
  22 #include <getopt.h>
  23 #include <stdlib.h>
  24 #include <fcntl.h>
  25 #include <string.h>
  26 #include <dirent.h>
  27
  28 #include "ustcomm.h"
  29 #include "ust/ustctl.h"
  30 #include "usterr.h"
  31
  32 static int do_cmd(int sock,
  33                   const struct ustcomm_header *req_header,
  34                   const char *req_data,
  35                   struct ustcomm_header *res_header,
  36                   char **res_data)
  37 {
  38         int result, saved_errno = 0;
  39         char *recv_buf;
  40
  41         recv_buf = zmalloc(USTCOMM_BUFFER_SIZE);
  42         if (!recv_buf) {
  43                 saved_errno = ENOMEM;
  44                 goto out;
  45         }
  46
  47         result = ustcomm_req(sock, req_header, req_data, res_header, recv_buf);
  48         if (result > 0) {
  49                 saved_errno = -res_header->result;
  50                 if (res_header->size == 0 || saved_errno > 0) {
  51                         free(recv_buf);
  52                 } else {
  53                         if (res_data) {
  54                                 *res_data = recv_buf;
  55                         } else {
  56                                 free(recv_buf);
  57                         }
  58                 }
  59         } else {
  60                 ERR("ustcomm req failed");
  61                 if (result == 0) {
  62                         saved_errno = ENOTCONN;
  63                 } else {
  64                         saved_errno = -result;
  65                 }
  66                 free(recv_buf);
  67         }
  68
  69 out:
  70         errno = saved_errno;
  71         if (errno) {
  72                 return -1;
  73         }
  74
  75         return 0;
  76 }
  77
  78 int ustctl_connect_pid(pid_t pid)
  79 {
  80         int sock;
  81
  82         if (ustcomm_connect_app(pid, &sock)) {
  83                 ERR("could not connect to PID %u", (unsigned int) pid);
  84                 errno = ENOTCONN;
  85                 return -1;
  86         }
  87
  88         return sock;
  89 }
  90
  91 pid_t *ustctl_get_online_pids(void)
  92 {
  93         struct dirent *dirent;
  94         DIR *dir;
  95         unsigned int ret_size = 1 * sizeof(pid_t), i = 0;
  96
  97         dir = opendir(SOCK_DIR);
  98         if (!dir) {
  99                 return NULL;
 100         }
 101
 102         pid_t *ret = (pid_t *) malloc(ret_size);
 103
 104         while ((dirent = readdir(dir))) {
 105                 if (!strcmp(dirent->d_name, ".") ||
 106                     !strcmp(dirent->d_name, "..")) {
 107
 108                         continue;
 109                 }
 110
 111                 if (dirent->d_type != DT_DIR &&
 112                     !!strcmp(dirent->d_name, "ust-consumer")) {
 113
 114                         sscanf(dirent->d_name, "%u", (unsigned int *) &ret[i]);
 115                         /* FIXME: Here we previously called pid_is_online, which
 116                          * always returned 1, now I replaced it with just 1.
 117                          * We need to figure out an intelligent way of solving
 118                          * this, maybe connect-disconnect.
 119                          */
 120                         if (1) {
 121                                 ret_size += sizeof(pid_t);
 122                                 ret = (pid_t *) realloc(ret, ret_size);
 123                                 ++i;
 124                         }
 125                 }
 126         }
 127
 128         ret[i] = 0; /* Array end */
 129
 130         if (ret[0] == 0) {
 131                 /* No PID at all */
 132                 free(ret);
 133                 return NULL;
 134         }
 135
 136         closedir(dir);
 137         return ret;
 138 }
 139
 140 /**
 141  * Sets marker state (USTCTL_MS_ON or USTCTL_MS_OFF).
 142  *
 143  * @param mn    Marker name
 144  * @param state Marker's new state
 145  * @param pid   Traced process ID
 146  * @return      0 if successful, or errors {USTCTL_ERR_GEN, USTCTL_ERR_ARG}
 147  */
 148 int ustctl_set_marker_state(int sock, const char *trace, const char *channel,
 149                             const char *marker, int state)
 150 {
 151         struct ustcomm_header req_header, res_header;
 152         struct ustcomm_marker_info marker_inf;
 153         int result;
 154
 155         result = ustcomm_pack_marker_info(&req_header,
 156                                           &marker_inf,
 157                                           trace,
 158                                           channel,
 159                                           marker);
 160         if (result < 0) {
 161                 errno = -result;
 162                 return -1;
 163         }
 164
 165         req_header.command = state ? ENABLE_MARKER : DISABLE_MARKER;
 166
 167         return do_cmd(sock, &req_header, (char *)&marker_inf,
 168                       &res_header, NULL);
 169 }
 170
 171 /**
 172  * Set subbuffer size.
 173  *
 174  * @param channel_size  Channel name and size
 175  * @param pid           Traced process ID
 176  * @return              0 if successful, or error
 177  */
 178 int ustctl_set_subbuf_size(int sock, const char *trace, const char *channel,
 179                            unsigned int subbuf_size)
 180 {
 181         struct ustcomm_header req_header, res_header;
 182         struct ustcomm_channel_info ch_inf;
 183         int result;
 184
 185         result = ustcomm_pack_channel_info(&req_header,
 186                                            &ch_inf,
 187                                            trace,
 188                                            channel);
 189         if (result < 0) {
 190                 errno = -result;
 191                 return -1;
 192         }
 193
 194         req_header.command = SET_SUBBUF_SIZE;
 195         ch_inf.subbuf_size = subbuf_size;
 196
 197         return do_cmd(sock, &req_header, (char *)&ch_inf,
 198                       &res_header, NULL);
 199 }
 200
 201 /**
 202  * Set subbuffer num.
 203  *
 204  * @param channel_num   Channel name and num
 205  * @param pid           Traced process ID
 206  * @return              0 if successful, or error
 207  */
 208 int ustctl_set_subbuf_num(int sock, const char *trace, const char *channel,
 209                           unsigned int num)
 210 {
 211         struct ustcomm_header req_header, res_header;
 212         struct ustcomm_channel_info ch_inf;
 213         int result;
 214
 215         result = ustcomm_pack_channel_info(&req_header,
 216                                            &ch_inf,
 217                                            trace,
 218                                            channel);
 219         if (result < 0) {
 220                 errno = -result;
 221                 return -1;
 222         }
 223
 224         req_header.command = SET_SUBBUF_NUM;
 225         ch_inf.subbuf_num = num;
 226
 227         return do_cmd(sock, &req_header, (char *)&ch_inf,
 228                       &res_header, NULL);
 229
 230 }
 231
 232
 233 static int ustctl_get_subbuf_num_size(int sock, const char *trace, const char *channel,
 234                                       int *num, int *size)
 235 {
 236         struct ustcomm_header req_header, res_header;
 237         struct ustcomm_channel_info ch_inf, *ch_inf_res;
 238         int result;
 239
 240
 241         result = ustcomm_pack_channel_info(&req_header,
 242                                            &ch_inf,
 243                                            trace,
 244                                            channel);
 245         if (result < 0) {
 246                 errno = -result;
 247                 return -1;
 248         }
 249
 250         req_header.command = GET_SUBBUF_NUM_SIZE;
 251
 252         result = do_cmd(sock, &req_header, (char *)&ch_inf,
 253                         &res_header, (char **)&ch_inf_res);
 254         if (result < 0) {
 255                 return -1;
 256         }
 257
 258         *num = ch_inf_res->subbuf_num;
 259         *size = ch_inf_res->subbuf_size;
 260
 261         free(ch_inf_res);
 262
 263         return 0;
 264 }
 265
 266 /**
 267  * Get subbuffer num.
 268  *
 269  * @param channel       Channel name
 270  * @param pid           Traced process ID
 271  * @return              subbuf cnf if successful, or error
 272  */
 273 int ustctl_get_subbuf_num(int sock, const char *trace, const char *channel)
 274 {
 275         int num, size, result;
 276
 277         result = ustctl_get_subbuf_num_size(sock, trace, channel,
 278                                             &num, &size);
 279         if (result < 0) {
 280                 errno = -result;
 281                 return -1;
 282         }
 283
 284         return num;
 285 }
 286
 287 /**
 288  * Get subbuffer size.
 289  *
 290  * @param channel       Channel name
 291  * @param pid           Traced process ID
 292  * @return              subbuf size if successful, or error
 293  */
 294 int ustctl_get_subbuf_size(int sock, const char *trace, const char *channel)
 295 {
 296         int num, size, result;
 297
 298         result = ustctl_get_subbuf_num_size(sock, trace, channel,
 299                                             &num, &size);
 300         if (result < 0) {
 301                 errno = -result;
 302                 return -1;
 303         }
 304
 305         return size;
 306 }
 307
 308 static int do_trace_cmd(int sock, const char *trace, int command)
 309 {
 310         struct ustcomm_header req_header, res_header;
 311         struct ustcomm_single_field trace_inf;
 312         int result;
 313
 314         result = ustcomm_pack_single_field(&req_header,
 315                                            &trace_inf,
 316                                            trace);
 317         if (result < 0) {
 318                 errno = -result;
 319                 return -1;
 320         }
 321
 322         req_header.command = command;
 323
 324         return do_cmd(sock, &req_header, (char *)&trace_inf, &res_header, NULL);
 325 }
 326
 327 /**
 328  * Destroys an UST trace according to a PID.
 329  *
 330  * @param pid   Traced process ID
 331  * @return      0 if successful, or error USTCTL_ERR_GEN
 332  */
 333 int ustctl_destroy_trace(int sock, const char *trace)
 334 {
 335         return do_trace_cmd(sock, trace, DESTROY_TRACE);
 336 }
 337
 338 /**
 339  * Starts an UST trace (and setups it) according to a PID.
 340  *
 341  * @param pid   Traced process ID
 342  * @return      0 if successful, or error USTCTL_ERR_GEN
 343  */
 344 int ustctl_setup_and_start(int sock, const char *trace)
 345 {
 346         return do_trace_cmd(sock, trace, START);
 347 }
 348
 349 /**
 350  * Creates an UST trace according to a PID.
 351  *
 352  * @param pid   Traced process ID
 353  * @return      0 if successful, or error USTCTL_ERR_GEN
 354  */
 355 int ustctl_create_trace(int sock, const char *trace)
 356 {
 357         return do_trace_cmd(sock, trace, CREATE_TRACE);
 358 }
 359
 360 /**
 361  * Starts an UST trace according to a PID.
 362  *
 363  * @param pid   Traced process ID
 364  * @return      0 if successful, or error USTCTL_ERR_GEN
 365  */
 366 int ustctl_start_trace(int sock, const char *trace)
 367 {
 368         return do_trace_cmd(sock, trace, START_TRACE);
 369 }
 370
 371 /**
 372  * Alloc an UST trace according to a PID.
 373  *
 374  * @param pid   Traced process ID
 375  * @return      0 if successful, or error USTCTL_ERR_GEN
 376  */
 377 int ustctl_alloc_trace(int sock, const char *trace)
 378 {
 379         return do_trace_cmd(sock, trace, ALLOC_TRACE);
 380 }
 381
 382
 383 int ustctl_force_switch(int sock, const char *trace)
 384 {
 385         return do_trace_cmd(sock, trace, FORCE_SUBBUF_SWITCH);
 386 }
 387
 388 /**
 389  * Stops an UST trace according to a PID.
 390  *
 391  * @param pid   Traced process ID
 392  * @return      0 if successful, or error USTCTL_ERR_GEN
 393  */
 394 int ustctl_stop_trace(int sock, const char *trace)
 395 {
 396         return do_trace_cmd(sock, trace, STOP_TRACE);
 397 }
 398
 399 /**
 400  * Counts newlines ('\n') in a string.
 401  *
 402  * @param str   String to search in
 403  * @return      Total newlines count
 404  */
 405 unsigned int ustctl_count_nl(const char *str)
 406 {
 407         unsigned int i = 0, tot = 0;
 408
 409         while (str[i] != '\0') {
 410                 if (str[i] == '\n') {
 411                         ++tot;
 412                 }
 413                 ++i;
 414         }
 415
 416         return tot;
 417 }
 418
 419 /**
 420  * Frees a CMSF array.
 421  *
 422  * @param cmsf  CMSF array to free
 423  * @return      0 if successful, or error USTCTL_ERR_ARG
 424  */
 425 int ustctl_free_cmsf(struct marker_status *cmsf)
 426 {
 427         if (cmsf == NULL) {
 428                 return USTCTL_ERR_ARG;
 429         }
 430
 431         unsigned int i = 0;
 432         while (cmsf[i].channel != NULL) {
 433                 free(cmsf[i].channel);
 434                 free(cmsf[i].marker);
 435                 free(cmsf[i].fs);
 436                 ++i;
 437         }
 438         free(cmsf);
 439
 440         return 0;
 441 }
 442
 443 /**
 444  * Gets channel/marker/state/format string for a given PID.
 445  *
 446  * @param cmsf  Pointer to CMSF array to be filled (callee allocates, caller
 447  *              frees with `ustctl_free_cmsf')
 448  * @param pid   Targeted PID
 449  * @return      0 if successful, or -1 on error
 450  */
 451 int ustctl_get_cmsf(int sock, struct marker_status **cmsf)
 452 {
 453         struct ustcomm_header req_header, res_header;
 454         char *big_str = NULL;
 455         int result;
 456         struct marker_status *tmp_cmsf = NULL;
 457         unsigned int i = 0, cmsf_ind = 0;
 458
 459         if (cmsf == NULL) {
 460                 return -1;
 461         }
 462
 463         req_header.command = LIST_MARKERS;
 464         req_header.size = 0;
 465
 466         result = ustcomm_send(sock, &req_header, NULL);
 467         if (result <= 0) {
 468                 PERROR("error while requesting markers list");
 469                 return -1;
 470         }
 471
 472         result = ustcomm_recv_alloc(sock, &res_header, &big_str);
 473         if (result <= 0) {
 474                 ERR("error while receiving markers list");
 475                 return -1;
 476         }
 477
 478         tmp_cmsf = (struct marker_status *) zmalloc(sizeof(struct marker_status) *
 479                                                     (ustctl_count_nl(big_str) + 1));
 480         if (tmp_cmsf == NULL) {
 481                 ERR("Failed to allocate CMSF array");
 482                 return -1;
 483         }
 484
 485         /* Parse received reply string (format: "[chan]/[mark] [st] [fs]"): */
 486         while (big_str[i] != '\0') {
 487                 char state;
 488
 489                 sscanf(big_str + i, "marker: %a[^/]/%a[^ ] %c %a[^\n]",
 490                        &tmp_cmsf[cmsf_ind].channel,
 491                        &tmp_cmsf[cmsf_ind].marker,
 492                        &state,
 493                        &tmp_cmsf[cmsf_ind].fs);
 494                 tmp_cmsf[cmsf_ind].state = (state == USTCTL_MS_CHR_ON ?
 495                                             USTCTL_MS_ON : USTCTL_MS_OFF); /* Marker state */
 496
 497                 while (big_str[i] != '\n') {
 498                         ++i; /* Go to next '\n' */
 499                 }
 500                 ++i; /* Skip current pointed '\n' */
 501                 ++cmsf_ind;
 502         }
 503         tmp_cmsf[cmsf_ind].channel = NULL;
 504         tmp_cmsf[cmsf_ind].marker = NULL;
 505         tmp_cmsf[cmsf_ind].fs = NULL;
 506
 507         *cmsf = tmp_cmsf;
 508
 509         free(big_str);
 510         return 0;
 511 }
 512
 513 /**
 514  * Frees a TES array.
 515  *
 516  * @param tes   TES array to free
 517  * @return      0 if successful, or error USTCTL_ERR_ARG
 518  */
 519 int ustctl_free_tes(struct trace_event_status *tes)
 520 {
 521         if (tes == NULL) {
 522                 return USTCTL_ERR_ARG;
 523         }
 524
 525         unsigned int i = 0;
 526         while (tes[i].name != NULL) {
 527                 free(tes[i].name);
 528                 ++i;
 529         }
 530         free(tes);
 531
 532         return 0;
 533 }
 534
 535 /**
 536  * Gets trace_events string for a given PID.
 537  *
 538  * @param tes   Pointer to TES array to be filled (callee allocates, caller
 539  *              frees with `ustctl_free_tes')
 540  * @param pid   Targeted PID
 541  * @return      0 if successful, or -1 on error
 542  */
 543 int ustctl_get_tes(int sock, struct trace_event_status **tes)
 544 {
 545         struct ustcomm_header req_header, res_header;
 546         char *big_str = NULL;
 547         int result;
 548         struct trace_event_status *tmp_tes = NULL;
 549         unsigned int i = 0, tes_ind = 0;
 550
 551         if (tes == NULL) {
 552                 return -1;
 553         }
 554
 555         req_header.command = LIST_TRACE_EVENTS;
 556         req_header.size = 0;
 557
 558         result = ustcomm_send(sock, &req_header, NULL);
 559         if (result != 1) {
 560                 ERR("error while requesting trace_event list");
 561                 return -1;
 562         }
 563
 564         result = ustcomm_recv_alloc(sock, &res_header, &big_str);
 565         if (result != 1) {
 566                 ERR("error while receiving markers list");
 567                 return -1;
 568         }
 569
 570         tmp_tes = (struct trace_event_status *)
 571                 zmalloc(sizeof(struct trace_event_status) *
 572                         (ustctl_count_nl(big_str) + 1));
 573         if (tmp_tes == NULL) {
 574                 ERR("Failed to allocate TES array");
 575                 return -1;
 576         }
 577
 578         /* Parse received reply string (format: "[name]"): */
 579         while (big_str[i] != '\0') {
 580                 sscanf(big_str + i, "trace_event: %a[^\n]",
 581                        &tmp_tes[tes_ind].name);
 582                 while (big_str[i] != '\n') {
 583                         ++i; /* Go to next '\n' */
 584                 }
 585                 ++i; /* Skip current pointed '\n' */
 586                 ++tes_ind;
 587         }
 588         tmp_tes[tes_ind].name = NULL;
 589
 590         *tes = tmp_tes;
 591
 592         free(big_str);
 593         return 0;
 594 }
 595
 596 /**
 597  * Set sock path
 598  *
 599  * @param sock_path     Sock path
 600  * @param pid           Traced process ID
 601  * @return              0 if successful, or error
 602  */
 603 int ustctl_set_sock_path(int sock, const char *sock_path)
 604 {
 605         int result;
 606         struct ustcomm_header req_header, res_header;
 607         struct ustcomm_single_field sock_path_msg;
 608
 609         result = ustcomm_pack_single_field(&req_header,
 610                                            &sock_path_msg,
 611                                            sock_path);
 612         if (result < 0) {
 613                 errno = -result;
 614                 return -1;
 615         }
 616
 617         req_header.command = SET_SOCK_PATH;
 618
 619         return do_cmd(sock, &req_header, (char *)&sock_path_msg,
 620                       &res_header, NULL);
 621 }
 622
 623 /**
 624  * Get sock path
 625  *
 626  * @param sock_path     Pointer to where the sock path will be returned
 627  * @param pid           Traced process ID
 628  * @return              0 if successful, or error
 629  */
 630 int ustctl_get_sock_path(int sock, char **sock_path)
 631 {
 632         int result;
 633         struct ustcomm_header req_header, res_header;
 634         struct ustcomm_single_field *sock_path_msg;
 635
 636         req_header.command = GET_SOCK_PATH;
 637         req_header.size = 0;
 638
 639         result = do_cmd(sock, &req_header, NULL, &res_header,
 640                         (char **)&sock_path_msg);
 641         if (result < 0) {
 642                 return -1;
 643         }
 644
 645         result = ustcomm_unpack_single_field(sock_path_msg);
 646         if (result < 0) {
 647                 return result;
 648         }
 649
 650         *sock_path = strdup(sock_path_msg->field);
 651
 652         free(sock_path_msg);
 653
 654         return 0;
 655 }