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
c8184429
Commit
c8184429
authored
Jun 15, 2023
by
wangdawei
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
revert to before test
parent
12cd7175
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
11 additions
and
12 deletions
+11
-12
adjust_ppk.cpp
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
+11
-12
No files found.
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
View file @
c8184429
...
@@ -83,10 +83,10 @@ void AdjustPPK::ReadBag(const string &bagPath)
...
@@ -83,10 +83,10 @@ void AdjustPPK::ReadBag(const string &bagPath)
continue
;
continue
;
}
}
PPointCloud
cloud
;
PPointCloud
cloud
;
//
if(cloudCnt_ % 20 != 0){
if
(
cloudCnt_
%
20
!=
0
){
//
cloudCnt_++;
cloudCnt_
++
;
//
continue;
continue
;
//
}
}
if
(
convert_
->
processScan
(
m
.
instantiate
<
pandar_msgs
::
PandarScan
>
(),
cloud
)){
if
(
convert_
->
processScan
(
m
.
instantiate
<
pandar_msgs
::
PandarScan
>
(),
cloud
)){
OnReceivedCloud
(
cloud
);
OnReceivedCloud
(
cloud
);
}
}
...
@@ -126,12 +126,12 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
...
@@ -126,12 +126,12 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
// }
// }
double
backPTime
=
cloud
.
back
().
timestamp
;
double
backPTime
=
cloud
.
back
().
timestamp
;
double
frontPTime
=
cloud
.
front
().
timestamp
;
double
frontPTime
=
cloud
.
front
().
timestamp
;
//
if(frontPTime < localPoseVec_.front().timestamp){
if
(
frontPTime
<
localPoseVec_
.
front
().
timestamp
){
//
return;
return
;
//
}
}
//
if(backPTime > localPoseVec_.back().timestamp){
if
(
backPTime
>
localPoseVec_
.
back
().
timestamp
){
//
return;
return
;
//
}
}
vector
<
IsometryData
>
periodPose
=
HandleLocalPPK
(
backPTime
,
frontPTime
);
vector
<
IsometryData
>
periodPose
=
HandleLocalPPK
(
backPTime
,
frontPTime
);
CloudPacket
cloudPacket
;
CloudPacket
cloudPacket
;
ros
::
Time
rosTime
;
ros
::
Time
rosTime
;
...
@@ -143,8 +143,7 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
...
@@ -143,8 +143,7 @@ void AdjustPPK::OnReceivedCloud(const PPointCloud &cloud)
// << " frontPTime: " << cloud.front().timestamp
// << " frontPTime: " << cloud.front().timestamp
// << " backPTime: " << cloud.back().timestamp;
// << " backPTime: " << cloud.back().timestamp;
pcl
::
io
::
savePCDFileBinary
(
ieBaseDir_
+
"/baseCloud/"
+
to_string
(
cloudPacket
.
timestamp
)
+
"_ori.pcd"
,
cloud
);
exit
(
0
);
for
(
size_t
i
=
0
;
i
<
cloud
.
size
();
i
++
){
for
(
size_t
i
=
0
;
i
<
cloud
.
size
();
i
++
){
if
(
i
%
5
!=
0
){
if
(
i
%
5
!=
0
){
continue
;
continue
;
...
...
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