1*0f4c859eSApple OSS Distributions /*
2*0f4c859eSApple OSS Distributions * Copyright (c) 2004-2021 Apple Inc. All rights reserved.
3*0f4c859eSApple OSS Distributions *
4*0f4c859eSApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*0f4c859eSApple OSS Distributions *
6*0f4c859eSApple OSS Distributions * This file contains Original Code and/or Modifications of Original Code
7*0f4c859eSApple OSS Distributions * as defined in and that are subject to the Apple Public Source License
8*0f4c859eSApple OSS Distributions * Version 2.0 (the 'License'). You may not use this file except in
9*0f4c859eSApple OSS Distributions * compliance with the License. The rights granted to you under the License
10*0f4c859eSApple OSS Distributions * may not be used to create, or enable the creation or redistribution of,
11*0f4c859eSApple OSS Distributions * unlawful or unlicensed copies of an Apple operating system, or to
12*0f4c859eSApple OSS Distributions * circumvent, violate, or enable the circumvention or violation of, any
13*0f4c859eSApple OSS Distributions * terms of an Apple operating system software license agreement.
14*0f4c859eSApple OSS Distributions *
15*0f4c859eSApple OSS Distributions * Please obtain a copy of the License at
16*0f4c859eSApple OSS Distributions * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*0f4c859eSApple OSS Distributions *
18*0f4c859eSApple OSS Distributions * The Original Code and all software distributed under the License are
19*0f4c859eSApple OSS Distributions * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*0f4c859eSApple OSS Distributions * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*0f4c859eSApple OSS Distributions * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*0f4c859eSApple OSS Distributions * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*0f4c859eSApple OSS Distributions * Please see the License for the specific language governing rights and
24*0f4c859eSApple OSS Distributions * limitations under the License.
25*0f4c859eSApple OSS Distributions *
26*0f4c859eSApple OSS Distributions * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*0f4c859eSApple OSS Distributions */
28*0f4c859eSApple OSS Distributions
29*0f4c859eSApple OSS Distributions /*
30*0f4c859eSApple OSS Distributions * devtimer.c
31*0f4c859eSApple OSS Distributions * - timer source based on <kern/thread_call.h>
32*0f4c859eSApple OSS Distributions */
33*0f4c859eSApple OSS Distributions
34*0f4c859eSApple OSS Distributions /*
35*0f4c859eSApple OSS Distributions * Modification History:
36*0f4c859eSApple OSS Distributions *
37*0f4c859eSApple OSS Distributions * June 22, 2004 Dieter Siegmund ([email protected])
38*0f4c859eSApple OSS Distributions * - created
39*0f4c859eSApple OSS Distributions */
40*0f4c859eSApple OSS Distributions #include <sys/param.h>
41*0f4c859eSApple OSS Distributions #include <sys/kernel.h>
42*0f4c859eSApple OSS Distributions #include <sys/malloc.h>
43*0f4c859eSApple OSS Distributions #include <kern/thread_call.h>
44*0f4c859eSApple OSS Distributions #include <net/devtimer.h>
45*0f4c859eSApple OSS Distributions #include <os/refcnt.h>
46*0f4c859eSApple OSS Distributions
47*0f4c859eSApple OSS Distributions #ifdef DEVTIMER_DEBUG
48*0f4c859eSApple OSS Distributions #define _devtimer_printf printf
49*0f4c859eSApple OSS Distributions #else /* !DEVTIMER_DEBUG */
50*0f4c859eSApple OSS Distributions static __inline__ void
_devtimer_printf(__unused const char * fmt,...)51*0f4c859eSApple OSS Distributions _devtimer_printf(__unused const char * fmt, ...)
52*0f4c859eSApple OSS Distributions {
53*0f4c859eSApple OSS Distributions }
54*0f4c859eSApple OSS Distributions #endif /* !DEVTIMER_DEBUG */
55*0f4c859eSApple OSS Distributions
56*0f4c859eSApple OSS Distributions struct devtimer_s {
57*0f4c859eSApple OSS Distributions void * dt_callout;
58*0f4c859eSApple OSS Distributions devtimer_timeout_func dt_timeout_func;
59*0f4c859eSApple OSS Distributions devtimer_process_func dt_process_func;
60*0f4c859eSApple OSS Distributions void * dt_arg0;
61*0f4c859eSApple OSS Distributions void * dt_arg1;
62*0f4c859eSApple OSS Distributions void * dt_arg2;
63*0f4c859eSApple OSS Distributions int dt_generation;
64*0f4c859eSApple OSS Distributions struct os_refcnt dt_retain_count;
65*0f4c859eSApple OSS Distributions };
66*0f4c859eSApple OSS Distributions
67*0f4c859eSApple OSS Distributions static __inline__ void
timeval_add(struct timeval tv1,struct timeval tv2,struct timeval * result)68*0f4c859eSApple OSS Distributions timeval_add(struct timeval tv1, struct timeval tv2,
69*0f4c859eSApple OSS Distributions struct timeval * result)
70*0f4c859eSApple OSS Distributions {
71*0f4c859eSApple OSS Distributions result->tv_sec = tv1.tv_sec + tv2.tv_sec;
72*0f4c859eSApple OSS Distributions result->tv_usec = tv1.tv_usec + tv2.tv_usec;
73*0f4c859eSApple OSS Distributions if (result->tv_usec > DEVTIMER_USECS_PER_SEC) {
74*0f4c859eSApple OSS Distributions result->tv_usec -= DEVTIMER_USECS_PER_SEC;
75*0f4c859eSApple OSS Distributions result->tv_sec++;
76*0f4c859eSApple OSS Distributions }
77*0f4c859eSApple OSS Distributions return;
78*0f4c859eSApple OSS Distributions }
79*0f4c859eSApple OSS Distributions
80*0f4c859eSApple OSS Distributions static __inline__ uint64_t
timeval_to_absolutetime(struct timeval tv)81*0f4c859eSApple OSS Distributions timeval_to_absolutetime(struct timeval tv)
82*0f4c859eSApple OSS Distributions {
83*0f4c859eSApple OSS Distributions uint64_t secs;
84*0f4c859eSApple OSS Distributions uint64_t usecs;
85*0f4c859eSApple OSS Distributions
86*0f4c859eSApple OSS Distributions clock_interval_to_absolutetime_interval(tv.tv_sec, NSEC_PER_SEC,
87*0f4c859eSApple OSS Distributions &secs);
88*0f4c859eSApple OSS Distributions clock_interval_to_absolutetime_interval(tv.tv_usec, NSEC_PER_USEC,
89*0f4c859eSApple OSS Distributions &usecs);
90*0f4c859eSApple OSS Distributions return secs + usecs;
91*0f4c859eSApple OSS Distributions }
92*0f4c859eSApple OSS Distributions
93*0f4c859eSApple OSS Distributions
94*0f4c859eSApple OSS Distributions __private_extern__ int
devtimer_valid(devtimer_ref timer)95*0f4c859eSApple OSS Distributions devtimer_valid(devtimer_ref timer)
96*0f4c859eSApple OSS Distributions {
97*0f4c859eSApple OSS Distributions return timer->dt_callout != NULL;
98*0f4c859eSApple OSS Distributions }
99*0f4c859eSApple OSS Distributions
100*0f4c859eSApple OSS Distributions __private_extern__ void
devtimer_retain(devtimer_ref timer)101*0f4c859eSApple OSS Distributions devtimer_retain(devtimer_ref timer)
102*0f4c859eSApple OSS Distributions {
103*0f4c859eSApple OSS Distributions os_ref_retain(&timer->dt_retain_count);
104*0f4c859eSApple OSS Distributions }
105*0f4c859eSApple OSS Distributions
106*0f4c859eSApple OSS Distributions __private_extern__ void
devtimer_invalidate(devtimer_ref timer)107*0f4c859eSApple OSS Distributions devtimer_invalidate(devtimer_ref timer)
108*0f4c859eSApple OSS Distributions {
109*0f4c859eSApple OSS Distributions devtimer_cancel(timer);
110*0f4c859eSApple OSS Distributions timer->dt_arg0 = NULL;
111*0f4c859eSApple OSS Distributions if (timer->dt_callout != NULL) {
112*0f4c859eSApple OSS Distributions thread_call_free(timer->dt_callout);
113*0f4c859eSApple OSS Distributions timer->dt_callout = NULL;
114*0f4c859eSApple OSS Distributions }
115*0f4c859eSApple OSS Distributions return;
116*0f4c859eSApple OSS Distributions }
117*0f4c859eSApple OSS Distributions
118*0f4c859eSApple OSS Distributions __private_extern__ void
devtimer_release(devtimer_ref timer)119*0f4c859eSApple OSS Distributions devtimer_release(devtimer_ref timer)
120*0f4c859eSApple OSS Distributions {
121*0f4c859eSApple OSS Distributions if (os_ref_release(&timer->dt_retain_count) == 0) {
122*0f4c859eSApple OSS Distributions devtimer_invalidate(timer);
123*0f4c859eSApple OSS Distributions kfree_type(struct devtimer_s, timer);
124*0f4c859eSApple OSS Distributions _devtimer_printf("devtimer: timer released\n");
125*0f4c859eSApple OSS Distributions }
126*0f4c859eSApple OSS Distributions }
127*0f4c859eSApple OSS Distributions
128*0f4c859eSApple OSS Distributions static void
devtimer_process(void * param0,void * param1)129*0f4c859eSApple OSS Distributions devtimer_process(void * param0, void * param1)
130*0f4c859eSApple OSS Distributions {
131*0f4c859eSApple OSS Distributions int generation = *(int*)param1;
132*0f4c859eSApple OSS Distributions devtimer_process_func process_func;
133*0f4c859eSApple OSS Distributions devtimer_timeout_func timeout_func;
134*0f4c859eSApple OSS Distributions devtimer_ref timer = (devtimer_ref)param0;
135*0f4c859eSApple OSS Distributions
136*0f4c859eSApple OSS Distributions process_func = timer->dt_process_func;
137*0f4c859eSApple OSS Distributions if (process_func != NULL) {
138*0f4c859eSApple OSS Distributions (*process_func)(timer, devtimer_process_func_event_lock);
139*0f4c859eSApple OSS Distributions }
140*0f4c859eSApple OSS Distributions timeout_func = timer->dt_timeout_func;
141*0f4c859eSApple OSS Distributions if (timeout_func != NULL) {
142*0f4c859eSApple OSS Distributions timer->dt_timeout_func = NULL;
143*0f4c859eSApple OSS Distributions if (timer->dt_generation == generation) {
144*0f4c859eSApple OSS Distributions (*timeout_func)(timer->dt_arg0, timer->dt_arg1, timer->dt_arg2);
145*0f4c859eSApple OSS Distributions }
146*0f4c859eSApple OSS Distributions }
147*0f4c859eSApple OSS Distributions devtimer_release(timer);
148*0f4c859eSApple OSS Distributions if (process_func != NULL) {
149*0f4c859eSApple OSS Distributions (*process_func)(timer, devtimer_process_func_event_unlock);
150*0f4c859eSApple OSS Distributions }
151*0f4c859eSApple OSS Distributions return;
152*0f4c859eSApple OSS Distributions }
153*0f4c859eSApple OSS Distributions
154*0f4c859eSApple OSS Distributions __private_extern__ void *
devtimer_arg0(devtimer_ref timer)155*0f4c859eSApple OSS Distributions devtimer_arg0(devtimer_ref timer)
156*0f4c859eSApple OSS Distributions {
157*0f4c859eSApple OSS Distributions return timer->dt_arg0;
158*0f4c859eSApple OSS Distributions }
159*0f4c859eSApple OSS Distributions
160*0f4c859eSApple OSS Distributions __private_extern__ devtimer_ref
devtimer_create(devtimer_process_func process_func,void * arg0)161*0f4c859eSApple OSS Distributions devtimer_create(devtimer_process_func process_func, void * arg0)
162*0f4c859eSApple OSS Distributions {
163*0f4c859eSApple OSS Distributions devtimer_ref timer;
164*0f4c859eSApple OSS Distributions
165*0f4c859eSApple OSS Distributions timer = kalloc_type(struct devtimer_s, Z_WAITOK | Z_ZERO | Z_NOFAIL);
166*0f4c859eSApple OSS Distributions os_ref_init(&timer->dt_retain_count, NULL);
167*0f4c859eSApple OSS Distributions timer->dt_callout = thread_call_allocate(devtimer_process, timer);
168*0f4c859eSApple OSS Distributions if (timer->dt_callout == NULL) {
169*0f4c859eSApple OSS Distributions _devtimer_printf("devtimer: thread_call_allocate failed\n");
170*0f4c859eSApple OSS Distributions devtimer_release(timer);
171*0f4c859eSApple OSS Distributions timer = NULL;
172*0f4c859eSApple OSS Distributions }
173*0f4c859eSApple OSS Distributions timer->dt_process_func = process_func;
174*0f4c859eSApple OSS Distributions timer->dt_arg0 = arg0;
175*0f4c859eSApple OSS Distributions return timer;
176*0f4c859eSApple OSS Distributions }
177*0f4c859eSApple OSS Distributions
178*0f4c859eSApple OSS Distributions __private_extern__ void
devtimer_set_absolute(devtimer_ref timer,struct timeval abs_time,devtimer_timeout_func timeout_func,void * arg1,void * arg2)179*0f4c859eSApple OSS Distributions devtimer_set_absolute(devtimer_ref timer,
180*0f4c859eSApple OSS Distributions struct timeval abs_time,
181*0f4c859eSApple OSS Distributions devtimer_timeout_func timeout_func,
182*0f4c859eSApple OSS Distributions void * arg1, void * arg2)
183*0f4c859eSApple OSS Distributions {
184*0f4c859eSApple OSS Distributions if (timer->dt_callout == NULL) {
185*0f4c859eSApple OSS Distributions printf("devtimer_set_absolute: uninitialized/freed timer\n");
186*0f4c859eSApple OSS Distributions return;
187*0f4c859eSApple OSS Distributions }
188*0f4c859eSApple OSS Distributions devtimer_cancel(timer);
189*0f4c859eSApple OSS Distributions if (timeout_func == NULL) {
190*0f4c859eSApple OSS Distributions return;
191*0f4c859eSApple OSS Distributions }
192*0f4c859eSApple OSS Distributions timer->dt_timeout_func = timeout_func;
193*0f4c859eSApple OSS Distributions timer->dt_arg1 = arg1;
194*0f4c859eSApple OSS Distributions timer->dt_arg2 = arg2;
195*0f4c859eSApple OSS Distributions _devtimer_printf("devtimer: wakeup time is (%d.%d)\n",
196*0f4c859eSApple OSS Distributions abs_time.tv_sec, abs_time.tv_usec);
197*0f4c859eSApple OSS Distributions timer->dt_generation++;
198*0f4c859eSApple OSS Distributions devtimer_retain(timer);
199*0f4c859eSApple OSS Distributions thread_call_enter1_delayed(timer->dt_callout,
200*0f4c859eSApple OSS Distributions &timer->dt_generation,
201*0f4c859eSApple OSS Distributions timeval_to_absolutetime(abs_time));
202*0f4c859eSApple OSS Distributions return;
203*0f4c859eSApple OSS Distributions }
204*0f4c859eSApple OSS Distributions
205*0f4c859eSApple OSS Distributions __private_extern__ void
devtimer_set_relative(devtimer_ref timer,struct timeval rel_time,devtimer_timeout_func timeout_func,void * arg1,void * arg2)206*0f4c859eSApple OSS Distributions devtimer_set_relative(devtimer_ref timer,
207*0f4c859eSApple OSS Distributions struct timeval rel_time,
208*0f4c859eSApple OSS Distributions devtimer_timeout_func timeout_func,
209*0f4c859eSApple OSS Distributions void * arg1, void * arg2)
210*0f4c859eSApple OSS Distributions {
211*0f4c859eSApple OSS Distributions struct timeval abs_time;
212*0f4c859eSApple OSS Distributions struct timeval current_time;
213*0f4c859eSApple OSS Distributions
214*0f4c859eSApple OSS Distributions current_time = devtimer_current_time();
215*0f4c859eSApple OSS Distributions timeval_add(current_time, rel_time, &abs_time);
216*0f4c859eSApple OSS Distributions devtimer_set_absolute(timer, abs_time, timeout_func, arg1, arg2);
217*0f4c859eSApple OSS Distributions return;
218*0f4c859eSApple OSS Distributions }
219*0f4c859eSApple OSS Distributions
220*0f4c859eSApple OSS Distributions __private_extern__ void
devtimer_cancel(devtimer_ref timer)221*0f4c859eSApple OSS Distributions devtimer_cancel(devtimer_ref timer)
222*0f4c859eSApple OSS Distributions {
223*0f4c859eSApple OSS Distributions if (timer->dt_timeout_func != NULL) {
224*0f4c859eSApple OSS Distributions timer->dt_timeout_func = NULL;
225*0f4c859eSApple OSS Distributions if (timer->dt_callout != NULL) {
226*0f4c859eSApple OSS Distributions _devtimer_printf("devtimer: cancelling timer source\n");
227*0f4c859eSApple OSS Distributions if (thread_call_cancel(timer->dt_callout)) {
228*0f4c859eSApple OSS Distributions devtimer_release(timer);
229*0f4c859eSApple OSS Distributions } else {
230*0f4c859eSApple OSS Distributions _devtimer_printf("devtimer: delayed release\n");
231*0f4c859eSApple OSS Distributions }
232*0f4c859eSApple OSS Distributions }
233*0f4c859eSApple OSS Distributions }
234*0f4c859eSApple OSS Distributions return;
235*0f4c859eSApple OSS Distributions }
236*0f4c859eSApple OSS Distributions
237*0f4c859eSApple OSS Distributions __private_extern__ int
devtimer_enabled(devtimer_ref timer)238*0f4c859eSApple OSS Distributions devtimer_enabled(devtimer_ref timer)
239*0f4c859eSApple OSS Distributions {
240*0f4c859eSApple OSS Distributions return timer->dt_timeout_func != NULL;
241*0f4c859eSApple OSS Distributions }
242*0f4c859eSApple OSS Distributions
243*0f4c859eSApple OSS Distributions __private_extern__ int32_t
devtimer_current_secs(void)244*0f4c859eSApple OSS Distributions devtimer_current_secs(void)
245*0f4c859eSApple OSS Distributions {
246*0f4c859eSApple OSS Distributions struct timeval tv;
247*0f4c859eSApple OSS Distributions
248*0f4c859eSApple OSS Distributions tv = devtimer_current_time();
249*0f4c859eSApple OSS Distributions return tv.tv_sec;
250*0f4c859eSApple OSS Distributions }
251*0f4c859eSApple OSS Distributions
252*0f4c859eSApple OSS Distributions __private_extern__ struct timeval
devtimer_current_time(void)253*0f4c859eSApple OSS Distributions devtimer_current_time(void)
254*0f4c859eSApple OSS Distributions {
255*0f4c859eSApple OSS Distributions struct timeval tv;
256*0f4c859eSApple OSS Distributions clock_sec_t sec;
257*0f4c859eSApple OSS Distributions clock_usec_t usec;
258*0f4c859eSApple OSS Distributions
259*0f4c859eSApple OSS Distributions clock_get_system_microtime(&sec, &usec);
260*0f4c859eSApple OSS Distributions tv.tv_sec = sec;
261*0f4c859eSApple OSS Distributions tv.tv_usec = usec;
262*0f4c859eSApple OSS Distributions return tv;
263*0f4c859eSApple OSS Distributions }
264