mirror of https://github.com/PentHertz/srsLTE.git
152 lines
3.8 KiB
C++
152 lines
3.8 KiB
C++
/**
|
|
*
|
|
* \section COPYRIGHT
|
|
*
|
|
* Copyright 2013-2015 Software Radio Systems Limited
|
|
*
|
|
* \section LICENSE
|
|
*
|
|
* This file is part of the srsUE library.
|
|
*
|
|
* srsUE is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Affero General Public License as
|
|
* published by the Free Software Foundation, either version 3 of
|
|
* the License, or (at your option) any later version.
|
|
*
|
|
* srsUE is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU Affero General Public License for more details.
|
|
*
|
|
* A copy of the GNU Affero General Public License can be found in
|
|
* the LICENSE file in the top-level directory of this distribution
|
|
* and at http://www.gnu.org/licenses/.
|
|
*
|
|
*/
|
|
|
|
#include <pthread.h>
|
|
#include <stdint.h>
|
|
#include <sys/timerfd.h>
|
|
#include <unistd.h>
|
|
#include <stdio.h>
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif // __cplusplus
|
|
|
|
bool threads_new_rt(pthread_t *thread, void *(*start_routine) (void*), void *arg);
|
|
bool threads_new_rt_prio(pthread_t *thread, void *(*start_routine) (void*), void *arg, int prio_offset);
|
|
bool threads_new_rt_cpu(pthread_t *thread, void *(*start_routine) (void*), void *arg, int cpu, int prio_offset);
|
|
bool threads_new_rt_mask(pthread_t *thread, void *(*start_routine) (void*), void *arg, int mask, int prio_offset);
|
|
void threads_print_self();
|
|
|
|
#ifdef __cplusplus
|
|
}
|
|
|
|
#ifndef THREADS_
|
|
#define THREADS_
|
|
|
|
class thread
|
|
{
|
|
public:
|
|
bool start(int prio = -1) {
|
|
return threads_new_rt_prio(&_thread, thread_function_entry, this, prio);
|
|
}
|
|
bool start_cpu(int prio, int cpu) {
|
|
return threads_new_rt_cpu(&_thread, thread_function_entry, this, cpu, prio);
|
|
}
|
|
bool start_cpu_mask(int prio, int mask){
|
|
return threads_new_rt_mask(&_thread, thread_function_entry, this, mask, prio);
|
|
}
|
|
void print_priority() {
|
|
threads_print_self();
|
|
}
|
|
void wait_thread_finish() {
|
|
pthread_join(_thread, NULL);
|
|
}
|
|
void thread_cancel() {
|
|
pthread_cancel(_thread);
|
|
}
|
|
protected:
|
|
virtual void run_thread() = 0;
|
|
private:
|
|
static void *thread_function_entry(void *_this) { ((thread*) _this)->run_thread(); return NULL; }
|
|
pthread_t _thread;
|
|
};
|
|
|
|
class periodic_thread : public thread
|
|
{
|
|
public:
|
|
void start_periodic(int period_us_, int priority = -1) {
|
|
period_us = period_us_;
|
|
start(priority);
|
|
}
|
|
protected:
|
|
virtual void run_period() = 0;
|
|
private:
|
|
int wakeups_missed;
|
|
int timer_fd;
|
|
int period_us;
|
|
void run_thread() {
|
|
if (make_periodic()) {
|
|
return;
|
|
}
|
|
while(1) {
|
|
run_period();
|
|
wait_period();
|
|
}
|
|
}
|
|
int make_periodic() {
|
|
int ret = -1;
|
|
unsigned int ns;
|
|
unsigned int sec;
|
|
struct itimerspec itval;
|
|
|
|
/* Create the timer */
|
|
ret = timerfd_create (CLOCK_MONOTONIC, 0);
|
|
wakeups_missed = 0;
|
|
timer_fd = ret;
|
|
if (ret > 0) {
|
|
/* Make the timer periodic */
|
|
sec = period_us/1e6;
|
|
ns = (period_us - (sec * 1000000)) * 1000;
|
|
itval.it_interval.tv_sec = sec;
|
|
itval.it_interval.tv_nsec = ns;
|
|
itval.it_value.tv_sec = sec;
|
|
itval.it_value.tv_nsec = ns;
|
|
ret = timerfd_settime (timer_fd, 0, &itval, NULL);
|
|
if (ret < 0) {
|
|
perror("timerfd_settime");
|
|
}
|
|
} else {
|
|
perror("timerfd_create");
|
|
}
|
|
return ret;
|
|
}
|
|
void wait_period() {
|
|
unsigned long long missed;
|
|
int ret;
|
|
|
|
/* Wait for the next timer event. If we have missed any the
|
|
number is written to "missed" */
|
|
ret = read (timer_fd, &missed, sizeof (missed));
|
|
if (ret == -1)
|
|
{
|
|
perror ("read timer");
|
|
return;
|
|
}
|
|
|
|
/* "missed" should always be >= 1, but just to be sure, check it is not 0 anyway */
|
|
if (missed > 0) {
|
|
wakeups_missed += (missed - 1);
|
|
}
|
|
}
|
|
};
|
|
|
|
|
|
|
|
#endif // THREADS_
|
|
|
|
#endif // __cplusplus
|
|
|