diff --git a/library/stm32f072xb/motor/servo/servo.hpp b/library/stm32f072xb/motor/servo/servo.hpp
index f66bcbfaffb7eaf2d491126cc4bae08f02d4d94d..750a0b7dd9fbcb07e77083056ee247a4d609a999 100644
--- a/library/stm32f072xb/motor/servo/servo.hpp
+++ b/library/stm32f072xb/motor/servo/servo.hpp
@@ -75,6 +75,8 @@ class Servo {
 		setAngle((maxAngle + minAngle) / 2);
 	}
 
+	int16_t getAngle() const { return _currentAngle; }
+
 	void setAngle(int16_t angle) {
 		if (angle > _maxAngle) {
 			angle = _maxAngle;