pathfinding for movement improved