From 8af96b8cdde75b4d7be2c1c55a870e62fbf3f481 Mon Sep 17 00:00:00 2001 From: InsanityAutomation Date: Thu, 9 Jun 2022 15:48:08 -0400 Subject: [PATCH] Update Servo.cpp --- Marlin/src/HAL/DUE/Servo.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/Marlin/src/HAL/DUE/Servo.cpp b/Marlin/src/HAL/DUE/Servo.cpp index fd6ae1d79a..0f179fbe16 100644 --- a/Marlin/src/HAL/DUE/Servo.cpp +++ b/Marlin/src/HAL/DUE/Servo.cpp @@ -86,7 +86,7 @@ void Servo_Handler(const timer16_Sequence_t timer, Tc *tc, const uint8_t channel } else { // finished all channels so wait for the refresh period to expire before starting over - const unsigned int cval = tc->TC_CHANNEL[channel].TC_CV + 4, // at least REFRESH_INTERVAL has elapsed + const unsigned int cval = tc->TC_CHANNEL[channel].TC_CV + (256 / SERVO_TIMER_PRESCALER), // at least REFRESH_INTERVAL has elapsed ival = (unsigned int)usToTicks(REFRESH_INTERVAL); // allow a few ticks to ensure the next OCR1A not missed tc->TC_CHANNEL[channel].TC_RA = max(cval, ival);