diff --git a/src/trekstor.rs b/src/trekstor.rs
index 9f0aad6..02d9b53 100644
--- a/src/trekstor.rs
+++ b/src/trekstor.rs
@@ -50,13 +50,13 @@ impl Trekstor {
             self.screen.flush();
             self.input.finish();
 
-            let wait_time = if dt < self.update_timestep {
-                self.update_timestep - dt
+            let wait_time = if dt > self.update_timestep {
+                dt - self.update_timestep
             } else {
-                Duration::from_millis(33)
+                self.update_timestep
             };
 
-            dbg!(dt, self.update_timestep);
+            dbg!(wait_time, dt, self.update_timestep);
 
             self.last_time = self.current_time;
             sleep(wait_time);