Bug fix from Mylittledream: issue andyzeng#10

yqtl · Mar 30, 2018 · de8ac38 · de8ac38
1 parent 0148f01
commit de8ac38
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/ros-packages/catkin_ws/src/pose_estimation/src/getObjectPose.m b/ros-packages/catkin_ws/src/pose_estimation/src/getObjectPose.m
@@ -113,6 +113,7 @@
     [indicesNN,distsNN] = multiQueryKNNSearchImpl(backgroundPointCloud,objSegmPts',1);
 end
 objSegmPts(:,find(sqrt(distsNN) < 0.005)) = [];
+objSegmConf(:,find(sqrt(distsNN) < 0.005)) = [];
 if strcmp(sceneData.env,'shelf')
   objSegmPtsBg = extBin2Bg(1:3,1:3) * objSegmPts + repmat(extBin2Bg(1:3,4) + [0;0;0.01],1,size(objSegmPts,2));
   bgRot = vrrotvec2mat([0 1 0 -atan(0.025/0.20)]);