学习OpenCV3:计算三角形的3个角度


一、问题

    已知三角形的3个点p0p1p2。现希望画出三角形,并计算3个角度的大小。

二、分析

    直线a的直线方程:
\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\end{cases}

    已知3个点p0p1p2,要构造三角形必须确保3个点不在同一直线上,即p0不在直线a上:

    a * p0.x + b * p0.y + c != 0

   三角形各边边长为:

a = \sqrt{(p2.x-p1.x)^2+(p2.y-p1.y)^2}

b = \sqrt{(p2.x-p0.x)^2+(p2.y-p0.y)^2}

c = \sqrt{(p1.x-p0.x)^2+(p1.y-p0.y)^2}

  由余弦定理得:
a^2=b^2+c^2-2bc \cos \theta \Rightarrow \cos \theta = \frac{b^2+c^2-a^2}{2bc} \Rightarrow \theta = \arccos (\frac{b^2+c^2-a^2}{2bc})

三、实现

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

Point2d g_p0(200, 500), g_p1(400, 100), g_p2(600, 500);

// 判断3个点不在同一直线上
bool same_line(Point2d p0, Point2d p1, Point2d p2)
{
    double a = -(p2.y - p1.y);
    double b = p2.x - p1.x;
    double c = (p2.y - p1.y) * p1.x - (p2.x - p1.x) * p1.y;
    if (a * p0.x + b * p0.y + c != 0) // p0不在直线p1p2上
        return true;
    else
        return false;
}

// 计算夹角
double calculate_angle(Point2d p0, Point2d p1, Point2d p2)
{
    double a = sqrt(pow(p2.x - p1.x, 2) + pow(p2.y - p1.y, 2));
    double b = sqrt(pow(p2.x - p0.x, 2) + pow(p2.y - p0.y, 2));
    double c = sqrt(pow(p1.x - p0.x, 2) + pow(p1.y - p0.y, 2));
    double angle = acos((b * b + c * c - a * a) / (2 * b * c)) * 180 / CV_PI;
    return angle;
}

// 画夹角
void draw_angle(Mat img, Point2d p0, Point2d p1, Point2d p2, double radius, const Scalar color, int thickness)
{
    // 计算直线的角度
    double angle1 = atan2(-(p1.y - p0.y), (p1.x - p0.x)) * 180 / CV_PI;
    double angle2 = atan2(-(p2.y - p0.y), (p2.x - p0.x)) * 180 / CV_PI;
    // 计算主轴的角度
    double angle = angle1 <= 0 ? -angle1 : 360 - angle1;
    // 计算圆弧的结束角度
    double end_angle = (angle2 < angle1) ? (angle1 - angle2) : (360 - (angle2 - angle1));
    if (end_angle > 180)
    {
        angle = angle2 <= 0 ? -angle2 : 360 - angle2;
        end_angle = 360 - end_angle;
    }
    // 画圆弧
    ellipse(img, p0, Size(radius, radius), angle, 0, end_angle, color, thickness);
}

// 鼠标回调函数
void mouse_callback(int event, int x, int y, int flags, void *param)
{
    static Point2d p(0, 0), p1(0, 0), p2(0, 0);
    static int n = -1;
    switch (event)
    {
    case cv::EVENT_LBUTTONDOWN: // 鼠标左键点击
    {
        p1 = Point2d(x, y);
        int w = 15, h = 15;
        Rect r0(g_p0.x - w, g_p0.y - h, 2 * w, 2 * h);
        Rect r1(g_p1.x - w, g_p1.y - h, 2 * w, 2 * h);
        Rect r2(g_p2.x - w, g_p2.y - h, 2 * w, 2 * h);
        if (r0.contains(p1)) // 鼠标落在中心点g_p0
        {
            n = 0;
            p = g_p0;
        }
        else if (r1.contains(p1)) // 鼠标落在g_p1
        {
            n = 1;
            p = g_p1;
        }
        else if (r2.contains(p1)) // 鼠标落在g_p2
        {
            n = 2;
            p = g_p2;
        }
        break;
    }
    case cv::EVENT_MOUSEMOVE: // 鼠标移动
        p2 = Point2d(x, y);
        if (n == 0)
        {
            g_p0 = p + p2 - p1;
        }
        else if (n == 1)
        {
            g_p1 = p + p2 - p1;
        }
        else if (n == 2)
        {
            g_p2 = p + p2 - p1;
        }
        break;
    case cv::EVENT_LBUTTONUP: // 鼠标左键释放
        p1 = Point2d(0, 0);
        p2 = Point2d(0, 0);
        n = -1;
        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(); // 拷贝空白图片,方便重复画图

        line(img, g_p1, g_p2, Scalar(255, 0, 0), 2); // 画蓝线a
        line(img, g_p2, g_p0, Scalar(0, 255, 0), 2); // 画绿线b
        line(img, g_p1, g_p0, Scalar(0, 0, 255), 2); // 画红线c

        if (same_line(g_p0, g_p1, g_p2)) // 3个点不在同一条直线上
        {
            draw_angle(img, g_p0, g_p1, g_p2, 15, Scalar(255, 0, 0), 2); // 画蓝色夹角
            double b = calculate_angle(g_p0, g_p1, g_p2);
            string s2 = "p0: (" + to_string(g_p1.x) + ", " + to_string(g_p1.y) + ") " + to_string(b);
            putText(img, s2, Point2d(10, 25), cv::FONT_HERSHEY_COMPLEX, 0.5, Scalar(255, 0, 0));

            draw_angle(img, g_p1, g_p2, g_p0, 15, Scalar(0, 255, 0), 2); // 画绿色夹角
            double c = calculate_angle(g_p1, g_p2, g_p0);
            string s3 = "p1: (" + to_string(g_p2.x) + ", " + to_string(g_p2.y) + ") " + to_string(c);
            putText(img, s3, Point2d(10, 50), cv::FONT_HERSHEY_COMPLEX, 0.5, Scalar(0, 255, 0));

            draw_angle(img, g_p2, g_p0, g_p1, 15, Scalar(0, 0, 255), 2); // 画红色夹角
            double a = calculate_angle(g_p2, g_p0, g_p1);
            string s1 = "p2: (" + to_string(g_p0.x) + ", " + to_string(g_p0.y) + ") " + to_string(a);
            putText(img, s1, Point2d(10, 75), cv::FONT_HERSHEY_COMPLEX, 0.5, Scalar(0, 0, 255));
        }
        else
        {
            putText(img, "error", Point2d(10, 25), cv::FONT_HERSHEY_COMPLEX, 0.5, Scalar(0, 0, 255), 1);
        }

        imshow(window_name, img);
        if (waitKey(3) > 0)
            break;
    }
    return 0;
}

操作方法:
  鼠标左键点击三角形任意一个顶线并按住移动,由此可修改三角形。在键盘输入任意的键,可退出程序。

运行结果:

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