Removed feedback from servo
Working version