From 4bb31ff0f4d14d21055297bcdf08688afe8ecb96 Mon Sep 17 00:00:00 2001
From: Valenza Florian <fvalenza@laas.fr>
Date: Wed, 3 Aug 2016 16:14:41 +0200
Subject: [PATCH] [C++] Fix distance_impl for derived joints
---
src/multibody/joint/joint-revolute-unbounded.hpp | 2 +-
1 file changed, 1 insertion(+), 1 deletion(-)
diff --git a/src/multibody/joint/joint-revolute-unbounded.hpp b/src/multibody/joint/joint-revolute-unbounded.hpp
index 70465dc4c..4ce217e4e 100644
--- a/src/multibody/joint/joint-revolute-unbounded.hpp
+++ b/src/multibody/joint/joint-revolute-unbounded.hpp
@@ -236,7 +236,7 @@ namespace se3
double distance_impl(const Eigen::VectorXd & q0,const Eigen::VectorXd & q1) const
{
- return fabs(difference_impl(q0,q1)[0]);
+ return difference_impl(q0,q1).norm();
}
ConfigVector_t neutralConfiguration_impl() const
--
GitLab