Fully Refactored ScanElevator, algo working fine