输入文件名和TriangulatePoints的结果。
void savePLY(const std::string& ply3D_filename, cv::Mat& pnts)
{
time_t t = time(0);
char tmp1[64];
strftime(tmp1, sizeof(tmp1), "%m%d-%H%M%S", localtime(&t));
string PLY3D_filename = ply3D_filename + tmp1 + ".PLY";
ofstream fout(PLY3D_filename);
fout << "ply\n";
fout << "format ascii 1.0\n";
int pointNumber = pnts.cols;
fout << "element vertex " << pointNumber << endl;
fout << "property float x\n";
fout << "property float y\n";
fout << "property float z\n";
//fout << "property uchar red\n";
//fout << "property uchar green\n";
//fout << "property uchar blue\n";
fout << "end_header\n";
float* pnts3D_row1 = pnts.ptr<float>(0);
float* pnts3D_row2 = pnts.ptr<float>(1);
float* pnts3D_row3 = pnts.ptr<float>(2);
float* pnts3D_row4 = pnts.ptr<float>(3);
for (int i = 0; i < pointNumber; i++)
{
float pnts3D_data4 = *(pnts3D_row4 + i);
float pnts3D_data1 = *(pnts3D_row1 + i) / pnts3D_data4;
float pnts3D_data2 = *(pnts3D_row2 + i) / pnts3D_data4;
float pnts3D_data3 = *(pnts3D_row3 + i) / pnts3D_data4;
fout << pnts3D_data1 / 1000.0f << ' ' << pnts3D_data2 / 1000.0f << ' ' << pnts3D_data3 / 1000.0f << endl;
}
fout.close();
}