Commit e8b326d4 authored by wangdawei's avatar wangdawei

test

parent eedeacf5
Pipeline #1537 canceled with stages
...@@ -177,7 +177,7 @@ void AdjustPPK::CalLocalPose() ...@@ -177,7 +177,7 @@ void AdjustPPK::CalLocalPose()
{ {
localPoseVec_.reserve(rawData_.size()); localPoseVec_.reserve(rawData_.size());
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_){
IsometryData localPose; IsometryData localPose;
proj.Forward(rawPPK.latitude, rawPPK.longitude, rawPPK.height, proj.Forward(rawPPK.latitude, rawPPK.longitude, rawPPK.height,
...@@ -188,10 +188,10 @@ void AdjustPPK::CalLocalPose() ...@@ -188,10 +188,10 @@ void AdjustPPK::CalLocalPose()
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(); 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;
} }
ofs.close(); // ofs.close();
LOG(INFO) << "localPoseVec_.size(): " << localPoseVec_.size(); LOG(INFO) << "localPoseVec_.size(): " << localPoseVec_.size();
} }
......
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