add servo startup function