Adding mesh creating; Adding grasp planning with the 3d mesh; Adding filtering of grasps with correct pose;