Modify computation of weights in weighed distance.
Modify computation of weights in weighed distance.

  Take into account motion implied by rotation of leaf joints. This way, all
  weights are positive, unlike in previous implementation.

humanoid-path-planner/hpp-core