2014-03-05 00:58:02 +01:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2008 The Android Open Source Project
|
|
|
|
* All rights reserved.
|
|
|
|
*
|
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
|
|
* modification, are permitted provided that the following conditions
|
|
|
|
* are met:
|
|
|
|
* * Redistributions of source code must retain the above copyright
|
|
|
|
* notice, this list of conditions and the following disclaimer.
|
|
|
|
* * 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.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <errno.h>
|
2015-01-29 03:02:33 +01:00
|
|
|
#include <malloc.h>
|
2015-01-14 04:53:15 +01:00
|
|
|
#include <pthread.h>
|
|
|
|
#include <stdatomic.h>
|
2014-03-05 00:58:02 +01:00
|
|
|
#include <stdio.h>
|
|
|
|
#include <string.h>
|
2015-01-14 04:53:15 +01:00
|
|
|
#include <time.h>
|
2014-03-05 00:58:02 +01:00
|
|
|
|
|
|
|
// System calls.
|
2018-02-09 22:38:32 +01:00
|
|
|
extern "C" int __rt_sigprocmask(int, const sigset64_t*, sigset64_t*, size_t);
|
|
|
|
extern "C" int __rt_sigtimedwait(const sigset64_t*, siginfo_t*, const timespec*, size_t);
|
2014-03-05 00:58:02 +01:00
|
|
|
extern "C" int __timer_create(clockid_t, sigevent*, __kernel_timer_t*);
|
|
|
|
extern "C" int __timer_delete(__kernel_timer_t);
|
|
|
|
extern "C" int __timer_getoverrun(__kernel_timer_t);
|
|
|
|
extern "C" int __timer_gettime(__kernel_timer_t, itimerspec*);
|
|
|
|
extern "C" int __timer_settime(__kernel_timer_t, int, const itimerspec*, itimerspec*);
|
|
|
|
|
|
|
|
// Most POSIX timers are handled directly by the kernel. We translate SIGEV_THREAD timers
|
|
|
|
// into SIGEV_THREAD_ID timers so the kernel handles all the time-related stuff and we just
|
|
|
|
// need to worry about running user code on a thread.
|
|
|
|
|
|
|
|
// We can't use SIGALRM because too many other C library functions throw that around, and since
|
|
|
|
// they don't send to a specific thread, all threads are eligible to handle the signal and we can
|
|
|
|
// end up with one of our POSIX timer threads handling it (meaning that the intended recipient
|
|
|
|
// doesn't). glibc uses SIGRTMIN for its POSIX timer implementation, so in the absence of any
|
|
|
|
// reason to use anything else, we use that too.
|
2014-04-30 18:45:40 +02:00
|
|
|
static const int TIMER_SIGNAL = (__SIGRTMIN + 0);
|
2014-03-05 00:58:02 +01:00
|
|
|
|
|
|
|
struct PosixTimer {
|
|
|
|
__kernel_timer_t kernel_timer_id;
|
|
|
|
|
|
|
|
int sigev_notify;
|
|
|
|
|
2015-01-14 04:53:15 +01:00
|
|
|
// The fields below are only needed for a SIGEV_THREAD timer.
|
2014-03-05 00:58:02 +01:00
|
|
|
pthread_t callback_thread;
|
|
|
|
void (*callback)(sigval_t);
|
|
|
|
sigval_t callback_argument;
|
2015-01-14 04:53:15 +01:00
|
|
|
atomic_bool deleted; // Set when the timer is deleted, to prevent further calling of callback.
|
2014-03-05 00:58:02 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
static __kernel_timer_t to_kernel_timer_id(timer_t timer) {
|
|
|
|
return reinterpret_cast<PosixTimer*>(timer)->kernel_timer_id;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void* __timer_thread_start(void* arg) {
|
|
|
|
PosixTimer* timer = reinterpret_cast<PosixTimer*>(arg);
|
|
|
|
|
2018-01-31 00:09:51 +01:00
|
|
|
sigset64_t sigset = {};
|
|
|
|
sigaddset64(&sigset, TIMER_SIGNAL);
|
2014-03-05 00:58:02 +01:00
|
|
|
|
|
|
|
while (true) {
|
|
|
|
// Wait for a signal...
|
2018-01-31 00:09:51 +01:00
|
|
|
siginfo_t si = {};
|
2018-02-09 22:38:32 +01:00
|
|
|
if (__rt_sigtimedwait(&sigset, &si, nullptr, sizeof(sigset)) == -1) continue;
|
2014-03-05 00:58:02 +01:00
|
|
|
|
2015-01-14 04:53:15 +01:00
|
|
|
if (si.si_code == SI_TIMER) {
|
2014-03-05 00:58:02 +01:00
|
|
|
// This signal was sent because a timer fired, so call the callback.
|
2015-01-14 04:53:15 +01:00
|
|
|
|
|
|
|
// All events to the callback will be ignored when the timer is deleted.
|
|
|
|
if (atomic_load(&timer->deleted) == true) {
|
|
|
|
continue;
|
|
|
|
}
|
2014-03-05 00:58:02 +01:00
|
|
|
timer->callback(timer->callback_argument);
|
|
|
|
} else if (si.si_code == SI_TKILL) {
|
|
|
|
// This signal was sent because someone wants us to exit.
|
2014-04-02 04:07:52 +02:00
|
|
|
free(timer);
|
2014-03-05 00:58:02 +01:00
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __timer_thread_stop(PosixTimer* timer) {
|
2015-01-14 04:53:15 +01:00
|
|
|
atomic_store(&timer->deleted, true);
|
2014-03-05 00:58:02 +01:00
|
|
|
pthread_kill(timer->callback_thread, TIMER_SIGNAL);
|
|
|
|
}
|
|
|
|
|
|
|
|
// http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_create.html
|
|
|
|
int timer_create(clockid_t clock_id, sigevent* evp, timer_t* timer_id) {
|
2014-04-02 04:07:52 +02:00
|
|
|
PosixTimer* timer = reinterpret_cast<PosixTimer*>(malloc(sizeof(PosixTimer)));
|
|
|
|
if (timer == NULL) {
|
2014-03-05 00:58:02 +01:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2014-04-02 04:07:52 +02:00
|
|
|
timer->sigev_notify = (evp == NULL) ? SIGEV_SIGNAL : evp->sigev_notify;
|
2014-03-05 00:58:02 +01:00
|
|
|
|
|
|
|
// If not a SIGEV_THREAD timer, the kernel can handle it without our help.
|
2014-04-02 04:07:52 +02:00
|
|
|
if (timer->sigev_notify != SIGEV_THREAD) {
|
|
|
|
if (__timer_create(clock_id, evp, &timer->kernel_timer_id) == -1) {
|
|
|
|
free(timer);
|
2014-03-05 00:58:02 +01:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2014-04-02 04:07:52 +02:00
|
|
|
*timer_id = timer;
|
2014-03-05 00:58:02 +01:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Otherwise, this must be SIGEV_THREAD timer...
|
2014-04-02 04:07:52 +02:00
|
|
|
timer->callback = evp->sigev_notify_function;
|
|
|
|
timer->callback_argument = evp->sigev_value;
|
2015-01-14 04:53:15 +01:00
|
|
|
atomic_init(&timer->deleted, false);
|
2014-03-05 00:58:02 +01:00
|
|
|
|
|
|
|
// Check arguments that the kernel doesn't care about but we do.
|
2014-04-02 04:07:52 +02:00
|
|
|
if (timer->callback == NULL) {
|
|
|
|
free(timer);
|
2014-03-05 00:58:02 +01:00
|
|
|
errno = EINVAL;
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Create this timer's thread.
|
|
|
|
pthread_attr_t thread_attributes;
|
|
|
|
if (evp->sigev_notify_attributes == NULL) {
|
|
|
|
pthread_attr_init(&thread_attributes);
|
|
|
|
} else {
|
|
|
|
thread_attributes = *reinterpret_cast<pthread_attr_t*>(evp->sigev_notify_attributes);
|
|
|
|
}
|
|
|
|
pthread_attr_setdetachstate(&thread_attributes, PTHREAD_CREATE_DETACHED);
|
|
|
|
|
|
|
|
// We start the thread with TIMER_SIGNAL blocked by blocking the signal here and letting it
|
|
|
|
// inherit. If it tried to block the signal itself, there would be a race.
|
2018-01-31 00:09:51 +01:00
|
|
|
sigset64_t sigset = {};
|
|
|
|
sigaddset64(&sigset, TIMER_SIGNAL);
|
|
|
|
sigset64_t old_sigset;
|
2018-02-09 22:38:32 +01:00
|
|
|
|
|
|
|
// Use __rt_sigprocmask instead of sigprocmask64 to avoid filtering out TIMER_SIGNAL.
|
|
|
|
__rt_sigprocmask(SIG_BLOCK, &sigset, &old_sigset, sizeof(sigset));
|
2014-03-05 00:58:02 +01:00
|
|
|
|
2014-04-02 04:07:52 +02:00
|
|
|
int rc = pthread_create(&timer->callback_thread, &thread_attributes, __timer_thread_start, timer);
|
2014-03-05 00:58:02 +01:00
|
|
|
|
2018-03-21 01:58:11 +01:00
|
|
|
__rt_sigprocmask(SIG_SETMASK, &old_sigset, nullptr, sizeof(old_sigset));
|
2014-03-05 00:58:02 +01:00
|
|
|
|
|
|
|
if (rc != 0) {
|
2014-04-02 04:07:52 +02:00
|
|
|
free(timer);
|
2014-03-05 00:58:02 +01:00
|
|
|
errno = rc;
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
sigevent se = *evp;
|
|
|
|
se.sigev_signo = TIMER_SIGNAL;
|
|
|
|
se.sigev_notify = SIGEV_THREAD_ID;
|
2014-09-12 01:11:43 +02:00
|
|
|
se.sigev_notify_thread_id = pthread_gettid_np(timer->callback_thread);
|
2014-04-02 04:07:52 +02:00
|
|
|
if (__timer_create(clock_id, &se, &timer->kernel_timer_id) == -1) {
|
|
|
|
__timer_thread_stop(timer);
|
2014-03-05 00:58:02 +01:00
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2015-04-25 19:05:24 +02:00
|
|
|
// Give the thread a specific meaningful name.
|
2014-03-05 00:58:02 +01:00
|
|
|
// It can't do this itself because the kernel timer isn't created until after it's running.
|
2015-04-25 19:05:24 +02:00
|
|
|
char name[16]; // 16 is the kernel-imposed limit.
|
|
|
|
snprintf(name, sizeof(name), "POSIX timer %d", to_kernel_timer_id(timer));
|
2014-04-02 04:07:52 +02:00
|
|
|
pthread_setname_np(timer->callback_thread, name);
|
2014-03-05 00:58:02 +01:00
|
|
|
|
2014-04-02 04:07:52 +02:00
|
|
|
*timer_id = timer;
|
2014-03-05 00:58:02 +01:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
// http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_delete.html
|
|
|
|
int timer_delete(timer_t id) {
|
|
|
|
int rc = __timer_delete(to_kernel_timer_id(id));
|
|
|
|
if (rc == -1) {
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
PosixTimer* timer = reinterpret_cast<PosixTimer*>(id);
|
|
|
|
if (timer->sigev_notify == SIGEV_THREAD) {
|
2014-04-02 04:07:52 +02:00
|
|
|
// Stopping the timer's thread frees the timer data when it's safe.
|
2014-03-05 00:58:02 +01:00
|
|
|
__timer_thread_stop(timer);
|
2014-04-02 04:07:52 +02:00
|
|
|
} else {
|
|
|
|
// For timers without threads, we can just free right away.
|
|
|
|
free(timer);
|
2014-03-05 00:58:02 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-01-14 04:53:15 +01:00
|
|
|
// http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_gettime.html
|
2014-03-05 00:58:02 +01:00
|
|
|
int timer_gettime(timer_t id, itimerspec* ts) {
|
|
|
|
return __timer_gettime(to_kernel_timer_id(id), ts);
|
|
|
|
}
|
|
|
|
|
2015-01-14 04:53:15 +01:00
|
|
|
// http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_settime.html
|
|
|
|
// When using timer_settime to disarm a repeatable SIGEV_THREAD timer with a very small
|
|
|
|
// period (like below 1ms), the kernel may continue to send events to the callback thread
|
|
|
|
// for a few extra times. This behavior is fine because in POSIX standard: The effect of
|
|
|
|
// disarming or resetting a timer with pending expiration notifications is unspecified.
|
2014-03-05 00:58:02 +01:00
|
|
|
int timer_settime(timer_t id, int flags, const itimerspec* ts, itimerspec* ots) {
|
2014-10-21 04:09:19 +02:00
|
|
|
PosixTimer* timer= reinterpret_cast<PosixTimer*>(id);
|
2015-01-14 04:53:15 +01:00
|
|
|
return __timer_settime(timer->kernel_timer_id, flags, ts, ots);
|
2014-03-05 00:58:02 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
// http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_getoverrun.html
|
|
|
|
int timer_getoverrun(timer_t id) {
|
|
|
|
return __timer_getoverrun(to_kernel_timer_id(id));
|
|
|
|
}
|