基本定义
struct dot {
double x, y;
dot(double _x, double _y) {x = _x, y = _y;}
dot() {}
};
struct line {
dot p, v;
line(dot _p, dot _v) {p = _p, v = _v;}
line() {}
};
double dcmp(double x) {
if (fabs(x) < eps) return 0; else return (x < 0 ? -1 : 1);
}
dot operator + (dot a, dot b) {return dot(a.x + b.x, a.y + b.y);}
dot operator - (dot a, dot b) {return dot(a.x - b.x, a.y - b.y);}
dot operator * (dot a, double b) {return dot(a.x * b, a.y * b);}
表示向量 u u u在向量 v v v上的投影的模长乘以向量 v v v模长。
double dot(dot a, dot b) {return a.x * b.x + a.y * b.y;}
double len(dot a) {return sqrt(dot(a, a));}
dot adjust(dot a, double b) {return a * (b / len(a));}
double shade(dot a, dot b) {return dot(a, b) / len(a);}
叉积表示的为有向面积,其定义为:一个向量与一个位于其左手的向量的叉积为正,而与其右手的向量叉积为负。
double cro(dot a, dot b) {return a.x * b.y - a.y * b.x;}
bool direct(dot a, dot b) {return cro(a, b) <= 0;}
dot perpendicular(dot a) {return dot(a.y, -a.x);}
double dist(dot a, dot b) {return len(a - b);}
double listl(line a, dot b) {return fabs(cro(b - a.p, a.v) / len(a.v));}
判断两条直线有没有交点需要通过快速排斥实验和跨立实验
判断以两条直线为对角线的矩形是否相交,如果不相交则线段不可能相交;如果矩形相交则进行跨立实验
判断线段A的两个端点是否分别位于直线B的两侧;线段B的两个端点是否位于直线A的两侧。如果在同侧则无交点,使用叉积判断一个点在直线的哪一侧。
bool repel(dot a, dot b, dot c, dot d) {
if (min(a.x, b.x) > max(c.x, d.x) || min(a.y, b.y) > max(c.y, d.y) || min(c.x, d.x) > max(a.x, b.x) || min(c.y, d.y) > max(a.y, b.y)) return 0;
return 1;
}
bool straddle(dot a, dot b, dot c, dot d) {
return ((dcmp(cro(a - b, c - b)) * dcmp(cro(a - b, d - b)) <= 0) &&
(dcmp(cro(c - d, a - d)) * dcmp(cro(c - d, b - d))) <= 0);
}
bool LineCross(line a, line b) {
dot A = a.p, B = a.p + a.v, C = b.p, D = b.p + b.v;
if (!repel(A, B, C, D)) return 0;
return straddle(A, B, C, D);
}
如图,我们需要求解直线 A A A与直线 B B B的交点 P P P,令
A . q = A . p + A . v B . q = B . p + B . v A.q = A.p + A.v \\ B.q = B.p + B.v A.q=A.p+A.vB.q=B.p+B.v
如果计算出 B . p B . q ‾ \overline{B.pB.q} B.pB.q与 B . p P ‾ \overline{B.pP} B.pP的比值,就可以利用比例关系计算出点 P P P。从图中可以看出,两者的比值等一 H 2 H2 H2与 H 1 H1 H1的比值,又等于 S 2 S2 S2与 S 1 S1 S1的比值。而 S 1 , S 2 S1,S2 S1,S2可以通过叉积的计算得到。
dot intersect(line a, line b) {
return b.p + b.v * (cro(a.v, a.p - b.p) / cro(a.v, b.v));
}
判断点 p p p是否在线段上 a a a时,首先判断是否在线段 a a a所处的直线上,然后再判断是否在两个端点之间即可。
bool OnSegment(line a, dot p) {
dot A = a.p, B = a.p + a.v;
return dcmp(cro(A - p, B - p)) == 0 && dcmp((A - p) * (B - p)) < 0;
}