Skip to content
GitLab
Menu
Projects
Groups
Snippets
Help
Help
Support
Community forum
Keyboard shortcuts
?
Submit feedback
Contribute to GitLab
Sign in / Register
Toggle navigation
Menu
Open sidebar
Stack Of Tasks
pinocchio
Commits
4de5e1a4
Commit
4de5e1a4
authored
Jun 17, 2020
by
Joseph Mirabel
Browse files
Implement VectorSpaceOperationTpl::dIntegrate_product_impl
parent
a212763e
Changes
1
Hide whitespace changes
Inline
Side-by-side
src/multibody/liegroup/vector-space.hpp
View file @
4de5e1a4
...
...
@@ -150,6 +150,30 @@ namespace pinocchio
}
}
template
<
class
Config_t
,
class
Tangent_t
,
class
JacobianIn_t
,
class
JacobianOut_t
>
void
dIntegrate_product_impl
(
const
Config_t
&
,
const
Tangent_t
&
,
const
JacobianIn_t
&
Jin
,
JacobianOut_t
&
Jout
,
bool
,
const
ArgumentPosition
,
const
AssignmentOperatorType
op
)
const
{
switch
(
op
)
{
case
SETTO
:
Jout
=
Jin
;
break
;
case
ADDTO
:
Jout
+=
Jin
;
break
;
case
RMTO
:
Jout
-=
Jin
;
break
;
default:
assert
(
false
&&
"Wrong Op requesed value"
);
break
;
}
}
template
<
class
Config_t
,
class
Tangent_t
,
class
JacobianIn_t
,
class
JacobianOut_t
>
void
dIntegrateTransport_dq_impl
(
const
Eigen
::
MatrixBase
<
Config_t
>
&
/*q*/
,
...
...
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