Qt+Opencv实现四步相移

#include "rebuildhandle.h" #include <QDebug> rebuildHandle::rebuildHandle(QObject *parent): QObject(parent) { } void rebuildHandle::perform() { readSourceImg(); performStep4(); } void rebuildHandle::readSourceImg() { QDir sourceImgDir("../CtrlGUI/cal/after"); QStringList filter("*.bmp"); QFileInfoList imgInfoList = sourceImgDir.entryInfoList(filter,QDir::Files,QDir::Time|QDir::Reversed); for (int i = 0; i < imgInfoList.count(); i++) { sourceImgs.append(imread(imgInfoList.at(i).filePath().toStdString(),0)); } } void rebuildHandle::performStep4() { Mat_<double> target(964,1292,CV_64FC1);//最终相位 // 求出三个频率的相位主值 for(int i=0;i<964;i++) { for(int j=0;j<1292;j++) { double indexHigh=0;double indexMid=0;double indexLow=0; indexHigh = atan2((sourceImgs.at(3).ptr<double>(i)[j]-sourceImgs.at(1).ptr<double>(i)[j]), (sourceImgs.at(2).ptr<double>(i)[j]-sourceImgs.at(0).ptr<double>(i)[j])); indexMid = atan2((sourceImgs.at(7).ptr<double>(i)[j]-sourceImgs.at(5).ptr<double>(i)[j]), (sourceImgs.at(6).ptr<double>(i)[j]-sourceImgs.at(4).ptr<double>(i)[j])); indexLow = atan2((sourceImgs.at(11).ptr<double>(i)[j]-sourceImgs.at(9).ptr<double>(i)[j]), (sourceImgs.at(10).ptr<double>(i)[j]-sourceImgs.at(8).ptr<double>(i)[j])); QCoreApplication::processEvents(); indexHigh += 3.14159; indexMid += 3.14159; indexLow += 3.14159; double indexTmp1=0;double indexTmp2=0; indexTmp1=round((indexMid*5-indexHigh)/(2*3.14159)); indexTmp2=indexHigh+indexTmp1*2*3.14159; double indexTarget1=0;double indexTarget2=0; indexTarget1=round((indexLow*20-indexTmp2)/(10*3.14159)); indexTarget2=indexTmp2+indexTarget1*10*3.14159; target.ptr<double>(i)[j] = indexTarget2; } } fitPhase(target); } void rebuildHandle::fitPhase(Mat &sourceMat) { Mat height(sourceMat.rows,sourceMat.cols,CV_8UC1);//最终显示结果 QFile dataFile("../CtrlGUI/cal/pointCloud.txt"); QTextStream stream; stream.setDevice(&dataFile); dataFile.open(QIODevice::Text|QIODevice::ReadWrite); for(int i=0;i<sourceMat.rows;i++) { for(int j=0;j<sourceMat.cols;j++) { double tmpa = pow((sourceImgs.at(3).ptr<double>(i)[j]-sourceImgs.at(1).ptr<double>(i)[j]),2); double tmpb = pow((sourceImgs.at(2).ptr<double>(i)[j]-sourceImgs.at(0).ptr<double>(i)[j]),2); if(sqrt(tmpa+tmpb)<=30) { height.ptr(i)[j] = 0; } else { height.ptr(i)[j] = 5-sourceMat.ptr<double>(i)[j]; stream<<i<<" "<<j<<" "<<height.ptr(i)[j]<<endl; } } } dataFile.close(); Mat att; applyColorMap(height,att,COLORMAP_BONE); imshow("phase",att); }