add function to initialize servo in startup position