Servo does not work correctly anymore

Issue #180 resolved