diff --git a/camAlgoSW/camAlgoSW.vcxproj b/camAlgoSW/camAlgoSW.vcxproj
index 03e2baa..9baf6c7 100644
--- a/camAlgoSW/camAlgoSW.vcxproj
+++ b/camAlgoSW/camAlgoSW.vcxproj
@@ -97,10 +97,12 @@
true
.\sourceCode;.\sourceCode\CG_frontEnd\inc;$(VC_IncludePath);$(WindowsSDK_IncludePath);
+ $(SolutionDir)build\$(Platform)\$(Configuration)\
false
.\sourceCode;.\sourceCode\CG_frontEnd\inc;$(VC_IncludePath);$(WindowsSDK_IncludePath);
+ $(SolutionDir)build\$(Platform)\$(Configuration)\
diff --git a/camAlgoSW/sourceCode/camAlgoSW.cpp b/camAlgoSW/sourceCode/camAlgoSW.cpp
index c1a5a7e..ab57a75 100644
--- a/camAlgoSW/sourceCode/camAlgoSW.cpp
+++ b/camAlgoSW/sourceCode/camAlgoSW.cpp
@@ -10,17 +10,6 @@
#include "compute3D.h"
#include "camAlgoSW_Export.h"
-typedef struct
-{
- uint16_t WinRdx;//窗口在图像内的起始坐标
- uint16_t y; //y坐标
- uint16_t Rid; //region的ID
- uint8_t Flag; //bit0是overlap标志。bit1是反光信号标志
- uint8_t PeakRltvRdx; //peak在窗口内的的相对坐标,低4位是起始坐标,高4位是结束坐标
- uint8_t data[RGN_DATA_WIN_SIZE];
- //double offset;
-}Luma_rgnData;
-
#define SV_WIN_SIZE 16
#define ALIGN_RDX ((LAZER_WIN_SIZE-SV_WIN_SIZE)/2)
std::vector SvPickRgnRslt(
@@ -280,8 +269,15 @@ void camAlgoSW(
CamPara& calibPara,
LineCalibK* lineCalibKx,
LineCalibK* lineCalibKy,
+#if _ALGO_MODULE_DEBUG
+ std::vector& frontendData_debug,
+ std::vector& centeringPnt_debug,
+ std::vector& subpixPnt_debug,
+ std::vector& calibSubpixPnt_debug,
+#endif
std::vector& resul3DPnts)
{
+
PickLaserResult pFrontendResult;
PickLazerWin(
1,
@@ -312,15 +308,17 @@ void camAlgoSW(
frontendPara.RgnMeanETh,
&pFrontendResult
);
-
//将前端数据转成输入数据格式
-
std::vector frontendData = SvPickRgnRslt(
inData,
inFrmH,
inFrmW,
pFrontendResult
);
+#if _ALGO_MODULE_DEBUG
+ frontendData_debug.insert(frontendData_debug.end(), frontendData.begin(), frontendData.end());
+#endif
+
std::vector InRgnPnt;
genTestSream(
frontendData,
@@ -332,6 +330,9 @@ void camAlgoSW(
InRgnPnt,
OutCenteringPnt
);
+#if _ALGO_MODULE_DEBUG
+ centeringPnt_debug.insert(centeringPnt_debug.end(), OutCenteringPnt.begin(), OutCenteringPnt.end());
+#endif
//Convolve
std::vector OutConvolvePnt;
@@ -344,6 +345,9 @@ void camAlgoSW(
subpix(
OutConvolvePnt,
OutSubpixPnt);
+#if _ALGO_MODULE_DEBUG
+ subpixPnt_debug.insert(subpixPnt_debug.end(), OutSubpixPnt.begin(), OutSubpixPnt.end());
+#endif
//将subpix转成RgnSubPixCalib格式。在硬件实现时这一步骤由硬件完成
//数据格式:每行由行同步和后续的8拍构成。行同步传送x和y数据,后8拍依次传送KX0~KX7, 和KY0 ~ KY7
@@ -357,6 +361,9 @@ void camAlgoSW(
inCalibData,
outSubpixCalib
);
+#if _ALGO_MODULE_DEBUG
+ calibSubpixPnt_debug.insert(calibSubpixPnt_debug.end(), outSubpixCalib.begin(), outSubpixCalib.end());
+#endif
// Compute3D
compute3D(
diff --git a/camAlgoSW/sourceCode/camAlgoSW_Export.h b/camAlgoSW/sourceCode/camAlgoSW_Export.h
index a75065a..b56fb21 100644
--- a/camAlgoSW/sourceCode/camAlgoSW_Export.h
+++ b/camAlgoSW/sourceCode/camAlgoSW_Export.h
@@ -9,6 +9,18 @@
# define SG_APISHARED_EXPORT __declspec(dllimport)
#endif
+typedef struct
+{
+ uint16_t WinRdx;//窗口在图像内的起始坐标
+ uint16_t y; //y坐标
+ uint16_t Rid; //region的ID
+ uint8_t Flag; //bit0是overlap标志。bit1是反光信号标志
+ uint8_t PeakRltvRdx; //peak在窗口内的的相对坐标,低4位是起始坐标,高4位是结束坐标
+ uint8_t data[RGN_DATA_WIN_SIZE];
+ //double offset;
+}Luma_rgnData;
+
+#define _ALGO_MODULE_DEBUG 1
SG_APISHARED_EXPORT void camAlgoSW(
int inFrmH,
int inFrmW,
@@ -18,4 +30,10 @@ SG_APISHARED_EXPORT void camAlgoSW(
CamPara& calibPara,
LineCalibK* lineCalibKx,
LineCalibK* lineCalibKy,
+#if _ALGO_MODULE_DEBUG
+ std::vector& frontendData,
+ std::vector& centeringPnt_debug,
+ std::vector& subpixPnt_debug,
+ std::vector& calibSubpixPnt_debug,
+#endif
std::vector< Pnt3D>& resul3DPnts);
\ No newline at end of file
diff --git a/camAlgoSW/sourceCode/compute3D.cpp b/camAlgoSW/sourceCode/compute3D.cpp
index d032839..55a696f 100644
--- a/camAlgoSW/sourceCode/compute3D.cpp
+++ b/camAlgoSW/sourceCode/compute3D.cpp
@@ -62,10 +62,14 @@ void compute3D(
double u = (double)InData.x;
double v = (double)InData.y;
- double z_inv = u * plane_a + v * plane_b + plane_c;
- double z = 1/ z_inv;
- double x = (u - u0) * z * F_inv;
- double y = (v - v0) * z * F_inv;
+ double tmp_x = (u - u0) * F_inv;
+ double tmp_y = (v - v0) * F_inv;
+ double z_inv = plane_a * tmp_x + plane_b * tmp_y - 1;
+ double z = 1 / z_inv;
+ z = -z * plane_c;
+
+ double x = tmp_x * z ;
+ double y = tmp_y * z ;
outData.x = (float)x;
outData.y = (float)y;
outData.z = (float)z;
diff --git a/camAlgoSW/sourceCode/peakCentering.cpp b/camAlgoSW/sourceCode/peakCentering.cpp
index b286ac5..7f16dcd 100644
--- a/camAlgoSW/sourceCode/peakCentering.cpp
+++ b/camAlgoSW/sourceCode/peakCentering.cpp
@@ -49,6 +49,7 @@ void peakCentering(
RgnPix zeroData = {0,0,0,0,0,0,0};
//ping-pong buffer
RgnPix HSyncData_d1 = {0,0,0,0,0,0,0};
+ ushort LazerWinX_d1 = 0;
uchar lineBuff_0[RGN_DATA_WIN_SIZE * 2];
//#pragma HLS RESOURCE variable=lineBuff_0 core=RAM_2P
uchar lineBuff_1[RGN_DATA_WIN_SIZE * 2];
@@ -82,9 +83,18 @@ void peakCentering(
if(0 == i) //HSync
{
+ evenFlag = n % 2;
+ if (0 == linePk.len)
+ pkCenter = RGN_DATA_WIN_SIZE / 2;
+ else
+ pkCenter = linePk.start + (linePk.len >> 1);
+ HSyncData_d1.LazerWinX = LazerWinX_d1 + pkCenter;
+ if (HSyncData_d1.LazerWinY == 578)
+ int kkk = 1;
if ((n > 0) &&( linePk.len>0))
OutCenteringPnt.push_back(HSyncData_d1);
HSyncData_d1 = InData;
+ LazerWinX_d1 = InData.LazerWinX - RGN_DATA_WIN_SIZE;
pkRng_S = InData.RltvRdx & 0x0f;
pkRng_S += RGN_DATA_WIN_SIZE / 2;
@@ -92,11 +102,6 @@ void peakCentering(
pkRng_E = InData.RltvRdx & 0x0f;
pkRng_E += RGN_DATA_WIN_SIZE / 2;
- evenFlag = n%2;
- if(0 == linePk.len)
- pkCenter = RGN_DATA_WIN_SIZE/2;
- else
- pkCenter = linePk.start + (linePk.len >> 1);
linePk.start = 0;
linePk.len = 0;
linePk.value = 0;
diff --git a/camAlgoSW/sourceCode/subPix.cpp b/camAlgoSW/sourceCode/subPix.cpp
index 87418b3..428d0dc 100644
--- a/camAlgoSW/sourceCode/subPix.cpp
+++ b/camAlgoSW/sourceCode/subPix.cpp
@@ -84,6 +84,8 @@ void subpix(
InData = InConvolvePnt[readPtr++];
+ if (InData.LazerWinY == 579)
+ int kkk = 1;
float fx;
if(InData.nD2 == 0)
fx = 0;
@@ -91,7 +93,7 @@ void subpix(
fx = (float)InData.nD1/(float)InData.nD2;
RgnSubPix a_pnt;
- if(n == 1)
+ if(n == 0)
a_pnt.Sync = 0b01;
else
a_pnt.Sync = 0b00;
@@ -99,7 +101,7 @@ void subpix(
a_pnt.y = InData.LazerWinY;
a_pnt.rid = InData.LazerWinRid;
a_pnt.value = InData.value;
- a_pnt.x = (float)InData.LazerWinX + 8.0f + fx;
+ a_pnt.x = (float)InData.LazerWinX + 8.0f + fx + 0.5; //+0.5: adjust pnt to pixel center
a_pnt.rsv = 0;
OutSubpixPnt.push_back(a_pnt);
}
diff --git a/camAlgoSW_test/camAlgoSW_test.cpp b/camAlgoSW_test/camAlgoSW_test.cpp
index 00fcc8e..377d1d0 100644
--- a/camAlgoSW_test/camAlgoSW_test.cpp
+++ b/camAlgoSW_test/camAlgoSW_test.cpp
@@ -2,10 +2,387 @@
//
#include
+#include
+#include "..\camAlgoSW\sourceCode\camAlgoSW_Export.h"
+#include
+#include
+#include "..\camAlgoSW\sourceCode\algoGlobals.h"
-int main()
+typedef struct
{
- std::cout << "Hello World!\n";
+ int nMin; //< 鏈灏忓
+ int nMax; //< 鏈澶у
+} SWdNLRange;
+
+void saveFrontEndData(char* fileName, std::vector& frontendData)
+{
+ if (0 == frontendData.size())
+ return;
+
+ std::ofstream TXTFile(fileName);
+ char TXTData[250];
+ snprintf(TXTData, sizeof(TXTData), "%3x", (0x800 | 0x10));//MEANSTG_WIN_SIZE);
+ TXTFile << TXTData << std::endl;
+
+ for (int i = 0, i_max = (int)frontendData.size(); i < i_max; i++)
+ {
+ Luma_rgnData data = frontendData[i];
+ snprintf(TXTData, sizeof(TXTData), "%04x %04x %04x %01x %02x", data.WinRdx, data.y, data.Rid, data.Flag, data.PeakRltvRdx);
+ TXTFile << TXTData << std::endl;
+ for (int j = 0; j < 16; j++)
+ {
+ snprintf(TXTData, sizeof(TXTData), "%02x", data.data[j]);
+ TXTFile << TXTData << std::endl;
+ }
+ }
+ TXTFile.close();
+}
+
+void readFrontEndDataFile(char* fileName, std::vector& frontendData)
+{
+ std::ifstream inputFile(fileName);
+ std::string linedata;
+
+ if (inputFile.is_open() == false)
+ return;
+
+ std::getline(inputFile, linedata); //绗竴琛
+
+ int idx = 0;
+ Luma_rgnData a_pk;
+ while (std::getline(inputFile, linedata))
+ {
+ if (idx == 0)
+ {
+ int WinRdx, y, Rid, Flag, PeakRltvRdx;
+ sscanf_s(linedata.c_str(), "%04x %04x %04x %01x %02x", &WinRdx, &y, &Rid, &Flag, &PeakRltvRdx);
+ a_pk.WinRdx = WinRdx;
+ a_pk.y = y;
+ a_pk.Rid = Rid;
+ a_pk.Flag = Flag;
+ a_pk.PeakRltvRdx = PeakRltvRdx;
+ idx++;
+ }
+ else
+ {
+ int value;
+ sscanf_s(linedata.c_str(), "%02x", &value);
+ a_pk.data[idx - 1] = value;
+ idx++;
+ }
+ if (idx == 17)
+ {
+ frontendData.push_back(a_pk);
+ idx = 0;
+ }
+ }
+ inputFile.close();
+ return;
+}
+
+void saveCenteringData(char* filename, std::vector& centeringPnt)
+{
+ if (centeringPnt.size() < 6)
+ return;
+
+ int vldSize = (int)centeringPnt.size() - 6;
+ if ( (vldSize % 9) != 0)
+ return;
+ int grp = vldSize / 9;
+
+ std::ofstream TXTFile(filename);
+ char TXTData[250];
+ snprintf(TXTData, sizeof(TXTData), "%3x", (0x800 | 0x10));//MEANSTG_WIN_SIZE);
+ TXTFile << TXTData << std::endl;
+
+ int headOffset = 6;
+ for (int i = 0; i < grp; i++)
+ {
+ RgnPix data = centeringPnt[i * 9 + headOffset];
+ snprintf(TXTData, sizeof(TXTData), "%04x %04x %04x %01x %02x", data.LazerWinX, data.LazerWinY, data.LazerWinRid, data.LazerWinFlag, data.RltvRdx);
+ TXTFile << TXTData << std::endl;
+ for (int j = 1; j <= 8; j++)
+ {
+ data = centeringPnt[i * 9 + j + headOffset];
+ snprintf(TXTData, sizeof(TXTData), "%02x", data.LazerWinX);
+ TXTFile << TXTData << std::endl;
+ snprintf(TXTData, sizeof(TXTData), "%02x", data.LazerWinY);
+ TXTFile << TXTData << std::endl;
+ }
+ }
+ TXTFile.close();
+
+}
+
+void saveSubpixData(char* filename, std::vector& subpixPnt)
+{
+ if (subpixPnt.size() < 6)
+ return;
+
+ std::ofstream TXTFile(filename);
+ char TXTData[250];
+ int headOffset = 6;
+ for (int i = 6, i_max = (int)subpixPnt.size(); i< i_max; i++)
+ {
+ RgnSubPix data = subpixPnt[i];
+ snprintf(TXTData, sizeof(TXTData), "%.5f %04d rid=%04d flag=%01x value=%03d", data.x, data.y, data.rid, data.flag, data.value);
+ TXTFile << TXTData << std::endl;
+ }
+ TXTFile.close();
+}
+
+void saveCalibSubpixData(char* filename, std::vector& subpixPnt)
+{
+ if (subpixPnt.size() < 6)
+ return;
+
+ std::ofstream TXTFile(filename);
+ char TXTData[250];
+ int headOffset = 6;
+ for (int i = 6, i_max = (int)subpixPnt.size(); i < i_max; i++)
+ {
+ RgnSubPixCalib data = subpixPnt[i];
+ snprintf(TXTData, sizeof(TXTData), "%.5f %.5f rid=%04d flag=%01x value=%03d", data.x, data.y, data.rid, data.flag, data.value);
+ TXTFile << TXTData << std::endl;
+ }
+ TXTFile.close();
+}
+
+
+void readCalibK(char* paraFilename, LineCalibK* lineCalibK)
+{
+ std::ifstream inputFile(paraFilename);
+ std::string linedata;
+
+ if (inputFile.is_open() == false)
+ return;
+ int i = 0;
+ while (std::getline(inputFile, linedata))
+ {
+ LineCalibK a_para;
+ sscanf_s(linedata.c_str(), "%lf, %lf, %lf, %lf, %lf, %lf, %lf, %lf", &a_para.calibK[0], &a_para.calibK[1], &a_para.calibK[2], &a_para.calibK[3], &a_para.calibK[4], &a_para.calibK[5], &a_para.calibK[6], &a_para.calibK[7]);
+ lineCalibK[i] = a_para;
+ i++;
+ }
+ inputFile.close();
+ return;
+}
+
+CamPara readLaserPlanePara(char* filename)
+{
+
+ CamPara para;
+ memset(¶, 0, sizeof(CamPara));
+ std::ifstream inputFile(filename);
+ std::string linedata;
+
+ if (inputFile.is_open() == false)
+ return para;
+
+ //璇诲彇: fx, 0, cx
+ if (std::getline(inputFile, linedata))
+ {
+ double tmp;
+ sscanf_s(linedata.c_str(), "%lf, %lf, %lf", ¶.F_inv, &tmp, ¶.u0);
+ para.F_inv = 1.0 / para.F_inv;
+ }
+ else
+ return para;
+
+ //璇诲彇: 0, fy, cy
+ if (std::getline(inputFile, linedata))
+ {
+ double tmp_1, tmp_2;
+ sscanf_s(linedata.c_str(), "%lf, %lf, %lf", &tmp_1, &tmp_2, ¶.v0);
+ }
+ else
+ return para;
+
+ //璺宠繃鐜拌
+ if (!std::getline(inputFile, linedata))
+ return para;
+ if (!std::getline(inputFile, linedata))
+ return para;
+
+ //璇诲彇: a, b, c
+ if (std::getline(inputFile, linedata))
+ sscanf_s(linedata.c_str(), "%lf, %lf, %lf", ¶.plane_a, ¶.plane_b, ¶.plane_c);
+
+ return para;
+}
+
+void saveLineData(char* fileName, std::vector< Pnt3D>& resul3DPnts)
+{
+ std::ofstream sw(fileName);
+ sw << "LineNum:1" << std::endl;
+// sw << "DataType: 0" << std::endl;
+// sw << "ScanSpeed: 0" << std::endl;
+// sw << "PointAdjust:1" << std::endl;
+// sw << "MaxTimeStamp:0_0" << std::endl;
+
+ int ptCounter = (int)resul3DPnts.size() - 4;
+ sw << "Line_0_0_" << ptCounter << std::endl;
+ for (int i = 4; i < (int)resul3DPnts.size(); i++)
+ {
+ Pnt3D a_pt = resul3DPnts[i];
+ float x = (float)a_pt.x;
+ float y = (float)a_pt.y;
+ float z = (float)a_pt.z;
+ sw << "{" << x << "," << y << "," << z << "}-";
+ sw << "{0,0}-{0,0}" << std::endl;
+ }
+ sw.close();
+}
+
+#define CALIB_TEST_GROUP 3
+int main()
+{
+ std::cout << "Hello World!\n";
+ const char* calibDataPath[CALIB_TEST_GROUP] = {
+ "F:\\ShangGu\\ProductDev\\涓夎鍏夌浉鏈篭\鐩告満寮鍙慭\CamAlgo_git\\camCalib\\camCalibData\\chessboard\\", //1
+ "F:\\ShangGu\\ProductDev\\涓夎鍏夌浉鏈篭\鐩告満寮鍙慭\CamAlgo_git\\camCalib\\camCalibData\\circlePoint\\", //2
+ "F:\\ShangGu\\ProductDev\\涓夎鍏夌浉鏈篭\鐩告満寮鍙慭\CamAlgo_git\\camCalib\\camCalibData\\charuCo\\", //3
+ };
+ const SWdNLRange fileIdx[CALIB_TEST_GROUP] = {
+ {1,33},{1,33},{1,10}
+ };
+
+ //绠楁硶鍙傛暟
+ ProcObj frontendPara;
+ frontendPara.StartIdx = 0;
+ frontendPara.EndIdx = 0;
+ frontendPara.MinStgTh = 5;
+ frontendPara.LazerWMin = 2;
+ frontendPara.LazerWMax = 10;
+ frontendPara.RflctPixTh = 128;
+ frontendPara.RflctOutEna = 0;//??
+ frontendPara.OverlapPixTh = 32;
+ frontendPara.EnhanStep = 2;
+ frontendPara.PickEna = 1;
+ frontendPara.RgnFltrTh = 0;
+ frontendPara.RmvWkEndEna = 1;
+ frontendPara.RmvWkEndTh = 2;
+ frontendPara.RmvWkEndMultCoe = 16;
+ frontendPara.RmvWkEndMinLen = 3;
+ frontendPara.PickBFEna = 0;
+ frontendPara.PickBkGrnd = 0;
+ frontendPara.PickRLenTh = 4;
+ frontendPara.EnergyPickEna = 1;
+ frontendPara.PickEnergyType = 0;
+ frontendPara.RgnEnergyPLen = 32;
+ frontendPara.RgnMeanETh = 0;
+
+ LineCalibK* lineCalibKx = (LineCalibK*)malloc(sizeof(LineCalibK) * MAX_HEIGHT);
+ LineCalibK* lineCalibKy = (LineCalibK*)malloc(sizeof(LineCalibK) * MAX_HEIGHT);
+
+ FramePara inFramePara;
+ CamPara calibPara;
+
+ for (int grp = 0; grp < CALIB_TEST_GROUP; grp++)
+ {
+ memset(lineCalibKx, 0, sizeof(LineCalibK) * MAX_HEIGHT);
+ memset(lineCalibKy, 0, sizeof(LineCalibK) * MAX_HEIGHT);
+ //璇诲彇鏍℃绯绘暟
+ char paraFilename[256];
+ sprintf_s(paraFilename, "%scalib_param_x.txt", calibDataPath[grp]);
+ readCalibK(paraFilename, lineCalibKx);
+ sprintf_s(paraFilename, "%scalib_param_y.txt", calibDataPath[grp]);
+ readCalibK(paraFilename, lineCalibKy);
+ //璇诲彇鍏夊垁闈
+ sprintf_s(paraFilename, "%scalib_param_K_D.txt", calibDataPath[grp]);
+ calibPara = readLaserPlanePara(paraFilename);
+
+ int startIndex = fileIdx[grp].nMin;
+ int endIndex = fileIdx[grp].nMax;
+ int index;
+ for (index = startIndex; index <= endIndex; index++)
+ {
+ char filename[256];
+ sprintf_s(filename, "%slaser_rotate_mask_%03d.png", calibDataPath[grp], index);
+ cv::Mat srcImg = cv::imread(filename);
+ if (srcImg.empty())
+ break;
+
+ inFramePara.FrmNo = index;
+ inFramePara.timeStamp = index;
+ inFramePara.encInfo = 0;
+ inFramePara.frameROI_w = srcImg.cols;
+ inFramePara.frameROI_h = srcImg.rows;
+ inFramePara.frameROI_x = 0;
+ inFramePara.frameROI_y = 0;
+
+ cv::Mat gray;
+ if (srcImg.channels() == 3)
+ cv::cvtColor(srcImg, gray, cv::COLOR_BGR2GRAY);
+ else
+ gray = srcImg.clone();
+
+ unsigned char* dataPtr = gray.data;
+
+ std::vector< Pnt3D> resul3DPnts;
+#if _ALGO_MODULE_DEBUG
+ std::vector frontendData;
+ std::vector centeringPnt;
+ std::vector subpixPnt;
+ std::vector calibSubpixPnt;
+#endif
+ camAlgoSW(
+ gray.rows,
+ gray.cols,
+ dataPtr,
+ frontendPara,
+ inFramePara,
+ calibPara,
+ lineCalibKx,
+ lineCalibKy,
+#if _ALGO_MODULE_DEBUG
+ frontendData,
+ centeringPnt,
+ subpixPnt,
+ calibSubpixPnt,
+#endif
+ resul3DPnts);
+#if _ALGO_MODULE_DEBUG
+ //淇濆瓨frontendData
+ sprintf_s(filename, "%sresult\\%d_verilog.txt", calibDataPath[grp], index);
+ saveFrontEndData(filename, frontendData);
+ //淇濆瓨centeringData
+ sprintf_s(filename, "%sresult\\%d_centeringData.txt", calibDataPath[grp], index);
+ saveCenteringData(filename, centeringPnt);
+ //淇濆瓨subpixData
+ sprintf_s(filename, "%sresult\\%d_subpixData.txt", calibDataPath[grp], index);
+ saveSubpixData(filename, subpixPnt);
+ //鏄剧ず浜氬儚绱犵偣
+ cv::Mat enlargeImg;
+ if (srcImg.channels() == 1)
+ srcImg.convertTo(enlargeImg, cv::COLOR_GRAY2BGR);
+ else
+ enlargeImg = srcImg.clone();
+ cv::Size objSize = srcImg.size();
+ objSize.width = objSize.width * 5;
+ cv::resize(enlargeImg, enlargeImg, objSize, 0, 0, cv::INTER_NEAREST);
+ for (int i = 6, i_max = (int)subpixPnt.size(); i < i_max; i++)
+ {
+ RgnSubPix a_subPix = subpixPnt[i];
+ int row = (int)(a_subPix.y + 0.5);
+ int col = (int)(a_subPix.x * 5 + 0.5);
+ enlargeImg.at(row, col)[0] = 0;
+ enlargeImg.at(row, col)[1] = 0;
+ enlargeImg.at(row, col)[2] = 255;
+ }
+ sprintf_s(filename, "%sresult\\%d_subpix.png", calibDataPath[grp], index);
+ cv::imwrite(filename, enlargeImg);
+
+ //淇濆瓨鏍℃鍚庣殑subpixData
+ sprintf_s(filename, "%sresult\\%d_calibSubpixData.txt", calibDataPath[grp], index);
+ saveCalibSubpixData(filename, calibSubpixPnt);
+
+#endif
+ sprintf_s(filename, "%sresult\\%d_3D_data.txt", calibDataPath[grp], index);
+ saveLineData(filename, resul3DPnts);
+ }
+ }
+
}
diff --git a/camAlgoSW_test/camAlgoSW_test.vcxproj b/camAlgoSW_test/camAlgoSW_test.vcxproj
index d9274f9..9c59262 100644
--- a/camAlgoSW_test/camAlgoSW_test.vcxproj
+++ b/camAlgoSW_test/camAlgoSW_test.vcxproj
@@ -78,11 +78,13 @@
true
- F:\ShangGu\ProductDev\AlgoDev\thirdParty\opencv\build\include;$(IncludePath)
+ F:\ShangGu\ProductDev\AlgoDev\thirdParty\opencv\build\include;$(IncludePath);F:\ShangGu\ProductDev\涓夎鍏夌浉鏈篭鐩告満寮鍙慭camAlgo_git\camAlgoSW\sourceCode
+ $(SolutionDir)build\$(Platform)\$(Configuration)\
false
- F:\ShangGu\ProductDev\AlgoDev\thirdParty\opencv\build\include;$(VC_IncludePath);$(WindowsSDK_IncludePath);
+ F:\ShangGu\ProductDev\AlgoDev\thirdParty\opencv\build\include;$(VC_IncludePath);$(WindowsSDK_IncludePath);;F:\ShangGu\ProductDev\涓夎鍏夌浉鏈篭鐩告満寮鍙慭camAlgo_git\camAlgoSW\sourceCode
+ $(SolutionDir)build\$(Platform)\$(Configuration)\
@@ -122,6 +124,8 @@
Console
true
+ F:\ShangGu\ProductDev\AlgoDev\thirdParty\opencv\build\x64\vc16\lib;..\build\x64\Debug;.\sourceCode\CG_frontEnd\lib\debug;%(AdditionalLibraryDirectories)
+ opencv_world480d.lib;camAlgoSW.lib;ImgAccd.lib;kernel32.lib;user32.lib;gdi32.lib;winspool.lib;comdlg32.lib;advapi32.lib;shell32.lib;ole32.lib;oleaut32.lib;uuid.lib;odbc32.lib;odbccp32.lib;%(AdditionalDependencies)
@@ -132,12 +136,15 @@
true
NDEBUG;_CONSOLE;%(PreprocessorDefinitions)
true
+ Disabled
Console
true
true
true
+ F:\ShangGu\ProductDev\AlgoDev\thirdParty\opencv\build\x64\vc16\lib;..\build\x64\Release;F:\ShangGu\ProductDev\涓夎鍏夌浉鏈篭鐩告満寮鍙慭camAlgo_git\camAlgoSW\sourceCode\CG_frontEnd\lib\debug;%(AdditionalLibraryDirectories)
+ opencv_world480.lib;camAlgoSW.lib;ImgAccd.lib;kernel32.lib;user32.lib;gdi32.lib;winspool.lib;comdlg32.lib;advapi32.lib;shell32.lib;ole32.lib;oleaut32.lib;uuid.lib;odbc32.lib;odbccp32.lib;%(AdditionalDependencies)