Set servo neutral to 85, added safety to ServoNeutral code.