add ElevatorAlgorithm and first draft of AutoElevatorAlgorithm