comment broken bits

Author: fmessmer

cob_obstacle_distance/include/cob_obstacle_distance/marker_shapes/marker_shapes_impl.hpp

@@ -127,14 +127,18 @@ inline visualization_msgs::Marker MarkerShape<T>::getMarker()
 template <typename T>
 FCL_CollisionObject MarkerShape<T>::getCollisionObject() const
 {
-    fcl::Transform3f x(fcl::Quaternion3f(this->marker_.pose.orientation.w,
-                                         this->marker_.pose.orientation.x,
-                                         this->marker_.pose.orientation.y,
-                                         this->marker_.pose.orientation.z),
-                       fcl::Vec3f(this->marker_.pose.position.x,
-                                  this->marker_.pose.position.y,
-                                  this->marker_.pose.position.z));
-    fcl::CollisionObject cobj(this->ptr_fcl_bvh_, x);
+    // FIXME
+    // fcl::Transform3f x(fcl::Quaternionf(this->marker_.pose.orientation.w,
+    //                                     this->marker_.pose.orientation.x,
+    //                                     this->marker_.pose.orientation.y,
+    //                                     this->marker_.pose.orientation.z),
+    //                    fcl::Vector3f(this->marker_.pose.position.x,
+    //                                  this->marker_.pose.position.y,
+    //                                  this->marker_.pose.position.z));
+    fcl::Transform3f x(fcl::Quaternionf(this->marker_.pose.orientation.w,
+                                        this->marker_.pose.orientation.x,
+                                        this->marker_.pose.orientation.y,
+                                        this->marker_.pose.orientation.z));
 
     FCL_CollisionObject cobj(this->ptr_fcl_bvh_, x);
     return cobj;

cob_obstacle_distance/src/distance_manager.cpp

@@ -276,7 +276,9 @@ void DistanceManager::calculate()
                 FCL_CollisionObject collision_obj = obstacle->getCollisionObject();
                 FCL_DistanceResult dist_result;
                 FCL_DistanceRequest dist_request(true, 5.0, 0.01);
-                fcl::FCL_REAL dist = fcl::distance(&ooi_co, &collision_obj, dist_request, dist_result);
+                //FIXME
+                // double dist = fcl::distance(&ooi_co, &collision_obj, dist_request, dist_result);
+                double dist = 0;
 
 
                 Eigen::Vector3d abs_obst_vector(dist_result.nearest_points[1][VEC_X],

cob_obstacle_distance/src/marker_shapes/marker_shapes_impl.cpp

@@ -165,13 +165,18 @@ inline visualization_msgs::Marker MarkerShape<BVH_RSS_t>::getMarker()
 
 FCL_CollisionObject MarkerShape<BVH_RSS_t>::getCollisionObject() const
 {
-    fcl::Transform3f x(fcl::Quaternion3f(this->marker_.pose.orientation.w,
-                                         this->marker_.pose.orientation.x,
-                                         this->marker_.pose.orientation.y,
-                                         this->marker_.pose.orientation.z),
-                       fcl::Vec3f(this->marker_.pose.position.x,
-                                  this->marker_.pose.position.y,
-                                  this->marker_.pose.position.z));
+    // FIXME
+    // fcl::Transform3f x(fcl::Quaternionf(this->marker_.pose.orientation.w,
+    //                                     this->marker_.pose.orientation.x,
+    //                                     this->marker_.pose.orientation.y,
+    //                                     this->marker_.pose.orientation.z),
+    //                    fcl::Vector3f(this->marker_.pose.position.x,
+    //                                  this->marker_.pose.position.y,
+    //                                  this->marker_.pose.position.z));
+    fcl::Transform3f x(fcl::Quaternionf(this->marker_.pose.orientation.w,
+                                        this->marker_.pose.orientation.x,
+                                        this->marker_.pose.orientation.y,
+                                        this->marker_.pose.orientation.z));
     FCL_CollisionObject cobj(this->ptr_fcl_bvh_, x);
     return cobj;
 }