xref: /dragonfly/lib/libc/upmap/ukp_clock.c (revision 279dd846)
1 /*
2  * Copyright (c) 2014 The DragonFly Project.  All rights reserved.
3  *
4  * This code is derived from software contributed to The DragonFly Project
5  * by Matthew Dillon <dillon@backplane.com>
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  *
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in
15  *    the documentation and/or other materials provided with the
16  *    distribution.
17  * 3. Neither the name of The DragonFly Project nor the names of its
18  *    contributors may be used to endorse or promote products derived
19  *    from this software without specific, prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE
25  * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26  * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
29  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
30  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
31  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32  * SUCH DAMAGE.
33  */
34 
35 /*
36  * UKP-Optimized clock_gettime().  Use the kpmap after the 10th call.
37  */
38 
39 #include <sys/cdefs.h>
40 #include <sys/types.h>
41 #include <sys/syscall.h>
42 #include <sys/upmap.h>
43 #include <sys/time.h>
44 #include <machine/cpufunc.h>
45 #include <errno.h>
46 #include <time.h>
47 #include <stdio.h>
48 #include <unistd.h>
49 /*#include "un-namespace.h"*/
50 #include "libc_private.h"
51 #include "upmap.h"
52 
53 extern int __sys_clock_gettime(clockid_t clock_id, struct timespec *ts);
54 int __clock_gettime(clockid_t clock_id, struct timespec *ts);
55 
56 __weak_reference(__clock_gettime, clock_gettime);
57 
58 static int fast_clock;
59 static int fast_count;
60 static int *upticksp;
61 static struct timespec *ts_uptime;
62 static struct timespec *ts_realtime;
63 
64 int
65 __clock_gettime(clockid_t clock_id, struct timespec *ts)
66 {
67 	int res;
68 	int w;
69 
70 	if (fast_clock == 0 && fast_count++ >= 10) {
71 		__kpmap_map(&upticksp, &fast_clock, KPTYPE_UPTICKS);
72 		__kpmap_map(&ts_uptime, &fast_clock, KPTYPE_TS_UPTIME);
73 		__kpmap_map(&ts_realtime, &fast_clock, KPTYPE_TS_REALTIME);
74 		__kpmap_map(NULL, &fast_clock, 0);
75 	}
76 	if (fast_clock > 0) {
77 		switch(clock_id) {
78 		case CLOCK_UPTIME_FAST:
79 		case CLOCK_MONOTONIC_FAST:
80 			do {
81 				w = *upticksp;
82 				cpu_lfence();
83 				*ts = ts_uptime[w & 1];
84 				cpu_lfence();
85 				w = *upticksp - w;
86 			} while (w > 1);
87 			res = 0;
88 			break;
89 		case CLOCK_REALTIME_FAST:
90 		case CLOCK_SECOND:
91 			do {
92 				w = *upticksp;
93 				cpu_lfence();
94 				*ts = ts_realtime[w & 1];
95 				cpu_lfence();
96 				w = *upticksp - w;
97 			} while (w > 1);
98 
99 			if (clock_id == CLOCK_SECOND)
100 				ts->tv_nsec = 0;
101 			res = 0;
102 			break;
103 		default:
104 			res = __sys_clock_gettime(clock_id, ts);
105 			break;
106 		}
107 	} else {
108 		res = __sys_clock_gettime(clock_id, ts);
109 	}
110 	return res;
111 }
112