Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2008 The Android Open Source Project |
| 3 | * All rights reserved. |
| 4 | * |
| 5 | * Redistribution and use in source and binary forms, with or without |
| 6 | * modification, are permitted provided that the following conditions |
| 7 | * are met: |
| 8 | * * Redistributions of source code must retain the above copyright |
| 9 | * notice, this list of conditions and the following disclaimer. |
| 10 | * * Redistributions in binary form must reproduce the above copyright |
| 11 | * notice, this list of conditions and the following disclaimer in |
| 12 | * the documentation and/or other materials provided with the |
| 13 | * distribution. |
| 14 | * |
| 15 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| 16 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| 17 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| 18 | * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| 19 | * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| 20 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| 21 | * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS |
| 22 | * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
| 23 | * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| 24 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT |
| 25 | * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| 26 | * SUCH DAMAGE. |
| 27 | */ |
| 28 | |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 29 | #include <errno.h> |
Elliott Hughes | 05fc1d7 | 2015-01-28 18:02:33 -0800 | [diff] [blame] | 30 | #include <malloc.h> |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 31 | #include <pthread.h> |
| 32 | #include <stdatomic.h> |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 33 | #include <stdio.h> |
| 34 | #include <string.h> |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 35 | #include <time.h> |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 36 | |
| 37 | // System calls. |
Josh Gao | 6fcba93 | 2018-02-09 13:38:32 -0800 | [diff] [blame^] | 38 | extern "C" int __rt_sigprocmask(int, const sigset64_t*, sigset64_t*, size_t); |
| 39 | extern "C" int __rt_sigtimedwait(const sigset64_t*, siginfo_t*, const timespec*, size_t); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 40 | extern "C" int __timer_create(clockid_t, sigevent*, __kernel_timer_t*); |
| 41 | extern "C" int __timer_delete(__kernel_timer_t); |
| 42 | extern "C" int __timer_getoverrun(__kernel_timer_t); |
| 43 | extern "C" int __timer_gettime(__kernel_timer_t, itimerspec*); |
| 44 | extern "C" int __timer_settime(__kernel_timer_t, int, const itimerspec*, itimerspec*); |
| 45 | |
| 46 | // Most POSIX timers are handled directly by the kernel. We translate SIGEV_THREAD timers |
| 47 | // into SIGEV_THREAD_ID timers so the kernel handles all the time-related stuff and we just |
| 48 | // need to worry about running user code on a thread. |
| 49 | |
| 50 | // We can't use SIGALRM because too many other C library functions throw that around, and since |
| 51 | // they don't send to a specific thread, all threads are eligible to handle the signal and we can |
| 52 | // end up with one of our POSIX timer threads handling it (meaning that the intended recipient |
| 53 | // doesn't). glibc uses SIGRTMIN for its POSIX timer implementation, so in the absence of any |
| 54 | // reason to use anything else, we use that too. |
Elliott Hughes | 0990d4f | 2014-04-30 09:45:40 -0700 | [diff] [blame] | 55 | static const int TIMER_SIGNAL = (__SIGRTMIN + 0); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 56 | |
| 57 | struct PosixTimer { |
| 58 | __kernel_timer_t kernel_timer_id; |
| 59 | |
| 60 | int sigev_notify; |
| 61 | |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 62 | // The fields below are only needed for a SIGEV_THREAD timer. |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 63 | pthread_t callback_thread; |
| 64 | void (*callback)(sigval_t); |
| 65 | sigval_t callback_argument; |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 66 | atomic_bool deleted; // Set when the timer is deleted, to prevent further calling of callback. |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 67 | }; |
| 68 | |
| 69 | static __kernel_timer_t to_kernel_timer_id(timer_t timer) { |
| 70 | return reinterpret_cast<PosixTimer*>(timer)->kernel_timer_id; |
| 71 | } |
| 72 | |
| 73 | static void* __timer_thread_start(void* arg) { |
| 74 | PosixTimer* timer = reinterpret_cast<PosixTimer*>(arg); |
| 75 | |
Elliott Hughes | 5905d6f | 2018-01-30 15:09:51 -0800 | [diff] [blame] | 76 | sigset64_t sigset = {}; |
| 77 | sigaddset64(&sigset, TIMER_SIGNAL); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 78 | |
| 79 | while (true) { |
| 80 | // Wait for a signal... |
Elliott Hughes | 5905d6f | 2018-01-30 15:09:51 -0800 | [diff] [blame] | 81 | siginfo_t si = {}; |
Josh Gao | 6fcba93 | 2018-02-09 13:38:32 -0800 | [diff] [blame^] | 82 | if (__rt_sigtimedwait(&sigset, &si, nullptr, sizeof(sigset)) == -1) continue; |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 83 | |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 84 | if (si.si_code == SI_TIMER) { |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 85 | // This signal was sent because a timer fired, so call the callback. |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 86 | |
| 87 | // All events to the callback will be ignored when the timer is deleted. |
| 88 | if (atomic_load(&timer->deleted) == true) { |
| 89 | continue; |
| 90 | } |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 91 | timer->callback(timer->callback_argument); |
| 92 | } else if (si.si_code == SI_TKILL) { |
| 93 | // This signal was sent because someone wants us to exit. |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 94 | free(timer); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 95 | return NULL; |
| 96 | } |
| 97 | } |
| 98 | } |
| 99 | |
| 100 | static void __timer_thread_stop(PosixTimer* timer) { |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 101 | atomic_store(&timer->deleted, true); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 102 | pthread_kill(timer->callback_thread, TIMER_SIGNAL); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 103 | } |
| 104 | |
| 105 | // http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_create.html |
| 106 | int timer_create(clockid_t clock_id, sigevent* evp, timer_t* timer_id) { |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 107 | PosixTimer* timer = reinterpret_cast<PosixTimer*>(malloc(sizeof(PosixTimer))); |
| 108 | if (timer == NULL) { |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 109 | return -1; |
| 110 | } |
| 111 | |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 112 | timer->sigev_notify = (evp == NULL) ? SIGEV_SIGNAL : evp->sigev_notify; |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 113 | |
| 114 | // If not a SIGEV_THREAD timer, the kernel can handle it without our help. |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 115 | if (timer->sigev_notify != SIGEV_THREAD) { |
| 116 | if (__timer_create(clock_id, evp, &timer->kernel_timer_id) == -1) { |
| 117 | free(timer); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 118 | return -1; |
| 119 | } |
| 120 | |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 121 | *timer_id = timer; |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 122 | return 0; |
| 123 | } |
| 124 | |
| 125 | // Otherwise, this must be SIGEV_THREAD timer... |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 126 | timer->callback = evp->sigev_notify_function; |
| 127 | timer->callback_argument = evp->sigev_value; |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 128 | atomic_init(&timer->deleted, false); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 129 | |
| 130 | // Check arguments that the kernel doesn't care about but we do. |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 131 | if (timer->callback == NULL) { |
| 132 | free(timer); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 133 | errno = EINVAL; |
| 134 | return -1; |
| 135 | } |
| 136 | |
| 137 | // Create this timer's thread. |
| 138 | pthread_attr_t thread_attributes; |
| 139 | if (evp->sigev_notify_attributes == NULL) { |
| 140 | pthread_attr_init(&thread_attributes); |
| 141 | } else { |
| 142 | thread_attributes = *reinterpret_cast<pthread_attr_t*>(evp->sigev_notify_attributes); |
| 143 | } |
| 144 | pthread_attr_setdetachstate(&thread_attributes, PTHREAD_CREATE_DETACHED); |
| 145 | |
| 146 | // We start the thread with TIMER_SIGNAL blocked by blocking the signal here and letting it |
| 147 | // inherit. If it tried to block the signal itself, there would be a race. |
Elliott Hughes | 5905d6f | 2018-01-30 15:09:51 -0800 | [diff] [blame] | 148 | sigset64_t sigset = {}; |
| 149 | sigaddset64(&sigset, TIMER_SIGNAL); |
| 150 | sigset64_t old_sigset; |
Josh Gao | 6fcba93 | 2018-02-09 13:38:32 -0800 | [diff] [blame^] | 151 | |
| 152 | // Use __rt_sigprocmask instead of sigprocmask64 to avoid filtering out TIMER_SIGNAL. |
| 153 | __rt_sigprocmask(SIG_BLOCK, &sigset, &old_sigset, sizeof(sigset)); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 154 | |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 155 | int rc = pthread_create(&timer->callback_thread, &thread_attributes, __timer_thread_start, timer); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 156 | |
Josh Gao | 6fcba93 | 2018-02-09 13:38:32 -0800 | [diff] [blame^] | 157 | __rt_sigprocmask(SIG_BLOCK, &old_sigset, nullptr, sizeof(old_sigset)); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 158 | |
| 159 | if (rc != 0) { |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 160 | free(timer); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 161 | errno = rc; |
| 162 | return -1; |
| 163 | } |
| 164 | |
| 165 | sigevent se = *evp; |
| 166 | se.sigev_signo = TIMER_SIGNAL; |
| 167 | se.sigev_notify = SIGEV_THREAD_ID; |
Elliott Hughes | a4831cb | 2014-09-11 16:11:43 -0700 | [diff] [blame] | 168 | se.sigev_notify_thread_id = pthread_gettid_np(timer->callback_thread); |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 169 | if (__timer_create(clock_id, &se, &timer->kernel_timer_id) == -1) { |
| 170 | __timer_thread_stop(timer); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 171 | return -1; |
| 172 | } |
| 173 | |
Elliott Hughes | d1aea30 | 2015-04-25 10:05:24 -0700 | [diff] [blame] | 174 | // Give the thread a specific meaningful name. |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 175 | // It can't do this itself because the kernel timer isn't created until after it's running. |
Elliott Hughes | d1aea30 | 2015-04-25 10:05:24 -0700 | [diff] [blame] | 176 | char name[16]; // 16 is the kernel-imposed limit. |
| 177 | snprintf(name, sizeof(name), "POSIX timer %d", to_kernel_timer_id(timer)); |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 178 | pthread_setname_np(timer->callback_thread, name); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 179 | |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 180 | *timer_id = timer; |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 181 | return 0; |
| 182 | } |
| 183 | |
| 184 | // http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_delete.html |
| 185 | int timer_delete(timer_t id) { |
| 186 | int rc = __timer_delete(to_kernel_timer_id(id)); |
| 187 | if (rc == -1) { |
| 188 | return -1; |
| 189 | } |
| 190 | |
| 191 | PosixTimer* timer = reinterpret_cast<PosixTimer*>(id); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 192 | if (timer->sigev_notify == SIGEV_THREAD) { |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 193 | // Stopping the timer's thread frees the timer data when it's safe. |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 194 | __timer_thread_stop(timer); |
Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 195 | } else { |
| 196 | // For timers without threads, we can just free right away. |
| 197 | free(timer); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 198 | } |
| 199 | |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 200 | return 0; |
| 201 | } |
| 202 | |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 203 | // http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_gettime.html |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 204 | int timer_gettime(timer_t id, itimerspec* ts) { |
| 205 | return __timer_gettime(to_kernel_timer_id(id), ts); |
| 206 | } |
| 207 | |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 208 | // http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_settime.html |
| 209 | // When using timer_settime to disarm a repeatable SIGEV_THREAD timer with a very small |
| 210 | // period (like below 1ms), the kernel may continue to send events to the callback thread |
| 211 | // for a few extra times. This behavior is fine because in POSIX standard: The effect of |
| 212 | // disarming or resetting a timer with pending expiration notifications is unspecified. |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 213 | int timer_settime(timer_t id, int flags, const itimerspec* ts, itimerspec* ots) { |
Christopher Ferris | 62d84b1 | 2014-10-20 19:09:19 -0700 | [diff] [blame] | 214 | PosixTimer* timer= reinterpret_cast<PosixTimer*>(id); |
Yabin Cui | 95f1ee2 | 2015-01-13 19:53:15 -0800 | [diff] [blame] | 215 | return __timer_settime(timer->kernel_timer_id, flags, ts, ots); |
Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 216 | } |
| 217 | |
| 218 | // http://pubs.opengroup.org/onlinepubs/9699919799/functions/timer_getoverrun.html |
| 219 | int timer_getoverrun(timer_t id) { |
| 220 | return __timer_getoverrun(to_kernel_timer_id(id)); |
| 221 | } |