Commit c2774e21 authored by Le Quang Anh's avatar Le Quang Anh
Browse files

Minor fix for assert normalized quaternion

The assert raises issue even when the calculation is performed properly,
because the assert checks even before `result` is fully
computed. This has been fixed by simply moving the assert line.
parent 2a5c7657
Pipeline #20091 failed with stage
in 12 minutes and 59 seconds
......@@ -112,8 +112,8 @@ class HPP_CONSTRAINTS_DLLAPI DifferentiableFunctionSet
result.vector().segment(row, f.outputSize()) = result_[i].vector();
row += f.outputSize();
++i;
assert(hpp::pinocchio::checkNormalized(result));
}
assert(hpp::pinocchio::checkNormalized(result));
}
void impl_jacobian(matrixOut_t jacobian, ConfigurationIn_t arg) const {
size_type row = 0;
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment