/***********************************************************************

  $Id: tmrsvcs.c 1570 2011-06-12 22:09:19Z gyoung $

  Timer services

  Copyright (c) 2008 Steven H. Levine

  05 Jan 08 SHL Baseline
  12 Jun 11 GKY Added IdleIfNeeded to the container/list fill and free loops to improve system
                responsiveness when dealing with large numbers of items

***********************************************************************/

#define INCL_DOS			// QSV_MS_COUNT

// #include "errutil.h"			// DbgMsg // 05 Jan 08 SHL fixme debug
#include "tmrsvcs.h"

// static PSZ pszSrcFile = __FILE__;	// 05 Jan 08 SHL fixme debug

/**
 * Prepare interval timer descriptor for use
 * Call with interval 0 to to reset internal estimators
 * @param pTD point to interval timer descriptor
 * @param interval_msec is the timer interval in msec or 0 to retain existing value
 */

VOID InitITimer(ITIMER_DESC *pitd, UINT interval_msec)
{
  if (interval_msec) {
    // Assume starting new loop at similar rate
    pitd->interval_msec = interval_msec;
    pitd->remaining = pitd->estimated;
  }
  else {
    // Assume loop rate is changing to a significantly lower value
    pitd->remaining = 0;
    pitd->estimated = 1;		// Force rate recalc
  }
  DosQuerySysInfo(QSV_MS_COUNT, QSV_MS_COUNT, &pitd->start_msec, sizeof(pitd->start_msec));
}

/**
 * Check timer interval expired
 * Attempts to optimize calls to fetch QSV_MS_COUNT
 * Caller should reinit if processing rate changes
 * @return TRUE if expired
 */

BOOL IsITimerExpired(ITIMER_DESC *pitd)
{
  INT err_msec;
  ULONG cur_msec;
  UINT elapsed_msec;
  INT cnt;

  if (--pitd->remaining < 0) {

    DosQuerySysInfo(QSV_MS_COUNT, QSV_MS_COUNT, &cur_msec, sizeof(cur_msec));
    elapsed_msec = cur_msec - pitd->start_msec;
    if (elapsed_msec == pitd->interval_msec) {
      pitd->remaining = pitd->estimated;
      pitd->start_msec = cur_msec;
      pitd->misses = 0;
      return TRUE;			// Say interval expired
    }

    pitd->misses++;
    err_msec = (cur_msec - pitd->start_msec) - pitd->interval_msec;
    // Estimate counts per msec
    if (err_msec > 0) {
      // Late - need to reduce estimated count
      if (elapsed_msec)
	pitd->estimated = pitd->estimated * pitd->interval_msec / elapsed_msec;
      else {
	// Should not occur
	if (pitd->estimated)
	  pitd->estimated--;
      }
      // Calc counts for next interval
      pitd->remaining = pitd->estimated -
			(pitd->estimated * err_msec / pitd->interval_msec);
      pitd->start_msec += pitd->interval_msec;
      return TRUE;
    }

    // Early - need to increase estimated count
    cnt = pitd->estimated * (-err_msec) / pitd->interval_msec;
    if (!cnt) {
      if (pitd->estimated)
	cnt = pitd->estimated * 2;
      else
	cnt = 1;
    }
    pitd->estimated += cnt;
    pitd->remaining = cnt;
  }
  return FALSE;				// Keep waiting
}

VOID SleepIfNeeded(ITIMER_DESC *pitd, UINT sleepTime)
{
  if (IsITimerExpired(pitd)) {
    DosSleep(sleepTime);
    InitITimer(pitd, 0);
  }
}

ULONG IdleIfNeeded(ITIMER_DESC *pitd, LONG delta)
{
  APIRET rc;

  if (IsITimerExpired(pitd)) {
    rc = DosSetPriority(PRTYS_THREAD,PRTYC_IDLETIME,delta,0L);
    InitITimer(pitd, 0);
    return rc;
  }
  return 1;
}

#pragma alloc_text(TMRSVCS,InitITimer,IsITimerExpired,SleepIfNeeded,IdleIfNeeded)