给定两个点 A, B
它们的位置分别为(Ax, Ay), (Bx, By)
它们的方向分别为(Au, Av), (Bu, Bv)
它们会相交于点C,点C的位置为(Cx, Cy)
设未知数 s 与 t ,列出下面四个式子:
Ax + s * Au = Cx ①
Ay + s * Av = Cy ②
Bx + t * Bu = Cx ③
By + t * Bv = Cy ④
① - ③:Ax - Bx + sAu - tBu = 0
得 s = (tBu - Ax + Bx) / Au ⑤
② - ④:Ay - By + sAv - tBv = 0 ⑥
⑤代入⑥:t = (AxAv - AyAu + ByAu - BxAv) / (BuAv - BvAu)
当t与s都为大于0的数时,则有正向的交点。反之则交点在反方向。
function int isTowRaysIntersect(vector A; vector dirA; vector B; vector dirB; export float s; export float t)
{
t = (A.x * dirA.z - A.z * dirA.x + B.z * dirA.x - B.x * dirA.z) / (dirB.x * dirA.z - dirB.z * dirA.x);
s = (t * dirB.x - A.x + B.x) / dirA.x;
return s > 0.0f && t > 0.0f;
}
那么交点的位置
vec2 C = A + s * dirA;