diff --git a/timer.c b/timer.c
index 6ec0815..9481aed 100644
--- a/timer.c
+++ b/timer.c
@@ -136,6 +136,7 @@ void setTimer(uint32_t delay)
 	} else {
 		// flag: move has ended
 		next_step_time = 0;
+		TIMSK1 &= ~MASK(OCIE1A);
 	}
 	
 	// restore interrupt flag