2006-11-14 22:31:12 +00:00
|
|
|
/* $Id$ */
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-13 16:54:59 +00:00
|
|
|
/*
|
|
|
|
* timed_thread.c: Abstraction layer for timed threads
|
2006-11-14 22:30:31 +00:00
|
|
|
*
|
2007-08-10 20:09:43 +00:00
|
|
|
* Copyright (C) 2006-2007 Philip Kovacs pkovacs@users.sourceforge.net
|
2006-12-13 16:54:59 +00:00
|
|
|
*
|
|
|
|
* This library is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
|
|
* License as published by the Free Software Foundation; either
|
|
|
|
* version 2.1 of the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This library 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
|
|
|
|
* Lesser General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
|
|
* License along with this library; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301
|
|
|
|
* USA.
|
|
|
|
*
|
|
|
|
*/
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2007-12-31 00:00:35 +00:00
|
|
|
#ifdef HAVE_CONFIG_H
|
|
|
|
#include <config.h>
|
|
|
|
#endif
|
|
|
|
|
2006-11-14 22:30:31 +00:00
|
|
|
#include <pthread.h>
|
|
|
|
#include <assert.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <stdlib.h>
|
2006-11-15 01:20:49 +00:00
|
|
|
#include <stdio.h>
|
2006-11-14 22:30:31 +00:00
|
|
|
#include <time.h>
|
2007-01-15 00:02:38 +00:00
|
|
|
#ifndef HAVE_CLOCK_GETTIME
|
|
|
|
#include <sys/time.h>
|
|
|
|
#endif
|
2006-11-14 22:30:31 +00:00
|
|
|
#include "timed_thread.h"
|
|
|
|
|
|
|
|
/* Abstraction layer for timed threads */
|
|
|
|
|
2007-09-01 20:40:34 +00:00
|
|
|
static int now (struct timespec *);
|
|
|
|
|
2006-11-14 22:30:31 +00:00
|
|
|
/* private */
|
|
|
|
struct _timed_thread
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
pthread_t thread; /* thread itself */
|
|
|
|
pthread_attr_t thread_attr; /* thread attributes */
|
|
|
|
pthread_mutex_t cs_mutex; /* critical section mutex */
|
|
|
|
pthread_mutex_t runnable_mutex; /* only for the runnable_cond */
|
|
|
|
pthread_cond_t runnable_cond; /* signalled to stop the thread */
|
2007-08-31 21:35:30 +00:00
|
|
|
void *(*start_routine)(void*); /* thread function to run */
|
|
|
|
void *arg; /* thread function argument */
|
2007-09-01 20:40:34 +00:00
|
|
|
struct timespec interval_time; /* interval_usecs as a struct timespec */
|
2006-11-14 22:30:31 +00:00
|
|
|
};
|
|
|
|
|
2006-11-15 01:48:06 +00:00
|
|
|
/* linked list of created threads */
|
2006-11-14 22:30:31 +00:00
|
|
|
typedef struct _timed_thread_list
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
timed_thread *p_timed_thread;
|
|
|
|
timed_thread **addr_of_p_timed_thread;
|
|
|
|
struct _timed_thread_list *next;
|
2006-11-14 22:30:31 +00:00
|
|
|
} timed_thread_node, timed_thread_list;
|
|
|
|
|
|
|
|
static timed_thread_list *p_timed_thread_list_head = NULL;
|
|
|
|
static timed_thread_list *p_timed_thread_list_tail = NULL;
|
|
|
|
|
2007-09-01 20:40:34 +00:00
|
|
|
static int now (struct timespec *abstime)
|
|
|
|
{
|
|
|
|
if (!abstime)
|
|
|
|
return (-1);
|
|
|
|
|
|
|
|
#ifdef HAVE_CLOCK_GETTIME
|
2007-12-31 00:00:35 +00:00
|
|
|
return clock_gettime (CLOCK_REALTIME, abstime);
|
2007-09-01 20:40:34 +00:00
|
|
|
#else
|
|
|
|
/* fallback to gettimeofday () */
|
|
|
|
struct timeval tv;
|
|
|
|
if (gettimeofday (&tv, NULL) != 0)
|
|
|
|
return (-1);
|
|
|
|
|
|
|
|
abstime->tv_sec = tv.tv_sec;
|
|
|
|
abstime->tv_nsec = tv.tv_usec * 1000;
|
|
|
|
return 0;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2007-08-31 21:35:30 +00:00
|
|
|
/* create a timed thread (object creation only) */
|
2006-11-14 22:30:31 +00:00
|
|
|
timed_thread*
|
|
|
|
timed_thread_create (void *(*start_routine)(void*), void *arg, unsigned int interval_usecs)
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
timed_thread *p_timed_thread;
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2007-10-20 23:35:25 +00:00
|
|
|
assert (start_routine != NULL);
|
|
|
|
assert (interval_usecs >= MINIMUM_INTERVAL_USECS);
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
if ((p_timed_thread = calloc (sizeof(timed_thread), 1)) == 0)
|
|
|
|
return NULL;
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
/* init attributes, e.g. joinable thread */
|
|
|
|
pthread_attr_init (&p_timed_thread->thread_attr);
|
|
|
|
pthread_attr_setdetachstate (&p_timed_thread->thread_attr, PTHREAD_CREATE_JOINABLE);
|
|
|
|
/* init mutexes */
|
|
|
|
pthread_mutex_init (&p_timed_thread->cs_mutex, NULL);
|
|
|
|
pthread_mutex_init (&p_timed_thread->runnable_mutex, NULL);
|
|
|
|
/* init cond */
|
|
|
|
pthread_cond_init (&p_timed_thread->runnable_cond, NULL);
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2007-08-31 21:35:30 +00:00
|
|
|
p_timed_thread->start_routine = start_routine;
|
|
|
|
p_timed_thread->arg = arg;
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2007-09-01 20:40:34 +00:00
|
|
|
/* seconds portion of the microseconds interval */
|
|
|
|
p_timed_thread->interval_time.tv_sec = (time_t)(interval_usecs / 1000000);
|
|
|
|
/* remaining microseconds convert to nanoseconds */
|
|
|
|
p_timed_thread->interval_time.tv_nsec = (long)((interval_usecs % 1000000) * 1000);
|
|
|
|
|
2007-09-02 03:29:38 +00:00
|
|
|
/*
|
|
|
|
printf ("interval_time.tv_sec = %li, .tv_nsec = %li\n",
|
2007-09-02 02:22:46 +00:00
|
|
|
p_timed_thread->interval_time.tv_sec,
|
2007-09-02 03:29:38 +00:00
|
|
|
p_timed_thread->interval_time.tv_nsec);
|
|
|
|
*/
|
2006-12-23 06:01:16 +00:00
|
|
|
return p_timed_thread;
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|
2007-08-31 21:35:30 +00:00
|
|
|
/* run a timed thread (drop the thread and run it) */
|
|
|
|
int
|
|
|
|
timed_thread_run (timed_thread* p_timed_thread)
|
|
|
|
{
|
|
|
|
return pthread_create (&p_timed_thread->thread, &p_timed_thread->thread_attr,
|
|
|
|
p_timed_thread->start_routine, p_timed_thread->arg);
|
|
|
|
}
|
2006-11-14 22:30:31 +00:00
|
|
|
|
|
|
|
/* destroy a timed thread.
|
|
|
|
* optional addr_of_p_timed_thread to set callers pointer to NULL as a convenience. */
|
|
|
|
void
|
|
|
|
timed_thread_destroy (timed_thread* p_timed_thread, timed_thread** addr_of_p_timed_thread)
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
assert (p_timed_thread != NULL);
|
|
|
|
assert ((addr_of_p_timed_thread == NULL) || (*addr_of_p_timed_thread == p_timed_thread));
|
|
|
|
|
|
|
|
/* signal thread to stop */
|
|
|
|
pthread_mutex_lock (&p_timed_thread->runnable_mutex);
|
|
|
|
pthread_cond_signal (&p_timed_thread->runnable_cond);
|
|
|
|
pthread_mutex_unlock (&p_timed_thread->runnable_mutex);
|
|
|
|
|
|
|
|
/* join the terminating thread */
|
2007-09-02 05:08:28 +00:00
|
|
|
if (p_timed_thread->thread)
|
|
|
|
pthread_join (p_timed_thread->thread, NULL);
|
2006-12-23 06:01:16 +00:00
|
|
|
|
|
|
|
/* clean up */
|
|
|
|
pthread_attr_destroy (&p_timed_thread->thread_attr);
|
|
|
|
pthread_mutex_destroy (&p_timed_thread->cs_mutex);
|
|
|
|
pthread_mutex_destroy (&p_timed_thread->runnable_mutex);
|
|
|
|
pthread_cond_destroy (&p_timed_thread->runnable_cond);
|
|
|
|
|
|
|
|
free (p_timed_thread);
|
|
|
|
if (addr_of_p_timed_thread)
|
|
|
|
*addr_of_p_timed_thread = NULL;
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* lock a timed thread for critical section activity */
|
|
|
|
int
|
|
|
|
timed_thread_lock (timed_thread* p_timed_thread)
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
assert (p_timed_thread != NULL);
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
return pthread_mutex_lock (&p_timed_thread->cs_mutex);
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* unlock a timed thread after critical section activity */
|
|
|
|
int
|
|
|
|
timed_thread_unlock (timed_thread* p_timed_thread)
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
assert (p_timed_thread != NULL);
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
return pthread_mutex_unlock (&p_timed_thread->cs_mutex);
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2006-12-02 23:07:21 +00:00
|
|
|
/* thread waits interval_usecs for runnable_cond to be signaled. returns 1 if signaled,
|
|
|
|
* -1 on error, and 0 otherwise. caller should call timed_thread_exit() on any non-zero
|
|
|
|
* return value. */
|
2006-11-14 22:30:31 +00:00
|
|
|
int
|
|
|
|
timed_thread_test (timed_thread* p_timed_thread)
|
|
|
|
{
|
2007-09-02 00:58:42 +00:00
|
|
|
struct timespec wait_time;
|
2006-12-23 06:01:16 +00:00
|
|
|
int rc;
|
|
|
|
|
|
|
|
assert (p_timed_thread != NULL);
|
|
|
|
|
2007-09-02 00:58:42 +00:00
|
|
|
if (now (&wait_time)) return (-1);
|
2007-09-02 02:22:46 +00:00
|
|
|
/*printf ("PRE:wait_time.tv_secs = %li, .tv_nsecs = %li\n", wait_time.tv_sec, wait_time.tv_nsec);*/
|
2007-09-02 03:29:38 +00:00
|
|
|
|
|
|
|
/* add in the wait interval */
|
|
|
|
if (1000000000-wait_time.tv_nsec <= p_timed_thread->interval_time.tv_nsec)
|
2007-09-02 02:22:46 +00:00
|
|
|
{
|
2007-09-02 17:14:15 +00:00
|
|
|
/* perform nsec->sec carry operation */
|
2007-09-02 03:29:38 +00:00
|
|
|
wait_time.tv_sec += p_timed_thread->interval_time.tv_sec + 1;
|
2007-09-02 17:14:15 +00:00
|
|
|
wait_time.tv_nsec -= 1000000000-p_timed_thread->interval_time.tv_nsec;
|
2007-09-02 02:22:46 +00:00
|
|
|
/*printf ("001:wait_time.tv_secs = %li, .tv_nsecs = %li\n", wait_time.tv_sec, wait_time.tv_nsec);*/
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2007-09-02 17:14:15 +00:00
|
|
|
/* no carry needed, just add respective components */
|
2007-09-02 02:22:46 +00:00
|
|
|
wait_time.tv_sec += p_timed_thread->interval_time.tv_sec;
|
|
|
|
wait_time.tv_nsec += p_timed_thread->interval_time.tv_nsec;
|
|
|
|
/*printf ("002:wait_time.tv_secs = %li, .tv_nsecs = %li\n", wait_time.tv_sec, wait_time.tv_nsec);*/
|
|
|
|
}
|
2007-09-01 21:07:40 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
/* acquire runnable_cond mutex */
|
|
|
|
if (pthread_mutex_lock (&p_timed_thread->runnable_mutex))
|
|
|
|
return (-1); /* could not acquire runnable_cond mutex, so tell caller to exit thread */
|
|
|
|
|
|
|
|
/* release mutex and wait until future time for runnable_cond to signal */
|
|
|
|
rc = pthread_cond_timedwait (&p_timed_thread->runnable_cond,
|
|
|
|
&p_timed_thread->runnable_mutex,
|
2007-09-02 00:58:42 +00:00
|
|
|
&wait_time);
|
2006-12-23 06:01:16 +00:00
|
|
|
/* mutex re-acquired, so release it */
|
|
|
|
pthread_mutex_unlock (&p_timed_thread->runnable_mutex);
|
|
|
|
|
|
|
|
if (rc==0)
|
|
|
|
return 1; /* runnable_cond was signaled, so tell caller to exit thread */
|
|
|
|
|
|
|
|
/* tell caller not to exit yet */
|
|
|
|
return 0;
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* exit a timed thread */
|
|
|
|
void
|
|
|
|
timed_thread_exit (timed_thread* p_timed_thread)
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
assert (p_timed_thread != NULL);
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
pthread_exit (NULL);
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* register a timed thread for future destruction via timed_thread_destroy_registered_threads() */
|
|
|
|
int
|
|
|
|
timed_thread_register (timed_thread* p_timed_thread, timed_thread** addr_of_p_timed_thread)
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
timed_thread_node *p_node;
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
assert ((addr_of_p_timed_thread == NULL) || (*addr_of_p_timed_thread == p_timed_thread));
|
2006-11-14 22:30:31 +00:00
|
|
|
|
2006-12-23 06:01:16 +00:00
|
|
|
if ((p_node = calloc (sizeof (timed_thread_node), 1)) == 0)
|
2006-11-14 22:30:31 +00:00
|
|
|
return 0;
|
2006-12-23 06:01:16 +00:00
|
|
|
|
|
|
|
p_node->p_timed_thread = p_timed_thread;
|
|
|
|
p_node->addr_of_p_timed_thread = addr_of_p_timed_thread;
|
|
|
|
p_node->next = NULL;
|
|
|
|
|
|
|
|
if (!p_timed_thread_list_tail)
|
|
|
|
{
|
|
|
|
/* first node of empty list */
|
|
|
|
p_timed_thread_list_tail = p_node;
|
|
|
|
p_timed_thread_list_head = p_node;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/* add node to tail of non-empty list */
|
|
|
|
p_timed_thread_list_tail->next = p_node;
|
|
|
|
p_timed_thread_list_tail = p_node;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* destroy all registered timed threads */
|
|
|
|
void
|
|
|
|
timed_thread_destroy_registered_threads (void)
|
|
|
|
{
|
2006-12-23 06:01:16 +00:00
|
|
|
timed_thread_node *p_node, *p_next;
|
|
|
|
|
|
|
|
for (p_node=p_timed_thread_list_head;
|
|
|
|
p_node;
|
|
|
|
p_node=p_next)
|
|
|
|
{
|
|
|
|
p_next = p_node->next;
|
|
|
|
timed_thread_destroy (p_node->p_timed_thread, p_node->addr_of_p_timed_thread);
|
|
|
|
free (p_node);
|
|
|
|
p_node = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
p_timed_thread_list_head = NULL;
|
|
|
|
p_timed_thread_list_tail = NULL;
|
2006-11-14 22:30:31 +00:00
|
|
|
}
|
|
|
|
|