BZOJ 2626: JZPFAR KDtree + 堆

Code:

#include<bits/stdc++.h>
#define maxn 200000
#define inf 1000000000000000 
#define mid ((l+r)>>1) 
#define rson(x) (t[x].ch[1])
#define lson(x) (t[x].ch[0])
#define ll long long 
using namespace std;
void setIO(string s)
{
    string in = s + ".in"; 
    freopen(in.c_str(), "r" , stdin); 
}
int d, n, m; 
struct Node
{
    ll dis; 
    int k; 
    Node (ll dis = 0, int k = 0) : dis(dis), k(k) {} 
    bool operator < (Node b) const
    {
        return dis == b.dis ? b.k > k : b.dis < dis;  
    }
}; 
priority_queue <Node> Q;  
// return if a is less than b
bool cmp1(Node a, Node b)
{
    return a.dis == b.dis ? a.k > b.k : a.dis < b.dis; 
}
ll sqr(ll a) 
{
    return a * a; 
}
struct ND
{
    int ch[2], id; 
    ll p[2], minv[2], maxv[2]; 
}t[maxn],T; 
bool cmp(ND a, ND b)
{
    return a.p[d] == b.p[d] ? a.p[d ^ 1] < b.p[d ^ 1] : a.p[d] < b.p[d]; 
}
void pushup(int x, int y)
{
    for(int i = 0; i < 2 ; ++i)
    {
        t[x].minv[i] = min(t[x].minv[i], t[y].minv[i]); 
        t[x].maxv[i] = max(t[x].maxv[i], t[y].maxv[i]); 
    }
}
int build(int l, int r, int o)
{
    d = o; 
    nth_element(t + l, t + mid, t + 1 + r, cmp); 
    for(int i = 0; i < 2 ; ++i)
        t[mid].minv[i] = t[mid].maxv[i] = t[mid].p[i];
    lson(mid) = rson(mid) = 0; 
    if(mid > l) 
    {
        lson(mid) = build(l, mid - 1, o ^ 1);
        pushup(mid, lson(mid));  
    } 
    if(r > mid) 
    {
        rson(mid) = build(mid + 1, r, o ^ 1); 
        pushup(mid, rson(mid)); 
    }
    return mid; 
}   
ll getmax(int x)
{
    ll ans = 0; 
    for(int i = 0; i < 2 ; ++i)
    {
        ans += max(sqr(t[x].minv[i] - T.p[i]), sqr(t[x].maxv[i] - T.p[i])); 
    }
    return ans; 
}
void query(int x, ll x1, ll y1)
{
    ll cur = sqr(t[x].p[0] - x1) + sqr(t[x].p[1] - y1), dl, dr, dn = getmax(x); 
    if(dn < Q.top().dis) return; 
    if(cmp1(Q.top(), Node(cur, t[x].id))) 
    {
        Q.pop(); 
        Q.push(Node(cur, t[x].id)); 
    }
    dl = lson(x) ? getmax(lson(x)) : -inf; 
    dr = rson(x) ? getmax(rson(x)) : -inf; 
    if(dl > dr)
    {
        if(dl >= Q.top().dis) query(lson(x), x1, y1); 
        if(dr >= Q.top().dis) query(rson(x), x1, y1); 
    }
    else 
    {
        if(dr >= Q.top().dis) query(rson(x), x1, y1); 
        if(dl >= Q.top().dis) query(lson(x), x1, y1); 
    }
}
int main()
{
    int i, j, k, root; 
    ll x, y; 
    // setIO("input"); 
    scanf("%d",&n);
    for(i = 1; i <= n ; ++i) scanf("%lld%lld",&t[i].p[0],&t[i].p[1]), t[i].id = i; 
    root = build(1, n, 0); 
    scanf("%d",&m); 
    while(m --)
    {
        scanf("%lld%lld%d",&x,&y,&k);
        while(!Q.empty()) Q.pop(); 
        for(i = 1; i <= k ; ++i) Q.push(Node(-2333, -1));   
        T.p[0] = x, T.p[1] = y;  
        query(root, x, y); 
        printf("%d\n",Q.top().k); 
    }
    return 0; 
}

  

基于STM32F407,使用DFS算法实现最短迷宫路径检索,分为三种模式:1.DEBUG模式,2. 训练模式,3. 主程序模式 ,DEBUG模式主要分析bug,测量必要数据,训练模式用于DFS算法训练最短路径,并将最短路径以链表形式存储Flash, 主程序模式从Flash中….zip项目工程资源经过严格测试可直接运行成功且功能正常的情况才上传,可轻松复刻,拿到资料包后可轻松复现出一样的项目,本人系统开发经验充足(全领域),有任何使用问题欢迎随时与我联系,我会及时为您解惑,提供帮助。 【资源内容】:包含完整源码+工程文件+说明(如有)等。答辩评审平均分达到96分,放心下载使用!可轻松复现,设计报告也可借鉴此项目,该资源内项目代码都经过测试运行成功,功能ok的情况下才上传的。 【提供帮助】:有任何使用问题欢迎随时与我联系,我会及时解答解惑,提供帮助 【附带帮助】:若还需要相关开发工具、学习资料等,我会提供帮助,提供资料,鼓励学习进步 【项目价值】:可用在相关项目设计中,皆可应用在项目、毕业设计、课程设计、期末/期中/大作业、工程实训、大创等学科竞赛比赛、初期项目立项、学习/练手等方面,可借鉴此优质项目实现复刻,设计报告也可借鉴此项目,也可基于此项目来扩展开发出更多功能 下载后请首先打开README文件(如有),项目工程可直接复现复刻,如果基础还行,也可在此程序基础上进行修改,以实现其它功能。供开源学习/技术交流/学习参考,勿用于商业用途。质量优质,放心下载使用。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值