WebSVN – HelenOS – Diff – /tags/0.4.1/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>
 
#include <time.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 3488	Rev 4687
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	#include <time.h>	50	#include <time.h>
51		51
52	/* Pointers to public variables with time */	52	/* Pointers to public variables with time */
53	struct {	53	struct {
54	volatile sysarg_t seconds1;	54	volatile sysarg_t seconds1;
55	volatile sysarg_t useconds;	55	volatile sysarg_t useconds;
56	volatile sysarg_t seconds2;	56	volatile sysarg_t seconds2;
57	} *ktime = NULL;	57	} *ktime = NULL;
58		58
59	/** Add microseconds to given timeval.	59	/** Add microseconds to given timeval.
60	*	60	*
61	* @param tv Destination timeval.	61	* @param tv Destination timeval.
62	* @param usecs Number of microseconds to add.	62	* @param usecs Number of microseconds to add.
63	*/	63	*/
64	void tv_add(struct timeval *tv, suseconds_t usecs)	64	void tv_add(struct timeval *tv, suseconds_t usecs)
65	{	65	{
66	tv->tv_sec += usecs / 1000000;	66	tv->tv_sec += usecs / 1000000;
67	tv->tv_usec += usecs % 1000000;	67	tv->tv_usec += usecs % 1000000;
68	if (tv->tv_usec > 1000000) {	68	if (tv->tv_usec > 1000000) {
69	tv->tv_sec++;	69	tv->tv_sec++;
70	tv->tv_usec -= 1000000;	70	tv->tv_usec -= 1000000;
71	}	71	}
72	}	72	}
73		73
74	/** Subtract two timevals.	74	/** Subtract two timevals.
75	*	75	*
76	* @param tv1 First timeval.	76	* @param tv1 First timeval.
77	* @param tv2 Second timeval.	77	* @param tv2 Second timeval.
78	*	78	*
79	* @return Return difference between tv1 and tv2 (tv1 - tv2) in	79	* @return Return difference between tv1 and tv2 (tv1 - tv2) in
80	* microseconds.	80	* microseconds.
81	*/	81	*/
82	suseconds_t tv_sub(struct timeval tv1, struct timeval tv2)	82	suseconds_t tv_sub(struct timeval tv1, struct timeval tv2)
83	{	83	{
84	suseconds_t result;	84	suseconds_t result;
85		85
86	result = tv1->tv_usec - tv2->tv_usec;	86	result = tv1->tv_usec - tv2->tv_usec;
87	result += (tv1->tv_sec - tv2->tv_sec) * 1000000;	87	result += (tv1->tv_sec - tv2->tv_sec) * 1000000;
88		88
89	return result;	89	return result;
90	}	90	}
91		91
92	/** Decide if one timeval is greater than the other.	92	/** Decide if one timeval is greater than the other.
93	*	93	*
94	* @param t1 First timeval.	94	* @param t1 First timeval.
95	* @param t2 Second timeval.	95	* @param t2 Second timeval.
96	*	96	*
97	* @return Return true tv1 is greater than tv2. Otherwise return	97	* @return Return true tv1 is greater than tv2. Otherwise return
98	* false.	98	* false.
99	*/	99	*/
100	int tv_gt(struct timeval tv1, struct timeval tv2)	100	int tv_gt(struct timeval tv1, struct timeval tv2)
101	{	101	{
102	if (tv1->tv_sec > tv2->tv_sec)	102	if (tv1->tv_sec > tv2->tv_sec)
103	return 1;	103	return 1;
104	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec > tv2->tv_usec)	104	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec > tv2->tv_usec)
105	return 1;	105	return 1;
106	return 0;	106	return 0;
107	}	107	}
108		108
109	/** Decide if one timeval is greater than or equal to the other.	109	/** Decide if one timeval is greater than or equal to the other.
110	*	110	*
111	* @param tv1 First timeval.	111	* @param tv1 First timeval.
112	* @param tv2 Second timeval.	112	* @param tv2 Second timeval.
113	*	113	*
114	* @return Return true if tv1 is greater than or equal to tv2.	114	* @return Return true if tv1 is greater than or equal to tv2.
115	* Otherwise return false.	115	* Otherwise return false.
116	*/	116	*/
117	int tv_gteq(struct timeval tv1, struct timeval tv2)	117	int tv_gteq(struct timeval tv1, struct timeval tv2)
118	{	118	{
119	if (tv1->tv_sec > tv2->tv_sec)	119	if (tv1->tv_sec > tv2->tv_sec)
120	return 1;	120	return 1;
121	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec >= tv2->tv_usec)	121	if (tv1->tv_sec == tv2->tv_sec && tv1->tv_usec >= tv2->tv_usec)
122	return 1;	122	return 1;
123	return 0;	123	return 0;
124	}	124	}
125		125
126		126
127	/** POSIX gettimeofday	127	/** POSIX gettimeofday
128	*	128	*
129	* The time variables are memory mapped(RO) from kernel, which updates	129	* The time variables are memory mapped(RO) from kernel, which updates
130	* them periodically. As it is impossible to read 2 values atomically, we	130	* them periodically. As it is impossible to read 2 values atomically, we
131	* use a trick: First read a seconds, then read microseconds, then	131	* use a trick: First read a seconds, then read microseconds, then
132	* read seconds again. If a second elapsed in the meantime, set it to zero.	132	* read seconds again. If a second elapsed in the meantime, set it to zero.
133	* This provides assurance, that at least the	133	* This provides assurance, that at least the
134	* sequence of subsequent gettimeofday calls is ordered.	134	* sequence of subsequent gettimeofday calls is ordered.
135	*/	135	*/
136	int gettimeofday(struct timeval tv, struct timezone tz)	136	int gettimeofday(struct timeval tv, struct timezone tz)
137	{	137	{
138	void *mapping;	138	void *mapping;
139	sysarg_t s1, s2;	139	sysarg_t s1, s2;
140	int rights;	140	int rights;
141	int res;	141	int res;
142		142
143	if (!ktime) {	143	if (!ktime) {
144	mapping = as_get_mappable_page(PAGE_SIZE);	144	mapping = as_get_mappable_page(PAGE_SIZE);
145	/* Get the mapping of kernel clock */	145	/* Get the mapping of kernel clock */
146	res = ipc_share_in_start_1_1(PHONE_NS, mapping, PAGE_SIZE,	146	res = ipc_share_in_start_1_1(PHONE_NS, mapping, PAGE_SIZE,
147	SERVICE_MEM_REALTIME, &rights);	147	SERVICE_MEM_REALTIME, &rights);
148	if (res) {	148	if (res) {
149	printf("Failed to initialize timeofday memarea\n");	149	printf("Failed to initialize timeofday memarea\n");
150	_exit(1);	150	_exit(1);
151	}	151	}
152	if (!(rights & AS_AREA_READ)) {	152	if (!(rights & AS_AREA_READ)) {
153	printf("Received bad rights on time area: %X\n",	153	printf("Received bad rights on time area: %X\n",
154	rights);	154	rights);
155	as_area_destroy(mapping);	155	as_area_destroy(mapping);
156	_exit(1);	156	_exit(1);
157	}	157	}
158	ktime = mapping;	158	ktime = mapping;
159	}	159	}
160	if (tz) {	160	if (tz) {
161	tz->tz_minuteswest = 0;	161	tz->tz_minuteswest = 0;
162	tz->tz_dsttime = DST_NONE;	162	tz->tz_dsttime = DST_NONE;
163	}	163	}
164		164
165	s2 = ktime->seconds2;	165	s2 = ktime->seconds2;
166	read_barrier();	166	read_barrier();
167	tv->tv_usec = ktime->useconds;	167	tv->tv_usec = ktime->useconds;
168	read_barrier();	168	read_barrier();
169	s1 = ktime->seconds1;	169	s1 = ktime->seconds1;
170	if (s1 != s2) {	170	if (s1 != s2) {
171	tv->tv_usec = 0;	171	tv->tv_usec = 0;
172	tv->tv_sec = s1 > s2 ? s1 : s2;	172	tv->tv_sec = s1 > s2 ? s1 : s2;
173	} else	173	} else
174	tv->tv_sec = s1;	174	tv->tv_sec = s1;
175		175
176	return 0;	176	return 0;
177	}	177	}
178		178
179	time_t time(time_t *tloc)	179	time_t time(time_t *tloc)
180	{	180	{
181	struct timeval tv;	181	struct timeval tv;
182		182
183	if (gettimeofday(&tv, NULL))	183	if (gettimeofday(&tv, NULL))
184	return (time_t) -1;	184	return (time_t) -1;
185	if (tloc)	185	if (tloc)
186	*tloc = tv.tv_sec;	186	*tloc = tv.tv_sec;
187	return tv.tv_sec;	187	return tv.tv_sec;
188	}	188	}
189		189
190	/** Wait unconditionally for specified number of microseconds */	190	/** Wait unconditionally for specified number of microseconds */
191	int usleep(unsigned long usec)	191	int usleep(unsigned long usec)
192	{	192	{
193	atomic_t futex = FUTEX_INITIALIZER;	193	atomic_t futex = FUTEX_INITIALIZER;
194		194
195	futex_initialize(&futex, 0);	195	futex_initialize(&futex, 0);
196	futex_down_timeout(&futex, usec, 0);	196	futex_down_timeout(&futex, usec, 0);
197	return 0;	197	return 0;
198	}	198	}
199		199
200	/** Wait unconditionally for specified number of seconds */	200	/** Wait unconditionally for specified number of seconds */
201	unsigned int sleep(unsigned int seconds)	201	unsigned int sleep(unsigned int seconds)
202	{	202	{
203	atomic_t futex = FUTEX_INITIALIZER;	203	atomic_t futex = FUTEX_INITIALIZER;
204		204
205	futex_initialize(&futex, 0);	205	futex_initialize(&futex, 0);
206		206
207	/* Sleep in 1000 second steps to support	207	/* Sleep in 1000 second steps to support
208	full argument range */	208	full argument range */
209	while (seconds > 0) {	209	while (seconds > 0) {
210	unsigned int period = (seconds > 1000) ? 1000 : seconds;	210	unsigned int period = (seconds > 1000) ? 1000 : seconds;
211		211
212	futex_down_timeout(&futex, period * 1000000, 0);	212	futex_down_timeout(&futex, period * 1000000, 0);
213	seconds -= period;	213	seconds -= period;
214	}	214	}
215	return 0;	215	return 0;
216	}	216	}
217		217
218	/** @}	218	/** @}
219	*/	219	*/
220		220

Subversion Repositories HelenOS

(root)/tags/0.4.1/uspace/lib/libc/generic/time.c – Rev 3488 → 4687