ICode9

精准搜索请尝试: 精确搜索
首页 > 其他分享> 文章详细

求直线和直线交点

2021-02-23 14:34:27  阅读:196  来源: 互联网

标签:dSquareSum 直线 double Pow 交点 x3 x1 Math


/// <summary>
/// 求直线和直线交点
/// </summary>
public double[] GetIntersection(double x1, double y1, double x2, double y2, double x3, double y3, double x4, double y4)
{

//取得交点
var a = (y2 - y1) / (x2 - x1); //需考虑分母不能为0 即x2=x1 l1垂直于x轴
var b = (y4 - y3) / (x4 - x3); //需考虑分母不能为0 即x4=x3 l2垂直于x轴

if (a == b)
{//斜率相同,说明平行 无交点
//throw new Exception("两直线平行,无交点");
return null;
}

double x, y = 0;

if (x2 == x1)
{//L1垂直于x轴 则x=x1=x2 a=infinity 想办法消除a
x = x1;
////(y-y3)/(x-x3)=b 且x=x1 变换得y=bx1-bx3+y3
y = b * x1 - b * x3 + y3;
return new double[] { x, y };
}
if (x4 == x3)
{//L2垂直于x轴 则x=x3=x4 b=infinity
x = x3;
y = a * x - a * x1 + y1;
return new double[] { x, y };
}

x = (a * x1 - y1 + y3 - b * x3) / (a - b);
y = a * x - a * x1 + y1;

 

//前面算法自动延伸了

//判断交点是否在直线上

double dSquareSum = 0;
dSquareSum = Math.Pow(x2 - x1, 2) + Math.Pow(y2 - y1, 2);
double len3 = Math.Sqrt(dSquareSum);

dSquareSum = 0;
dSquareSum = Math.Pow(x - x1, 2) + Math.Pow(y - y1, 2);
double len1 = Math.Sqrt(dSquareSum);

dSquareSum = 0;
dSquareSum = Math.Pow(x - x2, 2) + Math.Pow(y - y2, 2);
double len2 = Math.Sqrt(dSquareSum);

dSquareSum = 0;
dSquareSum = Math.Pow(x - x3, 2) + Math.Pow(y - y3, 2);
double len4 = Math.Sqrt(dSquareSum);

dSquareSum = 0;
dSquareSum = Math.Pow(x - x4, 2) + Math.Pow(y - y4, 2);
double len5 = Math.Sqrt(dSquareSum);

dSquareSum = 0;
dSquareSum = Math.Pow(x4 - x3, 2) + Math.Pow(y4 - y3, 2);
double len6 = Math.Sqrt(dSquareSum);

if ((len1 + len2 - len3) < 0.1 && (len4 + len5 - len6) < 0.1)
{
return new double[] { Math.Round(x,2), Math.Round(y,2) };
}
else
{
return null;
}


}

标签:dSquareSum,直线,double,Pow,交点,x3,x1,Math
来源: https://www.cnblogs.com/tangpyODA/p/14435735.html

本站声明: 1. iCode9 技术分享网(下文简称本站)提供的所有内容,仅供技术学习、探讨和分享;
2. 关于本站的所有留言、评论、转载及引用,纯属内容发起人的个人观点,与本站观点和立场无关;
3. 关于本站的所有言论和文字,纯属内容发起人的个人观点,与本站观点和立场无关;
4. 本站文章均是网友提供,不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属;如您发现该文章侵犯了您的权益,可联系我们第一时间进行删除;
5. 本站为非盈利性的个人网站,所有内容不会用来进行牟利,也不会利用任何形式的广告来间接获益,纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。

专注分享技术,共同学习,共同进步。侵权联系[81616952@qq.com]

Copyright (C)ICode9.com, All Rights Reserved.

ICode9版权所有