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
d842cdc0
Commit
d842cdc0
authored
Jun 01, 2023
by
wangdawei
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
test
parent
a56d535e
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
5 additions
and
2 deletions
+5
-2
adjust_ppk.cpp
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
+5
-2
No files found.
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
View file @
d842cdc0
...
...
@@ -72,7 +72,10 @@ void AdjustPPK::ReadBag(const string &bagPath)
for
(;
viewIterator
!=
view
->
end
();
viewIterator
++
)
{
const
rosbag
::
MessageInstance
&
m
=
*
viewIterator
;
// LOG_EVERY_N(INFO, 100) << setprecision(15) << "m.getTime(): " << m.getTime().toSec();
LOG_EVERY_N
(
INFO
,
100
)
<<
setprecision
(
15
)
<<
"m.getTime(): "
<<
m
.
getTime
().
toSec
();
if
(
m
.
getTime
().
toSec
()
<
1683762409
){
continue
;
}
if
(
!
m
.
isType
<
pandar_msgs
::
PandarScan
>
()){
continue
;
}
...
...
@@ -346,7 +349,7 @@ bool AdjustPPK::Undisort(
cloudInfo
.
filterPoseInfo
.
filterPose
=
framePose
;
Quaterniond
q
(
increasePose
.
linear
());
Vector3d
rpy
=
RotationQuaternionToEulerVector
(
q
);
LOG_EVERY_N
(
INFO
,
1
0
)
<<
setprecision
(
15
)
LOG_EVERY_N
(
INFO
,
1
)
<<
setprecision
(
15
)
<<
" periodPose.front(): "
<<
periodPose
.
front
().
timestamp
<<
" periodPose.back(): "
<<
periodPose
.
back
().
timestamp
<<
" increasePose: "
<<
increasePose
.
translation
().
transpose
()
...
...
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