isotest: Fix not calculating time to wait

The difference of time start and current time may have advanced just
enough to add a second leaving start nanoseconds to be bigger.

1 files changed, 4 insertions, 0 deletions

diff --git a/tools/isotest.c b/tools/isotest.c
index dcd087ee1..2b5f164de 100644
--- a/tools/isotest.c
+++ b/tools/isotest.c
@@ -585,6 +585,10 @@ static void send_wait(struct timespec *t_start, uint32_t us)
 	}
 
 	t_diff.tv_sec = t_now.tv_sec - t_start->tv_sec;
+	if (t_start->tv_nsec > t_now.tv_nsec) {
+		t_diff.tv_sec--;
+		t_now.tv_nsec += 1000000000L;
+	}
 	t_diff.tv_nsec = t_now.tv_nsec - t_start->tv_nsec;
 
 	delta_us = us - TS_USEC(&t_diff);