Отменяемые таймеры

void *TimerThFunc(void* ptr)
{
  int sig;
  struct timespec tsp;
  struct itimerspec curr_value;
  sigset_t signal_set;
  if (TimerThreadPid ==0)
  {
    TimerThreadPid=syscall(SYS_gettid);
    sigemptyset(&signal_set);
    sigaddset(&signal_set, SIGALRM);
    sem_post(&TimerSem);
  }
  do
  {
    sigwait(&signal_set, &sig);
    if (sig ==SIGALRM)
    {
      clock_gettime(TIMER_CLOCK_SOURCE, &tsp);
      printf("[SIGALRM:%d]\t", tsp.tv_sec);
      timer_gettime(Timer, &curr_value);
      if ((curr_value.it_value.tv_sec) ==0 && (curr_value.it_value.tv_nsec==0) )
        TimerSetNext(true);
      else
        printf("False timer alarm %d.%d\n", (int)curr_value.it_value.tv_sec,
               curr_value.it_value.tv_nsec);
    }
  }
  while (1);
  return NULL;
}

/* Запускает таймер на ближайшее время срабатывания,
 * посылает сообщение о срабатывании предыдущего времени
 *      PostEvent
 *      true - посылать событие; false - не посылать
 */
void TimerSetNext(bool PostEvent)
{
  int j, jm;
  wakeuptime_t min;
 
  struct timespec now1;
  struct itimerspec timer_values;
  timer_element_t* pointer;
  vector<timer_element_t*>::iterator ib;
  vector<timer_element_t*>::iterator ie;
  vector<timer_element_t*>::iterator imin;
  //printf("TimerSetNext %d\n", (int)PostEvent);
 
    TimerLock();
 
    if (CurrentTimer.Started)
    {
      pointer=*(CurrentTimer.TimerElementIt);
      // удалим найденный элемент
      TimerVector.erase(CurrentTimer.TimerElementIt);
    }
    else
      pointer=NULL;
 
    if (!TimerVector.empty())
    {
      // ищем минимальное значение - это будет следующий таймаут
      min.tv_sec = TIME_T_MAX;
      min.tv_nsec = LONG_MAX;
      j=jm=0;
      ie=TimerVector.end();
      // printf("TimerVector.size=%d\t",TimerVector.size());
      for (ib=TimerVector.begin(); ib != ie; ++ib)
      {
        if ( timespec_compare((struct timespec *)&((*ib)->Time.tv_sec),
            (struct timespec *)&min) < 0)
        {
          min=(*ib)->Time;
          imin=ib;
          jm=j;
        }
        ++j;
      }
      //   printf(" jm=%d\n", jm);
      // сохраним только что запущенный элемент
      CurrentTimer.TimerElementIt=imin;
      CurrentTimer.Started=true;
      // здесь имеем
      // pointer - указатель на сработавший таймер
      // min - время в которое должен сработать таймер в следующий раз
    }
    else   // активных таймеров нет, запускаем фоновый таймер
    {
      CurrentTimer.Started=false;
      clock_gettime(TIMER_CLOCK_SOURCE, &now1);
      min=now1;
      min.tv_sec=min.tv_sec + 10;
      //printf("no active timers\n");
    }
    timer_values.it_value=min;
    timer_values.it_interval.tv_sec = 0;
    timer_values.it_interval.tv_nsec = 0;
    timer_settime (Timer, TIMER_ABSTIME /*0*/, &timer_values, NULL);
    TimerUnlock(); // перед отправкой сообщения нужно разблокировать таймер
    if (PostEvent)
    {
      TimerPostEvent(pointer);
    }
}