Moved delay mechanism into separate function

src/time.c

@@ -23,6 +23,7 @@
 #include <stdlib.h>
 #include <time.h>
 #include "tio/error.h"
+#include "tio/print.h"
 
 char * current_time(void)
 {
@@ -42,3 +43,13 @@ char * current_time(void)
 
     return time_string;
 }
+
+void delay(long ms)
+{
+    struct timespec ts;
+
+    ts.tv_sec = ms / 1000;
+    ts.tv_nsec = (ms % 1000) * 1000000;
+
+    nanosleep(&ts, NULL);
+}