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
eedeacf5
Commit
eedeacf5
authored
May 23, 2023
by
wangdawei
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
test
parent
296d390b
Pipeline
#1536
canceled with stages
Changes
1
Pipelines
1
Show whitespace changes
Inline
Side-by-side
Showing
1 changed file
with
1 addition
and
1 deletion
+1
-1
adjust_ppk.cpp
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
+1
-1
No files found.
libs/locate_system/adjust_ppk_by_locate/adjust_ppk.cpp
View file @
eedeacf5
...
@@ -179,7 +179,6 @@ void AdjustPPK::CalLocalPose()
...
@@ -179,7 +179,6 @@ void AdjustPPK::CalLocalPose()
LocalCartesian
proj
(
center_
.
x
(),
center_
.
y
(),
center_
.
z
());
LocalCartesian
proj
(
center_
.
x
(),
center_
.
y
(),
center_
.
z
());
std
::
ofstream
ofs
(
ieBaseDir_
+
"/LocalPPK.txt"
,
ios
::
app
);
std
::
ofstream
ofs
(
ieBaseDir_
+
"/LocalPPK.txt"
,
ios
::
app
);
for
(
const
IERawData
&
rawPPK
:
rawData_
){
for
(
const
IERawData
&
rawPPK
:
rawData_
){
LOG_EVERY_N
(
INFO
,
10
)
<<
"rawPPK.unix_time: "
<<
rawPPK
.
unix_time
;
IsometryData
localPose
;
IsometryData
localPose
;
proj
.
Forward
(
rawPPK
.
latitude
,
rawPPK
.
longitude
,
rawPPK
.
height
,
proj
.
Forward
(
rawPPK
.
latitude
,
rawPPK
.
longitude
,
rawPPK
.
height
,
localPose
.
pose
.
translation
().
x
(),
localPose
.
pose
.
translation
().
x
(),
...
@@ -188,6 +187,7 @@ void AdjustPPK::CalLocalPose()
...
@@ -188,6 +187,7 @@ void AdjustPPK::CalLocalPose()
localPose
.
pose
.
linear
()
=
rawPPK
.
getOrientation
();
localPose
.
pose
.
linear
()
=
rawPPK
.
getOrientation
();
localPose
.
timestamp
=
rawPPK
.
unix_time
;
localPose
.
timestamp
=
rawPPK
.
unix_time
;
localPoseVec_
.
emplace_back
(
localPose
);
localPoseVec_
.
emplace_back
(
localPose
);
LOG_EVERY_N
(
INFO
,
10000
)
<<
"localPoseVec_.size(): "
<<
localPoseVec_
.
size
();
ofs
<<
setprecision
(
16
)
<<
localPose
.
timestamp
<<
", "
<<
localPose
.
pose
.
translation
().
x
()
ofs
<<
setprecision
(
16
)
<<
localPose
.
timestamp
<<
", "
<<
localPose
.
pose
.
translation
().
x
()
<<
", "
<<
localPose
.
pose
.
translation
().
y
()
<<
", "
<<
localPose
.
pose
.
translation
().
z
()
<<
endl
;
<<
", "
<<
localPose
.
pose
.
translation
().
y
()
<<
", "
<<
localPose
.
pose
.
translation
().
z
()
<<
endl
;
}
}
...
...
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