xref: /xnu-11215/bsd/net/devtimer.c (revision e7776783)
114e3d835SApple OSS Distributions /*
2*e6231be0SApple OSS Distributions  * Copyright (c) 2004-2021 Apple Inc. All rights reserved.
314e3d835SApple OSS Distributions  *
4e13b1fa5SApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
514e3d835SApple OSS Distributions  *
6e13b1fa5SApple OSS Distributions  * This file contains Original Code and/or Modifications of Original Code
7e13b1fa5SApple OSS Distributions  * as defined in and that are subject to the Apple Public Source License
8e13b1fa5SApple OSS Distributions  * Version 2.0 (the 'License'). You may not use this file except in
9e13b1fa5SApple OSS Distributions  * compliance with the License. The rights granted to you under the License
10e13b1fa5SApple OSS Distributions  * may not be used to create, or enable the creation or redistribution of,
11e13b1fa5SApple OSS Distributions  * unlawful or unlicensed copies of an Apple operating system, or to
12e13b1fa5SApple OSS Distributions  * circumvent, violate, or enable the circumvention or violation of, any
13e13b1fa5SApple OSS Distributions  * terms of an Apple operating system software license agreement.
1414e3d835SApple OSS Distributions  *
15e13b1fa5SApple OSS Distributions  * Please obtain a copy of the License at
16e13b1fa5SApple OSS Distributions  * http://www.opensource.apple.com/apsl/ and read it before using this file.
17e13b1fa5SApple OSS Distributions  *
18e13b1fa5SApple OSS Distributions  * The Original Code and all software distributed under the License are
19e13b1fa5SApple OSS Distributions  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
2014e3d835SApple OSS Distributions  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
2114e3d835SApple OSS Distributions  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22e13b1fa5SApple OSS Distributions  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23e13b1fa5SApple OSS Distributions  * Please see the License for the specific language governing rights and
24e13b1fa5SApple OSS Distributions  * limitations under the License.
2514e3d835SApple OSS Distributions  *
26e13b1fa5SApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
2714e3d835SApple OSS Distributions  */
2814e3d835SApple OSS Distributions 
2914e3d835SApple OSS Distributions /*
3014e3d835SApple OSS Distributions  * devtimer.c
3114e3d835SApple OSS Distributions  * - timer source based on <kern/thread_call.h>
3214e3d835SApple OSS Distributions  */
3314e3d835SApple OSS Distributions 
3414e3d835SApple OSS Distributions /*
3514e3d835SApple OSS Distributions  * Modification History:
3614e3d835SApple OSS Distributions  *
3714e3d835SApple OSS Distributions  * June 22, 2004	Dieter Siegmund ([email protected])
3814e3d835SApple OSS Distributions  * - created
3914e3d835SApple OSS Distributions  */
4014e3d835SApple OSS Distributions #include <sys/param.h>
4114e3d835SApple OSS Distributions #include <sys/kernel.h>
4214e3d835SApple OSS Distributions #include <sys/malloc.h>
4314e3d835SApple OSS Distributions #include <kern/thread_call.h>
4414e3d835SApple OSS Distributions #include <net/devtimer.h>
45a5e72196SApple OSS Distributions #include <os/refcnt.h>
4614e3d835SApple OSS Distributions 
4714e3d835SApple OSS Distributions #ifdef DEVTIMER_DEBUG
4814e3d835SApple OSS Distributions #define _devtimer_printf        printf
493ca3bd55SApple OSS Distributions #else /* !DEVTIMER_DEBUG */
5014e3d835SApple OSS Distributions static __inline__ void
_devtimer_printf(__unused const char * fmt,...)5114e3d835SApple OSS Distributions _devtimer_printf(__unused const char * fmt, ...)
5214e3d835SApple OSS Distributions {
5314e3d835SApple OSS Distributions }
543ca3bd55SApple OSS Distributions #endif /* !DEVTIMER_DEBUG */
5514e3d835SApple OSS Distributions 
5614e3d835SApple OSS Distributions struct devtimer_s {
5714e3d835SApple OSS Distributions 	void *                      dt_callout;
5814e3d835SApple OSS Distributions 	devtimer_timeout_func       dt_timeout_func;
5914e3d835SApple OSS Distributions 	devtimer_process_func       dt_process_func;
6014e3d835SApple OSS Distributions 	void *                      dt_arg0;
6114e3d835SApple OSS Distributions 	void *                      dt_arg1;
6214e3d835SApple OSS Distributions 	void *                      dt_arg2;
6314e3d835SApple OSS Distributions 	int                         dt_generation;
64a5e72196SApple OSS Distributions 	struct os_refcnt            dt_retain_count;
6514e3d835SApple OSS Distributions };
6614e3d835SApple OSS Distributions 
6714e3d835SApple OSS Distributions static __inline__ void
timeval_add(struct timeval tv1,struct timeval tv2,struct timeval * result)6814e3d835SApple OSS Distributions timeval_add(struct timeval tv1, struct timeval tv2,
6914e3d835SApple OSS Distributions     struct timeval * result)
7014e3d835SApple OSS Distributions {
7114e3d835SApple OSS Distributions 	result->tv_sec = tv1.tv_sec + tv2.tv_sec;
7214e3d835SApple OSS Distributions 	result->tv_usec = tv1.tv_usec + tv2.tv_usec;
7314e3d835SApple OSS Distributions 	if (result->tv_usec > DEVTIMER_USECS_PER_SEC) {
7414e3d835SApple OSS Distributions 		result->tv_usec -= DEVTIMER_USECS_PER_SEC;
7514e3d835SApple OSS Distributions 		result->tv_sec++;
7614e3d835SApple OSS Distributions 	}
7714e3d835SApple OSS Distributions 	return;
7814e3d835SApple OSS Distributions }
7914e3d835SApple OSS Distributions 
8014e3d835SApple OSS Distributions static __inline__ uint64_t
timeval_to_absolutetime(struct timeval tv)8114e3d835SApple OSS Distributions timeval_to_absolutetime(struct timeval tv)
8214e3d835SApple OSS Distributions {
8314e3d835SApple OSS Distributions 	uint64_t    secs;
8414e3d835SApple OSS Distributions 	uint64_t    usecs;
8514e3d835SApple OSS Distributions 
8614e3d835SApple OSS Distributions 	clock_interval_to_absolutetime_interval(tv.tv_sec, NSEC_PER_SEC,
8714e3d835SApple OSS Distributions 	    &secs);
8814e3d835SApple OSS Distributions 	clock_interval_to_absolutetime_interval(tv.tv_usec, NSEC_PER_USEC,
8914e3d835SApple OSS Distributions 	    &usecs);
90a5e72196SApple OSS Distributions 	return secs + usecs;
9114e3d835SApple OSS Distributions }
9214e3d835SApple OSS Distributions 
9314e3d835SApple OSS Distributions 
9414e3d835SApple OSS Distributions __private_extern__ int
devtimer_valid(devtimer_ref timer)9514e3d835SApple OSS Distributions devtimer_valid(devtimer_ref timer)
9614e3d835SApple OSS Distributions {
97a5e72196SApple OSS Distributions 	return timer->dt_callout != NULL;
9814e3d835SApple OSS Distributions }
9914e3d835SApple OSS Distributions 
10014e3d835SApple OSS Distributions __private_extern__ void
devtimer_retain(devtimer_ref timer)10114e3d835SApple OSS Distributions devtimer_retain(devtimer_ref timer)
10214e3d835SApple OSS Distributions {
103a5e72196SApple OSS Distributions 	os_ref_retain(&timer->dt_retain_count);
10414e3d835SApple OSS Distributions }
10514e3d835SApple OSS Distributions 
10614e3d835SApple OSS Distributions __private_extern__ void
devtimer_invalidate(devtimer_ref timer)10714e3d835SApple OSS Distributions devtimer_invalidate(devtimer_ref timer)
10814e3d835SApple OSS Distributions {
10914e3d835SApple OSS Distributions 	devtimer_cancel(timer);
11014e3d835SApple OSS Distributions 	timer->dt_arg0 = NULL;
11114e3d835SApple OSS Distributions 	if (timer->dt_callout != NULL) {
11214e3d835SApple OSS Distributions 		thread_call_free(timer->dt_callout);
11314e3d835SApple OSS Distributions 		timer->dt_callout = NULL;
11414e3d835SApple OSS Distributions 	}
11514e3d835SApple OSS Distributions 	return;
11614e3d835SApple OSS Distributions }
11714e3d835SApple OSS Distributions 
11814e3d835SApple OSS Distributions __private_extern__ void
devtimer_release(devtimer_ref timer)11914e3d835SApple OSS Distributions devtimer_release(devtimer_ref timer)
12014e3d835SApple OSS Distributions {
121a5e72196SApple OSS Distributions 	if (os_ref_release(&timer->dt_retain_count) == 0) {
12214e3d835SApple OSS Distributions 		devtimer_invalidate(timer);
123*e6231be0SApple OSS Distributions 		kfree_type(struct devtimer_s, timer);
12414e3d835SApple OSS Distributions 		_devtimer_printf("devtimer: timer released\n");
12514e3d835SApple OSS Distributions 	}
12614e3d835SApple OSS Distributions }
12714e3d835SApple OSS Distributions 
12814e3d835SApple OSS Distributions static void
devtimer_process(void * param0,void * param1)12914e3d835SApple OSS Distributions devtimer_process(void * param0, void * param1)
13014e3d835SApple OSS Distributions {
1313ca3bd55SApple OSS Distributions 	int                         generation = *(int*)param1;
13214e3d835SApple OSS Distributions 	devtimer_process_func       process_func;
13314e3d835SApple OSS Distributions 	devtimer_timeout_func       timeout_func;
13414e3d835SApple OSS Distributions 	devtimer_ref                timer = (devtimer_ref)param0;
13514e3d835SApple OSS Distributions 
13614e3d835SApple OSS Distributions 	process_func = timer->dt_process_func;
13714e3d835SApple OSS Distributions 	if (process_func != NULL) {
13814e3d835SApple OSS Distributions 		(*process_func)(timer, devtimer_process_func_event_lock);
13914e3d835SApple OSS Distributions 	}
14014e3d835SApple OSS Distributions 	timeout_func = timer->dt_timeout_func;
14114e3d835SApple OSS Distributions 	if (timeout_func != NULL) {
14214e3d835SApple OSS Distributions 		timer->dt_timeout_func = NULL;
14314e3d835SApple OSS Distributions 		if (timer->dt_generation == generation) {
14414e3d835SApple OSS Distributions 			(*timeout_func)(timer->dt_arg0, timer->dt_arg1, timer->dt_arg2);
14514e3d835SApple OSS Distributions 		}
14614e3d835SApple OSS Distributions 	}
14714e3d835SApple OSS Distributions 	devtimer_release(timer);
14814e3d835SApple OSS Distributions 	if (process_func != NULL) {
14914e3d835SApple OSS Distributions 		(*process_func)(timer, devtimer_process_func_event_unlock);
15014e3d835SApple OSS Distributions 	}
15114e3d835SApple OSS Distributions 	return;
15214e3d835SApple OSS Distributions }
15314e3d835SApple OSS Distributions 
15414e3d835SApple OSS Distributions __private_extern__ void *
devtimer_arg0(devtimer_ref timer)15514e3d835SApple OSS Distributions devtimer_arg0(devtimer_ref timer)
15614e3d835SApple OSS Distributions {
157a5e72196SApple OSS Distributions 	return timer->dt_arg0;
15814e3d835SApple OSS Distributions }
15914e3d835SApple OSS Distributions 
16014e3d835SApple OSS Distributions __private_extern__ devtimer_ref
devtimer_create(devtimer_process_func process_func,void * arg0)16114e3d835SApple OSS Distributions devtimer_create(devtimer_process_func process_func, void * arg0)
16214e3d835SApple OSS Distributions {
16314e3d835SApple OSS Distributions 	devtimer_ref        timer;
16414e3d835SApple OSS Distributions 
165*e6231be0SApple OSS Distributions 	timer = kalloc_type(struct devtimer_s, Z_WAITOK | Z_ZERO | Z_NOFAIL);
166a5e72196SApple OSS Distributions 	os_ref_init(&timer->dt_retain_count, NULL);
16714e3d835SApple OSS Distributions 	timer->dt_callout = thread_call_allocate(devtimer_process, timer);
16814e3d835SApple OSS Distributions 	if (timer->dt_callout == NULL) {
16914e3d835SApple OSS Distributions 		_devtimer_printf("devtimer: thread_call_allocate failed\n");
17014e3d835SApple OSS Distributions 		devtimer_release(timer);
17114e3d835SApple OSS Distributions 		timer = NULL;
17214e3d835SApple OSS Distributions 	}
17314e3d835SApple OSS Distributions 	timer->dt_process_func = process_func;
17414e3d835SApple OSS Distributions 	timer->dt_arg0 = arg0;
175a5e72196SApple OSS Distributions 	return timer;
17614e3d835SApple OSS Distributions }
17714e3d835SApple OSS Distributions 
17814e3d835SApple OSS Distributions __private_extern__ void
devtimer_set_absolute(devtimer_ref timer,struct timeval abs_time,devtimer_timeout_func timeout_func,void * arg1,void * arg2)17914e3d835SApple OSS Distributions devtimer_set_absolute(devtimer_ref timer,
18014e3d835SApple OSS Distributions     struct timeval abs_time,
18114e3d835SApple OSS Distributions     devtimer_timeout_func timeout_func,
18214e3d835SApple OSS Distributions     void * arg1, void * arg2)
18314e3d835SApple OSS Distributions {
18414e3d835SApple OSS Distributions 	if (timer->dt_callout == NULL) {
18514e3d835SApple OSS Distributions 		printf("devtimer_set_absolute: uninitialized/freed timer\n");
18614e3d835SApple OSS Distributions 		return;
18714e3d835SApple OSS Distributions 	}
18814e3d835SApple OSS Distributions 	devtimer_cancel(timer);
18914e3d835SApple OSS Distributions 	if (timeout_func == NULL) {
19014e3d835SApple OSS Distributions 		return;
19114e3d835SApple OSS Distributions 	}
19214e3d835SApple OSS Distributions 	timer->dt_timeout_func = timeout_func;
19314e3d835SApple OSS Distributions 	timer->dt_arg1 = arg1;
19414e3d835SApple OSS Distributions 	timer->dt_arg2 = arg2;
19514e3d835SApple OSS Distributions 	_devtimer_printf("devtimer: wakeup time is (%d.%d)\n",
19614e3d835SApple OSS Distributions 	    abs_time.tv_sec, abs_time.tv_usec);
19714e3d835SApple OSS Distributions 	timer->dt_generation++;
19814e3d835SApple OSS Distributions 	devtimer_retain(timer);
19914e3d835SApple OSS Distributions 	thread_call_enter1_delayed(timer->dt_callout,
2003ca3bd55SApple OSS Distributions 	    &timer->dt_generation,
20114e3d835SApple OSS Distributions 	    timeval_to_absolutetime(abs_time));
20214e3d835SApple OSS Distributions 	return;
20314e3d835SApple OSS Distributions }
20414e3d835SApple OSS Distributions 
20514e3d835SApple OSS Distributions __private_extern__ void
devtimer_set_relative(devtimer_ref timer,struct timeval rel_time,devtimer_timeout_func timeout_func,void * arg1,void * arg2)20614e3d835SApple OSS Distributions devtimer_set_relative(devtimer_ref timer,
20714e3d835SApple OSS Distributions     struct timeval rel_time,
20814e3d835SApple OSS Distributions     devtimer_timeout_func timeout_func,
20914e3d835SApple OSS Distributions     void * arg1, void * arg2)
21014e3d835SApple OSS Distributions {
21114e3d835SApple OSS Distributions 	struct timeval              abs_time;
21214e3d835SApple OSS Distributions 	struct timeval              current_time;
21314e3d835SApple OSS Distributions 
21414e3d835SApple OSS Distributions 	current_time = devtimer_current_time();
21514e3d835SApple OSS Distributions 	timeval_add(current_time, rel_time, &abs_time);
21614e3d835SApple OSS Distributions 	devtimer_set_absolute(timer, abs_time, timeout_func, arg1, arg2);
21714e3d835SApple OSS Distributions 	return;
21814e3d835SApple OSS Distributions }
21914e3d835SApple OSS Distributions 
22014e3d835SApple OSS Distributions __private_extern__ void
devtimer_cancel(devtimer_ref timer)22114e3d835SApple OSS Distributions devtimer_cancel(devtimer_ref timer)
22214e3d835SApple OSS Distributions {
22314e3d835SApple OSS Distributions 	if (timer->dt_timeout_func != NULL) {
22414e3d835SApple OSS Distributions 		timer->dt_timeout_func = NULL;
22514e3d835SApple OSS Distributions 		if (timer->dt_callout != NULL) {
22614e3d835SApple OSS Distributions 			_devtimer_printf("devtimer: cancelling timer source\n");
22714e3d835SApple OSS Distributions 			if (thread_call_cancel(timer->dt_callout)) {
22814e3d835SApple OSS Distributions 				devtimer_release(timer);
229a5e72196SApple OSS Distributions 			} else {
23014e3d835SApple OSS Distributions 				_devtimer_printf("devtimer: delayed release\n");
23114e3d835SApple OSS Distributions 			}
23214e3d835SApple OSS Distributions 		}
23314e3d835SApple OSS Distributions 	}
23414e3d835SApple OSS Distributions 	return;
23514e3d835SApple OSS Distributions }
23614e3d835SApple OSS Distributions 
23714e3d835SApple OSS Distributions __private_extern__ int
devtimer_enabled(devtimer_ref timer)23814e3d835SApple OSS Distributions devtimer_enabled(devtimer_ref timer)
23914e3d835SApple OSS Distributions {
240a5e72196SApple OSS Distributions 	return timer->dt_timeout_func != NULL;
24114e3d835SApple OSS Distributions }
24214e3d835SApple OSS Distributions 
24314e3d835SApple OSS Distributions __private_extern__ int32_t
devtimer_current_secs(void)24414e3d835SApple OSS Distributions devtimer_current_secs(void)
24514e3d835SApple OSS Distributions {
24614e3d835SApple OSS Distributions 	struct timeval      tv;
24714e3d835SApple OSS Distributions 
24814e3d835SApple OSS Distributions 	tv = devtimer_current_time();
249a5e72196SApple OSS Distributions 	return tv.tv_sec;
25014e3d835SApple OSS Distributions }
25114e3d835SApple OSS Distributions 
25214e3d835SApple OSS Distributions __private_extern__ struct timeval
devtimer_current_time(void)25314e3d835SApple OSS Distributions devtimer_current_time(void)
25414e3d835SApple OSS Distributions {
25514e3d835SApple OSS Distributions 	struct timeval      tv;
2563ca3bd55SApple OSS Distributions 	clock_sec_t sec;
2573ca3bd55SApple OSS Distributions 	clock_usec_t usec;
25814e3d835SApple OSS Distributions 
25914e3d835SApple OSS Distributions 	clock_get_system_microtime(&sec, &usec);
26014e3d835SApple OSS Distributions 	tv.tv_sec = sec;
26114e3d835SApple OSS Distributions 	tv.tv_usec = usec;
262a5e72196SApple OSS Distributions 	return tv;
26314e3d835SApple OSS Distributions }
264