Fix servo issue (Resolves #54)