Use hpp-model function isApprox to compare 2 configurations

  - in ManipulationPlanner::extend.
  - the difference with eigen method isApprox is that quaternions and opposite
    reprensent the same rotation.