CanFestival: drivers/timers_unix/timers

00001 #include <stdlib.h>
+00002 
+00003 #include <sys/time.h>
+00004 #include <pthread.h> 
+00005 #include <signal.h>
+00006 
+00007 #include "applicfg.h"
+00008 #include "timer.h"
+00009 
+00010 pthread_mutex_t CanFestival_mutex = PTHREAD_MUTEX_INITIALIZER;
+00011 
+00012 TASK_HANDLE TimerLoopThread;
+00013 
+00014 TIMEVAL last_time_set = TIMEVAL_MAX;
+00015 
+00016 struct timeval last_sig;
+00017 
+00018 timer_t timer;
+00019 
+00020 void EnterMutex(void)
+00021 {
+00022         pthread_mutex_lock(&CanFestival_mutex); 
+00023 }
+00024 
+00025 void LeaveMutex(void)
+00026 {
+00027         pthread_mutex_unlock(&CanFestival_mutex);
+00028 }
+00029 
+00030 void timer_notify(sigval_t val)
+00031 {
+00032         gettimeofday(&last_sig,NULL);
+00033         EnterMutex();
+00034         TimeDispatch();
+00035         LeaveMutex();
+00036 //      printf("getCurrentTime() return=%u\n", p.tv_usec);
+00037 }
+00038 
+00039 void initTimer(void)
+00040 {
+00041         struct sigevent sigev;
+00042 
+00043         // Take first absolute time ref.
+00044         gettimeofday(&last_sig,NULL);
+00045 
+00046         memset (&sigev, 0, sizeof (struct sigevent));
+00047         sigev.sigev_value.sival_int = 0;
+00048         sigev.sigev_notify = SIGEV_THREAD;
+00049         sigev.sigev_notify_attributes = NULL;
+00050         sigev.sigev_notify_function = timer_notify;
+00051 
+00052         timer_create (CLOCK_REALTIME, &sigev, &timer);
+00053 }
+00054 
+00055 void StopTimerLoop(void)
+00056 {
+00057         EnterMutex();
+00058         timer_delete (timer);
+00059         LeaveMutex();
+00060 }
+00061 
+00062 void StartTimerLoop(TimerCallback_t init_callback)
+00063 {
+00064         initTimer();
+00065         EnterMutex();
+00066         // At first, TimeDispatch will call init_callback.
+00067         SetAlarm(NULL, 0, init_callback, 0, 0);
+00068         LeaveMutex();
+00069 }
+00070 
+00071 void CreateReceiveTask(CAN_PORT port, TASK_HANDLE* Thread, void* ReceiveLoopPtr)
+00072 {
+00073         pthread_create(Thread, NULL, ReceiveLoopPtr, (void*)port);
+00074 }
+00075 
+00076 void WaitReceiveTaskEnd(TASK_HANDLE Thread)
+00077 {
+00078         pthread_kill(Thread, SIGTERM);
+00079         pthread_join(Thread, NULL);
+00080 }
+00081 
+00082 #define maxval(a,b) ((a>b)?a:b)
+00083 void setTimer(TIMEVAL value)
+00084 {
+00085 //      printf("setTimer(TIMEVAL value=%d)\n", value);
+00086         // TIMEVAL is us whereas setitimer wants ns...
+00087         long tv_nsec = 1000 * (maxval(value,1)%1000000);
+00088         time_t tv_sec = value/1000000;
+00089         struct itimerspec timerValues;
+00090         timerValues.it_value.tv_sec = tv_sec;
+00091         timerValues.it_value.tv_nsec = tv_nsec;
+00092         timerValues.it_interval.tv_sec = 0;
+00093         timerValues.it_interval.tv_nsec = 0;
+00094 
+00095         timer_settime (timer, 0, &timerValues, NULL);
+00096 }
+00097 
+00098 TIMEVAL getElapsedTime(void)
+00099 {
+00100         struct timeval p;
+00101         gettimeofday(&p,NULL);
+00102 //      printf("getCurrentTime() return=%u\n", p.tv_usec);
+00103         return (p.tv_sec - last_sig.tv_sec)* 1000000 + p.tv_usec - last_sig.tv_usec;
+00104 }
+
timers_unix.c
