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
21600f58
Commit
21600f58
authored
Apr 30, 2018
by
jcarpent
Browse files
[Spatial] Add additionnal insight to a serious BUG on Inertia::vxi operation
parent
86fb541d
Pipeline
#643
failed with stage
in 31 minutes and 43 seconds
Changes
1
Pipelines
1
Show whitespace changes
Inline
Side-by-side
src/spatial/inertia.hpp
View file @
21600f58
...
...
@@ -407,8 +407,12 @@ namespace se3
//// Block 2,2
skewSquare
(
-
v
.
linear
(),
mc
,
Iout_
.
template
block
<
3
,
3
>(
ANGULAR
,
ANGULAR
));
// typename Symmetric3::AlphaSkewSquare mcxcx(I.mass(),I.lever());
// const Symmetric3 I_mcxcx(I.inertia() - mcxcx);
// TODO: I do not why, but depending on the CPU, these three lines can give
// wrong output.
// typename Symmetric3::AlphaSkewSquare mcxcx(I.mass(),I.lever());
// const Symmetric3 I_mcxcx(I.inertia() - mcxcx);
// Iout_.template block<3,3>(ANGULAR,ANGULAR) += I_mcxcx.vxs(v.angular());
Symmetric3
mcxcx
(
typename
Symmetric3
::
AlphaSkewSquare
(
I
.
mass
(),
I
.
lever
()));
Iout_
.
template
block
<
3
,
3
>(
ANGULAR
,
ANGULAR
)
+=
I
.
inertia
().
vxs
(
v
.
angular
());
Iout_
.
template
block
<
3
,
3
>(
ANGULAR
,
ANGULAR
)
-=
mcxcx
.
vxs
(
v
.
angular
());
...
...
Write
Preview
Supports
Markdown
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