Added smooth path finding