src/Unix/timer_unix.cpp

/*
 *  timer_unix.cpp - Time Manager emulation, Unix specific stuff
 *
 *  Basilisk II (C) 1997-2008 Christian Bauer
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#include "sysdeps.h"
#include "macos_util.h"
#include "timer.h"

#include <errno.h>

#define DEBUG 0
#include "debug.h"

// For NetBSD with broken pthreads headers
#ifndef CLOCK_REALTIME
#define CLOCK_REALTIME 0
#endif

#if defined(__MACH__)
#include <mach/mach.h>
#include <mach/clock.h>

static clock_serv_t host_clock;
static bool host_clock_inited = false;

static inline void mach_current_time(tm_time_t &t) {
        if(!host_clock_inited) {
                host_get_clock_service(mach_host_self(), SYSTEM_CLOCK, &host_clock);
                host_clock_inited = true;
        }
        
        clock_get_time(host_clock, &t);
}
#endif


/*
 *  Return microseconds since boot (64 bit)
 */

void Microseconds(uint32 &hi, uint32 &lo)
{
        D(bug("Microseconds\n"));
#if defined(HAVE_CLOCK_GETTIME)
        struct timespec t;
        clock_gettime(CLOCK_REALTIME, &t);
        uint64 tl = (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
#elif defined(__MACH__)
        tm_time_t t;
        mach_current_time(t);
        uint64 tl = (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
#else
        struct timeval t;
        gettimeofday(&t, NULL);
        uint64 tl = (uint64)t.tv_sec * 1000000 + t.tv_usec;
#endif
        hi = tl >> 32;
        lo = tl;
}


/*
 *  Return local date/time in Mac format (seconds since 1.1.1904)
 */

uint32 TimerDateTime(void)
{
        return TimeToMacTime(time(NULL));
}


/*
 *  Get current time
 */

void timer_current_time(tm_time_t &t)
{
#ifdef HAVE_CLOCK_GETTIME
        clock_gettime(CLOCK_REALTIME, &t);
#elif defined(__MACH__)
        mach_current_time(t);
#else
        gettimeofday(&t, NULL);
#endif
}


/*
 *  Add times
 */

void timer_add_time(tm_time_t &res, tm_time_t a, tm_time_t b)
{
#if defined(HAVE_CLOCK_GETTIME) || defined(__MACH__)
        res.tv_sec = a.tv_sec + b.tv_sec;
        res.tv_nsec = a.tv_nsec + b.tv_nsec;
        if (res.tv_nsec >= 1000000000) {
                res.tv_sec++;
                res.tv_nsec -= 1000000000;
        }
#else
        res.tv_sec = a.tv_sec + b.tv_sec;
        res.tv_usec = a.tv_usec + b.tv_usec;
        if (res.tv_usec >= 1000000) {
                res.tv_sec++;
                res.tv_usec -= 1000000;
        }
#endif
}


/*
 *  Subtract times
 */

void timer_sub_time(tm_time_t &res, tm_time_t a, tm_time_t b)
{
#if defined(HAVE_CLOCK_GETTIME) || defined(__MACH__)
        res.tv_sec = a.tv_sec - b.tv_sec;
        res.tv_nsec = a.tv_nsec - b.tv_nsec;
        if (res.tv_nsec < 0) {
                res.tv_sec--;
                res.tv_nsec += 1000000000;
        }
#else
        res.tv_sec = a.tv_sec - b.tv_sec;
        res.tv_usec = a.tv_usec - b.tv_usec;
        if (res.tv_usec < 0) {
                res.tv_sec--;
                res.tv_usec += 1000000;
        }
#endif
}


/*
 *  Compare times (<0: a < b, =0: a = b, >0: a > b)
 */

int timer_cmp_time(tm_time_t a, tm_time_t b)
{
#if defined(HAVE_CLOCK_GETTIME) || defined(__MACH__)
        if (a.tv_sec == b.tv_sec)
                return a.tv_nsec - b.tv_nsec;
        else
                return a.tv_sec - b.tv_sec;
#else
        if (a.tv_sec == b.tv_sec)
                return a.tv_usec - b.tv_usec;
        else
                return a.tv_sec - b.tv_sec;
#endif
}


/*
 *  Convert Mac time value (>0: microseconds, <0: microseconds) to tm_time_t
 */

void timer_mac2host_time(tm_time_t &res, int32 mactime)
{
#if defined(HAVE_CLOCK_GETTIME) || defined(__MACH__)
        if (mactime > 0) {
                // Time in milliseconds
                res.tv_sec = mactime / 1000;
                res.tv_nsec = (mactime % 1000) * 1000000;
        } else {
                // Time in negative microseconds
                res.tv_sec = -mactime / 1000000;
                res.tv_nsec = (-mactime % 1000000) * 1000;
        }
#else
        if (mactime > 0) {
                // Time in milliseconds
                res.tv_sec = mactime / 1000;
                res.tv_usec = (mactime % 1000) * 1000;
        } else {
                // Time in negative microseconds
                res.tv_sec = -mactime / 1000000;
                res.tv_usec = -mactime % 1000000;
        }
#endif
}


/*
 *  Convert positive tm_time_t to Mac time value (>0: microseconds, <0: microseconds)
 *  A negative input value for hosttime results in a zero return value
 *  As long as the microseconds value fits in 32 bit, it must not be converted to milliseconds!
 */

int32 timer_host2mac_time(tm_time_t hosttime)
{
        if (hosttime.tv_sec < 0)
                return 0;
        else {
#if defined(HAVE_CLOCK_GETTIME) || defined(__MACH__)
                uint64 t = (uint64)hosttime.tv_sec * 1000000 + hosttime.tv_nsec / 1000;
#else
                uint64 t = (uint64)hosttime.tv_sec * 1000000 + hosttime.tv_usec;
#endif
                if (t > 0x7fffffff)
                        return t / 1000;        // Time in milliseconds
                else
                        return -t;                      // Time in negative microseconds
        }
}


/*
 *  Get current value of microsecond timer
 */

uint64 GetTicks_usec(void)
{
#ifdef HAVE_CLOCK_GETTIME
        struct timespec t;
        clock_gettime(CLOCK_REALTIME, &t);
        return (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
#elif defined(__MACH__)
        tm_time_t t;
        mach_current_time(t);
        return (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
#else
        struct timeval t;
        gettimeofday(&t, NULL);
        return (uint64)t.tv_sec * 1000000 + t.tv_usec;
#endif
}


/*
 *  Delay by specified number of microseconds (<1 second)
 *  (adapted from SDL_Delay() source; this function is designed to provide
 *  the highest accuracy possible)
 */

#if defined(linux)
// Linux select() changes its timeout parameter upon return to contain
// the remaining time. Most other unixen leave it unchanged or undefined.
#define SELECT_SETS_REMAINING
#elif defined(__FreeBSD__) || defined(__sun__) || (defined(__MACH__) && defined(__APPLE__))
#define USE_NANOSLEEP
#elif defined(HAVE_PTHREADS) && defined(sgi)
// SGI pthreads has a bug when using pthreads+signals+nanosleep,
// so instead of using nanosleep, wait on a CV which is never signalled.
#include <pthread.h>
#define USE_COND_TIMEDWAIT
#endif

void Delay_usec(uint32 usec)
{
        int was_error;

#if defined(USE_NANOSLEEP)
        struct timespec elapsed, tv;
#elif defined(USE_COND_TIMEDWAIT)
        // Use a local mutex and cv, so threads remain independent
        pthread_cond_t delay_cond = PTHREAD_COND_INITIALIZER;
        pthread_mutex_t delay_mutex = PTHREAD_MUTEX_INITIALIZER;
        struct timespec elapsed;
        uint64 future;
#else
        struct timeval tv;
#ifndef SELECT_SETS_REMAINING
        uint64 then, now, elapsed;
#endif
#endif

        // Set the timeout interval - Linux only needs to do this once
#if defined(SELECT_SETS_REMAINING)
    tv.tv_sec = 0;
    tv.tv_usec = usec;
#elif defined(USE_NANOSLEEP)
    elapsed.tv_sec = 0;
    elapsed.tv_nsec = usec * 1000;
#elif defined(USE_COND_TIMEDWAIT)
        future = GetTicks_usec() + usec;
        elapsed.tv_sec = future / 1000000;
        elapsed.tv_nsec = (future % 1000000) * 1000;
#else
    then = GetTicks_usec();
#endif

        do {
                errno = 0;
#if defined(USE_NANOSLEEP)
                tv.tv_sec = elapsed.tv_sec;
                tv.tv_nsec = elapsed.tv_nsec;
                was_error = nanosleep(&tv, &elapsed);
#elif defined(USE_COND_TIMEDWAIT)
                was_error = pthread_mutex_lock(&delay_mutex);
                was_error = pthread_cond_timedwait(&delay_cond, &delay_mutex, &elapsed);
                was_error = pthread_mutex_unlock(&delay_mutex);
#else
#ifndef SELECT_SETS_REMAINING
                // Calculate the time interval left (in case of interrupt)
                now = GetTicks_usec();
                elapsed = now - then;
                then = now;
                if (elapsed >= usec)
                        break;
                usec -= elapsed;
                tv.tv_sec = 0;
                tv.tv_usec = usec;
#endif
                was_error = select(0, NULL, NULL, NULL, &tv);
#endif
        } while (was_error && (errno == EINTR));
}


/*
 *  Suspend emulator thread, virtual CPU in idle mode
 */

#ifdef HAVE_PTHREADS
#if defined(HAVE_PTHREAD_COND_INIT)
#define IDLE_USES_COND_WAIT 1
static pthread_mutex_t idle_lock = PTHREAD_MUTEX_INITIALIZER;
static pthread_cond_t idle_cond = PTHREAD_COND_INITIALIZER;
#elif defined(HAVE_SEM_INIT)
#define IDLE_USES_SEMAPHORE 1
#include <semaphore.h>
#ifdef HAVE_SPINLOCKS
static spinlock_t idle_lock = SPIN_LOCK_UNLOCKED;
#define LOCK_IDLE spin_lock(&idle_lock)
#define UNLOCK_IDLE spin_unlock(&idle_lock)
#else
static pthread_mutex_t idle_lock = PTHREAD_MUTEX_INITIALIZER;
#define LOCK_IDLE pthread_mutex_lock(&idle_lock)
#define UNLOCK_IDLE pthread_mutex_unlock(&idle_lock)
#endif
static sem_t idle_sem;
static int idle_sem_ok = -1;
#endif
#endif

void idle_wait(void)
{
#ifdef IDLE_USES_COND_WAIT
        pthread_mutex_lock(&idle_lock);
        pthread_cond_wait(&idle_cond, &idle_lock);
        pthread_mutex_unlock(&idle_lock);
#else
#ifdef IDLE_USES_SEMAPHORE
        LOCK_IDLE;
        if (idle_sem_ok < 0)
                idle_sem_ok = (sem_init(&idle_sem, 0, 0) == 0);
        if (idle_sem_ok > 0) {
                idle_sem_ok++;
                UNLOCK_IDLE;
                sem_wait(&idle_sem);
                return;
        }
        UNLOCK_IDLE;
#endif

        // Fallback: sleep 10 ms
        Delay_usec(10000);
#endif
}


/*
 *  Resume execution of emulator thread, events just arrived
 */

void idle_resume(void)
{
#ifdef IDLE_USES_COND_WAIT
        pthread_cond_signal(&idle_cond);
#else
#ifdef IDLE_USES_SEMAPHORE
        LOCK_IDLE;
        if (idle_sem_ok > 1) {
                idle_sem_ok--;
                UNLOCK_IDLE;
                sem_post(&idle_sem);
                return;
        }
        UNLOCK_IDLE;
#endif
#endif
}
Revision:	1.22
Committed:	2009-08-21T17:39:58Z (15 years, 3 months ago) by asvitkine
Branch:	MAIN
CVS Tags:	HEAD
Changes since 1.21:	+1 -1 lines
Log Message:	Change #include <mach/mach_host.h> to #include <mach/mach.h>
#	User	Rev	Content
1	cebix	1.1	/*
2			* timer_unix.cpp - Time Manager emulation, Unix specific stuff
3			*
4	gbeauche	1.20	* Basilisk II (C) 1997-2008 Christian Bauer
5	cebix	1.1	*
6			* This program is free software; you can redistribute it and/or modify
7			* it under the terms of the GNU General Public License as published by
8			* the Free Software Foundation; either version 2 of the License, or
9			* (at your option) any later version.
10			*
11			* This program is distributed in the hope that it will be useful,
12			* but WITHOUT ANY WARRANTY; without even the implied warranty of
13			* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14			* GNU General Public License for more details.
15			*
16			* You should have received a copy of the GNU General Public License
17			* along with this program; if not, write to the Free Software
18			* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19			*/
20
21			#include "sysdeps.h"
22	cebix	1.10	#include "macos_util.h"
23	cebix	1.1	#include "timer.h"
24
25	cebix	1.11	#include <errno.h>
26
27	cebix	1.1	#define DEBUG 0
28			#include "debug.h"
29
30	cebix	1.8	// For NetBSD with broken pthreads headers
31			#ifndef CLOCK_REALTIME
32			#define CLOCK_REALTIME 0
33			#endif
34
35	asvitkine	1.21	#if defined(__MACH__)
36	asvitkine	1.22	#include <mach/mach.h>
37	asvitkine	1.21	#include <mach/clock.h>
38
39			static clock_serv_t host_clock;
40			static bool host_clock_inited = false;
41
42			static inline void mach_current_time(tm_time_t &t) {
43			if(!host_clock_inited) {
44			host_get_clock_service(mach_host_self(), SYSTEM_CLOCK, &host_clock);
45			host_clock_inited = true;
46			}
47
48			clock_get_time(host_clock, &t);
49			}
50			#endif
51
52	cebix	1.1
53			/*
54			* Return microseconds since boot (64 bit)
55			*/
56
57			void Microseconds(uint32 &hi, uint32 &lo)
58			{
59			D(bug("Microseconds\n"));
60	asvitkine	1.21	#if defined(HAVE_CLOCK_GETTIME)
61	cebix	1.1	struct timespec t;
62			clock_gettime(CLOCK_REALTIME, &t);
63			uint64 tl = (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
64	asvitkine	1.21	#elif defined(__MACH__)
65			tm_time_t t;
66			mach_current_time(t);
67			uint64 tl = (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
68	cebix	1.1	#else
69			struct timeval t;
70			gettimeofday(&t, NULL);
71			uint64 tl = (uint64)t.tv_sec * 1000000 + t.tv_usec;
72			#endif
73			hi = tl >> 32;
74			lo = tl;
75			}
76
77
78			/*
79			* Return local date/time in Mac format (seconds since 1.1.1904)
80			*/
81
82			uint32 TimerDateTime(void)
83			{
84	cebix	1.10	return TimeToMacTime(time(NULL));
85	cebix	1.1	}
86
87
88			/*
89			* Get current time
90			*/
91
92			void timer_current_time(tm_time_t &t)
93			{
94			#ifdef HAVE_CLOCK_GETTIME
95			clock_gettime(CLOCK_REALTIME, &t);
96	asvitkine	1.21	#elif defined(__MACH__)
97			mach_current_time(t);
98	cebix	1.1	#else
99			gettimeofday(&t, NULL);
100			#endif
101			}
102
103
104			/*
105			* Add times
106			*/
107
108			void timer_add_time(tm_time_t &res, tm_time_t a, tm_time_t b)
109			{
110	asvitkine	1.21	#if defined(HAVE_CLOCK_GETTIME) \|\| defined(__MACH__)
111	cebix	1.1	res.tv_sec = a.tv_sec + b.tv_sec;
112			res.tv_nsec = a.tv_nsec + b.tv_nsec;
113			if (res.tv_nsec >= 1000000000) {
114			res.tv_sec++;
115			res.tv_nsec -= 1000000000;
116			}
117			#else
118			res.tv_sec = a.tv_sec + b.tv_sec;
119			res.tv_usec = a.tv_usec + b.tv_usec;
120			if (res.tv_usec >= 1000000) {
121			res.tv_sec++;
122			res.tv_usec -= 1000000;
123			}
124			#endif
125			}
126
127
128			/*
129			* Subtract times
130			*/
131
132			void timer_sub_time(tm_time_t &res, tm_time_t a, tm_time_t b)
133			{
134	asvitkine	1.21	#if defined(HAVE_CLOCK_GETTIME) \|\| defined(__MACH__)
135	cebix	1.1	res.tv_sec = a.tv_sec - b.tv_sec;
136			res.tv_nsec = a.tv_nsec - b.tv_nsec;
137			if (res.tv_nsec < 0) {
138			res.tv_sec--;
139			res.tv_nsec += 1000000000;
140			}
141			#else
142			res.tv_sec = a.tv_sec - b.tv_sec;
143			res.tv_usec = a.tv_usec - b.tv_usec;
144			if (res.tv_usec < 0) {
145			res.tv_sec--;
146			res.tv_usec += 1000000;
147			}
148			#endif
149			}
150
151
152			/*
153			* Compare times (<0: a < b, =0: a = b, >0: a > b)
154			*/
155
156			int timer_cmp_time(tm_time_t a, tm_time_t b)
157			{
158	asvitkine	1.21	#if defined(HAVE_CLOCK_GETTIME) \|\| defined(__MACH__)
159	cebix	1.1	if (a.tv_sec == b.tv_sec)
160			return a.tv_nsec - b.tv_nsec;
161			else
162			return a.tv_sec - b.tv_sec;
163			#else
164			if (a.tv_sec == b.tv_sec)
165			return a.tv_usec - b.tv_usec;
166			else
167			return a.tv_sec - b.tv_sec;
168			#endif
169			}
170
171
172			/*
173			* Convert Mac time value (>0: microseconds, <0: microseconds) to tm_time_t
174			*/
175
176			void timer_mac2host_time(tm_time_t &res, int32 mactime)
177			{
178	asvitkine	1.21	#if defined(HAVE_CLOCK_GETTIME) \|\| defined(__MACH__)
179	cebix	1.1	if (mactime > 0) {
180			// Time in milliseconds
181			res.tv_sec = mactime / 1000;
182			res.tv_nsec = (mactime % 1000) * 1000000;
183			} else {
184			// Time in negative microseconds
185			res.tv_sec = -mactime / 1000000;
186			res.tv_nsec = (-mactime % 1000000) * 1000;
187			}
188			#else
189			if (mactime > 0) {
190			// Time in milliseconds
191			res.tv_sec = mactime / 1000;
192			res.tv_usec = (mactime % 1000) * 1000;
193			} else {
194			// Time in negative microseconds
195			res.tv_sec = -mactime / 1000000;
196			res.tv_usec = -mactime % 1000000;
197			}
198			#endif
199			}
200
201
202			/*
203			* Convert positive tm_time_t to Mac time value (>0: microseconds, <0: microseconds)
204			* A negative input value for hosttime results in a zero return value
205			* As long as the microseconds value fits in 32 bit, it must not be converted to milliseconds!
206			*/
207
208			int32 timer_host2mac_time(tm_time_t hosttime)
209			{
210			if (hosttime.tv_sec < 0)
211			return 0;
212			else {
213	asvitkine	1.21	#if defined(HAVE_CLOCK_GETTIME) \|\| defined(__MACH__)
214	cebix	1.1	uint64 t = (uint64)hosttime.tv_sec * 1000000 + hosttime.tv_nsec / 1000;
215			#else
216			uint64 t = (uint64)hosttime.tv_sec * 1000000 + hosttime.tv_usec;
217			#endif
218			if (t > 0x7fffffff)
219			return t / 1000; // Time in milliseconds
220			else
221			return -t; // Time in negative microseconds
222			}
223	cebix	1.11	}
224
225
226			/*
227			* Get current value of microsecond timer
228			*/
229
230			uint64 GetTicks_usec(void)
231			{
232			#ifdef HAVE_CLOCK_GETTIME
233			struct timespec t;
234			clock_gettime(CLOCK_REALTIME, &t);
235			return (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
236	asvitkine	1.21	#elif defined(__MACH__)
237			tm_time_t t;
238			mach_current_time(t);
239			return (uint64)t.tv_sec * 1000000 + t.tv_nsec / 1000;
240	cebix	1.11	#else
241			struct timeval t;
242			gettimeofday(&t, NULL);
243			return (uint64)t.tv_sec * 1000000 + t.tv_usec;
244			#endif
245			}
246
247
248			/*
249			* Delay by specified number of microseconds (<1 second)
250			* (adapted from SDL_Delay() source; this function is designed to provide
251			* the highest accuracy possible)
252			*/
253
254			#if defined(linux)
255			// Linux select() changes its timeout parameter upon return to contain
256			// the remaining time. Most other unixen leave it unchanged or undefined.
257			#define SELECT_SETS_REMAINING
258	gbeauche	1.16	#elif defined(__FreeBSD__) \|\| defined(__sun__) \|\| (defined(__MACH__) && defined(__APPLE__))
259	cebix	1.11	#define USE_NANOSLEEP
260			#elif defined(HAVE_PTHREADS) && defined(sgi)
261			// SGI pthreads has a bug when using pthreads+signals+nanosleep,
262			// so instead of using nanosleep, wait on a CV which is never signalled.
263	cebix	1.12	#include <pthread.h>
264	cebix	1.11	#define USE_COND_TIMEDWAIT
265			#endif
266
267			void Delay_usec(uint32 usec)
268			{
269			int was_error;
270
271			#if defined(USE_NANOSLEEP)
272			struct timespec elapsed, tv;
273			#elif defined(USE_COND_TIMEDWAIT)
274			// Use a local mutex and cv, so threads remain independent
275			pthread_cond_t delay_cond = PTHREAD_COND_INITIALIZER;
276			pthread_mutex_t delay_mutex = PTHREAD_MUTEX_INITIALIZER;
277			struct timespec elapsed;
278			uint64 future;
279			#else
280			struct timeval tv;
281			#ifndef SELECT_SETS_REMAINING
282			uint64 then, now, elapsed;
283			#endif
284			#endif
285
286			// Set the timeout interval - Linux only needs to do this once
287			#if defined(SELECT_SETS_REMAINING)
288			tv.tv_sec = 0;
289			tv.tv_usec = usec;
290			#elif defined(USE_NANOSLEEP)
291			elapsed.tv_sec = 0;
292			elapsed.tv_nsec = usec * 1000;
293			#elif defined(USE_COND_TIMEDWAIT)
294			future = GetTicks_usec() + usec;
295			elapsed.tv_sec = future / 1000000;
296			elapsed.tv_nsec = (future % 1000000) * 1000;
297			#else
298			then = GetTicks_usec();
299			#endif
300
301			do {
302			errno = 0;
303			#if defined(USE_NANOSLEEP)
304			tv.tv_sec = elapsed.tv_sec;
305			tv.tv_nsec = elapsed.tv_nsec;
306			was_error = nanosleep(&tv, &elapsed);
307			#elif defined(USE_COND_TIMEDWAIT)
308			was_error = pthread_mutex_lock(&delay_mutex);
309			was_error = pthread_cond_timedwait(&delay_cond, &delay_mutex, &elapsed);
310			was_error = pthread_mutex_unlock(&delay_mutex);
311			#else
312			#ifndef SELECT_SETS_REMAINING
313			// Calculate the time interval left (in case of interrupt)
314			now = GetTicks_usec();
315			elapsed = now - then;
316			then = now;
317			if (elapsed >= usec)
318			break;
319			usec -= elapsed;
320			tv.tv_sec = 0;
321			tv.tv_usec = usec;
322			#endif
323			was_error = select(0, NULL, NULL, NULL, &tv);
324			#endif
325			} while (was_error && (errno == EINTR));
326	cebix	1.1	}
327	gbeauche	1.17
328
329			/*
330			* Suspend emulator thread, virtual CPU in idle mode
331			*/
332
333			#ifdef HAVE_PTHREADS
334			#if defined(HAVE_PTHREAD_COND_INIT)
335			#define IDLE_USES_COND_WAIT 1
336			static pthread_mutex_t idle_lock = PTHREAD_MUTEX_INITIALIZER;
337			static pthread_cond_t idle_cond = PTHREAD_COND_INITIALIZER;
338			#elif defined(HAVE_SEM_INIT)
339			#define IDLE_USES_SEMAPHORE 1
340			#include <semaphore.h>
341			#ifdef HAVE_SPINLOCKS
342			static spinlock_t idle_lock = SPIN_LOCK_UNLOCKED;
343			#define LOCK_IDLE spin_lock(&idle_lock)
344			#define UNLOCK_IDLE spin_unlock(&idle_lock)
345			#else
346			static pthread_mutex_t idle_lock = PTHREAD_MUTEX_INITIALIZER;
347			#define LOCK_IDLE pthread_mutex_lock(&idle_lock)
348			#define UNLOCK_IDLE pthread_mutex_unlock(&idle_lock)
349			#endif
350			static sem_t idle_sem;
351			static int idle_sem_ok = -1;
352			#endif
353			#endif
354
355			void idle_wait(void)
356			{
357			#ifdef IDLE_USES_COND_WAIT
358	gbeauche	1.18	pthread_mutex_lock(&idle_lock);
359	gbeauche	1.17	pthread_cond_wait(&idle_cond, &idle_lock);
360	gbeauche	1.18	pthread_mutex_unlock(&idle_lock);
361	gbeauche	1.17	#else
362			#ifdef IDLE_USES_SEMAPHORE
363	gbeauche	1.19	LOCK_IDLE;
364	gbeauche	1.17	if (idle_sem_ok < 0)
365			idle_sem_ok = (sem_init(&idle_sem, 0, 0) == 0);
366			if (idle_sem_ok > 0) {
367			idle_sem_ok++;
368			UNLOCK_IDLE;
369			sem_wait(&idle_sem);
370			return;
371			}
372	gbeauche	1.19	UNLOCK_IDLE;
373	gbeauche	1.17	#endif
374	gbeauche	1.19
375			// Fallback: sleep 10 ms
376	gbeauche	1.17	Delay_usec(10000);
377			#endif
378			}
379
380
381			/*
382			* Resume execution of emulator thread, events just arrived
383			*/
384
385			void idle_resume(void)
386			{
387			#ifdef IDLE_USES_COND_WAIT
388			pthread_cond_signal(&idle_cond);
389			#else
390			#ifdef IDLE_USES_SEMAPHORE
391	gbeauche	1.19	LOCK_IDLE;
392	gbeauche	1.17	if (idle_sem_ok > 1) {
393			idle_sem_ok--;
394			UNLOCK_IDLE;
395			sem_post(&idle_sem);
396			return;
397			}
398	gbeauche	1.19	UNLOCK_IDLE;
399	gbeauche	1.17	#endif
400			#endif
401			}