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
495625de
Commit
495625de
authored
May 24, 2023
by
wangdawei
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
test
parent
3aaaa3ad
Hide whitespace changes
Inline
Side-by-side
Showing
2 changed files
with
5 additions
and
5 deletions
+5
-5
adjust_ppk.cpp
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
+2
-2
adjust_ppk.h
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.h
+3
-3
No files found.
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
View file @
495625de
...
...
@@ -56,7 +56,7 @@ void AdjustPPK::ReadBag(const string &bagPath)
for
(;
viewIterator
!=
view
->
end
();
viewIterator
++
)
{
const
rosbag
::
MessageInstance
&
m
=
*
viewIterator
;
LOG_EVERY_N
(
INFO
,
1
)
<<
setprecision
(
15
)
<<
"m.getTime(): "
<<
m
.
getTime
().
toSec
();
//
LOG_EVERY_N(INFO, 1) << setprecision(15) << "m.getTime(): " << m.getTime().toSec();
if
(
!
m
.
isType
<
pandar_msgs
::
PandarScan
>
()){
viewIterator
++
;
continue
;
...
...
@@ -94,7 +94,7 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
pcl_conversions
::
fromPCL
(
cloud
.
header
.
stamp
,
rosTime
);
cloudPacket
.
timestamp
=
rosTime
.
toSec
();
cloudPacket
.
cloud
.
reserve
(
cloud
.
size
());
LOG
(
INFO
)
<<
setprecision
(
15
)
<<
"OnReceivedCloud: "
<<
cloudPacket
.
timestamp
LOG
_EVERY_N
(
INFO
,
99
)
<<
setprecision
(
15
)
<<
"OnReceivedCloud: "
<<
cloudPacket
.
timestamp
<<
" cloud.size()"
<<
cloud
.
size
();
// pcl::io::savePCDFileBinary(ieBaseDir_ + "/" + to_string(cloudPacket.timestamp) + ".pcd", cloud);
for
(
const
auto
&
p
:
cloud
){
...
...
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.h
View file @
495625de
...
...
@@ -20,9 +20,9 @@ struct PPKPeriod{
double
endTime
=
-
1
;
int
InPeriod
(
double
timestamp
){
LOG
(
INFO
)
<<
setprecision
(
15
)
<<
"timestamp "
<<
timestamp
<<
" startTime "
<<
startTime
<<
" endTime "
<<
endTime
;
//
LOG(INFO) << setprecision(15) << "timestamp " << timestamp
//
<< " startTime " << startTime
//
<< " endTime " << endTime;
if
(
timestamp
<
startTime
){
return
-
1
;
}
...
...
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