File tree Expand file tree Collapse file tree 1 file changed +19
-0
lines changed Expand file tree Collapse file tree 1 file changed +19
-0
lines changed Original file line number Diff line number Diff line change @@ -116,6 +116,25 @@ BOOST_AUTO_TEST_CASE(test_SE3)
116116 }
117117}
118118
119+ BOOST_AUTO_TEST_CASE (test_SE3_expr)
120+ {
121+ using namespace pinocchio ;
122+
123+ SE3 amb = SE3::Random ();
124+ SE3 bmc = SE3::Random ();
125+
126+ SE3 amc_expected;
127+ SE3 amc_expr;
128+ SE3 amc_expr_noalias;
129+
130+ amc_expected = amb * bmc;
131+ amc_expr.expr () = amb.const_expr () * bmc.const_expr ();
132+ amc_expr_noalias.expr ().noalias () = amb.const_expr () * bmc.const_expr ();
133+
134+ BOOST_CHECK (amc_expected.toActionMatrix ().isApprox (amc_expr.toActionMatrix ()));
135+ BOOST_CHECK (amc_expected.toActionMatrix ().isApprox (amc_expr_noalias.toActionMatrix ()));
136+ }
137+
119138BOOST_AUTO_TEST_CASE (test_Motion)
120139{
121140 using namespace pinocchio ;
You can’t perform that action at this time.
0 commit comments