【东莞市选2008】导弹

这题的n很小。
我们可以先用floyd求出两两之间的最小距离。
然后要求最值,我们可以二分最长的距离。
然后用匈牙利来判断。(将小于等于mid的边添加)
上标:

#include<cstdio>
#include<cstring>
#include<algorithm>
using namespace std;
struct node{int v,fr;}e[10010];
int K,n,m,f[110][110],tail[110],cnt=0;
int a[110],b[110],l,r,mid,to[110],vis[110],ans=0;

inline int read()
{
	int x=0; char c=getchar();
	while (c<'0' || c>'9') c=getchar();
	while (c>='0' && c<='9') x=(x<<1)+(x<<3)+(c^48),c=getchar();
	return x;
}

void add(int u,int v) {e[++cnt]=(node){v,tail[u]}; tail[u]=cnt;}

bool xyl(int x)
{
	for (int p=tail[x],v;p;p=e[p].fr)
	{
		v=e[p].v;
		if (!to[v]) {to[v]=x; return 1;}
		if (!vis[v])
		{
			vis[v]=1;
			if (xyl(to[v])) {to[v]=x; return 1;}
		}
	}
	return 0;
}

bool check(int x)
{
	memset(to,0,sizeof(to));
	for (int i=1;i<=m;i++)
	{
		memset(vis,0,sizeof(vis));
		if (!xyl(b[i])) return 0;
	}
	return 1;
}

int main()
{
	K=read();
	for (int i=1;i<=K;i++)
		for (int j=1;j<=K;j++)
			f[i][j]=read();
	n=read(); for (int i=1;i<=n;i++) a[i]=read();
	m=read(); for (int i=1;i<=m;i++) b[i]=read();
	for (int k=1;k<=K;k++)
		for (int i=1;i<=K;i++)
			for (int j=i+1;j<=K;j++)
				f[i][j]=f[j][i]=min(f[i][j],f[i][k]+f[k][j]);
	l=0,r=10000;
	while (l<=r)
	{
		mid=l+r>>1;
		memset(tail,0,sizeof(tail));cnt=0;
		for (int i=1;i<=m;i++)
			for (int j=1;j<=n;j++)
				if (f[b[i]][a[j]]<=mid) add(b[i],a[j]);
		if (check(mid)) ans=mid,r=mid-1;
		else l=mid+1;
	}
	printf("%d\n",ans);
	return 0;
}
资源下载链接为: https://pan.quark.cn/s/67c535f75d4c 在机器人技术中,轨迹规划是实现机器人从一个位置平稳高效移动到另一个位置的核心环节。本资源提供了一套基于 MATLAB 的机器人轨迹规划程序,涵盖了关节空间和笛卡尔空间两种规划方式。MATLAB 是一种强大的数值计算与可视化工具,凭借其灵活易用的特点,常被用于机器人控制算法的开发与仿真。 关节空间轨迹规划主要关注机器人各关节角度的变化,生成从初始配置到目标配置的连续路径。其关键知识点包括: 关节变量:指机器人各关节的旋转角度或伸缩长度。 运动学逆解:通过数学方法从末端执行器的目标位置反推关节变量。 路径平滑:确保关节变量轨迹连续且无抖动,常用方法有 S 型曲线拟合、多项式插值等。 速度和加速度限制:考虑关节的实际物理限制,确保轨迹在允许的动态范围内。 碰撞避免:在规划过程中避免关节与其他物体发生碰撞。 笛卡尔空间轨迹规划直接处理机器人末端执行器在工作空间中的位置和姿态变化,涉及以下内容: 工作空间:机器人可到达的所有三维空间点的集合。 路径规划:在工作空间中找到一条从起点到终点的无碰撞路径。 障碍物表示:采用二维或三维网格、Voronoi 图、Octree 等数据结构表示工作空间中的障碍物。 轨迹生成:通过样条曲线、直线插值等方法生成平滑路径。 实时更新:在规划过程中实时检测并避开新出现的障碍物。 在 MATLAB 中实现上述规划方法,可以借助其内置函数和工具箱: 优化工具箱:用于解决运动学逆解和路径规划中的优化问题。 Simulink:可视化建模环境,适合构建和仿真复杂的控制系统。 ODE 求解器:如 ode45,用于求解机器人动力学方程和轨迹执行过程中的运动学问题。 在实际应用中,通常会结合关节空间和笛卡尔空间的规划方法。先在关节空间生成平滑轨迹,再通过运动学正解将关节轨迹转换为笛卡
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值