//
// main.cpp
// Richard
//
// Created by 邵金杰 on 16/8/3.
// Copyright © 2016年 邵金杰. All rights reserved.
//
//返回值result.first
//0 规范相交
//1 端点重合,但不平行,不共线
//2 一个端点在另一个端点的内部 s1端点在 s2内部 (不平行,不共线)
//3 一个端点在另一个端点的内部 s2端点在 s1内部 (不平行,不共线)
//4 无交点,不平行,不共线,两直线交点是result.second
//5 平行
//6 共线且有公共点
//7 共线且无公共点
//8 s1,s2无交点,但是s2所在直线和s1有交点,即交点在s1上
//9 s1,s2无交点,但是s1所在直线和s2有交点,即交点在s2上
//
//有交点的情况下,交点都是:result.second
//
//
//
#include<iostream>
#include<vector>
#include<cmath>
using namespace std;
#define EPS 1e-6
typedef pair<double,double> CVector;
typedef pair<double,double> CPoint;
typedef pair<CPoint,CPoint> CLine;
//有直线的两点式方程得到x货y
double getX(double y,CPoint a,CPoint b){
return (y-a.second)/(b.second-a.second)*(b.first-a.first)+a.first;
}
double getY(double x,CPoint a,CPoint b){
return (x-a.first)/(b.first-a.first)*(b.second-a.second)+a.second;
}
double operator ^ (CVector p,CVector q){
return p.first*q.second-p.second*q.first;
}
CVector operator - (CPoint p,CPoint q){
return CVector(p.first-q.first,p.second-q.second);
}
CVector operator * (double k,CVector p){
return CVector(k*p.first,k*p.second);
}
double operator * (CVector p,CVector q){
return p.first*q.first+p.second*q.second;
}
CPoint operator + (CPoint p,CVector q){
return CPoint(p.first+q.first,p.second+q.second);
}
double area(CVector p,CVector q){
return (p^q)/2;
}
bool IsZero(double x){
return -EPS<x&&x<EPS;
}
double Cross(CVector p,CVector q){
return p^q;
}
//判断线段p1p2与p3p4是否规范相交
bool IsFormalCross(CPoint p1,CPoint p2,CPoint p3,CPoint p4){
return ((p3-p1)^(p2-p1))*((p2-p1)^(p4-p1))<-EPS&&((p1-p3)^(p4-p3))*((p4-p3)^(p2-p3))<-EPS;
}
bool FlessEq(double a,double b){
return b-a>EPS||IsZero(b-a);
}
bool PointSeg(CPoint p,CLine s){
double temp=Cross(p-s.first,s.second-s.first);
if(!IsZero(temp)) return false;
if((FlessEq(min(s.first.first,s.second.first),p.first))
&&FlessEq(p.first,max(s.first.first,s.second.first))
&&FlessEq(min(s.first.second,s.second.second),p.second)
&&FlessEq(p.second,max(s.first.second,s.second.second)))
return true;
return false;
}
double length(CVector p){
return sqrt(p*p);
}
double Distance(CPoint p,CLine s){
return area(p-s.first,s.second-s.first)/length(s.second-s.first);
}
pair<int,CPoint> CrossPoint(CLine s1,CLine s2){
CPoint p1,p2,p3,p4;
p1=s1.first,p2=s1.second;
p3=s2.first,p4=s2.second;
double a1=area(p3-p1,p4-p1);
double a2=area(p3-p2,p4-p2);
if(IsFormalCross(p1, p2, p3, p4))
return make_pair(0,p1+(a1/(a1+a2))*(p2-p1));
if(!IsZero(Cross(p2-p1,p4-p3))){
if(p1==p3||p1==p4)
return make_pair(1,p1);
if(p2==p3||p2==p4)
return make_pair(1,p2);
if(PointSeg(p1,s2))
return make_pair(2,p1);
if(PointSeg(p2,s2))
return make_pair(2,p2);
if(PointSeg(p3,s1))
return make_pair(3,p3);
if(PointSeg(p4,s1))
return make_pair(3,p4);
CPoint crossPoint=p1+(a1/(a1+a2))*(p2-p1);
if(PointSeg(crossPoint,s1))
return make_pair(8,crossPoint);
if(PointSeg(crossPoint,s2))
return make_pair(9,crossPoint);
return make_pair(4,crossPoint);
}
if(!IsZero(Distance(p1,s2)))
return make_pair(5,CPoint(0,0));
if(PointSeg(p1,s2))
return make_pair(6,p1);
if(PointSeg(p2,s2))
return make_pair(6,p2);
if(PointSeg(p3,s1))
return make_pair(6,p3);
if(PointSeg(p4,s1))
return make_pair(6,p4);
return make_pair(7,CPoint(0,0));
}
两条线段相交的各种情况
最新推荐文章于 2020-03-24 22:01:26 发布