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
97d4dec7
Verified
Commit
97d4dec7
authored
Dec 14, 2019
by
Justin Carpentier
Browse files
joint/revolute: change order of operations
parent
af26ea70
Changes
1
Show whitespace changes
Inline
Side-by-side
src/multibody/joint/joint-revolute.hpp
View file @
97d4dec7
...
@@ -120,16 +120,16 @@ namespace pinocchio
...
@@ -120,16 +120,16 @@ namespace pinocchio
}
}
case
1
:
case
1
:
{
{
res
.
rotation
().
col
(
1
)
=
m
.
rotation
().
col
(
1
);
res
.
rotation
().
col
(
2
).
noalias
()
=
m_cos
*
m
.
rotation
().
col
(
2
)
+
m_sin
*
m
.
rotation
().
col
(
0
);
res
.
rotation
().
col
(
2
).
noalias
()
=
m_cos
*
m
.
rotation
().
col
(
2
)
+
m_sin
*
m
.
rotation
().
col
(
0
);
res
.
rotation
().
col
(
1
)
=
m
.
rotation
().
col
(
1
);
res
.
rotation
().
col
(
0
).
noalias
()
=
res
.
rotation
().
col
(
1
).
cross
(
res
.
rotation
().
col
(
2
));
res
.
rotation
().
col
(
0
).
noalias
()
=
res
.
rotation
().
col
(
1
).
cross
(
res
.
rotation
().
col
(
2
));
break
;
break
;
}
}
case
2
:
case
2
:
{
{
res
.
rotation
().
col
(
2
)
=
m
.
rotation
().
col
(
2
);
res
.
rotation
().
col
(
0
).
noalias
()
=
m_cos
*
m
.
rotation
().
col
(
0
)
+
m_sin
*
m
.
rotation
().
col
(
1
);
res
.
rotation
().
col
(
0
).
noalias
()
=
m_cos
*
m
.
rotation
().
col
(
0
)
+
m_sin
*
m
.
rotation
().
col
(
1
);
res
.
rotation
().
col
(
1
).
noalias
()
=
res
.
rotation
().
col
(
2
).
cross
(
res
.
rotation
().
col
(
0
));
res
.
rotation
().
col
(
1
).
noalias
()
=
res
.
rotation
().
col
(
2
).
cross
(
res
.
rotation
().
col
(
0
));
res
.
rotation
().
col
(
2
)
=
m
.
rotation
().
col
(
2
);
break
;
break
;
}
}
default:
default:
...
...
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