判断直角坐标系中两条线段是否相交

原文参考博客http://blog.csdn.net/keyboarderqq/article/details/51222441

 

已知:其中一条线段两个端点为(x1,y1),(x2,y2),另一条线段的两个端点为(x3,y3),(x4,y4)

问题:判断两条线段是否相交

解题思路:

方法1:利用向量的叉积判断

 

                                    

                    (向量叉积得到的非零系数与0比较大小)

                    向量AB×向量AC>0    ----->    C在直线AB上方

                    向量AB×向量AD<0     ----->    D在直线AB下方

                     

                    

对于线段AB和线段BD,判断他们是否相交,只需利用上述原理,判断C和D是否位于AB所在直线的两侧以及判断

A和B是否位于CD所在直线的两侧即可,若是,则两条线段相交

具体代码:

#include<iostream>
#include<cmath>
using namespace std;


#define temp 1e-10


int main(){
	double x1,y1,x2,y2,x3,y3,x4,y4;
	scanf("%lf%lf%lf%lf%lf%lf%lf%lf",&x1,&y1,&x2,&y2,&x3,&y3,&x4,&y4);
	
	//共线的情况单独考虑 
	if( abs((x2-x1)*(y4-y3)-(x4-x3)*(y2-y1))<temp ){
		if( (x1==x3)&&((y3-y1)*(y3-y2)<=temp||(y4-y1)*(y4-y2)<=temp) ) printf("Yes\n");
		else printf("No\n");
	}
	else{
		double m=(x2-x1)*(y3-y1)-(x3-x1)*(y2-y1);
		double n=(x2-x1)*(y4-y1)-(x4-x1)*(y2-y1);
		double p=(x4-x3)*(y1-y3)-(x1-x3)*(y4-y3);
		double q=(x4-x3)*(y2-y3)-(x2-x3)*(y4-y3);
		if( m*n<=temp && p*q<=temp ) printf("Yes\n");
		else printf("No\n");
	} 
	return 0;
} 
	double x1,y1,x2,y2,x3,y3,x4,y4;
	scanf("%lf%lf%lf%lf%lf%lf%lf%lf",&x1,&y1,&x2,&y2,&x3,&y3,&x4,&y4);
	
	//共线的情况单独考虑 
	if( abs((x2-x1)*(y4-y3)-(x4-x3)*(y2-y1))<temp ){
		if( (x1==x3)&&((y3-y1)*(y3-y2)<=temp||(y4-y1)*(y4-y2)<=temp) ) printf("Yes\n");
		else printf("No\n");
	}
	else{
		double m=(x2-x1)*(y3-y1)-(x3-x1)*(y2-y1);
		double n=(x2-x1)*(y4-y1)-(x4-x1)*(y2-y1);
		double p=(x4-x3)*(y1-y3)-(x1-x3)*(y4-y3);
		double q=(x4-x3)*(y2-y3)-(x2-x3)*(y4-y3);
		if( m*n<=temp && p*q<=temp ) printf("Yes\n");
		else printf("No\n");
	} 
	return 0;
} 

 

方法2:利用直线的函数表达式判断      

 

                

计算出AB、CD所在直线的函数表达式:

(1)当两条直线对的斜率都存在时,算出各点在另外一条直线上沿y轴方向的投影点,即A',B',C',D',如果(w1-y1)*(w2-y2)<=0  &&(w3-y3)*(w4-y4)<=0  ,则相交;

(2)当直线AB斜率不存在(即x1==x2),CD斜率存在时,算出点A,B在CD直线上沿y轴的投影点A',B',如果(w1-y1)*(w2-y2)<=0 &&(x3-x1)*(x4-x1)<=0,则相交;

(3)当直线CD斜率不存在(即x3==x4),AB斜率存在时,算出点C,D在AB直线上沿y轴的投影点A',B',如果(w3-y3)*(w4-y4)<=0 &&(x1-x3)*(x2-x3)<=0,则相交;

(4)当斜率都不存在时,如果(x1==x3)&&((y3-y1)*(y3-y2)<=0 || (y4-y1)*(y4-y2)<=0),则相交。

具体代码:

 	double x1,y1,x2,y2,x3,y3,x4,y4;
	scanf("%lf%lf%lf%lf%lf%lf%lf%lf",&x1,&y1,&x2,&y2,&x3,&y3,&x4,&y4);
	double k1,k2;
	double b1,b2; 
	double w1,w2,w3,w4; 
	int flag=0;
	if(x2==x1&&x3==x4){
		if( (x1==x3)&&((y3-y1)*(y3-y2)<=temp||(y4-y1)*(y4-y2)<=temp) ) flag=2;
		else flag=0;
	}
	else{
		if(x2!=x1){
			k1=(double)(y2-y1)/(x2-x1);
			b1=y1-k1*x1;
			w3=k1*x3+b1;
			w4=k1*x4+b1;
			if( (w3-y3)*(w4-y4)<=temp ) flag++;
		}
		else if( (x3-x1)*(x4-x1)<=temp ) flag++;
		if(flag){
			if(x3!=x4){
				k2=(double)(y3-y4)/(x3-x4);
				b2=y3-k2*x3;
				w1=k2*x1+b2;
				w2=k2*x2+b2;
				if( (w1-y1)*(w2-y2)<=temp ) flag++;
			}
			else if( (x1-x3)*(x2-x3)<=temp ) flag++;
		}
	}
	if(flag==2) printf("Yes\n");
	else printf("No\n");
	return 0;
} 

(第一次发博客,如有错误还请指正,不胜感激)

可以使用以下步骤解决这个问题: 1. 将经纬度转换为直角坐标系的点,这可以通过以下公式实现:x = R * cos(lat) * cos(lon),y = R * cos(lat) * sin(lon),z = R * sin(lat),其中 R 是地球半径,lat 和 lon 分别是纬度和经度。 2. 根据第一个点的经纬度、方向角和距离计算出第一个点的终点坐标。 3. 同样的,根据第二个点的经纬度、方向角和距离计算出第二个点的终点坐标。 4. 计算第一个点到第二个点的向量和交点向量,如果两个向量平行,则两条线段相交;否则,它们相交。 5. 如果两条线段相交,则计算它们的交点。可以使用以下公式计算:交点 = P1 + (P2 - P1) * t1,其中 P1 和 P2 分别是两个线段的起点和终点,t1 是第一个线段上与第二个线段相交的位置。 6. 将交点的直角坐标系转换回经纬度。 下面是 Java 代码的示例,用于计算两条线段是否相交并找到它们的交点: ```java public class LineIntersection { static final double EARTH_RADIUS = 6378137; // 地球半径,单位为米 static class Point { double x, y, z; Point(double x, double y, double z) { this.x = x; this.y = y; this.z = z; } } static Point toCartesian(double lat, double lon) { double x = EARTH_RADIUS * Math.cos(Math.toRadians(lat)) * Math.cos(Math.toRadians(lon)); double y = EARTH_RADIUS * Math.cos(Math.toRadians(lat)) * Math.sin(Math.toRadians(lon)); double z = EARTH_RADIUS * Math.sin(Math.toRadians(lat)); return new Point(x, y, z); } static Point move(Point p, double distance, double azimuth) { double lat1 = Math.asin(p.z / EARTH_RADIUS); // 起点纬度 double lon1 = Math.atan2(p.y, p.x); // 起点经度 double lat2 = Math.asin(Math.sin(lat1) * Math.cos(distance / EARTH_RADIUS) + Math.cos(lat1) * Math.sin(distance / EARTH_RADIUS) * Math.cos(azimuth)); double lon2 = lon1 + Math.atan2(Math.sin(azimuth) * Math.sin(distance / EARTH_RADIUS) * Math.cos(lat1), Math.cos(distance / EARTH_RADIUS) - Math.sin(lat1) * Math.sin(lat2)); return toCartesian(Math.toDegrees(lat2), Math.toDegrees(lon2)); } static boolean intersect(Point p1, Point p2, Point q1, Point q2) { Point v1 = new Point(p2.x - p1.x, p2.y - p1.y, p2.z - p1.z); // p1 -> p2 的向量 Point v2 = new Point(q2.x - q1.x, q2.y - q1.y, q2.z - q1.z); // q1 -> q2 的向量 Point v3 = new Point(q1.x - p1.x, q1.y - p1.y, q1.z - p1.z); // p1 -> q1 的向量 Point n1 = new Point(v1.y * v2.z - v1.z * v2.y, v1.z * v2.x - v1.x * v2.z, v1.x * v2.y - v1.y * v2.x); // v1 和 v2 的叉积 double d = n1.x * v3.x + n1.y * v3.y + n1.z * v3.z; // n1 和 v3 的点积 if (Math.abs(d) < 1e-6) { return false; // 平行,不相交 } double t1 = (v2.x * v3.y - v2.y * v3.x) / d; double t2 = (v1.x * v3.y - v1.y * v3.x) / d; return t1 >= 0 && t1 <= 1 && t2 >= 0 && t2 <= 1; // 相交当且仅当 t1 和 t2 均在 [0, 1] 内 } static Point intersection(Point p1, Point p2, Point q1, Point q2) { Point v1 = new Point(p2.x - p1.x, p2.y - p1.y, p2.z - p1.z); // p1 -> p2 的向量 Point v2 = new Point(q2.x - q1.x, q2.y - q1.y, q2.z - q1.z); // q1 -> q2 的向量 Point v3 = new Point(q1.x - p1.x, q1.y - p1.y, q1.z - p1.z); // p1 -> q1 的向量 Point n1 = new Point(v1.y * v2.z - v1.z * v2.y, v1.z * v2.x - v1.x * v2.z, v1.x * v2.y - v1.y * v2.x); // v1 和 v2 的叉积 double d = n1.x * v3.x + n1.y * v3.y + n1.z * v3.z; // n1 和 v3 的点积 double t1 = (v2.x * v3.y - v2.y * v3.x) / d; return new Point(p1.x + v1.x * t1, p1.y + v1.y * t1, p1.z + v1.z * t1); } public static void main(String[] args) { // 第一个点的经纬度和方向角 double lat1 = 39.9042; double lon1 = 116.4074; double azimuth1 = 45; double distance1 = 10000; // 以米为单位 // 第二个点的经纬度和方向角 double lat2 = 40.7128; double lon2 = -74.0060; double azimuth2 = 225; double distance2 = 10000; // 以米为单位 // 将经纬度转换为直角坐标系的点 Point p1 = toCartesian(lat1, lon1); Point p2 = move(p1, distance1, azimuth1); Point q1 = toCartesian(lat2, lon2); Point q2 = move(q1, distance2, azimuth2); // 判断两条线段是否相交 if (intersect(p1, p2, q1, q2)) { // 计算交点的经纬度 Point intersection = intersection(p1, p2, q1, q2); double lat = Math.toDegrees(Math.asin(intersection.z / EARTH_RADIUS)); double lon = Math.toDegrees(Math.atan2(intersection.y, intersection.x)); System.out.println("交点经纬度:" + lat + ", " + lon); } else { System.out.println("两条线段相交"); } } } ```
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值