refactor + findNextDestinationFloor

refactored some code to allow for testability. also wrote method for
finding next elevator floor