Read servo position (not called)

Your code is setting the position of the servo, so you know what the angle is.