行进路线 并查集 联通圆

题目:

代码:

#include<bits/stdc++.h>
using namespace std;

int f[10005],n,m;
double a[1005][3];
double cacl(int x1,int y1,int x2,int y2){
    //这里的1ll是为了防止爆int
    return sqrt(1ll*(x1-x2)*(x1-x2)+1ll*(y2-y1)*(y2-y1));
}

int findset(int x){
    return f[x]==x?x:f[x]=findset(f[x]);
}

void solve(){
    double ex,ey;
    int n,end;
    scanf("%lf%lf",&ex,&ey);
    scanf("%d",&n);
    for(int i=1;i<=n;i++)f[i]=i;
    a[0][0]=0,a[0][1]=0,a[0][2]=1;
    for(int i=1;i<=n;i++){
        double x,y,r;
        scanf("%lf%lf%lf",&x,&y,&r);
        cacl(ex,ey,x,y)<=r;
        end=i;
        a[i][0]=x,a[i][1]=y,a[i][2]=r;
    }
    for(int i=0;i<=n;i++){
        for(int j=i+1;j<=n;j++){
            if(cacl(a[i][0],a[i][1],a[j][0],a[j][1])<=a[i][2]+a[j][2]){
                int fx=findset(i),fy=findset(j);
                f[fx]=fy;
            }
            
        }
    }
    printf("%d",findset(0)==findset(end)?1:0);
}

int main(){
    int _;
    cin>>_;
    while(_--){
        solve();
    }

}

点与圆和圆与圆是否联通用对应的点是否在圆内和圆是否相交的数学公式来判断。

最后判一个每个圆之间是否联通所以时间复杂度为O( n^{2} )

您好!对于小车行进路线规划的开源代码,我推荐您使用 ROS(机器人操作系统)平台进行开发。ROS是一个灵活且强大的开源框架,专门用于构建机器人应用程序。 在ROS中,您可以利用导航栈(Navigation Stack)来实现小车的路径规划功能。导航栈包含了一系列的节点,用于地图构建、定位、路径规划和控制等功能。您可以通过安装和配置导航栈,即可使用其中的算法和模块来实现小车的路径规划。 以下是一些与小车行进路线规划相关的开源代码资源: 1. ROS Navigation Stack: 官方提供的导航栈代码库,包含了常用的路径规划算法和模块。您可以通过安装ROS并下载导航栈来使用其中的功能。 官方链接:https://github.com/ros-planning/navigation 2. OpenSLAM: 提供了一些开源的激光雷达SLAM(同时定位与地图构建)库,用于构建地图和定位。这对于路径规划是一个重要的前提。 官方链接:https://github.com/OpenSLAM-org 3. RRT(Rapidly-exploring Random Tree)算法: 是一种常用的路径规划算法,通过随机采样和树结构搜索来寻找可行路径。您可以在ROS中使用RRT算法来实现路径规划。 开源库链接:https://github.com/AtsushiSakai/PythonRobotics 4. A*算法: 是一种经典的路径规划算法,可以用于寻找最短路径。在ROS中,您可以使用开源库 navfn 来实现A*算法的路径规划。 开源库链接:https://github.com/ros-planning/navigation/tree/main/navfn 这些开源代码资源提供了丰富的功能和算法,能够帮助您实现小车的行进路线规划。您可以根据您的具体需求选择合适的代码库,并在ROS平台上进行开发。祝您顺利完成项目!
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值