+long mainCounter(int mode)
+{
+ static struct timeval base_time = { 0, 0 };
+ struct timeval current_time;
+ long counter_ms;
+
+ gettimeofday(¤t_time,NULL);
+ if (mode==0 || current_time.tv_sec<base_time.tv_sec)
+ base_time = current_time;
+
+ counter_ms = (current_time.tv_sec - base_time.tv_sec)*1000
+ + (current_time.tv_usec - base_time.tv_usec)/1000;
+
+ if (mode==1)
+ return(counter_ms/10); /* return 1/100 secs since last init */
+ else
+ return(counter_ms); /* return 1/1000 secs since last init */
+}
+
+void InitCounter() /* set counter back to zero */
+{
+ mainCounter(0);
+}
+
+long Counter() /* returns 1/100 secs since last call of InitCounter() */
+{
+ return(mainCounter(1));
+}
+
+long Counter2() /* returns 1/1000 secs since last call of InitCounter() */
+{
+ return(mainCounter(2));
+}
+
+void WaitCounter(long value) /* wait for counter to reach value */
+{
+ long wait;
+
+ while((wait=value-Counter())>0)
+ microsleep(wait*10000);
+}
+
+void WaitCounter2(long value) /* wait for counter to reach value */
+{
+ long wait;
+
+ while((wait=value-Counter2())>0)
+ microsleep(wait*1000);
+}
+
+void Delay(long value)
+{
+ microsleep(value);
+}
+
+BOOL DelayReached(long *counter_var, int delay)
+{
+ long actual_counter = Counter();
+
+ if (actual_counter>*counter_var+delay || actual_counter<*counter_var)
+ {
+ *counter_var = actual_counter;
+ return(TRUE);
+ }
+ else
+ return(FALSE);
+}
+