WebSVN – HelenOS – Diff – /trunk/uspace/lib/libc/generic/time.c


/*
 * Copyright (c) 2006 Ondrej Palkovsky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup libc
 * @{
 */
/** @file
 */
 
#include <sys/time.h>
#include <unistd.h>
#include <ipc/ipc.h>
#include <stdio.h>
#include <arch/barrier.h>
#include <unistd.h>
#include <atomic.h>
#include <futex.h>
#include <sysinfo.h>
#include <ipc/services.h>
 
#include <sysinfo.h>
#include <as.h>
#include <ddi.h>
 
/* Pointers to public variables with time */
struct {
    volatile sysarg_t seconds1;
    volatile sysarg_t useconds;
    volatile sysarg_t seconds2;
} *ktime = NULL;
 
/** Add microseconds to given timeval.
 *
 * @param tv        Destination timeval.
 * @param usecs     Number of microseconds to add.
 */
void tv_add(struct timeval *tv, suseconds_t usecs)
{
    tv->tv_sec += usecs / 1000000;
    tv->tv_usec += usecs % 1000000;
    if (tv->tv_usec > 1000000) {
        tv->tv_sec++;
        tv->tv_usec -= 1000000;
    }
}
 
/** Subtract two timevals.
 *
 * @param tv1       First timeval.
 * @param tv2       Second timeval.
 *
 * @return      Return difference between tv1 and tv2 (tv1 - tv2) in
 *          microseconds.
 */
suseconds_t tv_sub(struct timeval *tv1, struct timeval *tv2)
{
    suseconds_t result;
 
    result = tv1->tv_usec - tv2->tv_usec;
    result += (tv1->tv_sec - tv2->tv_sec) * 1000000;
 
    return result;
}
 
/** Decide if one timeval is greater than the other.
 *
 * @param t1        First timeval.
 * @param t2        Second timeval.
 *
 * @return      Return true tv1 is greater than tv2. Otherwise return
 *          false.
 */
int tv_gt(struct timeval *tv1, struct timeval *tv2)
{
    if (tv1->tv_sec > tv2->tv_sec)
        return 1;
    if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec > tv2->tv_usec)
        return 1;
    return 0;
}
 
/** Decide if one timeval is greater than or equal to the other.
 *
 * @param tv1       First timeval.
 * @param tv2       Second timeval.
 *
 * @return      Return true if tv1 is greater than or equal to tv2.
 *          Otherwise return false.
 */
int tv_gteq(struct timeval *tv1, struct timeval *tv2)
{
    if (tv1->tv_sec > tv2->tv_sec)
        return 1;
    if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec >= tv2->tv_usec)
        return 1;
    return 0;
}
 
 
/** POSIX gettimeofday
 *
 * The time variables are memory mapped(RO) from kernel, which updates
 * them periodically. As it is impossible to read 2 values atomically, we
 * use a trick: First read a seconds, then read microseconds, then
 * read seconds again. If a second elapsed in the meantime, set it to zero.
 * This provides assurance, that at least the
 * sequence of subsequent gettimeofday calls is ordered.
 */
int gettimeofday(struct timeval *tv, struct timezone *tz)
{
    void *mapping;
    sysarg_t s1, s2;
    int rights;
    int res;
 
    if (!ktime) {
        mapping = as_get_mappable_page(PAGE_SIZE);
        /* Get the mapping of kernel clock */
        res = ipc_share_in_start_1_1(PHONE_NS, mapping, PAGE_SIZE,
            SERVICE_MEM_REALTIME, &rights);
        if (res) {
            printf("Failed to initialize timeofday memarea\n");
            _exit(1);
        }
        if (!(rights & AS_AREA_READ)) {
            printf("Received bad rights on time area: %X\n",
                rights);
            as_area_destroy(mapping);
            _exit(1);
        }
        ktime = mapping;
    }
    if (tz) {
        tz->tz_minuteswest = 0;
        tz->tz_dsttime = DST_NONE;
    }
 
    s2 = ktime->seconds2;
    read_barrier();
    tv->tv_usec = ktime->useconds;
    read_barrier();
    s1 = ktime->seconds1;
    if (s1 != s2) {
        tv->tv_usec = 0;
        tv->tv_sec = s1 > s2 ? s1 : s2;
    } else
        tv->tv_sec = s1;
 
    return 0;
}
 
time_t time(time_t *tloc)
{
    struct timeval tv;
 
    if (gettimeofday(&tv, NULL))
        return (time_t) -1;
    if (tloc)
        *tloc = tv.tv_sec;
    return tv.tv_sec;
}
 
/** Wait unconditionally for specified number of microseconds */
int usleep(unsigned long usec)
{
    atomic_t futex = FUTEX_INITIALIZER;
 
    futex_initialize(&futex, 0);
    futex_down_timeout(&futex, usec, 0);
    return 0;
}
 
/** Wait unconditionally for specified number of seconds */
unsigned int sleep(unsigned int seconds)
{
    atomic_t futex = FUTEX_INITIALIZER;
 
    futex_initialize(&futex, 0);
   
    /* Sleep in 1000 second steps to support
       full argument range */
    while (seconds > 0) {
        unsigned int period = (seconds > 1000) ? 1000 : seconds;
   
        futex_down_timeout(&futex, period * 1000000, 0);
        seconds -= period;
    }
    return 0;
}
 
/** @}
 */
 

Rev 2677	Rev 2678
1	/*	1	/*
2	* Copyright (c) 2006 Ondrej Palkovsky	2	* Copyright (c) 2006 Ondrej Palkovsky
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup libc	29	/** @addtogroup libc
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	#include <sys/time.h>	35	#include <sys/time.h>
36	#include <unistd.h>	36	#include <unistd.h>
37	#include <ipc/ipc.h>	37	#include <ipc/ipc.h>
38	#include <stdio.h>	38	#include <stdio.h>
39	#include <arch/barrier.h>	39	#include <arch/barrier.h>
40	#include <unistd.h>	40	#include <unistd.h>
41	#include <atomic.h>	41	#include <atomic.h>
42	#include <futex.h>	42	#include <futex.h>
43	#include <sysinfo.h>	43	#include <sysinfo.h>
44	#include <ipc/services.h>	44	#include <ipc/services.h>
45		45
46	#include <sysinfo.h>	46	#include <sysinfo.h>
47	#include <as.h>	47	#include <as.h>
48	#include <ddi.h>	48	#include <ddi.h>
49		49
50	/* Pointers to public variables with time */	50	/* Pointers to public variables with time */
51	struct {	51	struct {
52	volatile sysarg_t seconds1;	52	volatile sysarg_t seconds1;
53	volatile sysarg_t useconds;	53	volatile sysarg_t useconds;
54	volatile sysarg_t seconds2;	54	volatile sysarg_t seconds2;
55	} *ktime = NULL;	55	} *ktime = NULL;
56		56
57	/** Add microseconds to given timeval.	57	/** Add microseconds to given timeval.
58	*	58	*
59	* @param tv Destination timeval.	59	* @param tv Destination timeval.
60	* @param usecs Number of microseconds to add.	60	* @param usecs Number of microseconds to add.
61	*/	61	*/
62	void tv_add(struct timeval *tv, suseconds_t usecs)	62	void tv_add(struct timeval *tv, suseconds_t usecs)
63	{	63	{
64	tv->tv_sec += usecs / 1000000;	64	tv->tv_sec += usecs / 1000000;
65	tv->tv_usec += usecs % 1000000;	65	tv->tv_usec += usecs % 1000000;
66	if (tv->tv_usec > 1000000) {	66	if (tv->tv_usec > 1000000) {
67	tv->tv_sec++;	67	tv->tv_sec++;
68	tv->tv_usec -= 1000000;	68	tv->tv_usec -= 1000000;
69	}	69	}
70	}	70	}
71		71
72	/** Subtract two timevals.	72	/** Subtract two timevals.
73	*	73	*
74	* @param tv1 First timeval.	74	* @param tv1 First timeval.
75	* @param tv2 Second timeval.	75	* @param tv2 Second timeval.
76	*	76	*
77	* @return Return difference between tv1 and tv2 (tv1 - tv2) in	77	* @return Return difference between tv1 and tv2 (tv1 - tv2) in
78	* microseconds.	78	* microseconds.
79	*/	79	*/
80	suseconds_t tv_sub(struct timeval tv1, struct timeval tv2)	80	suseconds_t tv_sub(struct timeval tv1, struct timeval tv2)
81	{	81	{
82	suseconds_t result;	82	suseconds_t result;
83		83
84	result = tv1->tv_usec - tv2->tv_usec;	84	result = tv1->tv_usec - tv2->tv_usec;
85	result += (tv1->tv_sec - tv2->tv_sec) * 1000000;	85	result += (tv1->tv_sec - tv2->tv_sec) * 1000000;
86		86
87	return result;	87	return result;
88	}	88	}
89		89
90	/** Decide if one timeval is greater than the other.	90	/** Decide if one timeval is greater than the other.
91	*	91	*
92	* @param t1 First timeval.	92	* @param t1 First timeval.
93	* @param t2 Second timeval.	93	* @param t2 Second timeval.
94	*	94	*
95	* @return Return true tv1 is greater than tv2. Otherwise return	95	* @return Return true tv1 is greater than tv2. Otherwise return
96	* false.	96	* false.
97	*/	97	*/
98	int tv_gt(struct timeval tv1, struct timeval tv2)	98	int tv_gt(struct timeval tv1, struct timeval tv2)
99	{	99	{
100	if (tv1->tv_sec > tv2->tv_sec)	100	if (tv1->tv_sec > tv2->tv_sec)
101	return 1;	101	return 1;
102	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec > tv2->tv_usec)	102	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec > tv2->tv_usec)
103	return 1;	103	return 1;
104	return 0;	104	return 0;
105	}	105	}
106		106
107	/** Decide if one timeval is greater than or equal to the other.	107	/** Decide if one timeval is greater than or equal to the other.
108	*	108	*
109	* @param tv1 First timeval.	109	* @param tv1 First timeval.
110	* @param tv2 Second timeval.	110	* @param tv2 Second timeval.
111	*	111	*
112	* @return Return true if tv1 is greater than or equal to tv2.	112	* @return Return true if tv1 is greater than or equal to tv2.
113	* Otherwise return false.	113	* Otherwise return false.
114	*/	114	*/
115	int tv_gteq(struct timeval tv1, struct timeval tv2)	115	int tv_gteq(struct timeval tv1, struct timeval tv2)
116	{	116	{
117	if (tv1->tv_sec > tv2->tv_sec)	117	if (tv1->tv_sec > tv2->tv_sec)
118	return 1;	118	return 1;
119	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec >= tv2->tv_usec)	119	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec >= tv2->tv_usec)
120	return 1;	120	return 1;
121	return 0;	121	return 0;
122	}	122	}
123		123
124		124
125	/** POSIX gettimeofday	125	/** POSIX gettimeofday
126	*	126	*
127	* The time variables are memory mapped(RO) from kernel, which updates	127	* The time variables are memory mapped(RO) from kernel, which updates
128	* them periodically. As it is impossible to read 2 values atomically, we	128	* them periodically. As it is impossible to read 2 values atomically, we
129	* use a trick: First read a seconds, then read microseconds, then	129	* use a trick: First read a seconds, then read microseconds, then
130	* read seconds again. If a second elapsed in the meantime, set it to zero.	130	* read seconds again. If a second elapsed in the meantime, set it to zero.
131	* This provides assurance, that at least the	131	* This provides assurance, that at least the
132	* sequence of subsequent gettimeofday calls is ordered.	132	* sequence of subsequent gettimeofday calls is ordered.
133	*/	133	*/
134	int gettimeofday(struct timeval tv, struct timezone tz)	134	int gettimeofday(struct timeval tv, struct timezone tz)
135	{	135	{
136	void *mapping;	136	void *mapping;
137	sysarg_t s1, s2;	137	sysarg_t s1, s2;
138	int rights;	138	int rights;
139	int res;	139	int res;
140		140
141	if (!ktime) {	141	if (!ktime) {
142	mapping = as_get_mappable_page(PAGE_SIZE);	142	mapping = as_get_mappable_page(PAGE_SIZE);
143	/* Get the mapping of kernel clock */	143	/* Get the mapping of kernel clock */
144	res = ipc_share_in_send_1_1(PHONE_NS, mapping, PAGE_SIZE,	144	res = ipc_share_in_start_1_1(PHONE_NS, mapping, PAGE_SIZE,
145	SERVICE_MEM_REALTIME, &rights);	145	SERVICE_MEM_REALTIME, &rights);
146	if (res) {	146	if (res) {
147	printf("Failed to initialize timeofday memarea\n");	147	printf("Failed to initialize timeofday memarea\n");
148	_exit(1);	148	_exit(1);
149	}	149	}
150	if (!(rights & AS_AREA_READ)) {	150	if (!(rights & AS_AREA_READ)) {
151	printf("Received bad rights on time area: %X\n",	151	printf("Received bad rights on time area: %X\n",
152	rights);	152	rights);
153	as_area_destroy(mapping);	153	as_area_destroy(mapping);
154	_exit(1);	154	_exit(1);
155	}	155	}
156	ktime = mapping;	156	ktime = mapping;
157	}	157	}
158	if (tz) {	158	if (tz) {
159	tz->tz_minuteswest = 0;	159	tz->tz_minuteswest = 0;
160	tz->tz_dsttime = DST_NONE;	160	tz->tz_dsttime = DST_NONE;
161	}	161	}
162		162
163	s2 = ktime->seconds2;	163	s2 = ktime->seconds2;
164	read_barrier();	164	read_barrier();
165	tv->tv_usec = ktime->useconds;	165	tv->tv_usec = ktime->useconds;
166	read_barrier();	166	read_barrier();
167	s1 = ktime->seconds1;	167	s1 = ktime->seconds1;
168	if (s1 != s2) {	168	if (s1 != s2) {
169	tv->tv_usec = 0;	169	tv->tv_usec = 0;
170	tv->tv_sec = s1 > s2 ? s1 : s2;	170	tv->tv_sec = s1 > s2 ? s1 : s2;
171	} else	171	} else
172	tv->tv_sec = s1;	172	tv->tv_sec = s1;
173		173
174	return 0;	174	return 0;
175	}	175	}
176		176
177	time_t time(time_t *tloc)	177	time_t time(time_t *tloc)
178	{	178	{
179	struct timeval tv;	179	struct timeval tv;
180		180
181	if (gettimeofday(&tv, NULL))	181	if (gettimeofday(&tv, NULL))
182	return (time_t) -1;	182	return (time_t) -1;
183	if (tloc)	183	if (tloc)
184	*tloc = tv.tv_sec;	184	*tloc = tv.tv_sec;
185	return tv.tv_sec;	185	return tv.tv_sec;
186	}	186	}
187		187
188	/** Wait unconditionally for specified number of microseconds */	188	/** Wait unconditionally for specified number of microseconds */
189	int usleep(unsigned long usec)	189	int usleep(unsigned long usec)
190	{	190	{
191	atomic_t futex = FUTEX_INITIALIZER;	191	atomic_t futex = FUTEX_INITIALIZER;
192		192
193	futex_initialize(&futex, 0);	193	futex_initialize(&futex, 0);
194	futex_down_timeout(&futex, usec, 0);	194	futex_down_timeout(&futex, usec, 0);
195	return 0;	195	return 0;
196	}	196	}
197		197
198	/** Wait unconditionally for specified number of seconds */	198	/** Wait unconditionally for specified number of seconds */
199	unsigned int sleep(unsigned int seconds)	199	unsigned int sleep(unsigned int seconds)
200	{	200	{
201	atomic_t futex = FUTEX_INITIALIZER;	201	atomic_t futex = FUTEX_INITIALIZER;
202		202
203	futex_initialize(&futex, 0);	203	futex_initialize(&futex, 0);
204		204
205	/* Sleep in 1000 second steps to support	205	/* Sleep in 1000 second steps to support
206	full argument range */	206	full argument range */
207	while (seconds > 0) {	207	while (seconds > 0) {
208	unsigned int period = (seconds > 1000) ? 1000 : seconds;	208	unsigned int period = (seconds > 1000) ? 1000 : seconds;
209		209
210	futex_down_timeout(&futex, period * 1000000, 0);	210	futex_down_timeout(&futex, period * 1000000, 0);
211	seconds -= period;	211	seconds -= period;
212	}	212	}
213	return 0;	213	return 0;
214	}	214	}
215		215
216	/** @}	216	/** @}
217	*/	217	*/
218		218

Subversion Repositories HelenOS

(root)/trunk/uspace/lib/libc/generic/time.c – Rev 2677 → 2678