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
e8b326d4
Commit
e8b326d4
authored
May 23, 2023
by
wangdawei
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
test
parent
eedeacf5
Pipeline
#1537
canceled with stages
Changes
1
Pipelines
1
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 @
e8b326d4
...
@@ -177,7 +177,7 @@ void AdjustPPK::CalLocalPose()
...
@@ -177,7 +177,7 @@ void AdjustPPK::CalLocalPose()
{
{
localPoseVec_
.
reserve
(
rawData_
.
size
());
localPoseVec_
.
reserve
(
rawData_
.
size
());
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_
){
IsometryData
localPose
;
IsometryData
localPose
;
proj
.
Forward
(
rawPPK
.
latitude
,
rawPPK
.
longitude
,
rawPPK
.
height
,
proj
.
Forward
(
rawPPK
.
latitude
,
rawPPK
.
longitude
,
rawPPK
.
height
,
...
@@ -188,10 +188,10 @@ void AdjustPPK::CalLocalPose()
...
@@ -188,10 +188,10 @@ void AdjustPPK::CalLocalPose()
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
();
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;
}
}
ofs
.
close
();
//
ofs.close();
LOG
(
INFO
)
<<
"localPoseVec_.size(): "
<<
localPoseVec_
.
size
();
LOG
(
INFO
)
<<
"localPoseVec_.size(): "
<<
localPoseVec_
.
size
();
}
}
...
...
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