Contact normal used in the shooter algorithm[1] are not correctly computed, exept when the environment is composed of fcl::BV_OBBRSS nodes, with modelType==BVH_MODEL_TRIANGLES.
[1] the normals used for the equilibrium tests and all the other algorithms are corrects.
See https://github.com/humanoid-path-planner/hpp-rbprm/pull/57
Contact normal used in the shooter algorithm [1] are not correctly computed, exept when the environment is composed of fcl::BV_OBBRSS nodes, with modelType==BVH_MODEL_TRIANGLES.
[1] the normals used for the equilibrium tests and all the other algorithms are corrects.