【BZOJ 3053】The Closest M Points

KDTree模板，在m维空间中找最近的k个点，用的是欧几里德距离。

理解了好久，昨晚始终不明白那些“估价函数”，后来才知道分情况讨论，≤k还是=k，在当前这一维度距离过线还是不过线，过线则要继续搜索另一个子树。还有别忘了当前这个节点！

#include<cmath>
#include<queue>
#include<cstdio>
#include<cstring>
#include<algorithm>
#define read(x) x=getint()
using namespace std;
typedef long long LL;
const int N = 50003;
const int inf = 0x7fffffff;
int getint() {
	int k = 0, fh = 1; char c = getchar();
	for(; c < '0' || c > '9'; c = getchar())
		if (c == '-') fh = -1;
	for(; c >= '0' && c <= '9'; c = getchar())
		k = k * 10 + c - '0';
	return k * fh;
}
int n, m, root, D;
LL minn;
struct P {
	int d[5], mx[5], mn[5], l, r, id;
	P (): l(0), r(0), id(0) {};
	int &operator [] (int x) {return d[x];}
	bool operator < (P point) const {return d[D] < point[D];}
} T[N << 1], po[N];
priority_queue <pair <LL, int> > Q;
LL sqr(LL x) {return x * x;}
LL dis(P a, P b) {
	LL ret = 0;
	for(int i = 0; i < m; ++i) ret += sqr(a[i] - b[i]);
	return ret;
}
void pushup(int x, int y) {
	for(int i = 0; i < m; ++i)
		T[x].mn[i] = min(T[x].mn[i], T[y].mn[i]),
		T[x].mx[i] = max(T[x].mx[i], T[y].mx[i]);
}
int Build(int l, int r, int dd) {
	D = dd; int mid = (l + r) >> 1; nth_element(po + l, po + mid, po + r + 1);
	for(int i = 0; i < m; ++i)
		T[mid].mn[i] = T[mid].mx[i] = T[mid].d[i] = po[mid].d[i];
	T[mid].id = mid;
	if (l < mid) T[mid].l = Build(l, mid - 1, (dd + 1) % m);
	if (mid < r) T[mid].r = Build(mid + 1, r, (dd + 1) % m);
	if (T[mid].l) pushup(mid, T[mid].l);
	if (T[mid].r) pushup(mid, T[mid].r);
	return mid;
}
void ask(int rt, int dd, P p, int k) {
	int L = T[rt].l, R = T[rt].r;
	if (p[dd] >= T[rt][dd]) swap(L, R);
	if (L) ask(L, (dd + 1) % m, p, k);
	bool pd = 0; LL di = dis(T[rt], p); minn = min(minn, di);
	if (Q.size() < k) { Q.push(pair <LL, int> (di, rt)); pd = 1;}
	else {
		if (di < Q.top().first) Q.pop(), Q.push(make_pair(di, rt));
		if (sqr(p[dd] - T[rt][dd]) < Q.top().first) pd = 1;
	}
	if (pd && R) ask(R, (dd + 1) % m, p, k);
}
int ans[N];
int main() {
	while (~scanf("%d%d", &n, &m)) {
		for(int i = 1; i <= n; ++i)
			for(int j = 0; j < m; ++j)
				read(po[i][j]);
		memset(T, 0, sizeof(T));
		root = Build(1, n, 0);
		int qq; read(qq);
		for(; qq; --qq) {
			P p; int k;
			for(int i = 0; i < m; ++i)
				read(p[i]);
			read(k);
			printf("the closest %d points are:
", k);
			minn = inf; ask(root, 0, p, k);
			while (!Q.empty()) {
				ans[++ans[0]] = Q.top().second;
				Q.pop();
			}
			for(; ans[0]; --ans[0])
				for(int i = 0; i < m; ++i)
					printf("%d%c", T[ans[ans[0]]][i]," 
"[i == m - 1]);
		}
	}
	return 0;
}

我就是弱啊～～～