improved version of pathfinding, cleaned scene1

improved version of pathfinding, cleaned scene1