标签: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. 本站为非盈利性的个人网站,所有内容不会用来进行牟利,也不会利用任何形式的广告来间接获益,纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。