Added input and pathfinding algo changes