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
10cd413b
Commit
10cd413b
authored
Apr 21, 2020
by
Rohan Budhiraja
Browse files
fix minor implementation bug.
parent
314792e6
Changes
2
Hide whitespace changes
Inline
Side-by-side
src/multibody/liegroup/special-euclidean.hpp
View file @
10cd413b
...
...
@@ -416,8 +416,8 @@ namespace pinocchio
//TODO: Remove aliasing
Jout
.
template
topRows
<
2
>()
=
Jtmp6
.
template
topLeftCorner
<
2
,
2
>()
*
Jout
.
template
topRows
<
2
>();
Jout
.
template
topRows
<
2
>().
noalias
()
+=
Jtmp6
.
template
topRightCorner
<
2
,
1
>()
*
Jout
.
template
bottomRows
<
1
>();
Jout
.
template
bottomRows
<
1
>()
.
noalias
()
=
Jtmp6
.
template
bottom
Lef
tCorner
<
1
,
2
>()
*
Jout
.
template
to
p
Rows
<
2
>();
Jout
.
template
bottomRows
<
1
>()
+=
Jtmp6
.
template
bottom
Righ
tCorner
<
1
,
1
>()
*
Jout
.
template
bot
to
m
Rows
<
1
>();
Jout
.
template
bottomRows
<
1
>()
=
Jtmp6
.
template
bottom
Righ
tCorner
<
1
,
1
>()
*
Jout
.
template
bot
to
m
Rows
<
1
>();
Jout
.
template
bottomRows
<
1
>()
.
noalias
()
+=
Jtmp6
.
template
bottom
Lef
tCorner
<
1
,
2
>()
*
Jout
.
template
to
p
Rows
<
2
>();
}
...
...
unittest/joint-configurations.cpp
View file @
10cd413b
...
...
@@ -300,10 +300,6 @@ BOOST_AUTO_TEST_CASE ( dIntegrate_assignementop_test )
results
[
0
].
setZero
();
dIntegrate
(
model
,
qs
,
vs
,
results
[
0
],
ARG1
,
SETTO
);
dIntegrateTransportInPlace
(
model
,
qs
,
vs
,
J
[
1
],
ARG1
);
std
::
cerr
<<
Eigen
::
MatrixXd
(
results
[
0
].
row
(
11
))
<<
std
::
endl
;
std
::
cerr
<<
Eigen
::
MatrixXd
(
J
[
0
].
row
(
11
))
<<
std
::
endl
;
std
::
cerr
<<
Eigen
::
MatrixXd
(
J
[
1
].
row
(
11
))
<<
std
::
endl
;
std
::
cerr
<<
J
[
1
]
-
results
[
0
]
*
J
[
0
]
<<
std
::
endl
;
BOOST_CHECK
(
J
[
1
].
isApprox
(
results
[
0
]
*
J
[
0
]));
}
...
...
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