| 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); | 
| Yi Kong | 32bc0fc | 2018-08-02 17:31:13 -0700 | [diff] [blame] | 95 |       return nullptr; | 
| Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 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))); | 
| Yi Kong | 32bc0fc | 2018-08-02 17:31:13 -0700 | [diff] [blame] | 108 |   if (timer == nullptr) { | 
| Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 109 |     return -1; | 
 | 110 |   } | 
 | 111 |  | 
| Yi Kong | 32bc0fc | 2018-08-02 17:31:13 -0700 | [diff] [blame] | 112 |   timer->sigev_notify = (evp == nullptr) ? 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. | 
| Yi Kong | 32bc0fc | 2018-08-02 17:31:13 -0700 | [diff] [blame] | 131 |   if (timer->callback == nullptr) { | 
| Elliott Hughes | 473d067 | 2014-04-01 19:07:52 -0700 | [diff] [blame] | 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; | 
| Yi Kong | 32bc0fc | 2018-08-02 17:31:13 -0700 | [diff] [blame] | 139 |   if (evp->sigev_notify_attributes == nullptr) { | 
| Elliott Hughes | 4b558f5 | 2014-03-04 15:58:02 -0800 | [diff] [blame] | 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 |  | 
| Elliott Hughes | 48a6974 | 2018-03-20 17:58:11 -0700 | [diff] [blame] | 157 |   __rt_sigprocmask(SIG_SETMASK, &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 | } |