Skip to content
GitLab
Explore
Sign in
Primary navigation
Search or go to…
Project
I
imu
Manage
Activity
Members
Labels
Plan
Issues
Issue boards
Milestones
Wiki
Code
Merge requests
Repository
Branches
Commits
Tags
Repository graph
Compare revisions
Snippets
Deploy
Releases
Model registry
Monitor
Incidents
Service Desk
Analyze
Value stream analytics
Contributor analytics
Repository analytics
Model experiments
Help
Help
Support
GitLab documentation
Compare GitLab plans
Community forum
Contribute to GitLab
Provide feedback
Keyboard shortcuts
?
Snippets
Groups
Projects
Show more breadcrumbs
mobile_robotics
wolf_projects
wolf_lib
plugins
imu
Commits
2e8c29ca
Commit
2e8c29ca
authored
2 years ago
by
Mederic Fourmy
Browse files
Options
Downloads
Patches
Plain Diff
[skip-ci] little renaming
parent
cf80004f
No related branches found
No related tags found
1 merge request
!54
devel->main
Changes
1
Hide whitespace changes
Inline
Side-by-side
Showing
1 changed file
src/processor/processor_imu.cpp
+7
-7
7 additions, 7 deletions
src/processor/processor_imu.cpp
with
7 additions
and
7 deletions
src/processor/processor_imu.cpp
+
7
−
7
View file @
2e8c29ca
...
@@ -259,7 +259,7 @@ void ProcessorImu::bootstrap()
...
@@ -259,7 +259,7 @@ void ProcessorImu::bootstrap()
CaptureBasePtr
first_capture
=
bootstrapOrigin
();
CaptureBasePtr
first_capture
=
bootstrapOrigin
();
TimeStamp
t_current
=
last_ptr_
->
getBuffer
().
back
().
ts_
;
TimeStamp
t_current
=
last_ptr_
->
getBuffer
().
back
().
ts_
;
VectorComposite
transfo
rmation
(
"PO"
);
VectorComposite
transfo
_w_l
(
"PO"
);
switch
(
params_motion_Imu_
->
bootstrap_method
)
switch
(
params_motion_Imu_
->
bootstrap_method
)
{
{
case
ParamsProcessorImu
::
BootstrapMethod
::
BOOTSTRAP_STATIC
:
case
ParamsProcessorImu
::
BootstrapMethod
::
BOOTSTRAP_STATIC
:
...
@@ -282,11 +282,11 @@ void ProcessorImu::bootstrap()
...
@@ -282,11 +282,11 @@ void ProcessorImu::bootstrap()
const
auto
&
g_w
=
gravity
();
//
const
auto
&
g_w
=
gravity
();
//
const
auto
&
p_w_l
=
Vector3d
::
Zero
();
// will pivot around the origin
const
auto
&
p_w_l
=
Vector3d
::
Zero
();
// will pivot around the origin
Quaterniond
q_w_l
=
Quaterniond
::
FromTwoVectors
(
g_l
,
g_w
);
//
Quaterniond
q_w_l
=
Quaterniond
::
FromTwoVectors
(
g_l
,
g_w
);
//
transfo
rmation
.
at
(
'P'
)
=
p_w_l
;
//
transfo
_w_l
.
at
(
'P'
)
=
p_w_l
;
//
transfo
rmation
.
at
(
'O'
)
=
q_w_l
.
coeffs
();
//
transfo
_w_l
.
at
(
'O'
)
=
q_w_l
.
coeffs
();
//
// Transform problem to new reference
// Transform problem to new reference
getProblem
()
->
transform
(
transfo
rmation
);
getProblem
()
->
transform
(
transfo
_w_l
);
// Recompute states at keyframes if they were provided by this processor
// Recompute states at keyframes if they were provided by this processor
bool
recomputed
=
recomputeStates
();
bool
recomputed
=
recomputeStates
();
...
@@ -331,11 +331,11 @@ void ProcessorImu::bootstrap()
...
@@ -331,11 +331,11 @@ void ProcessorImu::bootstrap()
const
auto
&
g_w
=
gravity
();
//
const
auto
&
g_w
=
gravity
();
//
const
auto
&
p_w_l
=
Vector3d
::
Zero
();
// will pivot around the origin
const
auto
&
p_w_l
=
Vector3d
::
Zero
();
// will pivot around the origin
Quaterniond
q_w_l
=
Quaterniond
::
FromTwoVectors
(
g_l
,
g_w
);
//
Quaterniond
q_w_l
=
Quaterniond
::
FromTwoVectors
(
g_l
,
g_w
);
//
transfo
rmation
.
at
(
'P'
)
=
p_w_l
;
//
transfo
_w_l
.
at
(
'P'
)
=
p_w_l
;
//
transfo
rmation
.
at
(
'O'
)
=
q_w_l
.
coeffs
();
//
transfo
_w_l
.
at
(
'O'
)
=
q_w_l
.
coeffs
();
//
// Transform problem to new reference
// Transform problem to new reference
getProblem
()
->
transform
(
transfo
rmation
);
getProblem
()
->
transform
(
transfo
_w_l
);
// Recompute states at keyframes if they were provided by this processor
// Recompute states at keyframes if they were provided by this processor
bool
recomputed
=
recomputeStates
();
bool
recomputed
=
recomputeStates
();
...
...
This diff is collapsed.
Click to expand it.
Preview
0%
Loading
Try again
or
attach a new file
.
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Save comment
Cancel
Please
register
or
sign in
to comment