diff --git a/src/main.cpp b/src/main.cpp
index 9e02066..a9fa3e0 100644
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -11,7 +11,7 @@
 #define MEASUREPIN A3
 #define MOSFETPIN A2
 
-unsigned long oldtime = -1;
+unsigned long oldtime = 0;
 
 void setup() {
     Serial.begin(9600);
@@ -61,7 +61,8 @@ void loop() {
     Serial.print("Voltage: ");
     Serial.println(voltage);
 
-    int delaytime = INTERVALTIME * 1000 - ((micros() - oldtime) / 1000);
+    unsigned int delaytime = (micros() - oldtime) / 1000;
+    Serial.println(INTERVALTIME * 1000 - delaytime);
+    delay(INTERVALTIME * 1000 - delaytime);
     oldtime = micros();
-    delay(delaytime);
 }
\ No newline at end of file