Unverified Commit 5befd28e authored by Guilhem Saurel's avatar Guilhem Saurel Committed by GitHub
Browse files

Merge pull request #51 from jmirabel/devel

Update to changes in hpp-fcl.
parents 644e6014 4e7760c7
......@@ -324,8 +324,7 @@ std::vector<fcl::Vec3f> computeRectangleContactLocalTr(const rbprm::RbPrmFullBod
fcl::Transform3f roWorld, roEffector;
roWorld.setRotation(state.contactRotation_.at(name));
roWorld.setTranslation(position);
roEffector = roWorld;
roEffector.inverse();
roEffector = roWorld.inverse();
fcl::Vec3f z_axis(0, 0, 1);
fcl::Matrix3f rotationLocal = tools::GetRotationMatrix(z_axis, limb->normal_);
if (limb->contactType_ == _3_DOF) {
......
Markdown is supported
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