[manifolds] pinocchio-groups : return false for isNormalized()

Simple-Robotics · Dec 4, 2023 · d9f3189 · d9f3189
1 parent 21ea9ee
commit d9f3189
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/include/proxnlp/modelling/spaces/pinocchio-groups.hpp b/include/proxnlp/modelling/spaces/pinocchio-groups.hpp
@@ -84,6 +84,8 @@ struct PinocchioLieGroup
 
   PointType rand() const { return lg_.random(); }
   bool isNormalized(const ConstVectorRef &x) const {
+    if (x.size() < nx())
+      return false;
     return lg_.isNormalized(x);
   }
 };