Minor fixes to strtonum.

[libucw.git] / ucw / mainloop.c

diff --git a/ucw/mainloop.c b/ucw/mainloop.c
index d6d9c367a495af46f48f724a4b40118390789fb2..4138aae1ec237aa42d79d90a56f6833f901b42b4 100644 (file)
--- a/ucw/mainloop.c
+++ b/ucw/mainloop.c
@@ -10,6 +10,7 @@
 #undef LOCAL_DEBUG
 
 #include "ucw/lib.h"
+#include "ucw/heap.h"
 #include "ucw/mainloop.h"
 
 #include <stdio.h>
@@ -28,7 +29,15 @@ ucw_time_t main_now_seconds;
 timestamp_t main_idle_time;
 uns main_shutdown;
 
-clist main_timer_list, main_file_list, main_hook_list, main_process_list;
+#define GBUF_PREFIX(x) main_timer_table_##x
+#define GBUF_TYPE struct main_timer *
+#include "ucw/gbuf.h"
+static uns main_timer_cnt;
+static main_timer_table_t main_timer_table;
+#define MAIN_TIMER_LESS(x,y) ((x)->expires < (y)->expires)
+#define MAIN_TIMER_SWAP(heap,a,b,t) (t=heap[a], heap[a]=heap[b], heap[b]=t, heap[a]->index=(a), heap[b]->index=(b))
+
+clist main_file_list, main_hook_list, main_hook_done_list, main_process_list;
 static uns main_file_cnt;
 static uns main_poll_table_obsolete, main_poll_table_size;
 static struct pollfd *main_poll_table;
@@ -56,9 +65,10 @@ void
 main_init(void)
 {
   DBG("MAIN: Initializing");
-  clist_init(&main_timer_list);
+  main_timer_cnt = 0;
   clist_init(&main_file_list);
   clist_init(&main_hook_list);
+  clist_init(&main_hook_done_list);
   clist_init(&main_process_list);
   main_file_cnt = 0;
   main_poll_table_obsolete = 1;
@@ -72,15 +82,36 @@ timer_add(struct main_timer *tm, timestamp_t expires)
     DBG("MAIN: Setting timer %p (expire at now+%lld)", tm, (long long)(expires-main_now));
   else
     DBG("MAIN: Clearing timer %p", tm);
-  if (tm->expires)
-    clist_remove(&tm->n);
-  tm->expires = expires;
-  if (expires)
+  if (tm->expires < expires)
+    {
+      if (!tm->expires)
+       {
+         tm->expires = expires;
+         tm->index = ++main_timer_cnt;
+         main_timer_table_grow(&main_timer_table, tm->index + 1);
+         main_timer_table.ptr[tm->index] = tm;
+         HEAP_INSERT(struct main_timer *, main_timer_table.ptr, main_timer_cnt, MAIN_TIMER_LESS, MAIN_TIMER_SWAP);
+       }
+      else
+       {
+         tm->expires = expires;
+         HEAP_INCREASE(struct main_timer *, main_timer_table.ptr, main_timer_cnt, MAIN_TIMER_LESS, MAIN_TIMER_SWAP, tm->index);
+       }
+    }
+  else if (tm->expires > expires)
     {
-      cnode *t = main_timer_list.head.next;
-      while (t != &main_timer_list.head && ((struct main_timer *) t)->expires < expires)
-       t = t->next;
-      clist_insert_before(&tm->n, t);
+      if (!expires)
+       {
+         ASSERT(tm->index && tm->index <= main_timer_cnt);
+         HEAP_DELETE(struct main_timer *, main_timer_table.ptr, main_timer_cnt, MAIN_TIMER_LESS, MAIN_TIMER_SWAP, tm->index);
+         tm->index = 0;
+         tm->expires = 0;
+       }
+      else
+       {
+         tm->expires = expires;
+         HEAP_DECREASE(struct main_timer *, main_timer_table.ptr, main_timer_cnt, MAIN_TIMER_LESS, MAIN_TIMER_SWAP, tm->index);
+       }
     }
 }
 
@@ -370,9 +401,11 @@ main_debug(void)
 #ifdef CONFIG_DEBUG
   msg(L_DEBUG, "### Main loop status on %lld", (long long)main_now);
   msg(L_DEBUG, "\tActive timers:");
-  struct main_timer *tm;
-  CLIST_WALK(tm, main_timer_list)
-    msg(L_DEBUG, "\t\t%p (expires %lld, data %p)", tm, (long long)(tm->expires ? tm->expires-main_now : 999999), tm->data);
+  for (uns i = 1; i <= main_timer_cnt; i++)
+    {
+      struct main_timer *tm = main_timer_table.ptr[i];
+      msg(L_DEBUG, "\t\t%p (expires %lld, data %p)", tm, (long long)(tm->expires ? tm->expires-main_now : 999999), tm->data);
+    }
   struct main_file *fi;
   msg(L_DEBUG, "\tActive files:");
   CLIST_WALK(fi, main_file_list)
@@ -381,6 +414,8 @@ main_debug(void)
        (long long)(fi->timer.expires ? fi->timer.expires-main_now : 999999), fi->data);
   msg(L_DEBUG, "\tActive hooks:");
   struct main_hook *ho;
+  CLIST_WALK(ho, main_hook_done_list)
+    msg(L_DEBUG, "\t\t%p (func %p, data %p)", ho, ho->handler, ho->data);
   CLIST_WALK(ho, main_hook_list)
     msg(L_DEBUG, "\t\t%p (func %p, data %p)", ho, ho->handler, ho->data);
   msg(L_DEBUG, "\tActive processes:");
@@ -419,32 +454,33 @@ void
 main_loop(void)
 {
   DBG("MAIN: Entering main_loop");
-  ASSERT(main_timer_list.head.next);
+  ASSERT(main_hook_list.head.next);
 
   struct main_file *fi;
   struct main_hook *ho;
   struct main_timer *tm;
   struct main_process *pr;
-  cnode *tmp;
 
   main_get_time();
   for (;;)
     {
       timestamp_t wake = main_now + 1000000000;
-      while ((tm = clist_head(&main_timer_list)) && tm->expires <= main_now)
+      while (main_timer_cnt && (tm = main_timer_table.ptr[1])->expires <= main_now)
        {
          DBG("MAIN: Timer %p expired at now-%lld", tm, (long long)(main_now - tm->expires));
          tm->handler(tm);
        }
       int hook_min = HOOK_RETRY;
       int hook_max = HOOK_SHUTDOWN;
-      CLIST_WALK_DELSAFE(ho, main_hook_list, tmp)
+      while (ho = clist_remove_head(&main_hook_list))
        {
+         clist_add_tail(&main_hook_done_list, &ho->n);
          DBG("MAIN: Hook %p", ho);
          int ret = ho->handler(ho);
          hook_min = MIN(hook_min, ret);
          hook_max = MAX(hook_max, ret);
        }
+      clist_move(&main_hook_list, &main_hook_done_list);
       if (hook_min == HOOK_SHUTDOWN ||
          hook_min == HOOK_DONE && hook_max == HOOK_DONE ||
          main_shutdown)
@@ -482,10 +518,10 @@ main_loop(void)
              wake = 0;
            }
        }
-      if ((tm = clist_head(&main_timer_list)) && tm->expires < wake)
+      if (main_timer_cnt && (tm = main_timer_table.ptr[1])->expires < wake)
        wake = tm->expires;
       main_get_time();
-      int timeout = (wake ? wake - main_now : 0);
+      int timeout = ((wake > main_now) ? wake - main_now : 0);
       DBG("MAIN: Poll for %d fds and timeout %d ms", main_file_cnt, timeout);
       int p = poll(main_poll_table, main_file_cnt, timeout);
       timestamp_t old_now = main_now;