// BinocularMarkCam_test.cpp : 此文件包含 "main" 函数。程序执行将在此处开始并结束。
//
#include <iostream>
#include <fstream>
#include <vector>
#include <stdio.h>
#include <VZNL_Types.h>
#include <string>
#include "binocularMarkCam_Export.h"
#include <opencv2/opencv.hpp>
#include <opencv2/core/core.hpp>
#include <opencv2/imgcodecs/imgcodecs.hpp>
#include <Windows.h>

#define TEST_GROUP 2
int main(int argc, char** argv)
{
    const char* dataPath[TEST_GROUP] = {
        "F:/标定采图/charucoMark图/MarkTest/",  //0
        "F:/标定采图/charucoMark图/Mark_13度/",
    };

    SVzNLRange fileIdx[TEST_GROUP] = {
        {1,4}, {1,5}, 
    };

	const char* ver = wd_charuco3DMarkVersion();
	printf("ver:%s\n", ver);

    for (int grp = 1; grp < 2; grp++)
    {
        SWD_BQ_CharucoMarkInfo markInfo;
        markInfo.patternSize = cv::Size(3, 3);
        markInfo.dictType = 1; //DICT_6x6
        markInfo.checkerSize = 60.0;
        markInfo.markerSize = 45.0;

        SWD_BQ_MarkBoardInfo boardInfo;
        boardInfo.totalBoardNum = 10;
        boardInfo.boardIdInterval = 8;
        boardInfo.boardChaucoIDNum = 4;

        // 1. 打开 XML 文件（READ 模式）
        char calibFile[250];
        sprintf_s(calibFile, sizeof(calibFile), "%sStereoCamera.xml", dataPath[grp]);
        cv::FileStorage fs("F:/标定采图/charucoMark图/Mark_13度/StereoCamera.xml", cv::FileStorage::READ);

        // 检查文件是否成功打开
        if (!fs.isOpened()) {
            printf( "错误：无法打开 XML 文件！请检查路径是否正确。\n" );
            return -1;
        }
        cv::FileNode LeftCamera = fs["LeftCamera"];
        cv::Mat cameraMatrixL, distCoeffsL;
        LeftCamera["CameraMatrix"] >> cameraMatrixL;
        LeftCamera["DistCoeffs"] >> distCoeffsL;
        cv::FileNode RightCamera = fs["RightCamera"];
        cv::Mat cameraMatrixR, distCoeffsR;
        RightCamera["CameraMatrix"] >> cameraMatrixR;
        RightCamera["DistCoeffs"] >> distCoeffsR;
        cv::FileNode Rectification = fs["Rectification"];
        cv::Mat R1, R2,P1,P2,Q;
        Rectification["R1"] >> R1;
        Rectification["R2"] >> R2;
        Rectification["P1"] >> P1;
        Rectification["P2"] >> P2;
        Rectification["Q"] >> Q;

        int fidx1 = fileIdx[grp].nMin;
        int fidx2 = fileIdx[grp].nMax;
        for (int index = fidx1; index < fidx2; index ++) 
        {
            char filename[256];
            sprintf_s(filename, "%s/left%d.bmp", dataPath[grp], index);
            cv::Mat leftimg = cv::imread(filename, cv::IMREAD_GRAYSCALE);

            sprintf_s(filename, "%s/right%d.bmp", dataPath[grp], index);
            cv::Mat rightimg = cv::imread(filename, cv::IMREAD_GRAYSCALE);

            if (leftimg.empty() || rightimg.empty())
                break;

            double disparityOffset = 0;
            std::vector<SWD_charuco3DMark> marks;
            wd_BQ_getCharuco3DMark(
                leftimg, rightimg,
                cameraMatrixL, distCoeffsL, cameraMatrixR, distCoeffsR, R1, R2, P1, P2, Q,
                markInfo, boardInfo,
                disparityOffset,
                marks);
        }
    }
}

// 运行程序: Ctrl + F5 或调试 >“开始执行(不调试)”菜单
// 调试程序: F5 或调试 >“开始调试”菜单

// 入门使用技巧: 
//   1. 使用解决方案资源管理器窗口添加/管理文件
//   2. 使用团队资源管理器窗口连接到源代码管理
//   3. 使用输出窗口查看生成输出和其他消息
//   4. 使用错误列表窗口查看错误
//   5. 转到“项目”>“添加新项”以创建新的代码文件，或转到“项目”>“添加现有项”以将现有代码文件添加到项目
//   6. 将来，若要再次打开此项目，请转到“文件”>“打开”>“项目”并选择 .sln 文件