diff --git a/ros_arduino_python/nodes/arduino_node.py b/ros_arduino_python/nodes/arduino_node.py
index d281f9e..eae7a73 100755
--- a/ros_arduino_python/nodes/arduino_node.py
+++ b/ros_arduino_python/nodes/arduino_node.py
@@ -172,8 +172,8 @@ class ArduinoROS():
         return ServoWriteResponse()
     
     def ServoReadHandler(self, req):
-        self.controller.servo_read(req.id)
-        return ServoReadResponse()
+        pos = self.controller.servo_read(req.id)
+        return ServoReadResponse(pos)
     
     def DigitalSetDirectionHandler(self, req):
         self.controller.pin_mode(req.pin, req.direction)