fixed that servo bugg at start-up