WIP

latency-measure/src/main.c

@@ -68,7 +68,24 @@ static inline struct timespec add_ns(struct timespec t, int64_t ns) {
   return ret;
 }
 
+static inline struct timespec sub_ns(struct timespec t, int64_t ns) {
+  struct timespec ret;
+
+  ret.tv_nsec = t.tv_nsec - ns;
+  ret.tv_sec = t.tv_sec;
+  if(ret.tv_nsec < 0) {
+    ret.tv_sec--;
+    ret.tv_nsec += NSECS_PER_SECOND;
+  }
+
+  return ret;
+}
+
 static void sleep_poll(struct timespec * next, struct timespec * current) {
+    struct timespec pre_next;
+
+    pre_next = sub_ns(next, 3000000);
+    clock_nanosleep(CLOCK_ID, TIMER_ABSTIME, 
     for(;;) {
       clock_gettime(CLOCK_ID, current);
       if( current->tv_sec > next->tv_sec || (current->tv_sec == next->tv_sec && current->tv_nsec >= next->tv_nsec) )