diff --git a/object_manager/src/dynamic_object_compute_mask_server.cpp b/object_manager/src/dynamic_object_compute_mask_server.cpp index 1e9e717f..51e8fb3a 100644 --- a/object_manager/src/dynamic_object_compute_mask_server.cpp +++ b/object_manager/src/dynamic_object_compute_mask_server.cpp @@ -414,6 +414,7 @@ CloudPtr find_object_using_metaroom(std::string observation_xml, std::string obj registered_transform = room_transform; } + bool reg_server_called = false; if (registration_client.call(srv)) { ROS_INFO_STREAM("Registration done using the observation_registration_server service. Number of constraints "<::downsampleCloud(previous_observation_data.completeRoomCloud->makeShared()); pcl::transformPointCloud(*previous_interior_cloud, *previous_interior_cloud,registered_transform); +// { +// pcl::visualization::PointCloudColorHandlerCustom room_handler(observation_interior_cloud, 255, 0,0); +// p->addPointCloud (observation_interior_cloud,room_handler,"room"); +// pcl::visualization::PointCloudColorHandlerCustom views_handler(registered_views_cloud, 0, 255,0); +// p->addPointCloud (registered_views_cloud,views_handler,"views"); +// pcl::visualization::PointCloudColorHandlerCustom prev_handler(previous_interior_cloud, 0, 0, 255); +// p->addPointCloud (previous_interior_cloud,prev_handler,"clusters"); +// p->spin(); +// p->removeAllPointClouds(); +// } + // compute differences and update metaroom CloudPtr differenceRoomToPrevRoom(new Cloud); CloudPtr differencePrevRoomToRoom(new Cloud);