Commit eedeacf5 authored by wangdawei's avatar wangdawei

test

parent 296d390b
Pipeline #1536 canceled with stages
......@@ -179,7 +179,6 @@ void AdjustPPK::CalLocalPose()
LocalCartesian proj(center_.x(), center_.y(), center_.z());
std::ofstream ofs(ieBaseDir_ + "/LocalPPK.txt", ios::app);
for(const IERawData& rawPPK : rawData_){
LOG_EVERY_N(INFO, 10) << "rawPPK.unix_time: " << rawPPK.unix_time;
IsometryData localPose;
proj.Forward(rawPPK.latitude, rawPPK.longitude, rawPPK.height,
localPose.pose.translation().x(),
......@@ -188,6 +187,7 @@ void AdjustPPK::CalLocalPose()
localPose.pose.linear() = rawPPK.getOrientation();
localPose.timestamp = rawPPK.unix_time;
localPoseVec_.emplace_back(localPose);
LOG_EVERY_N(INFO, 10000) << "localPoseVec_.size(): " << localPoseVec_.size();
ofs << setprecision(16) << localPose.timestamp << ", " << localPose.pose.translation().x()
<< ", " << 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