Commit 7a49468c authored by wangdawei's avatar wangdawei

add down sample gnss result

parent 3f402e7e
......@@ -394,10 +394,8 @@ vector<IsometryData> AdjustPPK::HandleLocalPPK(
<< ", " << rawData.n_velocity << ", " << rawData.e_velocity << ", " << rawData.u_velocity
<< ", " << rpy.x() << ", " << rpy.y() << ", " << rpy.z() << ", " << rawData.status << endl;
if(ppkIndex_ % 10 == 0){
ofs << setprecision(16) << "qx" << ", " << rawData.week << ", " << rawData.seconds
<< ", " << calibedBLH.x() << ", " << calibedBLH.y() << ", " << calibedBLH.z()
<< ", " << rawData.n_velocity << ", " << rawData.e_velocity << ", " << rawData.u_velocity
<< ", " << rpy.x() << ", " << rpy.y() << ", " << rpy.z() << ", " << rawData.status << endl;
ofs << setprecision(16) << pose.timestamp << ", " << mapPose_.translation().x() << ", "
<< mapPose_.translation().y() << ", " << mapPose_.translation().z() << endl;
}
if(pose.timestamp >= frontPTime){
IsometryData calibedPose;
......
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