added keypoints 3d position computation