Removed debugging code and made minor tweaks to elevator strategy, polished and clean now :)