Commit eedeacf5 authored by wangdawei's avatar wangdawei

test

parent 296d390b
Pipeline #1536 canceled with stages
...@@ -179,7 +179,6 @@ void AdjustPPK::CalLocalPose() ...@@ -179,7 +179,6 @@ void AdjustPPK::CalLocalPose()
LocalCartesian proj(center_.x(), center_.y(), center_.z()); LocalCartesian proj(center_.x(), center_.y(), center_.z());
std::ofstream ofs(ieBaseDir_ + "/LocalPPK.txt", ios::app); std::ofstream ofs(ieBaseDir_ + "/LocalPPK.txt", ios::app);
for(const IERawData& rawPPK : rawData_){ for(const IERawData& rawPPK : rawData_){
LOG_EVERY_N(INFO, 10) << "rawPPK.unix_time: " << rawPPK.unix_time;
IsometryData localPose; IsometryData localPose;
proj.Forward(rawPPK.latitude, rawPPK.longitude, rawPPK.height, proj.Forward(rawPPK.latitude, rawPPK.longitude, rawPPK.height,
localPose.pose.translation().x(), localPose.pose.translation().x(),
...@@ -188,6 +187,7 @@ void AdjustPPK::CalLocalPose() ...@@ -188,6 +187,7 @@ void AdjustPPK::CalLocalPose()
localPose.pose.linear() = rawPPK.getOrientation(); localPose.pose.linear() = rawPPK.getOrientation();
localPose.timestamp = rawPPK.unix_time; localPose.timestamp = rawPPK.unix_time;
localPoseVec_.emplace_back(localPose); localPoseVec_.emplace_back(localPose);
LOG_EVERY_N(INFO, 10000) << "localPoseVec_.size(): " << localPoseVec_.size();
ofs << setprecision(16) << localPose.timestamp << ", " << localPose.pose.translation().x() ofs << setprecision(16) << localPose.timestamp << ", " << localPose.pose.translation().x()
<< ", " << localPose.pose.translation().y() << ", " << localPose.pose.translation().z() << endl; << ", " << localPose.pose.translation().y() << ", " << localPose.pose.translation().z() << endl;
} }
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment