Visualize best grasp

This commit is contained in:
Michel Breyer
2021-09-03 11:50:14 +02:00
parent 98abe3789d
commit f43688023b
3 changed files with 18 additions and 10 deletions

View File

@@ -24,7 +24,7 @@ class NextBestView(MultiViewPolicy):
nbv, ig = views[i], gains[i]
if self.check_stopping_criteria(ig):
self.vis.clear_views()
self.vis.clear_views(len(views))
self.done = True
else:
return nbv.inv() # the controller expects T_cam_base