geo_opencv.cpp

//
// Created by Harold on 2020/11/23.
//

#include <random>
#include <vector>
#include <iostream>
#include "m_geo_opencv.h"

using namespace M_MATH;

int main() {
    std::random_device dev;
    std::mt19937 rng(dev());
    std::uniform_real_distribution<float> dist(-1,1);
    auto gen = [&]() -> float {
        return dist(rng);
    };

    int const N = 1000;
    std::vector<cv::Point3f> pts;
    pts.reserve(N);
    for (auto i = 0; i < N; ++i)
        pts.emplace_back(gen(), gen(), gen());

    // xy plane
    auto p0 = cv::Point3f{0, 0, 0};
    auto p1 = cv::Point3f{0, 1, 0};
    auto p2 = cv::Point3f{1, 0, 0};
    auto p3 = cv::Point3f{1, 1, 0};
    auto pair = GetPlane(p0, p1, p2);
    std::cout << pair.first << pair.second << std::endl;
    auto vpts = std::vector<cv::Point3f>{p0, p1, p2, p3};
    auto vpair = GetPlane(vpts);
    std::cout << vpair.first << vpair.second << std::endl;

    // xy plane
    auto pts_x = PlanePts(pts.begin(), pts.end(), cv::Point3f{0, 0, 1}, cv::Point3f{0, 0, 0}, 0.05f);
    for (auto const& e : pts_x)
        assert(std::abs(e.z) <= 0.05);

    // x axis direction
    auto pts_xaxis = LinePts(pts.begin(), pts.end(),
                             cv::Point3f{0, 0, 1}, cv::Point3f{0, 0, 0},
                             cv::Point3f{0, 1, 0}, cv::Point3f{0, 0, 0},
                             0.05f,
                             0.05f);
    for (auto const& e : pts_xaxis)
        assert(std::abs(e.z) <= 0.05 && std::abs(e.y) <= 0.05);

    auto ppts = CrossSectionProject2D(pts, {-1, 0}, {1, 0}, 0.05f);
    std::cout << ppts << std::endl;
    ppts = CrossSectionProject2D(pts, { 0, -1 }, { 0, 1 }, 0.05f, false);
    std::cout << ppts << std::endl;

    auto centrialized_pts_2d = CentrializePoints2D(ppts);
    std::cout << "centrialized 2d points: \n" << centrialized_pts_2d << std::endl;
    auto centrialized_pts_3d = CentrializePoints3D(pts);
    std::cout << "centrialized 3d points: \n" << centrialized_pts_3d << std::endl;

    return 0;
}