两直线交点算法 C

求两直线交点算法
在这里插入图片描述
有中间交点 CD在AB异侧且AB在CD异侧

AB在CD异侧但 CD在AB同侧无中间交点

$\nobreak AB \times AC \newline AB \times AD$
异号

叉乘后相乘小于零

等于零的几种情况
A = B
C与AB共线
D与AB共线

求交点，可由面积比例用叉乘计算

$\frac{CE}{CD} =\frac{S_{ABC}}{S_{ABCD}} .$

综上代码部分

float cross(float* A, float* B, float* C, float* D)
{return (B[0] - A[0]) * (D[1] - C[1]) - (B[1] - A[1]) * (D[0] - C[0]);
}void copyPoint(float* dst, float *src)
{dst[0] = src[0];dst[1] = src[1]; 
}
// EPS 误差自定  等零用线段长度点到直线距离替换 
int intersect(float* a, float *b, float *c, float *d, float* res)
{if (a[0] == b[0] && a[1] == b[1])  // ab同一点return 0;float a1 = cross(a,b,a,c);float a2 = cross(a,b,a,d);float a3 = cross(c,d,c,a);float a4 = cross(c,d,c,b);if (a1*a2 > 0 || a3*a4 > 0)  return -1;   //无交点if (a1 == 0)  { // 交点为ccopyPoint(res,c);return 1;}  else if (a2 == 0) {  // 交点为dcopyPoint(res,d);return 1;}    	     //中间交点 float t = a1 / (a1 - a2);   // 面积1与面积2异号  保持a1方向 res[0] = c[0] + t*(d[0] - c[0]);   res[1] = c[1] + t*(d[1] - c[1]);return 1;
}