#include<stdio.h>
#include<math.h>
#include <exception>
#include <iostream>
#include <vector>
#include <fstream>
#include<sstream>
#include <stdlib.h>
#include <Eigen/Core>
#include <Eigen/Dense>
#include<Eigen/Eigen>
#include<Eigen/Geometry>
#include<math.h>
#include <exception>
#include <iostream>
#include <vector>
#include <fstream>
#include <boost/concept_check.hpp>
using namespace Eigen;
using namespace std;
int main()
{
/* string imu_file,end_file;
imu_file="/home/xs/SimlateIMU/indoor/end_3939.txt";
end_file="/home/xs/SimlateIMU/indoor/end.txt";
ifstream imuptr(imu_file.c_str());//读取imu
ofstream sampleptr(end_file);
string imuStr;
int countLine=0;
int tag=0;
std::string tempValue[7];
for(int i=0;i<7;i++)
tempValue[i]="";
while(getline(imuptr,imuStr))//以空格区分
{ countLine++;
if(countLine%12==0)
continue;
// if(tag==0)
// {
// if(countLine%3==0)
// {
// tag=1;
// continue;
// }
// }
// else
// {
// if(countLine%4==0)
// {
// tag=0;
// countLine;
// }
// }
std::stringstream linestream(imuStr);
std::string value;
int valueNum=0;
while(getline(linestream,value,','))
{
if(valueNum>=0&&valueNum<7)
tempValue[valueNum]=value.c_str();
++valueNum;
}
sampleptr<<tempValue[0]<<","<<tempValue[1]<<","<<tempValue[2]<<","<<tempValue[3]<<","<<tempValue[4]<<","<<tempValue[5]<<","<<tempValue[6]<<endl;
//countLine++;
}
sampleptr.close();
imuptr.close();
// timeptr.close();
return 0;*/
//添加新的时间戳
string time_file, imu_file,end_file;
time_file="/home/xs/SimlateIMU/indoor/imunew.csv";
imu_file="/home/xs/SimlateIMU/indoor/end_3593.txt";
end_file="/home/xs/SimlateIMU/indoor/end.txt";
ifstream timeptr(time_file.c_str());//读取时间
ifstream imuptr(imu_file.c_str());//读取imu
ofstream sampleptr(end_file);
// sampleptr<<"% timestamp(sec), $a_{is}^s$(m/s^2), $\Omega_{is}^s$(rad/sec), $v_{ws}^w$(m/s), $gravity^e$."<<endl;
string imuStr,timeStr;
int countLine=0;
std::string tempVa
ubuntu下文件读写
最新推荐文章于 2023-08-31 16:16:23 发布