/* $Id: timer.c,v 1.13 2005/05/08 04:32:45 reinelt Exp $ * * generic timer handling * * Copyright (C) 2003, 2004 Michael Reinelt * Copyright (C) 2004 The LCD4Linux Team * * 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, 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., 675 Mass Ave, Cambridge, MA 02139, USA. * * * $Log: timer.c,v $ * Revision 1.13 2005/05/08 04:32:45 reinelt * CodingStyle added and applied * * Revision 1.12 2005/01/18 06:30:24 reinelt * added (C) to all copyright statements * * Revision 1.11 2004/09/19 09:31:19 reinelt * HD44780 busy flag checking improved: fall back to busy-waiting if too many errors occur * * Revision 1.10 2004/06/26 12:05:00 reinelt * * uh-oh... the last CVS log message messed up things a lot... * * Revision 1.9 2004/06/26 09:27:21 reinelt * * added '-W' to CFLAGS * changed all C++ comments to C ones * cleaned up a lot of signed/unsigned mistakes * * Revision 1.8 2004/06/20 10:09:56 reinelt * * 'const'ified the whole source * * Revision 1.7 2004/06/01 06:45:30 reinelt * * some Fixme's processed * documented some code * * Revision 1.6 2004/03/03 04:44:16 reinelt * changes (cosmetics?) to the big patch from Martin * hash patch un-applied * * Revision 1.5 2004/03/03 03:47:04 reinelt * big patch from Martin Hejl: * - use qprintf() where appropriate * - save CPU cycles on gettimeofday() * - add quit() functions to free allocated memory * - fixed lots of memory leaks * * Revision 1.4 2004/01/30 20:57:56 reinelt * HD44780 patch from Martin Hejl * dmalloc integrated * * Revision 1.3 2004/01/29 04:40:03 reinelt * every .c file includes "config.h" now * * Revision 1.2 2004/01/18 09:01:45 reinelt * /proc/stat parsing finished * * Revision 1.1 2004/01/13 08:18:20 reinelt * timer queues added * liblcd4linux deactivated turing transformation to new layout * */ /* * exported functions: * * int timer_add (void(*callback)(void *data), void *data, int interval, int one_shot); * adds a timer to the queue * * int timer_process (struct timespec *delay); * process timer queue * * void timer_exit(); * release all timers * */ #include "config.h" #include #include #include #include #include #include "debug.h" #include "cfg.h" #include "timer.h" #ifdef WITH_DMALLOC #include #endif typedef struct TIMER { void (*callback) (void *data); void *data; struct timeval when; int interval; int one_shot; int active; } TIMER; TIMER *Timers = NULL; int nTimers = 0; static void timer_inc(struct timeval *tv, const int msec) { tv->tv_sec += msec / 1000; tv->tv_usec += (msec - 1000 * (msec / 1000)) * 1000; if (tv->tv_usec >= 1000000) { tv->tv_usec -= 1000000; tv->tv_sec++; } } int timer_add(void (*callback) (void *data), void *data, const int interval, const int one_shot) { int i; struct timeval now; /* find a free slot */ for (i = 0; i < nTimers; i++) { if (Timers[i].active == 0) break; } /* none found, allocate a new slot */ if (i >= nTimers) { nTimers++; Timers = realloc(Timers, nTimers * sizeof(*Timers)); } gettimeofday(&now, NULL); /* fill slot */ Timers[i].callback = callback; Timers[i].data = data; Timers[i].when = now; Timers[i].interval = interval; Timers[i].one_shot = one_shot; Timers[i].active = 1; /* if one-shot timer, don't fire now */ if (one_shot) { timer_inc(&Timers[i].when, interval); } return 0; } int timer_process(struct timespec *delay) { int i, flag, min; struct timeval now; /* the current moment */ gettimeofday(&now, NULL); /* sanity check */ if (nTimers == 0) { error("huh? not one single timer to process? dazed and confused..."); return -1; } /* process expired timers */ flag = 0; for (i = 0; i < nTimers; i++) { if (Timers[i].active == 0) continue; if (timercmp(&Timers[i].when, &now, <=)) { flag = 1; /* callback */ if (Timers[i].callback != NULL) { Timers[i].callback(Timers[i].data); } /* respawn or delete timer */ if (Timers[i].one_shot) { Timers[i].active = 0; } else { Timers[i].when = now; timer_inc(&Timers[i].when, Timers[i].interval); } } } /* find next timer */ flag = 1; min = -1; for (i = 0; i < nTimers; i++) { if (Timers[i].active == 0) continue; if (flag || timercmp(&Timers[i].when, &Timers[min].when, <)) { flag = 0; min = i; } } if (min < 0) { error("huh? not one single timer left? dazed and confused..."); return -1; } /* delay until next timer event */ delay->tv_sec = Timers[min].when.tv_sec - now.tv_sec; delay->tv_nsec = Timers[min].when.tv_usec - now.tv_usec; if (delay->tv_nsec < 0) { delay->tv_sec--; delay->tv_nsec += 1000000; } /* nanoseconds!! */ delay->tv_nsec *= 1000; return 0; } void timer_exit(void) { nTimers = 0; if (Timers != NULL) { free(Timers);; Timers = NULL; } }