zoukankan      html  css  js  c++  java
  • 求平面两直线的交点,两直线段的交点

    ////////////////////////////////////////////////////////////////////////////////////////////////////////
    //aa, bb为一条线段两端点 cc, dd为另一条线段的两端点 相交返回true, 不相交返回false
    bool LinesProject::getCrossPoint(const PointType& aa, const PointType& bb, const PointType& cc, const PointType& dd, PointType& crossPoint) {
        if (max(aa.x, bb.x)<min(cc.x, dd.x))
        {
            return false;
        }
        if (max(aa.y, bb.y)<min(cc.y, dd.y))
        {
            return false;
        }
        if (max(cc.x, dd.x)<min(aa.x, bb.x))
        {
            return false;
        }
        if (max(cc.y, dd.y)<min(aa.y, bb.y))
        {
            return false;
        }
        if (mult(cc, bb, aa)*mult(bb, dd, aa)<0)
        {
            return false;
        }
        if (mult(aa, dd, cc)*mult(dd, bb, cc)<0)
        {
            return false;
        }
    
        float a1 = bb.y - aa.y;
        float b1 = aa.x - bb.x;
        float c1 = aa.x*bb.y - bb.x*aa.y;
        float a2 = dd.y - cc.y;
        float b2 = cc.x - dd.x;
        float c2 = cc.x*dd.y - dd.x*cc.y;
        float det = a1*b2 - a2*b1;
    
        if (det == 0)
            return false;    //说明两线段平行
    
        crossPoint.x = (c1*b2 - c2*b1) / det;
        crossPoint.y = (a1*c2 - a2*c1) / det;
    
        return true;
    }
            //getCrossPoint 计算两直线交点
            int getCrossPoint(cv::Point& A, cv::Point& B, cv::Point& C, cv::Point& D, cv::Point& crosspoint)
            {
                    double m = (B.y - A.y)*(C.x - D.x) - (D.y - C.y)*(A.x- B.x);
                if (m == 0) {   //平行不相交
    
                    crosspoint.x = 0;
                    crosspoint.y = 0;
                    return -1;    
                }
                else
                {
                    crosspoint.x = ((D.x * C.y - C.x * D.y)*(A.x - B.x) - (B.x * A.y - A.x * B.y)*(C.x - D.x)) / m;
                    crosspoint.y = ((B.x * A.y - A.x * B.y)*(D.y - C.y) - (D.x * C.y - C.x * D.y)*(B.y - A.y)) / m;
                }
                return 0;
            }
  • 相关阅读:
    Oracle-函数
    Oracle-存储过程
    Linux-文件系统概述
    Oralce-PL/SQL编程-游标
    Oracle -操作数据库
    Oralce常用系统函数
    SQL语言基础-基本概念
    Linux-进程管理
    Linux-用户管理
    shell里的IFS内置环境变量
  • 原文地址:https://www.cnblogs.com/lovebay/p/12447368.html
Copyright © 2011-2022 走看看