判断两线段相交,并求交点

原文
http://blog.youkuaiyun.com/rickliuxiao/article/details/6259322

#include "math.h"
#include "stdio.h"

double E = 0.0001;

struct Point  
{   
    double x, y;  
};   

double min(double x1, double x2)
{
    return x1 < x2 ? x1 : x2;
}

double max(double x1, double x2)
{
    return x1 > x2 ? x1 : x2;
}

bool between(double X, double X1, double X2)  
{  
    return X >= min(X1, X2) && X <= max(X1, X2);
}  


// 判断两条直线段是否有交点,有则计算交点的坐标  
// p1,p2是直线一的端点坐标  
// p3,p4是直线二的端点坐标  
// line_x, line_y; //交点
bool detectIntersect(Point p1, Point p2, Point p3, Point p4, double &line_x, double &line_y)  
{  
    if ( (fabs(p1.x-p2.x)<E) && (fabs(p3.x-p4.x)<E) )  
    {  
        return false;  
    }  
    else if ( (fabs(p1.x-p2.x)<E) ) //如果直线段p1p2垂直与y轴  
    {  
        if (between(p1.x, p3.x, p4.x))  
        {  
            double k = (p4.y-p3.y)/(p4.x-p3.x);  
            line_x = p1.x;  
            line_y = k*(line_x-p3.x) + p3.y;  

            if (between(line_y,p1.y,p2.y))  
            {  
                return true;  
            }  
            else  
            {  
                return false;  
            }  
        }  
        else   
        {  
            return false;  
        }  
    }  
    else if ( (fabs(p3.x-p4.x)<E) ) //如果直线段p3p4垂直于y轴  
    {  
        if (between(p3.x,p1.x,p2.x))  
        {  
            double k = (p2.y-p1.y)/(p2.x-p1.x);  
            line_x = p3.x;  
            line_y = k*(line_x-p2.x) + p2.y;  

            if (between(line_y, p3.y, p4.y))  
            {  
                return true;  
            }  
            else  
            {  
                return false;  
            }  
        }  
        else   
        {  
            return true;  
        }  
    }  
    else  
    {  
        double k1 = (p2.y-p1.y)/(p2.x-p1.x);   
        double k2 = (p4.y-p3.y)/(p4.x-p3.x);  

        if (fabs(k1-k2) < E)  
        {  
            return false;  
        }  
        else   
        {  
            line_x = ((p3.y - p1.y) - (k2*p3.x - k1*p1.x)) / (k1 - k2);  
            line_y = k1*(line_x-p1.x) + p1.y;  
        }  

        if (between(line_x, p1.x, p2.x) && between(line_x, p3.x, p4.x))  
        {  
            return true;  
        }  
        else   
        {  
            return false;  
        }  
    }  
}  

int main()
{
    Point p1, p2, p3, p4;  
    p1.x = 5.0;  
    p1.y = 0.0;  
    p2.x = 0.0;  
    p2.y = 5.0;  
    p3.x = 0.0;  
    p3.y = 0.0;  
    p4.x = 5.0;  
    p4.y = 5.0;  

    double x, y;
    int ok = detectIntersect(p1, p2, p3, p4, x, y); 
    if(ok)
    {
        printf("相交,交点为:(%.3f, %.3f)\n", x, y);
    }
    else
    {
        printf("不相交\n");
    }
    return 0;
}

这里写图片描述

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值