thread.hpp

Go to the documentation of this file.

/*
 * Copyright (C) 2015 Hamburg University of Applied Sciences (HAW)
 *
 * This file is subject to the terms and conditions of the GNU Lesser
 * General Public License v2.1. See the file LICENSE in the top level
 * directory for more details.
 */

 
#ifndef RIOT_THREAD_HPP
#define RIOT_THREAD_HPP
 
#include "time.h"
#include "thread.h"
 
#include <array>
#include <tuple>
#include <atomic>
#include <memory>
#include <utility>
#include <exception>
#include <stdexcept>
#include <functional>
#include <type_traits>
 
#include "riot/mutex.hpp"
#include "riot/chrono.hpp"
#include "riot/condition_variable.hpp"
 
#include "riot/detail/thread_util.hpp"
 
namespace riot {

struct thread_data {
  thread_data() : ref_count{2}, joining_thread{KERNEL_PID_UNDEF} {
    // nop
  }
  std::atomic<unsigned> ref_count;
  kernel_pid_t joining_thread;
  std::array<char, THREAD_STACKSIZE_MAIN> stack;
};

struct thread_data_deleter {
  void operator()(thread_data* ptr) {
    if (--ptr->ref_count == 0) {
      delete ptr;
    }
  }
};

class thread_id {
  template <class T, class Traits>
  friend std::basic_ostream<T, Traits>& operator<<(std::basic_ostream
                                                   <T, Traits>& out,
                                                   thread_id id);
  friend class thread;
 
public:
  inline thread_id() noexcept : m_handle{KERNEL_PID_UNDEF} {}
  explicit inline thread_id(kernel_pid_t handle) : m_handle{handle} {}

  inline bool operator==(thread_id other) noexcept {
    return m_handle == other.m_handle;
  }

  inline bool operator!=(thread_id other) noexcept {
    return !(m_handle == other.m_handle);
  }

  inline bool operator<(thread_id other) noexcept {
    return m_handle < other.m_handle;
  }

  inline bool operator<=(thread_id other) noexcept {
    return !(m_handle > other.m_handle);
  }

  inline bool operator>(thread_id other) noexcept {
    return m_handle > other.m_handle;
  }

  inline bool operator>=(thread_id other) noexcept {
    return !(m_handle < other.m_handle);
  }
 
private:
  kernel_pid_t m_handle;
};

template <class T, class Traits>
inline std::basic_ostream<T, Traits>& operator<<(std::basic_ostream
                                                 <T, Traits>& out,
                                                 thread_id id) {
  return out << id.m_handle;
}
 
namespace this_thread {

inline thread_id get_id() noexcept { return thread_id{thread_getpid()}; }
inline void yield() noexcept { thread_yield(); }
void sleep_for(const std::chrono::microseconds& us);
template <class Rep, class Period>
void sleep_for(const std::chrono::duration<Rep, Period>& sleep_duration) {
  using namespace std::chrono;
  if (sleep_duration > sleep_duration.zero()) {
    constexpr duration<long double> max = microseconds::max();
    microseconds us;
    if (sleep_duration < max) {
      us = duration_cast<microseconds>(sleep_duration);
      if (us.count() == 0) {
        // wait at least 1
        us = microseconds(1);
      }
      if (us < sleep_duration) {
        ++us;
      }
    } else {
      us = microseconds::max();
    }
    sleep_for(us);
  }
}

inline void sleep_until(const riot::time_point& sleep_time) {
  mutex mtx;
  condition_variable cv;
  unique_lock<mutex> lk(mtx);
  while (riot::now() < sleep_time) {
    cv.wait_until(lk, sleep_time);
  }
}
} // namespace this_thread

class thread {
public:
  using id = thread_id;
  using native_handle_type = kernel_pid_t;

  inline thread() noexcept : m_handle{KERNEL_PID_UNDEF} {}
  template <class F, class... Args>
  explicit thread(F&& f, Args&&... args);

  thread(const thread&) = delete;

  inline thread(thread&& t) noexcept : m_handle{t.m_handle} {
    t.m_handle = KERNEL_PID_UNDEF;
    std::swap(m_data, t.m_data);
  }
 
  ~thread();

  thread& operator=(const thread&) = delete;

  thread& operator=(thread&&) noexcept;

  void swap(thread& t) noexcept {
    std::swap(m_data, t.m_data);
    std::swap(m_handle, t.m_handle);
  }

  inline bool joinable() const noexcept {
    return m_handle != KERNEL_PID_UNDEF;
  }

  void join();
  void detach();
  inline id get_id() const noexcept { return thread_id{m_handle}; }
  inline native_handle_type native_handle() noexcept { return m_handle; }

  static unsigned hardware_concurrency() noexcept;
 
private:
  kernel_pid_t m_handle;
  std::unique_ptr<thread_data, thread_data_deleter> m_data;
};

void swap(thread& lhs, thread& rhs) noexcept;

template <class Tuple>
void* thread_proxy(void* vp) {
  { // without this scope, the objects here are not cleaned up correctly
    std::unique_ptr<Tuple> p(static_cast<Tuple*>(vp));
    auto tmp = std::get<0>(*p);
    std::unique_ptr<thread_data, thread_data_deleter> data{tmp};
    // create indices for the arguments, 0 is thread_data and 1 is the function
    auto indices = detail::get_indices<std::tuple_size<Tuple>::value, 2>();
    try {
      detail::apply_args(std::get<1>(*p), indices, *p);
    }
    catch (...) {
      // nop
    }
    if (data->joining_thread != KERNEL_PID_UNDEF) {
      thread_wakeup(data->joining_thread);
    }
  }
  // some riot cleanup code
  sched_task_exit();
  return nullptr;
}
 
template <class F, class... Args>
thread::thread(F&& f, Args&&... args) : m_data{new thread_data} {
  using namespace std;
  using func_and_args = tuple
    <thread_data*, typename decay<F>::type, typename decay<Args>::type...>;
  unique_ptr<func_and_args> p(
    new func_and_args(m_data.get(), std::forward<F>(f), std::forward<Args>(args)...));
  m_handle = thread_create(
    m_data->stack.data(), m_data->stack.size(), THREAD_PRIORITY_MAIN - 1, 0,
    &thread_proxy<func_and_args>, p.get(), "riot_cpp_thread");
  if (m_handle >= 0) {
    p.release();
  } else {
    throw std::system_error(
      std::make_error_code(std::errc::resource_unavailable_try_again),
        "Failed to create thread.");
  }
}
 
inline thread& thread::operator=(thread&& other) noexcept {
  if (m_handle != KERNEL_PID_UNDEF) {
    std::terminate();
  }
  m_handle = other.m_handle;
  other.m_handle = KERNEL_PID_UNDEF;
  std::swap(m_data, other.m_data);
  return *this;
}
 
inline void swap(thread& lhs, thread& rhs) noexcept { lhs.swap(rhs); }
 
} // namespace riot
 
#endif // RIOT_THREAD_HPP