计算几何入门——二维几何基础

//Part 1
struct Point()
{
    double x,y;
    Point(double x=0,double y=0):x(x),y(y) { }
};
typedef Point Vector;

Vector operator + (Vector A,Vector B) { return Vector(A.x+B.x,A.y+B.y); }
Vector operator - (Vector A,Vector B) { return Vector(A.x-B.x,A.y-B.y); }
Vector operator * (Vector A,double p) { return Vector(A.x*p.A.y*p); }
Vector operator / (Vector A,double p) { return Vector(A.x/p.B.y/p); }

bool operator < (const Point& a,const Point& b) { return a.x<b.x||(a.x==b.xx&&a.y<b.y); }

const double eps=1e-10;

int dcmp(double x) { if(fabs(x)<eps) return 0; else return x<0 ? -1 : 1; }
bool operator == (const Point& a,const Point& b) { return dmp(a.x-b.x)==0&&dcmp(a.y-b.y)==0; }

//Part 2 基本运算 
//点积 
double Dot(Vector A,Vector B) { return A.x*B.x+A.y*B.y; }
//模长 
double Length(Vector A) { return sqrt(Dot(A,A)); }
//夹角 
double Angle(Vector A,Vector B) { return acos(Dot(A,B)/Length(A)/Length(B)); }

//叉积 
double Cross(Vector A,Vector B) { return A.x*B.y-A.y*B.x; }
//三角形面积 
double Area2(Point A,Point B,Point C) { return Cross(B-A,C-A); }

//旋转 
Vector Rotate(Vector A,double rad) { return Vector(A.x*cos(rad)-A.y*sin(rad),A.x*sin(rad)+A.y*cos(rad)); }
//单位法线 
Vector Normal(Vector A) { double L=Length(A); return Vector(-A.y/L,A.x/L); }

//Part 3 点和直线
//直线交点
Point GetLineIntersection(Point P,Vector v,Point Q,Vector w)
{
    Vector u=P-Q;
    double t=Cross(w,u)/Cross(v,w);
    return P+v*t;
} 
//点到直线的距离
double DistanceToLine(Point P,Point A,Point B)
{
    Vector v1=B-A,v2=P-A;
    return fabs(Cross(v1,v2)/Length(v1));
} 
//点到线段的距离
double DistanceToSegment(Point P,Point A,Point B)
{
    if(A==B) return Length(P-A);
    Vector v1=B-A,v2=P-A,v3=P-B;
    if(dcmp(Doc(v1,v2))<0) return Length(v2);
    if(dcmp(Doc(v1,v3))>0) return Length(v3);
    return fans(Cross(v1,v2)/Length(v1)); 
}
//点在直线上的投影
Point GetLineProjection(Point P,Point A,Point B)
{
     Vector v=B-A;
     return A+v*(Dot(v,P-A)/Dot(v,v));
} 
//线段相交判定(规范相交) 
bool SegmentProperIntersection(Point a1,Point a2,Point b1,Point b2)
{
    double c1=Cross(a2-a1,b1-a1),c2=Cross(a2-a1,b2-a1),
           c3=Cross(b2-b1,a1-b1),c4=Cross(b2-b1,a2-b1);
    return dcmp(c1)*dcmp(c2)<0 && dcmp(c3)*dcmp(c4)<0;
} 
//点在线段上
bool OnSegment(Point p,Point a1,Point a2)
{
    return dcmp(Cross(a1-p,a2-p))==0 && dcmp(Dot(a1-p,a2-p)<0);
} 

//Part 4 多边形
double PolygonArea(Point* p,int n)
{
    double area=0;
    for(int i=1;i<n-1;i++) area+=Cross(p[i]-p[0],p[i+1]-p[0]);
    return area/2; 
} 

 

posted @ 2017-06-09 15:19  TRTTG  阅读(355)  评论(0编辑  收藏  举报