2 * (C) 2008,2009 by Holger Hans Peter Freyther <zecke@selfish.org>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 #include <osmocom/core/timer.h>
25 static LLIST_HEAD(timer_list);
26 static struct timeval s_nearest_time;
27 static struct timeval s_select_time;
29 #define MICRO_SECONDS 1000000LL
31 #define TIME_SMALLER(left, right) \
32 (left.tv_sec*MICRO_SECONDS+left.tv_usec) <= (right.tv_sec*MICRO_SECONDS+right.tv_usec)
34 void osmo_timer_add(struct osmo_timer_list *timer)
36 struct osmo_timer_list *list_timer;
38 /* TODO: Optimize and remember the closest item... */
41 /* this might be called from within update_timers */
42 llist_for_each_entry(list_timer, &timer_list, entry)
43 if (timer == list_timer)
47 llist_add(&timer->entry, &timer_list);
51 osmo_timer_schedule(struct osmo_timer_list *timer, int seconds, int microseconds)
53 struct timeval current_time;
55 gettimeofday(¤t_time, NULL);
56 unsigned long long currentTime = current_time.tv_sec * MICRO_SECONDS + current_time.tv_usec;
57 currentTime += seconds * MICRO_SECONDS + microseconds;
58 timer->timeout.tv_sec = currentTime / MICRO_SECONDS;
59 timer->timeout.tv_usec = currentTime % MICRO_SECONDS;
60 osmo_timer_add(timer);
63 void osmo_timer_del(struct osmo_timer_list *timer)
68 llist_del(&timer->entry);
72 int osmo_timer_pending(struct osmo_timer_list *timer)
78 * if we have a nearest time return the delta between the current
79 * time and the time of the nearest timer.
80 * If the nearest timer timed out return NULL and then we will
81 * dispatch everything after the select
83 struct timeval *osmo_timers_nearest()
85 struct timeval current_time;
87 if (s_nearest_time.tv_sec == 0 && s_nearest_time.tv_usec == 0)
90 if (gettimeofday(¤t_time, NULL) == -1)
93 unsigned long long nearestTime = s_nearest_time.tv_sec * MICRO_SECONDS + s_nearest_time.tv_usec;
94 unsigned long long currentTime = current_time.tv_sec * MICRO_SECONDS + current_time.tv_usec;
96 if (nearestTime < currentTime) {
97 s_select_time.tv_sec = 0;
98 s_select_time.tv_usec = 0;
100 s_select_time.tv_sec = (nearestTime - currentTime) / MICRO_SECONDS;
101 s_select_time.tv_usec = (nearestTime - currentTime) % MICRO_SECONDS;
104 return &s_select_time;
108 * Find the nearest time and update s_nearest_time
110 void osmo_timers_prepare()
112 struct osmo_timer_list *timer, *nearest_timer = NULL;
113 llist_for_each_entry(timer, &timer_list, entry) {
114 if (!nearest_timer || TIME_SMALLER(timer->timeout, nearest_timer->timeout)) {
115 nearest_timer = timer;
120 s_nearest_time = nearest_timer->timeout;
122 memset(&s_nearest_time, 0, sizeof(struct timeval));
127 * fire all timers... and remove them
129 int osmo_timers_update()
131 struct timeval current_time;
132 struct osmo_timer_list *timer, *tmp;
135 gettimeofday(¤t_time, NULL);
138 * The callbacks might mess with our list and in this case
139 * even llist_for_each_entry_safe is not safe to use. To allow
140 * del_timer, add_timer, schedule_timer to be called from within
141 * the callback we jump through some loops.
143 * First we set the handled flag of each active timer to zero,
144 * then we iterate over the list and execute the callbacks. As the
145 * list might have been changed (specially the next) from within
146 * the callback we have to start over again. Once every callback
147 * is dispatched we will remove the non-active from the list.
149 * TODO: If this is a performance issue we can poison a global
150 * variable in add_timer and del_timer and only then restart.
152 llist_for_each_entry(timer, &timer_list, entry) {
157 llist_for_each_entry(timer, &timer_list, entry) {
158 if (!timer->handled && TIME_SMALLER(timer->timeout, current_time)) {
161 (*timer->cb)(timer->data);
167 llist_for_each_entry_safe(timer, tmp, &timer_list, entry) {
169 if (!timer->active) {
170 osmo_timer_del(timer);
177 int osmo_timers_check(void)
179 struct osmo_timer_list *timer;
182 llist_for_each_entry(timer, &timer_list, entry) {