diff --git a/library/stm32f072xb/motor/servo/servo.hpp b/library/stm32f072xb/motor/servo/servo.hpp
index fd475170dd40bca88b21722c828c2b1d7d3152e9..f66bcbfaffb7eaf2d491126cc4bae08f02d4d94d 100644
--- a/library/stm32f072xb/motor/servo/servo.hpp
+++ b/library/stm32f072xb/motor/servo/servo.hpp
@@ -82,6 +82,7 @@ class Servo {
 		if (angle < _minAngle) {
 			angle = _minAngle;
 		}
+		_currentAngle = angle;
 		uint16_t dutyCycle = _zeroDegreeDutyCycle + _scaler * angle;
 		_timer.setDutyCycle(dutyCycle);
 	}