#include <opencv2/imgproc/imgproc_c.h>
#include <opencv2/legacy/legacy.hpp>
#include "opencv2/highgui/highgui.hpp"
#include<opencv2\opencv.hpp>
#include<iostream>
#include <stdio.h>
using namespace std;
using namespace cv;
static CvSubdiv2D* init_delaunay(CvMemStorage* storage,//初始化三角剖分结构，为其分配单元
    CvRect rect)
{
    CvSubdiv2D* subdiv;//三角剖分的数据单元

    subdiv = cvCreateSubdiv2D(CV_SEQ_KIND_SUBDIV2D, sizeof(*subdiv),
        sizeof(CvSubdiv2DPoint),
        sizeof(CvQuadEdge2D),
        storage);
    cvInitSubdivDelaunay2D(subdiv, rect);

    return subdiv;
}


static void draw_subdiv_point(IplImage* img, CvPoint2D32f fp, CvScalar color)//画出三角剖分的顶点
{
    cvCircle(img, cvPoint(cvRound(fp.x), cvRound(fp.y)), 5, color, CV_FILLED, 8, 0);
}


static void draw_subdiv_edge(IplImage* img, CvSubdiv2DEdge edge, CvScalar color)//画出三角剖分的边
{
    CvSubdiv2DPoint* org_pt;//源顶点
    CvSubdiv2DPoint* dst_pt;//目地顶点
    CvPoint2D32f org;
    CvPoint2D32f dst;
    CvPoint iorg, idst;

    org_pt = cvSubdiv2DEdgeOrg(edge);//通过边获取顶点
    dst_pt = cvSubdiv2DEdgeDst(edge);

    if (org_pt && dst_pt)//如果两个端点不为空
    {
        org = org_pt->pt;
        dst = dst_pt->pt;

        iorg = cvPoint(cvRound(org.x), cvRound(org.y));
        idst = cvPoint(cvRound(dst.x), cvRound(dst.y));

        cvLine(img, iorg, idst, color, 1, CV_AA, 0);
    }
}


static void draw_subdiv(IplImage* img, CvSubdiv2D* subdiv,
    CvScalar delaunay_color, CvScalar voronoi_color)//画出剖分和细分
{
    CvSeqReader  reader;
    int i, total = subdiv->edges->total;//边的数量
    int elem_size = subdiv->edges->elem_size;//边的大小
    cout << typeid(subdiv->edges).name() << endl;

    cvStartReadSeq((CvSeq*)(subdiv->edges), &reader, 0);//使用CvSeqReader遍历Delaunay或者Voronoi边

    for (i = 0; i < total; i++)
    {
        CvQuadEdge2D* edge = (CvQuadEdge2D*)(reader.ptr);

        if (CV_IS_SET_ELEM(edge))
        {
            // draw_subdiv_edge( img, (CvSubdiv2DEdge)edge + 1, voronoi_color );
            draw_subdiv_edge(img, (CvSubdiv2DEdge)edge, delaunay_color);
        }

        CV_NEXT_SEQ_ELEM(elem_size, reader);
    }

}


static void locate_point(CvSubdiv2D* subdiv, CvPoint2D32f fp, IplImage* img,//遍历三角剖分的边
    CvScalar active_color)
{
    CvSubdiv2DEdge e;
    CvSubdiv2DEdge e0 = 0;
    CvSubdiv2DPoint* p = 0;

    cvSubdiv2DLocate(subdiv, fp, &e0, &p);

    if (e0)
    {
        e = e0;
        do
        {
            draw_subdiv_edge(img, e, active_color);
            e = cvSubdiv2DGetEdge(e, CV_NEXT_AROUND_LEFT);
        } while (e != e0);
    }

    draw_subdiv_point(img, fp, active_color);
}

//@author andme-单目视觉
void dashLine(Mat &img, Point2d& pt1, Point2d& pt2, int n)//n为虚线段数
{
    Point sub = pt2 - pt1;
    for (int i = 0; i < 2 * n; i += 2)
    {
        line(img, Point(pt1.x + sub.x * i / (2 * n - 1), pt1.y + sub.y * i / (2 * n - 1)), Point(pt1.x + sub.x * (i + 1) / (2 * n - 1), pt1.y + sub.y * (i + 1) / (2 * n - 1)), Scalar(0, 255, 0), 2);
    }
}



//调用形式draw_subdiv_facet( img, cvSubdiv2DRotateEdge( e, 1 ));
static void draw_subdiv_facet(IplImage* img, CvSubdiv2DEdge edge)//画出voronoi面   
{
    //cout<<edge<<endl;//edge低两位表示表示索引，高位表示四方边缘指针。
    //cout<<(edge&3)<<endl;
    CvSubdiv2DEdge t = edge;//当我们按上面的调用形式时，edge为eRot。
    int i, count = 0;
    CvPoint* buf = 0;
    Point2d *buf1 = 0;

    // count number of edges in facet //面内边的计数
    do
    {
        count++;
        t = cvSubdiv2DGetEdge(t, CV_NEXT_AROUND_LEFT);
    } while (t != edge);//我们绕着一个voronoi单元一周，遍历该vornonoi边缘所拥有的边缘数。
    cout << "count=" << count << endl;
    buf = (CvPoint*)malloc(count * sizeof(buf[0]));
    buf1 = (Point2d*)malloc(count*sizeof(buf1[0]));

    // gather points
    t = edge;
    for (i = 0; i < count; i++)
    {
        CvSubdiv2DPoint* pt = cvSubdiv2DEdgeOrg(t);//第一次获取eRot边缘的起始点
        if (!pt) break;//如果得不到该源点，则退出循环
        buf[i] = cvPoint(cvRound(pt->pt.x), cvRound(pt->pt.y));//将该点转换为cvPoint类型点，存储在buf中
        t = cvSubdiv2DGetEdge(t, CV_NEXT_AROUND_LEFT);//然后绕着vornonoi单元，左旋转。
    }

    if (i == count)//如果所有的点都存储起来了。
    {
        CvSubdiv2DPoint* pt = cvSubdiv2DEdgeDst(cvSubdiv2DRotateEdge(edge, 1));//这里eRot的旋转边缘应该是reversed e,那么目的点，就是e的源点。
        // cvFillConvexPoly( img, buf, count, CV_RGB(rand()&255,rand()&255,rand()&255), CV_AA, 0 );//填充凸多边形
        for (i = 0; i<count; i++)
        {
            buf1[i].x = buf[i].x;
            buf1[i].y = buf[i].y;
        }
        Mat mat_img(img);

        cvPolyLine(img, &buf, &count, 1, 1, CV_RGB(0, 100, 0), 1, CV_AA, 0);//画出线。
        for(int i=0;i<count-1;i++)
        {
            cvCircle(img,cvPoint(buf1[i].x,buf1[i].y),5,CV_RGB(0,100,0));
        //dashLine(mat_img,buf1[i],buf1[i+1],100);
        }
        //dashLine(mat_img,buf1[i],buf1[0],100);*/
        //draw_subdiv_point(img, pt->pt, CV_RGB(0, 0, 0));//用黑色画出画出剖分顶点。
    }
    free(buf);
}

static void paint_voronoi(CvSubdiv2D* subdiv, IplImage* img)//画出voronoi面
{
    CvSeqReader  reader;
    int i, total = subdiv->edges->total;//边缘总数
    int elem_size = subdiv->edges->elem_size;//边缘的大小

    cvCalcSubdivVoronoi2D(subdiv);

    cvStartReadSeq((CvSeq*)(subdiv->edges), &reader, 0);

    for (i = 0; i < total; i++)
    {
        CvQuadEdge2D* edge = (CvQuadEdge2D*)(reader.ptr);//获取四方边缘

        if (CV_IS_SET_ELEM(edge))//判断边缘是否在边缘集中
        {
            CvSubdiv2DEdge e = (CvSubdiv2DEdge)edge;//edge是四方边缘的指针，而CvSubdiv2DEdge高位表示四方边缘的指针。
            //cout<<(e&3)<<endl;//通过测试e低2位即索引值应该设置为0了，即输入边缘
            // left
            draw_subdiv_facet(img, cvSubdiv2DRotateEdge(e, 1));//e为Delaunay边，获得Delaunay边对应的voronoi边，即e的旋转边缘
            
            // right
            draw_subdiv_facet(img, cvSubdiv2DRotateEdge(e, 3));//反向的旋转边缘
        }

        CV_NEXT_SEQ_ELEM(elem_size, reader);//移动到下一个位置
    }
}


static void run(void)
{
    char win[] = "source";
    int i;
    CvRect rect = { 0, 0, 600, 600 };
    CvMemStorage* storage;
    CvSubdiv2D* subdiv;
    IplImage* img;
    CvScalar active_facet_color, delaunay_color, voronoi_color, bkgnd_color;

    active_facet_color = CV_RGB(255, 0, 0);//红色
    delaunay_color = CV_RGB(0, 0, 0);//黑色
    voronoi_color = CV_RGB(0, 180, 0);//绿色
    bkgnd_color = CV_RGB(255, 255, 255);//白色

    img = cvCreateImage(cvSize(rect.width, rect.height), 8, 3);
    cvSet(img, bkgnd_color, 0);

    cvNamedWindow(win, 1);

    storage = cvCreateMemStorage(0);
    subdiv = init_delaunay(storage, rect);

    printf("Delaunay triangulation will be build now interactively.\n"
        "To stop the process, press any key\n\n");

    vector<CvPoint2D32f> points;
    for (i = 0; i < 5; i++)
    {
        CvPoint2D32f fp = cvPoint2D32f((float)(rand() % (rect.width - 10)),//使点约束在距离边框10像素之内。
            (float)(rand() % (rect.height - 10)));
        points.push_back(fp);

        locate_point(subdiv, fp, img, active_facet_color);//定位点的位置，并画出点所在delaunay面的边。
        cvShowImage(win, img);//刷新显示

    /*  if (cvWaitKey(100) >= 0)
            break;*/ 
        //cvWaitKey(0);

        cvSubdivDelaunay2DInsert(subdiv, fp);//向三角剖分中插入该点，即对该点进行三角剖分
        cvCalcSubdivVoronoi2D(subdiv);//计算Voronoi细分，有时候我们不需要
        cvSet(img, bkgnd_color, 0);//设置图像的背景颜色为白色
        draw_subdiv(img, subdiv, delaunay_color, voronoi_color);
        cvShowImage(win, img);

        //cvWaitKey();
        /*if (cvWaitKey(100) >= 0)
            break;*/
        //cvWaitKey(0);
    }
    for (int i = 0; i<points.size(); i++)
        draw_subdiv_point(img, points[i], active_facet_color);
    cvShowImage(win, img);
    cvWaitKey();

    //  cvSet( img, bkgnd_color, 0 );//重新刷新画布，即设置背景颜色为白色
    paint_voronoi(subdiv, img);//画出细分
    cvShowImage(win, img);//

    cvWaitKey(0);

    cvReleaseMemStorage(&storage);
    cvReleaseImage(&img);
    cvDestroyWindow(win);
}

int main(int argc, char** argv)
{
    (void)argc; (void)argv;
    run();
    return 0;
}

#ifdef _EiC
main(1, "delaunay.c");
#endif