写代码的时候忽视了一个问题,导致写入的文件只有一行,反复调试最后发现是f.open()写错了位置,代码如下:
int count = 0;//判定“KF”的计数器
int num = 0;
fstream f;
while (!fin.eof())
{
string img_time, img_name, pose_time;
double tx, ty, tz, qx, qy, qz, qw; // tum格式
fin >> img_time >> img_name >> pose_time >> tx >> ty >> tz >> qx >> qy >> qz >> qw;
Isometry3d T(Quaterniond(qw, qx, qy, qz)); // 定义4*4的变换矩阵
T.pretranslate(Vector3d(tx, ty, tz));// refer:slambook2/ch3/useGeometry.cpp
// Isometry3d Twr(Quaterniond(qw, qx, qy, qz));
// Twr.pretranslate(Vector3d(tx, ty, tz));
// cout << T.matrix() << endl;
img_path.push_back(img_name);
poses.push_back(T);
img_times.push_back(img_time);
if(count % delta == 0)
{
// 判定成功的话被选为“KF“
KF_img_path.push_back(img_name);
KF_poses.push_back(poses[count]);
KF_img_times.push_back(img_time);
// cout << KF_img_path[num] << endl;
// cout << KF_poses[num].matrix() << endl;
cout << KF_img_times[num] << endl;
f.open("/home/h/slam_pub_Datasets/TUM/rgbd_dataset_freiburg1_room/KF_rgb/selected_KF.txt", ios::out | ios::app);//问题出现在这里
f << KF_img_times[num] << endl;
num++;
}
count++;
}
f.close();
fin.close();
在外部声明了一个文件操作对象f后,一着急直接把f.open()写入while循环中的if里面了,写入的文件只有一行数据,但是cout打印的数据是正常的,所以判断为文件的写入方式有问题,
f.open()在每次使用的时候都会打开一个新的文件流,会将之前的覆盖掉,所以这就是查看写好的文件只有一行的原因了。
解决方法:
将f.open()放到while外面即可。