fix issue #590

expose IdVisitor of all other collision geometries

python/collision-geometries.cc

@@ -34,6 +34,7 @@
 
 #include <eigenpy/eigenpy.hpp>
 #include <eigenpy/eigen-to-python.hpp>
+#include <eigenpy/id.hpp>
 
 #include "fcl.hh"
 #include "deprecation.hh"
@@ -116,7 +117,8 @@ void exposeBVHModel(const std::string& bvname) {
       .def("clone", &BVH::clone, doxygen::member_func_doc(&BVH::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<BVH>())
-      .def(SerializableVisitor<BVH>());
+      .def(SerializableVisitor<BVH>())
+      .def(eigenpy::IdVisitor<BVH>());
 }
 
 template <typename BV>
@@ -157,7 +159,8 @@ void exposeHeightField(const std::string& bvname) {
                                     Geometry::getBV),
            bp::return_internal_reference<>())
       .def_pickle(PickleObject<Geometry>())
-      .def(SerializableVisitor<Geometry>());
+      .def(SerializableVisitor<Geometry>())
+      .def(eigenpy::IdVisitor<Geometry>());
 }
 
 struct ConvexBaseWrapper {
@@ -284,7 +287,8 @@ void exposeShapes() {
       .def("clone", &Box::clone, doxygen::member_func_doc(&Box::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Box>())
-      .def(SerializableVisitor<Box>());
+      .def(SerializableVisitor<Box>())
+      .def(eigenpy::IdVisitor<Box>());
 
   class_<Capsule, bases<ShapeBase>, shared_ptr<Capsule>>(
       "Capsule", doxygen::class_doc<Capsule>(), no_init)
@@ -296,7 +300,8 @@ void exposeShapes() {
       .def("clone", &Capsule::clone, doxygen::member_func_doc(&Capsule::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Capsule>())
-      .def(SerializableVisitor<Capsule>());
+      .def(SerializableVisitor<Capsule>())
+      .def(eigenpy::IdVisitor<Capsule>());
 
   class_<Cone, bases<ShapeBase>, shared_ptr<Cone>>(
       "Cone", doxygen::class_doc<Cone>(), no_init)
@@ -308,7 +313,8 @@ void exposeShapes() {
       .def("clone", &Cone::clone, doxygen::member_func_doc(&Cone::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Cone>())
-      .def(SerializableVisitor<Cone>());
+      .def(SerializableVisitor<Cone>())
+      .def(eigenpy::IdVisitor<Cone>());
 
   class_<ConvexBase, bases<ShapeBase>, shared_ptr<ConvexBase>, noncopyable>(
       "ConvexBase", doxygen::class_doc<ConvexBase>(), no_init)
@@ -356,7 +362,8 @@ void exposeShapes() {
       .DEF_RO_CLASS_ATTRIB(Convex<Triangle>, num_polygons)
       .def("polygons", &ConvexWrapper<Triangle>::polygons)
       .def_pickle(PickleObject<Convex<Triangle>>())
-      .def(SerializableVisitor<Convex<Triangle>>());
+      .def(SerializableVisitor<Convex<Triangle>>())
+      .def(eigenpy::IdVisitor<Convex<Triangle>>());
 
   class_<Cylinder, bases<ShapeBase>, shared_ptr<Cylinder>>(
       "Cylinder", doxygen::class_doc<Cylinder>(), no_init)
@@ -369,7 +376,8 @@ void exposeShapes() {
            doxygen::member_func_doc(&Cylinder::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Cylinder>())
-      .def(SerializableVisitor<Cylinder>());
+      .def(SerializableVisitor<Cylinder>())
+      .def(eigenpy::IdVisitor<Cylinder>());
 
   class_<Halfspace, bases<ShapeBase>, shared_ptr<Halfspace>>(
       "Halfspace", doxygen::class_doc<Halfspace>(), no_init)
@@ -383,7 +391,8 @@ void exposeShapes() {
            doxygen::member_func_doc(&Halfspace::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Halfspace>())
-      .def(SerializableVisitor<Halfspace>());
+      .def(SerializableVisitor<Halfspace>())
+      .def(eigenpy::IdVisitor<Halfspace>());
 
   class_<Plane, bases<ShapeBase>, shared_ptr<Plane>>(
       "Plane", doxygen::class_doc<Plane>(), no_init)
@@ -396,7 +405,8 @@ void exposeShapes() {
       .def("clone", &Plane::clone, doxygen::member_func_doc(&Plane::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Plane>())
-      .def(SerializableVisitor<Plane>());
+      .def(SerializableVisitor<Plane>())
+      .def(eigenpy::IdVisitor<Plane>());
 
   class_<Sphere, bases<ShapeBase>, shared_ptr<Sphere>>(
       "Sphere", doxygen::class_doc<Sphere>(), no_init)
@@ -407,7 +417,8 @@ void exposeShapes() {
       .def("clone", &Sphere::clone, doxygen::member_func_doc(&Sphere::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Sphere>())
-      .def(SerializableVisitor<Sphere>());
+      .def(SerializableVisitor<Sphere>())
+      .def(eigenpy::IdVisitor<Sphere>());
 
   class_<Ellipsoid, bases<ShapeBase>, shared_ptr<Ellipsoid>>(
       "Ellipsoid", doxygen::class_doc<Ellipsoid>(), no_init)
@@ -420,7 +431,8 @@ void exposeShapes() {
            doxygen::member_func_doc(&Ellipsoid::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<Ellipsoid>())
-      .def(SerializableVisitor<Ellipsoid>());
+      .def(SerializableVisitor<Ellipsoid>())
+      .def(eigenpy::IdVisitor<Ellipsoid>());
 
   class_<TriangleP, bases<ShapeBase>, shared_ptr<TriangleP>>(
       "TriangleP", doxygen::class_doc<TriangleP>(), no_init)
@@ -434,7 +446,8 @@ void exposeShapes() {
            doxygen::member_func_doc(&TriangleP::clone),
            return_value_policy<manage_new_object>())
       .def_pickle(PickleObject<TriangleP>())
-      .def(SerializableVisitor<TriangleP>());
+      .def(SerializableVisitor<TriangleP>())
+      .def(eigenpy::IdVisitor<TriangleP>());
 }
 
 boost::python::tuple AABB_distance_proxy(const AABB& self, const AABB& other) {
@@ -584,7 +597,8 @@ void exposeCollisionGeometries() {
            //         (AABB::*)(const Vec3f &)>(&AABB::expand)),
            bp::return_internal_reference<>())
       .def_pickle(PickleObject<AABB>())
-      .def(SerializableVisitor<AABB>());
+      .def(SerializableVisitor<AABB>())
+      .def(eigenpy::IdVisitor<AABB>());
 
   def("translate", (AABB(*)(const AABB&, const Vec3f&)) & translate,
       bp::args("aabb", "t"), "Translate the center of AABB by t");