学习OpenCV3:判断两条直线平行,并计算平行距离


一、问题

  已知两条直线l_1(x_1,y_1,x_2,y_2)l_2(x_3,y_3,x_4,y_4),现希望判断l_1l_2间是否平行。若平行,计算出两条直线间的平行距离。

二、分析

\frac{y-y_1}{y_2-y_1} = \frac{x-x_1}{x_2-x_1} \Rightarrow \begin{cases} ax+by+c=0 \\a=-(y_2-y_1) \\b = x_2-x_1 \\c = (y_2-y_1)x_1 - (x_2-x_1) y_1 \\ k = \frac{-a}{b}\end{cases}

  l_1的直线方程:
a_1x+b_1y+c_1=0

  l_2的直线方程:
a_2x+b_2y+c_2=0

1、排除l_1l_2重合

  l_2的起点p_{3}(x_{3},y_{3})和终点p_{4}(x_{4},y_{4})不能同时在直线l_1上:

    !(p3!=p4 && a1*x3+b1*y3+c1==0 && a1*x4+b1*y4+c1==0)

2、l_1l_2都垂直x

  当l_1l_2都垂直x轴时,l_1l_2平行:

    b2==0 && b1==0

  l_1l_2的直线方程:
l_1:a_1x+c_1=0 \quad l_2:a_2x+c_2=0

  l_1l_2间的距离为:
d= |x_2-x_1|= |\frac{c_1}{a_1} - \frac{c_2}{a_2} |

3、l_1l_2都倾斜于x轴,且斜率相同

  当l_1l_2斜率相同时,l_1l_2平行:

    b2!=0 && b1!=0 && a2/b2==a1/b1

  l_1l_2的直线方程:
l_1:a_1x+b_1y+c_1=0 \quad l_2:a_2x+b_2y+c_2=0

  l_2y轴的交点p_0
(x_0,y_0)=(0,\frac{-c_2}{b_2})

  p_0l_1距离:
d= \frac{|a_1x_0+b_1y_0+c_1|}{\sqrt{a_1^2+b_1^2}} = \frac{|c_1-\frac{b_1c_2}{b_2}|}{\sqrt{a_1^2+b_1^2}}

三、实现

#include <opencv2/opencv.hpp>
#include <iostream>
#include <string>
#include <cmath>
using namespace std;
using namespace cv;

Vec4d g_line1(200, 200, 600, 200), g_line2(200, 400, 600, 400); // 平行的两条线

// 判断两条线是否平行,若平行,则求出平行距离
double lines_parellel(const Vec4d l1, const Vec4d l2)
{
    double x1 = l1[0], y1 = l1[1], x2 = l1[2], y2 = l1[3];                      // 两点式:(y-y1)/(y2-y1)=(x-x1)/(x2-x1)
    double a1 = -(y2 - y1), b1 = x2 - x1, c1 = (y2 - y1) * x1 - (x2 - x1) * y1; // 一般式:a1x+b1y1+c1=0
    double x3 = l2[0], y3 = l2[1], x4 = l2[2], y4 = l2[3];                      // 两点式:(y-y3)/(y4-y3)=(x-x3)/(x4-x3)
    double a2 = -(y4 - y3), b2 = x4 - x3, c2 = (y4 - y3) * x3 - (x4 - x3) * y3; // 一般式:a2x+b2y1+c2=0
    Point2d p3(x3, y3), p4(x4, y4);
    double d = 0;
    if (!(p3 != p4 && a1 * x3 + b1 * y3 + c1 == 0 && a1 * x4 + b1 * y4 + c1 == 0)) // 排除重合的情况
    {
        if (b2 == 0 && b1 == 0) // l2,l1垂直x轴
        {
            d = abs(c1 / a1 - c2 / a2);
        }
        else if (b2 != 0 && b1 != 0 && a2 / b2 == a1 / b1) // l2,l1斜率相同
        {
            d = abs(c1 - b1 * c2 / b2) / sqrt(a1 * a1 + b1 * b1);
        }
    }
    return d;
}

// 计算垂足的坐标
Point calculate_foot_point(Point2d p, Vec4d l)
{
    double x0 = p.x, y0 = p.y;
    double x1 = l[0], y1 = l[1], x2 = l[2], y2 = l[3];
    Point2d p1(0, 0); // 垂足
    if (x1 == x2)     // 线与x轴垂直
    {
        p1.x = x1;
        p1.y = y0;
    }
    else if (y1 == y2) // 线与x轴水平
    {
        p1.x = x0;
        p1.y = y1;
    }
    else // 线与x轴倾斜
    {
        int a = -(y2 - y1);
        int b = x2 - x1;
        int c = (y2 - y1) * x1 - (x2 - x1) * y1;
        p1.x = (b * b * x0 - a * b * y0 - a * c) / (a * a + b * b);
        p1.y = (a * a * y0 - a * b * x0 - b * c) / (a * a + b * b);
    }
    return p1;
}

// 画虚线
void draw_dotted_line(Mat img, const Point2d p1, const Point2d p2, const Scalar color, const int thickness)
{
    double n = 15; // 小虚线的长度
    double w = p2.x - p1.x, h = p2.y - p1.y;
    double l = sqrtl(w * w + h * h);
    // 矫正线长度,使线个数为奇数
    int m = l / n;
    m = m % 2 ? m : m + 1;
    n = l / m;

    circle(img, p1, 1, color, thickness); // 画起点
    circle(img, p2, 1, color, thickness); // 画终点
    // 画中间点
    if (p1.y == p2.y) // 与x轴水平:y = m
    {
        double x1 = min(p1.x, p2.x);
        double x2 = max(p1.x, p2.x);
        for (double x = x1, n1 = 2 * n; x < x2; x = x + n1)
            line(img, Point2d(x, p1.y), Point2d(x + n, p1.y), color, thickness);
    }
    else if (p1.x == p2.x) // 与x轴垂直, x = m
    {
        double y1 = min(p1.y, p2.y);
        double y2 = max(p1.y, p2.y);
        for (double y = y1, n1 = 2 * n; y < y2; y = y + n1)
            line(img, Point2d(p1.x, y), Point2d(p1.x, y + n), color, thickness);
    }
    else // 与x轴倾斜,直线方程的两点式:(y-y1)/(y2-y1)=(x-x1)/(x2-x1) -> y = (y2-y1)*(x-x1)/(x2-x1)+y1
    {
        double n1 = n * abs(w) / l;
        double k = h / w;
        double x1 = min(p1.x, p2.x);
        double x2 = max(p1.x, p2.x);
        for (double x = x1, n2 = 2 * n1; x < x2; x = x + n2)
        {
            Point p3 = Point2d(x, k * (x - p1.x) + p1.y);
            Point p4 = Point2d(x + n1, k * (x + n1 - p1.x) + p1.y);
            line(img, p3, p4, color, thickness);
        }
    }
}

// 画延长线
void draw_extension_line(Mat img, const Vec4d l, Scalar color)
{
    double x1 = l[0], y1 = l[1], x2 = l[2], y2 = l[3];
    double a = -(y2 - y1), b = x2 - x1, c = (y2 - y1) * x1 - (x2 - x1) * y1;
    Point2d p1(0, 0), p2(0, 0);
    if (b != 0) // 与x轴倾斜
    {
        p1 = Point2d(0, -c / b);
        p2 = Point2d(img.cols, ((-a * img.cols - c) / b));
    }
    else // 与x轴垂直
    {
        p1 = Point2d(-c / a, 0);
        p2 = Point2d(-c / a, img.rows);
    }
    draw_dotted_line(img, p1, p2, color, 1);
}

// 画图
void draw(const Mat img, const Vec4d l1, const Vec4d l2)
{
    line(img, Point2d(l1[0], l1[1]), Point2d(l1[2], l1[3]), Scalar(0, 255, 0), 2); // 画绿线
    line(img, Point2d(l2[0], l2[1]), Point2d(l2[2], l2[3]), Scalar(0, 255, 0), 2); // 画绿线
    double d = lines_parellel(l1, l2);
    if (d > 0) // 重合
    {
        putText(img, "yes d = " + to_string(d), Point2d(10, 25), cv::FONT_HERSHEY_COMPLEX, 0.5, Scalar(0, 255, 0));
        draw_extension_line(img, l1, Scalar(0, 255, 0));      // 画延长线
        draw_extension_line(img, l2, Scalar(0, 255, 0));      // 画延长线
        Point2d p1((l1[2] + l1[0]) / 2, (l1[3] + l1[1]) / 2); // 获取线段的中间点
        Point p2 = calculate_foot_point(p1, l2);              // 获取垂足
        draw_dotted_line(img, p1, p2, Scalar(0, 255, 0), 1);  // 画垂线
    }
    else // 不重合
    {
        putText(img, "no", Point2d(10, 25), cv::FONT_HERSHEY_COMPLEX, 0.5, Scalar(0, 0, 255));
    }
}

// 确定鼠标左键点击在两条直线的那个点上
Vec6d define_area(const Vec4d l1, const Vec4d l2, const Point2d p)
{
    Vec6d v(-1, 0, 0, 0, 0, 0);
    double w = 20, h = 20;
    double x1 = l1[0], y1 = l1[1], x2 = l1[2], y2 = l1[3];
    double x3 = l2[0], y3 = l2[1], x4 = l2[2], y4 = l2[3];
    Rect r0(x1 - w, y1 - h, 2 * w, 2 * h);    // l1的起点点
    Point2d p1((x2 + x1) / 2, (y1 + y2) / 2); // l1的中间点
    Rect r1(p1.x - w, p1.y - h, 2 * w, 2 * h);
    Rect r2(x2 - w, y2 - h, 2 * w, 2 * h); // l1的终点

    Rect r3(x3 - w, y3 - h, 2 * w, 2 * h);    // l2的起点
    Point2d p2((x3 + x4) / 2, (y3 + y4) / 2); // l2的中间点
    Rect r4(p2.x - w, p2.y - h, 2 * w, 2 * h);
    Rect r5(x4 - w, y4 - h, 2 * w, 2 * h); // l2的终点

    if (r0.contains(p)) // 判断点是否在矩形中
    {
        v = Vec6d(0, x1, y1, 0, 0, 0);
    }
    else if (r1.contains(p))
    {
        v = Vec6d(1, x1, y1, x2, y2, 0);
    }
    else if (r2.contains(p))
    {
        v = Vec6d(2, x2, y2, 0, 0, 0);
    }
    else if (r3.contains(p))
    {
        v = Vec6d(3, x3, y3, 0, 0, 0);
    }
    else if (r4.contains(p))
    {
        v = Vec6d(4, x3, y3, x4, y4, 0);
    }
    else if (r5.contains(p))
    {
        v = Vec6d(5, x4, y4, 0, 0, 0);
    }
    return v;
}

// 根据鼠标移动相应的修改直线的起点和终点
void modify_line(Vec4d &l1, Vec4d &l2, const Vec6d area, const double w, const double h)
{
    if (area[0] == 0)
    {
        l1[0] = area[1] + w;
        l1[1] = area[2] + h;
    }
    else if (area[0] == 1)
    {
        l1[0] = area[1] + w;
        l1[1] = area[2] + h;
        l1[2] = area[3] + w;
        l1[3] = area[4] + h;
    }
    else if (area[0] == 2)
    {
        l1[2] = area[1] + w;
        l1[3] = area[2] + h;
    }
    else if (area[0] == 3)
    {
        l2[0] = area[1] + w;
        l2[1] = area[2] + h;
    }
    else if (area[0] == 4)
    {
        l2[0] = area[1] + w;
        l2[1] = area[2] + h;
        l2[2] = area[3] + w;
        l2[3] = area[4] + h;
    }
    else if (area[0] == 5)
    {
        l2[2] = area[1] + w;
        l2[3] = area[2] + h;
    }
}

// 鼠标回调函数
void mouse_callback(int event, int x, int y, int flags, void *param)
{
    static Point2d p1(0, 0), p2(0, 0);
    static Vec6d area(-1, 0, 0, 0, 0, 0);
    switch (event)
    {
    case cv::EVENT_LBUTTONDOWN: // 鼠标左键点击
        p1 = Point2d(x, y);
        area = define_area(g_line1, g_line2, p1); // 确定鼠标所要移动的区域
        break;
    case cv::EVENT_MOUSEMOVE: // 鼠标移动
        if (area[0] > -1)     // 移动直线
        {
            p2 = Point2d(x, y);
            double w = p2.x - p1.x, h = p2.y - p1.y;
            modify_line(g_line1, g_line2, area, w, h); // 根据鼠标移动相应的修改直线的起点和终点
        }
        break;
    case cv::EVENT_LBUTTONUP: // 鼠标左键释放
        p1 = Point2d(0, 0);
        p2 = Point2d(0, 0);
        area = Vec6d(-1, 0, 0, 0, 0, 0);
        break;
    default:
        break;
    }
}

// 主函数
int main()
{
    string window_name = "image";
    namedWindow(window_name, WINDOW_AUTOSIZE);
    int w = 800, h = 600;
    Mat image_original = Mat(h, w, CV_8UC3, Scalar(255, 255, 255));
    cv::setMouseCallback(window_name, mouse_callback); // 调用鼠标回调函数
    while (true)
    {
        Mat img = image_original.clone(); // 拷贝空白图片,方便重复画图
        draw(img, g_line1, g_line2);      // 画图
        imshow(window_name, img);
        char c = waitKey(3);
        if (c == '1') // l1,l2与x轴平行
        {
            g_line1 = Vec4d(200, 200, 600, 200);
            g_line2 = Vec4d(200, 400, 600, 400);
        }
        else if (c == '2') // l1,l2与x轴垂直
        {
            g_line1 = Vec4d(300, 200, 300, 400);
            g_line2 = Vec4d(500, 200, 500, 400);
        }
        else if (c == '3') // l1,l2与x轴右倾斜
        {
            g_line1 = Vec4d(200, 450, 600, 150);
            g_line2 = Vec4d(200, 500, 600, 200);
        }
        else if (c == '4') // l1,l2与x轴左倾斜
        {
            g_line1 = Vec4d(100, 100, 500, 500);
            g_line2 = Vec4d(100, 150, 500, 550);
        }
        else if (c > 0 && (c < '1' || c > '4')) // 退出循环
        {
            break;
        }
    }
    return 0;
}

操作方法:
  鼠标点击两条直线的起点或终点并按住移动,由此可以修改直线。鼠标点击两条直线的中间点并按住移动,由此可以平移直线。
  键盘按住1234可选择对应的模式,画出不同角度下两条直线平行的情况。键盘按其它的键会退出程序。

两条直线不平行时:

两条直线都与x轴水平(模式1)时:

两条直线都与x轴垂直(模式2)时:

两条直线都与x轴右倾斜(模式3)时:

两条直线都与x轴左倾斜(模式4)时:

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 216,496评论 6 501
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 92,407评论 3 392
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 162,632评论 0 353
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 58,180评论 1 292
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 67,198评论 6 388
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,165评论 1 299
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 40,052评论 3 418
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 38,910评论 0 274
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,324评论 1 310
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,542评论 2 332
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,711评论 1 348
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,424评论 5 343
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 41,017评论 3 326
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,668评论 0 22
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,823评论 1 269
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 47,722评论 2 368
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,611评论 2 353