death_handler.cc

/*

  Copyright (c) 2012, Samsung R&D Institute Russia
  All rights reserved.

  Redistribution and use in source and binary forms, with or without
  modification, are permitted provided that the following conditions are met:

  1. Redistributions of source code must retain the above copyright notice, this
     list of conditions and the following disclaimer.
  2. Redistributions in binary form must reproduce the above copyright notice,
     this list of conditions and the following disclaimer in the documentation
     and/or other materials provided with the distribution.

  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
  ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
  ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 */

/*! @file death_handler.cc
 *  @brief Implementation of the SIGSEGV/SIGABRT handler which prints the debug
 *  stack trace.
 *  @author Markovtsev Vadim <v.markovtsev@samsung.com>
 *  @version 1.0
 *  @license Simplified BSD License
 *  @copyright 2012 Samsung R&D Institute Russia
 */

#include "death_handler.h"
#include <assert.h>
#include <cxxabi.h>
#include <execinfo.h>
#include <malloc.h>
#include <pthread.h>
#include <signal.h>
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <string.h>
#include <unistd.h>
#include <wait.h>
#ifndef _GNU_SOURCE
#define _GNU_SOURCE
#endif
#include <dlfcn.h>

#define MALLOC_HOOK_DEPRECATED

#if defined(MALLOC_HOOK_DEPRECATED)
# define malloc_function_name malloc
# define free_function_name free
#endif

#pragma GCC poison malloc realloc free backtrace_symbols \
  printf fprintf sprintf snprintf scanf sscanf  // NOLINT(runtime/printf)

#if defined(MALLOC_HOOK_DEPRECATED) && !defined(__GNUC__)
# error "Not implemented on this compiler"
#endif

#define checked(x) do { if ((x) <= 0) _Exit(EXIT_FAILURE); } while (false)

#if defined(MALLOC_HOOK_DEPRECATED)
extern "C" void* __libc_malloc (size_t);
extern "C" void __libc_free (void*);
int g_malloc_hook_active = 0;

static void* my_malloc_hook (size_t size, const void*) {
  void* result;

  g_malloc_hook_active = 0;
  result = malloc_function_name(size);
  g_malloc_hook_active = 1;

  return result;
}
static void my_free_hook (void* ptr, const void*) {
	g_malloc_hook_active = 0;
	free_function_name(ptr);
	g_malloc_hook_active = 1;
}

void* malloc_function_name (size_t size) {
  void* const caller = NULL; //__builtin_return_address(0);
  if (g_malloc_hook_active)
    return my_malloc_hook(size, caller);
  else
    return __libc_malloc(size);
}
void free_function_name (void* ptr) {
  void* const caller = NULL; //__builtin_return_address(0);
  if (g_malloc_hook_active)
    return my_free_hook(ptr, caller);
  else
    return __libc_free(ptr);
}

# undef malloc_function_name
# undef free_function_name
#endif

namespace Debug {

/// @brief This namespace contains some basic supplements
/// of the needed libc functions which potentially use heap.
namespace Safe {
  /// @brief Converts an integer to a statically allocated string.
  char *itoa(int val, int base = 10) {
    static char res[32];
    int i;
    bool negative = val < 0;
    res[sizeof(res) - 1] = 0;
    for (i = sizeof(res) - 2; val != 0 && i != 0; i--, val /= base) {
      res[i] = "0123456789ABCDEF"[val % base];
    }
    if (negative) {
      res[i--] = '-';
    }
    return &res[i + 1];
  }

  /// @brief Converts an unsigned integer to a statically allocated string.
  char *utoa(uint64_t val, int base = 10) {
    static char res[32];
    int i;
    res[sizeof(res) - 1] = 0;
    for (i = sizeof(res) - 2; val != 0 && i != 0; i--, val /= base) {
      res[i] = "0123456789ABCDEF"[val % base];
    }
    return &res[i + 1];
  }

  /// @brief Converts a pointer to a statically allocated string.
  char *ptoa(const void *val) {
    char* buf = utoa(reinterpret_cast<uint64_t>(val), 16);
    static char result[32];
    strcpy(result + 2, buf);  // NOLINT(runtime/printf
    result[0] = '0';
    result[1] = 'x';
    return result;
  }

  /// @brief Reentrant printing to stderr.
  void print2stderr(const char *msg, size_t len = 0) {
    if (len > 0) {
      checked(write(STDERR_FILENO, msg, len));
    } else {
      checked(write(STDERR_FILENO, msg, strlen(msg)));
    }
  }
}  // namespace Safe

const int DeathHandler::kMaxPathLength = 1024;
bool DeathHandler::generate_core_dump_ = true;
bool DeathHandler::cleanup_ = true;
#ifdef QUICK_EXIT
bool DeathHandler::quick_exit_ = false;
#endif
int DeathHandler::frames_count_ = 16;
bool DeathHandler::cut_common_path_root_ = true;
bool DeathHandler::cut_relative_paths_ = true;
bool DeathHandler::append_pid_ = false;
bool DeathHandler::color_output_ = true;
bool DeathHandler::thread_safe_ = true;

DeathHandler::DeathHandler() {
  struct sigaction sa;
  sa.sa_handler = (__sighandler_t)SignalHandler;
  sigemptyset(&sa.sa_mask);
  sa.sa_flags = SA_RESTART | SA_SIGINFO;
  sigaction(SIGSEGV, &sa, NULL);
  sigaction(SIGABRT, &sa, NULL);
}

DeathHandler::~DeathHandler() {
  struct sigaction sa;
  sigaction(SIGSEGV, NULL, &sa);
  sa.sa_handler = SIG_DFL;
  sigaction(SIGSEGV, &sa, NULL);
  sigaction(SIGABRT, NULL, &sa);
  sa.sa_handler = SIG_DFL;
  sigaction(SIGABRT, &sa, NULL);
}

bool DeathHandler::generate_core_dump() {
  return generate_core_dump_;
}

void DeathHandler::set_generate_core_dump(bool value) {
  generate_core_dump_ = value;
}

bool DeathHandler::cleanup() {
  return cleanup_;
}

void DeathHandler::set_cleanup(bool value) {
  cleanup_ = value;
}

#ifdef QUICK_EXIT
bool DeathHandler::quick_exit() {
  return quick_exit_;
}

void DeathHandler::set_quick_exit(bool value) {
  quick_exit_ = value;
}
#endif

int DeathHandler::frames_count() {
  return frames_count_;
}

void DeathHandler::set_frames_count(int value) {
  assert(value > 0 && value <= 100);
  frames_count_ = value;
}

bool DeathHandler::cut_common_path_root() {
  return cut_common_path_root_;
}

void DeathHandler::set_cut_common_path_root(bool value) {
  cut_common_path_root_ = value;
}

bool DeathHandler::cut_relative_paths() {
  return cut_relative_paths_;
}

void DeathHandler::set_cut_relative_paths(bool value) {
  cut_relative_paths_ = value;
}

bool DeathHandler::append_pid() {
  return append_pid_;
}

void DeathHandler::set_append_pid(bool value) {
  append_pid_ = value;
}

bool DeathHandler::color_output() {
  return color_output_;
}

void DeathHandler::set_color_output(bool value) {
  color_output_ = value;
}

bool DeathHandler::thread_safe() {
  return thread_safe_;
}

void DeathHandler::set_thread_safe(bool value) {
  thread_safe_ = value;
}

/// @brief Invokes addr2line utility to determine the function name
/// and the line information from an address in the code segment.
static char *addr2line(const char *image, void *addr) {
  int pipefd[2];
  assert(pipe(pipefd) == 0);
  pid_t pid = fork();
  if (pid == 0) {
    close(pipefd[0]);
    dup2(pipefd[1], STDOUT_FILENO);
    dup2(pipefd[1], STDERR_FILENO);
    assert(execlp("addr2line", "addr2line",
                  Safe::ptoa(addr), "-f", "-C", "-e", image,
                  reinterpret_cast<void*>(NULL)) != -1);
  }

  close(pipefd[1]);
  static char line[4096];
  ssize_t len = read(pipefd[0], line, sizeof(line));
  close(pipefd[0]);
  line[len] = 0;

  assert(waitpid(pid, NULL, 0) == pid);
  if (line[0] == '?') {
    char* straddr = Safe::ptoa(addr);
    strcpy(line, "\033[32;1m");  // NOLINT(runtime/printf)
    strcat(line, straddr);  // NOLINT(runtime/printf)
    strcat(line, "\033[0m at ");  // NOLINT(runtime/printf)
    strcat(line, image);  // NOLINT(runtime/printf)
    strcat(line, " ");  // NOLINT(runtime/printf)
  } else {
    if (*(strstr(line, "\n") + 1) == '?') {
      char* straddr = Safe::ptoa(addr);
      strcpy(strstr(line, "\n") + 1, image);  // NOLINT(runtime/printf)
      strcat(line, ":");  // NOLINT(runtime/printf)
      strcat(line, straddr);  // NOLINT(runtime/printf)
      strcat(line, "\n");  // NOLINT(runtime/printf)
    }
  }
  return line;
}

#if !defined(MALLOC_HOOK_DEPRECATED)
/// @brief Used to workaround backtrace() usage of malloc().
static void* MallocHook(size_t size,
                        const void* caller __attribute__((unused))) {
  static char mallocBuffer[512];
  if (size > sizeof(mallocBuffer)) {
    const char* msg = "malloc() replacement function cannot return "
        "a memory block larger than 512 bytes\n";
    Safe::print2stderr(msg, strlen(msg) + 1);
    _Exit(EXIT_FAILURE);
  }
  return mallocBuffer;
}
#endif

#if __GNUC__ >= 4 && __GNUC_MINOR__ >= 6
#pragma GCC diagnostic push
#pragma GCC diagnostic ignored "-Wdeprecated-declarations"
#endif

void DeathHandler::SignalHandler(int sig,
                                 void *info __attribute__((unused)),
                                 void *secret) {
  // Stop all other running threads by forking
  pid_t forkedPid = fork();
  if (forkedPid != 0) {
    int status;
    if (thread_safe_) {
      // Freeze the original process, until it's child prints the stack trace
      kill(getpid(), SIGSTOP);
      // Wait for the child without blocking and exit as soon as possible,
      // so that no zombies are left.
      waitpid(forkedPid, &status, WNOHANG);
    } else {
      // Wait for the child, blocking only the current thread.
      /// All other threads will continue to run, potentially
      /// early crashing the parent.
      waitpid(forkedPid, &status, 0);
    }
#ifdef QUICK_EXIT
    if (quick_exit_) {
      ::quick_exit(EXIT_FAILURE);
    }
#endif
    if (generate_core_dump_) {
      struct sigaction sa;
      sigaction(SIGABRT, NULL, &sa);
      sa.sa_handler = SIG_DFL;
      sigaction(SIGABRT, &sa, NULL);
      abort();
    } else {
      if (cleanup_) {
        exit(EXIT_FAILURE);
      } else {
        _Exit(EXIT_FAILURE);
      }
    }
  }

  ucontext_t *uc = reinterpret_cast<ucontext_t *>(secret);

  if (dup2(STDERR_FILENO, STDOUT_FILENO) == -1) {  // redirect stdout to stderr
    Safe::print2stderr("Failed to redirect stdout to stderr\n");
  }
  {
    static char msg[128];
    if (color_output_) {
      // \033[31;1mSegmentation fault\033[0m \033[33;1m(%i)\033[0m\n
      strcpy(msg, "\033[31;1m");  // NOLINT(runtime/printf)
      switch (sig) {
        case SIGSEGV:
          strcat(msg, "Segmentation fault");  // NOLINT(runtime/printf)
          break;
        case SIGABRT:
          strcat(msg, "Aborted");  // NOLINT(runtime/printf)
          break;
        default:
          strcat(msg, "Caught signal ");  // NOLINT(runtime/printf)
          strcat(msg, Safe::itoa(sig));  // NOLINT(runtime/printf)
          break;
      }
      strcat(msg, "\033[0m (thread \033[33;1m");  // NOLINT(runtime/printf)
      strcat(msg, Safe::utoa(pthread_self()));  // NOLINT(runtime/printf)
      strcat(msg, "\033[0m, pid \033[33;1m");  // NOLINT(runtime/printf)
      strcat(msg, Safe::itoa(getppid()));  // NOLINT(runtime/printf)
      strcat(msg, "\033[0m)");  // NOLINT(runtime/printf)
    } else {
      strcpy(msg, "Segmentation fault (thread ");  // NOLINT(runtime/printf)
      strcat(msg, Safe::utoa(pthread_self()));  // NOLINT(runtime/printf)
      strcat(msg, ", pid ");  // NOLINT(runtime/printf)
      strcat(msg, Safe::itoa(getppid()));  // NOLINT(runtime/printf)
      strcat(msg, ")");  // NOLINT(runtime/printf)
    }
    Safe::print2stderr(msg);
  }

  Safe::print2stderr("\nStack trace:\n");
  void *trace[frames_count_ + 2];
  int trace_size;
#if defined(MALLOC_HOOK_DEPRECATED)
  {
    g_malloc_hook_active = 1;
	trace_size = backtrace(trace, frames_count_ + 2);
	g_malloc_hook_active = 0;
  }
#else
  // Workaround malloc() inside backtrace()
  {
    void* (*oldMallocHook)(size_t, const void*) = __malloc_hook;
    void (*oldFreeHook)(void *, const void *) = __free_hook;
    __malloc_hook = MallocHook;
    __free_hook = NULL;
    trace_size = backtrace(trace, frames_count_ + 2);
    __malloc_hook = oldMallocHook;
    __free_hook = oldFreeHook;
  }
#endif
  if (trace_size <= 2) {
    struct sigaction sa;
    sigaction(SIGABRT, NULL, &sa);
    sa.sa_handler = SIG_DFL;
    sigaction(SIGABRT, &sa, NULL);
    abort();
  }

  // Overwrite sigaction with caller's address
#if defined(__arm__)
  trace[1] = reinterpret_cast<void *>(uc->uc_mcontext.arm_pc);
#else
#if !defined(__i386__) && !defined(__x86_64__)
#error Only ARM, x86 and x86-64 are supported
#endif
#if defined(__x86_64__)
  trace[1] = reinterpret_cast<void *>(uc->uc_mcontext.gregs[REG_RIP]);
#else
  trace[1] = reinterpret_cast<void *>(uc->uc_mcontext.gregs[REG_EIP]);
#endif
#endif

  char name_buf[kMaxPathLength];
  name_buf[readlink("/proc/self/exe", name_buf, sizeof(name_buf) - 1)] = 0;
  char cwd[kMaxPathLength];
  assert(getcwd(cwd, sizeof(cwd)) != NULL);
  assert(static_cast<size_t>(strlen(cwd)) < sizeof(cwd) - 1);
  strcat(cwd, "/");  // NOLINT(runtime/printf)

  int stackOffset = trace[2] == trace[1]? 2 : 1;
  for (int i = stackOffset; i < trace_size; i++) {
    char *line;
    Dl_info dlinf;
    if (dladdr(trace[i], &dlinf) == 0 ||
        dlinf.dli_fname[0] != '/' ||
        !strcmp(name_buf, dlinf.dli_fname)) {
      line = addr2line(name_buf, trace[i]);
    } else {
      line = addr2line(dlinf.dli_fname, reinterpret_cast<void *>(
          reinterpret_cast<char *>(trace[i]) -
          reinterpret_cast<char *>(dlinf.dli_fbase)));
    }

    char *functionNameEnd = strstr(line, "\n");
    if (functionNameEnd != NULL) {
      *functionNameEnd = 0;
      {
        // "\033[34;1m[%s]\033[0m \033[33;1m(%i)\033[0m\n
        static char msg[512];
        msg[0] = 0;
        if (color_output_) {
          strcpy(msg, "\033[34;1m");  // NOLINT(runtime/printf)
        }
        strcat(msg, "[");  // NOLINT(runtime/printf)
        strcat(msg, line);  // NOLINT(runtime/printf)
        strcat(msg, "]");  // NOLINT(runtime/printf)
        if (append_pid_) {
          if (color_output_) {
            strcat(msg, "\033[0m\033[33;1m");  // NOLINT(runtime/printf)
          }
          strcat(msg, " (");  // NOLINT(runtime/printf)
          strcat(msg, Safe::itoa(getppid()));  // NOLINT(runtime/printf)
          strcat(msg, ")");  // NOLINT(runtime/printf)
          if (color_output_) {
            strcat(msg, "\033[0m");  // NOLINT(runtime/printf)
          }
          strcat(msg, "\n");  // NOLINT(runtime/printf)
        } else {
          if (color_output_) {
            strcat(msg, "\033[0m");  // NOLINT(runtime/printf)
          }
          strcat(msg, "\n");  // NOLINT(runtime/printf)
        }
        Safe::print2stderr(msg);
      }
      line = functionNameEnd + 1;

      // Remove the common path root
      if (cut_common_path_root_) {
        int cpi;
        for (cpi = 0; cwd[cpi] == line[cpi]; cpi++) {};
        if (line[cpi - 1] != '/') {
          for (; line[cpi - 1] != '/'; cpi--) {};
        }
        if (cpi > 1) {
          line = line + cpi;
        }
      }

      // Remove relative path root
      if (cut_relative_paths_) {
        char *pathCutPos = strstr(line, "../");
        if (pathCutPos != NULL) {
          pathCutPos += 3;
          while (!strncmp(pathCutPos, "../", 3)) {
            pathCutPos += 3;
          }
          line = pathCutPos;
        }
      }

      // Mark line number
      if (color_output_) {
        char* numberPos = strstr(line, ":");
        if (numberPos != NULL) {
          static char lineNumber[128];
          strcpy(lineNumber, numberPos);  // NOLINT(runtime/printf)
          // Overwrite the new line char
          lineNumber[strlen(lineNumber) - 1] = 0;
          // \033[32;1m%s\033[0m\n
          strcpy(numberPos, "\033[32;1m");  // NOLINT(runtime/printf)
          strcat(line, lineNumber);  // NOLINT(runtime/printf)
          strcat(line, "\033[0m\n");  // NOLINT(runtime/printf)
        }
      }
    }

    // Overwrite the new line char
    line[strlen(line) - 1] = 0;

    // Append pid
    if (append_pid_) {
      // %s\033[33;1m(%i)\033[0m\n
      strcat(line, " ");  // NOLINT(runtime/printf)
      if (color_output_) {
        strcat(line, "\033[33;1m");  // NOLINT(runtime/printf)
      }
      strcat(line, "(");  // NOLINT(runtime/printf)
      strcat(line, Safe::itoa(getppid()));  // NOLINT(runtime/printf)
      strcat(line, ")");  // NOLINT(runtime/printf)
      if (color_output_) {
        strcat(line, "\033[0m");  // NOLINT(runtime/printf)
      }
    }

    strcat(line, "\n");  // NOLINT(runtime/printf)
    Safe::print2stderr(line);
  }

  if (thread_safe_) {
    // Resume the parent process
    kill(getppid(), SIGCONT);
  }

  // This is called in the child process
  _Exit(EXIT_SUCCESS);
}

#if __GNUC__ >= 4 && __GNUC_MINOR__ >= 6
#pragma GCC diagnostic pop
#endif

}  // namespace Debug

#if defined(MALLOC_HOOK_DEPRECATED)
#undef MALLOC_HOOK_DEPRECATED
#endif