diff --git a/src/drivers/stm32/drv_pwm_servo.c b/src/drivers/stm32/drv_pwm_servo.c
index 0ee9ab3b60..6d841d6fee 100644
--- a/src/drivers/stm32/drv_pwm_servo.c
+++ b/src/drivers/stm32/drv_pwm_servo.c
@@ -133,8 +133,7 @@ int up_pwm_servo_set_rate_group_update(unsigned group, unsigned rate)
 		}
 	}
 
-	io_timer_set_rate(group, rate);
-	return OK;
+	return io_timer_set_rate(group, rate);
 }
 
 void up_pwm_update(void)