线段的交ZJU2870&PKU3304

题意:找一条直线让所有的线段在这条
直线的投影交集不为空

转化:题目可以转化为一条直线与所有线段判交。设直线ab为与所有线段
有交的直线,那所有线段在与ab相互垂直的直线上投影的交集至少有一个
交点(即不为空)。

解法:枚举所有不同的点中的两点所组成的直线与所有线段判交。

注意重点的判断。。。。。。。。




#include<stdio.h>
#include<stdlib.h>
#include<string.h>
#include<string>
#include<map>
#include<math.h>
#include<iostream>
#include <queue>
#include<algorithm>
using namespace std;
#define inf 2147483647
#define eps 1e-8
#define LL __int64
#define M 5001
struct point 
{
   double x,y;
}p[205];
struct Line 
{
   point p1, p2;
};
struct Segment
{
   point p1,p2;
}s[105];
double muilt(point p0,point p1,point p2)
{
   return (p1.x-p0.x)*(p2.y-p0.y)-(p2.x-p0.x)*(p1.y-p0.y);
}
bool cmp(point a,point b)
{
   if(abs(a.x-b.x)<eps) return a.y<b.y;
   return a.x<b.x;
}
int pd(Line l,Segment s)
{
   if(muilt(l.p1,l.p2,s.p1)*muilt(l.p1,l.p2 ,s.p2 )<eps)
	   return 1;
   return 0;
}
int main()
{
	int t;
	scanf("%d",&t);
	while(t--)
	{
	   int n;
	   scanf("%d",&n);
	   int i,j,k;
	   j=0;
	   for(i=0;i<n;i++)
	   {
	        scanf("%lf%lf%lf%lf",&s[i].p1.x,&s[i].p1.y,&s[i].p2.x,&s[i].p2.y);
			p[j].x=s[i].p1.x;p[j++].y=s[i].p1.y;
			p[j].x=s[i].p2.x;p[j++].y=s[i].p2.y;
	   }
	   int l=j,flag;
	   sort(p,p+j,cmp);
	   for(i=0;i<l;i++)
	   {
	      for(j=i+1;j<l;j++)
		  {
		      if(abs(p[i].x-p[j].x)<eps&&abs(p[i].y-p[j].y)<eps)
				  continue;
			  flag=1;
			  Line line;
			  line.p1=p[i];
			  line.p2=p[j];
			  for(k=0;k<n;k++)
			  {
			     if(!pd(line,s[k]))
				 {
				    flag=0;
					break;
				 }
			  }
			  if(flag)
				  break;
		  }
		  if(flag)
			  break;
	   }
	   if(flag)
		   printf("Yes!\n");
	   else printf("No!\n");
	}
	return 0;
}


  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
ZJU-I型机械臂是一种由浙江大学机器人研究所开发的六自由度机械臂,具有高速、精度和可靠性等特点。机械臂的运动控制是机器人中的重要研究领域之一,其中点到点轨迹规划是机器人在运动过程中最基础和常用的一种方式,也是机械臂控制的核心问题之一。 点到点轨迹规划的目标是通过给定的起点和终点,计算出机械臂的运动轨迹,使机械臂在运动过程中满足机械臂轨迹的连续性、平滑性、可控性等要求。在过去的研究中,经典的点到点轨迹规划方法包括插值法、线性规划法、最小能量法等。 如果使用Python实现机械臂的点到点轨迹规划,可以采用Robotics Toolkit(简称robot)这个模块。robot模块提供了各种从轨迹规划、控制到仿真的功能,可用于ROS、Vrep、Webots等机器人仿真软件。使用robot模块,可以通过几行代码实现机械臂的点到点轨迹规划,例如: ``` from roboticstoolkit import robot from roboticstoolkit.robots import zju # 初始化机器人 zju_arm = robot.Robot('zju', zju.URDF) # 设定起点和终点 start = [0, 0, 0, 0, 0, 0] goal = [0, 1, 1, 0.5, 0, 0] # 计算机械臂的轨迹 path = zju_arm.get_trajectory(start, goal) # 控制机械臂运动到终点 zju_arm.move_to(goal) ``` 其中,`roboticstoolkit`和`roboticstoolkit.robots`都是导入的Python模块,`zju`是机械臂的URDF定义文件,`start`和`goal`是起点和终点的坐标,`get_trajectory()`函数会返回计算得到的机械臂轨迹,`move_to()`函数则控制机械臂运动到终点。 总之,使用Python实现ZJU-I型机械臂的点到点轨迹规划相对简单,只需要导入相应的模块,并根据需要设置机械臂的各种参数,即可轻松实现机械臂的控制。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值