Skip to content
Projects
Groups
Snippets
Help
Loading...
Sign in / Register
Toggle navigation
L
localize_for_ppk
Project
Project
Details
Activity
Cycle Analytics
Repository
Repository
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Charts
Issues
0
Issues
0
List
Board
Labels
Milestones
Merge Requests
0
Merge Requests
0
CI / CD
CI / CD
Pipelines
Jobs
Schedules
Charts
Packages
Packages
Wiki
Wiki
Snippets
Snippets
Members
Members
Collapse sidebar
Close sidebar
Activity
Graph
Charts
Create a new issue
Jobs
Commits
Issue Boards
Open sidebar
wangdawei
localize_for_ppk
Commits
f9e0b3c0
Commit
f9e0b3c0
authored
Jun 01, 2023
by
wangdawei
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
test
parent
59c20c98
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
4 additions
and
4 deletions
+4
-4
adjust_ppk.cpp
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
+4
-4
No files found.
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
View file @
f9e0b3c0
...
...
@@ -69,7 +69,7 @@ void AdjustPPK::ReadBag(const string &bagPath)
continue
;
}
PPointCloud
cloud
;
if
(
cloudCnt_
%
1
0
!=
0
){
if
(
cloudCnt_
%
2
0
!=
0
){
cloudCnt_
++
;
continue
;
}
...
...
@@ -150,7 +150,7 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
PointCloudJ
mathedCloud
;
pcl
::
transformPointCloud
(
*
cloudInfo
.
frame
,
mathedCloud
,
mapPose_
.
cast
<
float
>
());
pcl
::
io
::
savePCDFileBinary
(
ieBaseDir_
+
"/baseCloud/"
+
to_string
(
cloudInfo
.
timestamp
)
+
"_matched.pcd"
,
mathedCloud
);
//
pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(cloudInfo.timestamp) + "_matched.pcd", mathedCloud);
}
void
AdjustPPK
::
LoadPPK
()
...
...
@@ -324,13 +324,13 @@ bool AdjustPPK::Undisort(
return
false
;
}
PointCloudInter
::
Ptr
frame
=
GetBaseFrame
(
rawFrame
);
pcl
::
io
::
savePCDFileBinary
(
ieBaseDir_
+
"/baseCloud/"
+
to_string
(
rawFrame
.
cloud
.
front
().
time
)
+
"_base.pcd"
,
*
frame
);
//
pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(rawFrame.cloud.front().time) + "_base.pcd", *frame);
Isometry3d
framePose
,
increasePose
;
PointCloudJ
::
Ptr
undisortedFrame
(
new
PointCloudJ
);
PointCloudJ
mappedFrame
;
CloudPreprocess
::
Instance
()
->
Undisort
(
frame
,
undisortedFrame
,
&
mappedFrame
,
periodPose
.
back
().
timestamp
,
&
periodPose
,
framePose
,
increasePose
);
pcl
::
io
::
savePCDFileBinary
(
ieBaseDir_
+
"/baseCloud/"
+
to_string
(
rawFrame
.
timestamp
)
+
"_mapped.pcd"
,
mappedFrame
);
//
pcl::io::savePCDFileBinary(ieBaseDir_ + "/baseCloud/" + to_string(rawFrame.timestamp) + "_mapped.pcd", mappedFrame);
cloudInfo
.
frame
=
undisortedFrame
;
cloudInfo
.
filterPoseInfo
.
increasePose
=
increasePose
;
cloudInfo
.
timestamp
=
rawFrame
.
timestamp
;
...
...
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment